dsky.ino

#include <Adafruit_NeoPixel.h>
#define PIN            6
#define NUMPIXELS      18
Adafruit_NeoPixel pixels = Adafruit_NeoPixel(NUMPIXELS, PIN, NEO_GRB + NEO_KHZ800);

#include "LedControl.h"
LedControl lc=LedControl(12,10,11,4);

#include "RTClib.h"
RTC_DS1307 rtc;

#include <Wire.h>
const int MPU_addr=0x69;  // I2C address of the MPU-6050
long imuval[7];
byte digitval[7][7];

byte keyVal = 20;
byte oldkey = 20;
bool fresh = 0;
byte action = 0;
byte currentaction = 0;
byte verb = 0;
byte verbnew[2];
byte verbold[2];
byte noun = 0;
byte nounnew[2];
byte nounold[2];
byte prog = 0;
byte prognew[2];
byte progold[2];
byte count = 0;
byte mode = 0;
byte oldmode = 0;
bool toggle = 0;
byte togcount = 0;
bool error = 0;
bool newAct = 0;
byte audioTrack = 1;


void setup() {
	pinMode(A0, INPUT);
	pinMode(A1, INPUT);
	pinMode(A2, INPUT);
	pinMode(A7, INPUT);
	pinMode(7, OUTPUT);
	digitalWrite(7, LOW);
	randomSeed(analogRead(A7));
	pixels.begin();

	for(int index = 0; index < 4; index++){
		lc.shutdown(index,false); 
		lc.setIntensity(index,8);
		lc.clearDisplay(index); 
	}

	Wire.begin();
	Wire.beginTransmission(MPU_addr);
	Wire.write(0x6B);  // PWR_MGMT_1 register
	Wire.write(0);     // set to zero (wakes up the MPU-6050)
	Wire.endTransmission(true);

	rtc.begin();

	Serial.begin(9600);

	//  Serial.println("Read Value from Analog pin & Print value");
}

void loop() {
	if (prog == 62){}
	if (prog == 70){}
	if (prog == 69){}  
	if (mode == 0) {mode0();}
	if (mode == 1) {mode1();}
	if (mode == 2) {mode2();}
	if (mode == 3) {mode3();}
	if (mode == 4) {mode4();}


	if (togcount == 4) {togcount = 0;if (toggle == 0) {toggle = 1;}else{toggle = 0;}}
	togcount++;
	if (action == 3){ togcount = 4;delay(200);} else {delay(100);}

	delay(100);

	if(action == 1) {action1();} // V16N17 ReadIMU
	if(action == 2) {action2();} // V16N36 ReadTime
	if(action == 3) {action3();} // V16N43 Read GPS
	if(action == 5) {action5();} // V21N36 Set The Time
	if(action == 6) {action6();} // V21N37 Set The Date
	Serial.print(verb);
	Serial.print("  ");
	Serial.print(noun);
	Serial.print("  ");
	Serial.println(action);
}

void mode0() {//no action set just reading the kb
	if (newAct == 1) {validateAct();} else {
		if(error == 1){flasher();}
		keyVal = readkb();
		processkey0();  
	}
}

void mode1() {//inputing the verb
	lampit(0,150,0, 2);
	flashkr();
	if(error == 1){flasher();}
	keyVal = readkb();
	processkey1(); 
}

void mode2() {//inputing the noun
	lampit(0,150,0, 0);
	flashkr();
	if(error == 1){flasher();}
	keyVal = readkb();
	processkey2(); 
}

void mode3() {//inputing the program
	lampit(0,150,0, 1);
	flashkr();
	if(error == 1){flasher();}
	keyVal = readkb();
	processkey3();
}

void mode4() {
	for (int index = 0; index < 4; index++){lampit(0,150,0, index);}
	for (int index = 4; index < 11; index++) {lampit(100,100,0, index);}
	for (int index = 11; index < 18; index++) {lampit(100,100,100, index);}
	for (int index = 0; index < 4; index++) {
		for (int indexb = 0; indexb < 6; indexb++){
			setdigits(index,indexb,8);
		}
	}
	delay(5000);
	for (int index = 0; index < 4; index++){lampit(0,0,0, index);}
	for (int index = 4; index < 11; index++) {lampit(0,0,0, index);}
	for (int index = 11; index < 18; index++) {lampit(0,0,0, index);}
	for (int index = 0; index < 4; index++) {lc.clearDisplay(index); }
	verbnew[0] = verbold[0]; verbnew[1] = verbold[1];
	verb = ((verbold[0] * 10) + verbold[1]);
	if (verb == 0) {lc.setRow(0,0,0);lc.setRow(0,1,0);}
	else{setdigits(0, 0,verbold[0]);setdigits(0, 1,verbold[1]);}
	if (prog == 0) {lc.setRow(0,2,0);lc.setRow(0,3,0);}
	else{setdigits(0, 0,prognew[0]);setdigits(0, 1,prognew[1]);}
	if (noun == 0) {lc.setRow(0,4,0);lc.setRow(0,5,0);}
	else{setdigits(0, 4,nounnew[0]);setdigits(0, 5,nounnew[1]);}
	keyVal = 20;
	mode = 0;
	validateAct(); 
}


void action1() {
	readimu(); 
}

void action2() { // Reads Time from RTC
	DateTime now = rtc.now();
	imuval[4] = (now.hour());
	imuval[5] = (now.minute());
	imuval[6] = ((now.second() * 100));
	setDigits();  
}

void action3(){     //Read GPS
	digitalWrite(7,HIGH);
	delay(20);
	byte data[83];
	while((Serial.available()) > 0) {int x =  Serial.read(); }
	while((Serial.available()) < 1) {int x = 1; }
	delay(6);
	int index = 0;
	while(Serial.available() > 0){
		data[index] = Serial.read();
		delayMicroseconds(960);
		index++;
		if(index >= 72) {index = 71; }
	}
	int lat = 0;
	int lon = 0;
	int alt = 0;
	if (count < 10){
		count++;
		lat = (((data[18] - 48) * 1000) + ((data[19] -48) * 100) + ((data[20] - 48) * 10) + ((data[21] - 48)));
		lon = (((data[30] - 48) * 10000) + ((data[31] - 48) * 1000) + ((data[32] -48) * 100) + ((data[33] - 48) * 10) + ((data[34] - 48)));
		alt = (((data[52] -48) * 100) + ((data[53] - 48) * 10) + ((data[54] - 48)));
	}
	else {
		count++;
		lat = (((data[21] - 48) * 10000) + ((data[23] - 48) * 1000) + ((data[24] -48) * 100) + ((data[25] - 48) * 10) + ((data[26] - 48)));
		lon = (((data[34] - 48) * 10000) + ((data[36] - 48) * 1000) + ((data[37] -48) * 100) + ((data[38] - 48) * 10) + ((data[39] - 48)));
		alt = (((data[52] -48) * 100) + ((data[53] - 48) * 10) + ((data[54] - 48)));
	}
	if (count > 25) {count = 0;}
	if (data[28] != 78) {lat = ((lat - (lat + lat)));}
	if (data[41] != 69) {lon = ((lon - (lon + lon)));} 
	imuval[4] = lat;
	imuval[5] = lon;
	imuval[6] = alt;
	digitalWrite(7,LOW);
	setDigits();  
}

void action5() { // Sets Time To RTC

	DateTime now = rtc.now();
	int NYR = now.year();
	int NMO = now.month();
	int NDY = now.day();
	int NHR = now.hour();
	int NMI = now.minute();
	int NSE = now.second();
	while(keyVal == 15){ keyVal = readkb();}

	while(keyVal != 15){
		Serial.println(keyVal);
		keyVal = readkb();
		if(keyVal != oldkey) {
			oldkey = keyVal;
			if(keyVal == 12) {NHR++;}
			if(keyVal == 13) {NHR--;}
			if( NHR > 23) {NHR = 0;}
			if(NHR < 0) {NHR = 23;}
		}
		imuval[4] = NHR; imuval[5] =  NMI; imuval[6] = (NSE *100);
		setDigits();
		delay(200);
		lc.clearDisplay(1);
		delay(50); 
	}
	while(keyVal == 15){ keyVal = readkb();}
	while(keyVal != 15){
		keyVal = readkb();
		if(keyVal != oldkey) {
			oldkey = keyVal;
			if(keyVal == 12) {NMI++;}
			if(keyVal == 13) {NMI--;}
			if( NMI > 59) {NMI = 0;}
			if(NMI < 0) {NMI = 59;} 
		}
		imuval[4] = NHR; imuval[5] =  NMI; imuval[6] = (NSE *100);
		setDigits(); 
		delay(200);
		lc.clearDisplay(2);
		delay(50); 
	}
	while(keyVal == 15){ keyVal = readkb();}
	while(keyVal != 15){
		keyVal = readkb();
		if(keyVal != oldkey) {
			oldkey = keyVal;
			if(keyVal == 12) {NSE++;}
			if(keyVal == 13) {NSE--;} 
			if( NSE > 59) {NSE = 0;}
			if(NSE < 0) {NSE = 59;}
		}
		imuval[4] = NHR; imuval[5] =  NMI; imuval[6] = (NSE *100);
		setDigits();
		delay(200);
		lc.clearDisplay(3);
		delay(50);  
	}
	rtc.adjust(DateTime(NYR,NMO,NDY,NHR , NMI , NSE));
	action = 2; setdigits(0, 0, 1);setdigits(0, 1, 6);verbold[0] = 1; verbold[1] = 6; verb = 16; 
}

void action6(){
	byte setyear[4];
	byte setmonth[2];
	byte setday[2];
	byte sethour[2];
	byte setminiut[2];
	byte setsecond[2];
	DateTime now = rtc.now();
	int NYR = now.year();
	int NMO = now.month();
	int NDY = now.day();
	int NHR = now.hour();
	int NMI = now.minute();
	int NSE = now.second();

	rtc.adjust(DateTime(((setyear[0] * 1000) + (setyear[1] * 100) + (setyear[2] * 10) + (setyear[3])), ((setmonth[0] * 10) + (setmonth[1])),((setday[0] * 10) + (setday[1])), NHR,NMI,NSE)); 
}

void mode11() {
	compAct(); 
}

int readkb() { 
	int value_row1 = analogRead(A0);
	int value_row2 = analogRead(A1);Serial.println(value_row2);
	int value_row3 = analogRead(A2);
	if ((value_row1 > 930)&&(value_row2 > 930)&&(value_row3 > 930)) {return 20 ;}// no key
	else if (value_row1 < 225) return 10 ; // Verb
	else if (value_row1 < 370) return 12 ; // +
	else if (value_row1 < 510) return 7 ;
	else if (value_row1 < 650) return 8 ;
	else if (value_row1 < 790) return 9 ;
	else if (value_row1 < 930) return 18 ;  // Clear

	else if (value_row2 < 200) return 11 ;  // Noun
	else if (value_row2 < 330) return 13 ;  // -
	else if (value_row2 < 455) return 4 ;
	else if (value_row2 < 577) return 5 ;
	else if (value_row2 < 700) return 6 ;
	else if (value_row2 < 823) return 14 ;  // Program
	else if (value_row2 < 930) return 15 ;  // Enter

	else if (value_row3 < 225) return 0 ; 
	else if (value_row3 < 370) return 1 ;
	else if (value_row3 < 510) return 2 ;
	else if (value_row3 < 650) return 3 ;
	else if (value_row3 < 790) return 16 ; // Key Rel
	else if (value_row3 < 930) return 17 ; // Reset
}

void processkey0() {

	if(keyVal != oldkey) { fresh = 1; oldkey = keyVal; }

	if((keyVal == 10) && (fresh == 1)){mode = 1; fresh = 0; byte keeper = verb; 
		for(int index = 0; keeper >= 10; keeper = (keeper - 10)) { index ++; verbold[0] = index; }
		for(int index = 0;keeper >= 1; keeper = (keeper - 1)) { index ++; verbold[1] = index; }}//verb

	if((keyVal == 11) && (fresh == 1)){mode = 2;fresh = 0; byte keeper = noun;
		for(int index = 0; keeper >= 10; keeper = (keeper - 10)) { index ++; nounold[0] = index; }
		for(int index = 0;keeper >= 1; keeper = (keeper - 1)) { index ++; nounold[1] = index; }}//noun

	if((keyVal == 14) && (fresh == 1)){mode = 3; fresh = 0;}//program
	if((keyVal == 17) && (fresh == 1)){error = 0;lampit(0,0,0, 13); fresh = 0;} //resrt reeor
}

void processkey1() {
	if(keyVal == oldkey){fresh = 0;} else { fresh = 1; oldkey = keyVal; 
		if((error == 1) && (keyVal == 17) && (fresh == 1)){error = 0;lampit(0,0,0, 13); fresh = 0;} //resrt reeor
		if((keyVal == 15) && (fresh == 1)) {
			fresh = 0;
			verb = ((verbnew[0] * 10) + (verbnew[1]));
			if((verb != 16) && (verb != 21) && (verb != 35) && (verb != 0)) {error = 1;verb = ((verbold[0] * 10) + verbold[1]);}
			else {

				lampit(0,0,0, 13);
				mode = 0;lampit(0,0,0, 14);lampit(0,0,0, 2);count = 0; fresh = 0; error = 0; newAct = 1;
			}}

		if((keyVal == 16) && (fresh == 1)){mode = oldmode;lampit(0,0,0, 14);lampit(0,0,0, 2);count = 0; fresh = 0;
			if (verb == 0) {lc.setRow(0,0,0);lc.setRow(0,1,0);} else{setdigits(0, 0,verbold[0]);setdigits(0, 1,verbold[1]);}}//verb 
		if((keyVal == 11) && (fresh == 1)){mode = 2;lampit(0,0,0, 2);count = 0; fresh = 0;}//noun
		if((keyVal == 14) && (fresh == 1)){mode = 3;lampit(0,0,0, 2);count = 0; fresh = 0;}//program
		if((keyVal < 10)&&(count < 2)) { verbnew[count] = keyVal;setdigits(0, count, keyVal);count++;fresh = 0;}
	}
}
void processkey2() {
	if(keyVal == oldkey){fresh = 0;} else { fresh = 1; oldkey = keyVal; 
		if((error == 1) && (keyVal == 17) && (fresh == 1)){error = 0;lampit(0,0,0, 13); fresh = 0;} //resrt reeor
		if((keyVal == 15) && (fresh == 1)) {fresh = 0;
			noun = ((nounnew[0] * 10) + (nounnew[1]));fresh = 0;
			if((noun != 17) && (noun != 36) && (noun != 43) && (noun != 68) && (noun != 0)) {error = 1; noun = ((nounold[0] * 10) + nounold[1]);  }
			else {
				lampit(0,0,0, 13);
				mode = 0;lampit(0,0,0, 14);lampit(0,0,0, 0);count = 0; fresh = 0; error = 0; newAct = 1;
			}}


		if((keyVal == 16) && (fresh == 1)){mode = oldmode;lampit(0,0,0, 14);lampit(0,0,0, 0);count = 0; fresh = 0;
			if (noun == 0) {lc.setRow(0,4,0);lc.setRow(0,5,0);} else{setdigits(0, 4,nounold[0]);setdigits(0, 5,nounold[1]);}}//verb 
		if((keyVal == 10) && (fresh == 1)){mode = 1;lampit(0,0,0, 0);count = 0; fresh = 0;}//verb
		if((keyVal == 14) && (fresh == 1)){mode = 3;lampit(0,0,0, 0);count = 0; fresh = 0;}//program
		if((keyVal < 10)&&(count < 2)) {nounnew[count] = keyVal;setdigits(0, (count + 4), keyVal);count++;}
	}
}
void processkey3() {
	if((error == 1) && (keyVal == 17) && (fresh == 1)){error = 0;lampit(0,0,0, 13); fresh = 0;} //resrt reeor
	if((keyVal == 15) && (fresh == 1)) {prog = ((prognew[0] * 10) + (prognew[1]));fresh = 0;
		if((prog != 16) && (prog != 21) && (prog != 35) && (prog != 62) && (prog != 69) &&(prog != 70) && (prog != 0)) {error = 1;} else {
			progold[0] = prognew[0]; progold[1] = prognew[1];lampit(0,0,0, 13);
			mode = 0;lampit(0,0,0, 14);lampit(0,0,0, 1);count = 0; fresh = 0; error = 0; newAct = 1;
		}}

	if(keyVal != oldkey) { fresh = 1; oldkey = keyVal; }
	if((keyVal == 16) && (fresh == 1)){mode = oldmode;lampit(0,0,0, 14);lampit(0,0,0, 1);count = 0; fresh = 0;}//verb 
	if((keyVal == 11) && (fresh == 1)){mode = 2;lampit(0,0,0, 1);count = 0; fresh = 0;}//noun
	if((keyVal == 10) && (fresh == 1)){mode = 1;lampit(0,0,0, 1);count = 0; fresh = 0;}//verb
	if((keyVal < 10)&&(count < 2)) {prognew[count] = keyVal;setdigits(0, (count + 2), keyVal);count++;}
}

void processkeytime(){

}

void compAct(){
	int randNumb = random(10, 30); 
	if ((randNumb == 15) || (randNumb == 25)) {lampit(0,150,0,3);}
	else {lampit(0,0,0,3);}
	if ((randNumb == 17) || (randNumb == 25)) {lampit(90,90,90,17);}
	else {lampit(0,0,0,17);}
}
void lampit(byte r, byte g, byte b , int lamp) {

	pixels.setPixelColor(lamp, pixels.Color(r,g,b)); // Set it the way we like it.
	pixels.show(); // This sends the updated pixel color to the hardware.

}
void setdigits(byte maxim, byte digit, byte value){

	lc.setDigit(maxim,digit,value,false);
}
void flashkr() {
	if(toggle == 0) {lampit(100,100,100, 14);} else {lampit(0,0,0, 14);}

}
void flasher() {
	if(toggle == 0) {lampit(100,100,100, 13);} else {lampit(0,0,0, 13);}
}

void validateAct(){
	if(verb == 35) {mode = 4; newAct = 0;}// Lamp Test
	else if((verb == 16) && (noun == 17)) {action = 1;newAct = 0;}//Display IMU Attitude
	else if((verb == 16) && (noun == 36)) {action = 2;newAct = 0;}//Display RTC Time 
	else if((verb == 16) && (noun == 43)) {action = 3;newAct = 0;count = 0;}//Display current GPS
	else if((verb == 16) && (noun == 68)) {action = 4;newAct = 0;}//Display Range With 1202 ERROR
	else if((verb == 21) && (noun == 36)) {action = 5;newAct = 0;}//set time
	else if((verb == 21) && (noun == 37)) {action = 6;newAct = 0;}//set date

	else{newAct = 0;action = 0;}
}

void readimu(){
	compAct();
	Wire.beginTransmission(MPU_addr);
	Wire.write(0x3B);  // starting with register 0x3B (ACCEL_XOUT_H)
	Wire.endTransmission(false);
	Wire.requestFrom(MPU_addr,14,true);  // request a total of 14 registers
	imuval[0]=Wire.read()<<8|Wire.read();  // 0x3B (ACCEL_XOUT_H) & 0x3C (ACCEL_XOUT_L)    
	imuval[1]=Wire.read()<<8|Wire.read();  // 0x3D (ACCEL_YOUT_H) & 0x3E (ACCEL_YOUT_L)
	imuval[2]=Wire.read()<<8|Wire.read();  // 0x3F (ACCEL_ZOUT_H) & 0x40 (ACCEL_ZOUT_L)
	imuval[3]=Wire.read()<<8|Wire.read();  // 0x41 (TEMP_OUT_H) & 0x42 (TEMP_OUT_L)
	imuval[4]=Wire.read()<<8|Wire.read();  // 0x43 (GYRO_XOUT_H) & 0x44 (GYRO_XOUT_L)
	imuval[5]=Wire.read()<<8|Wire.read();  // 0x45 (GYRO_YOUT_H) & 0x46 (GYRO_YOUT_L)
	imuval[6]=Wire.read()<<8|Wire.read();  // 0x47 (GYRO_ZOUT_H) & 0x48 (GYRO_ZOUT_L)
	imuval[3] = (imuval[3]/340.00+36.53);//equation for temperature in degrees C from datasheet
	/* Serial.print("AcX = "); Serial.print(imuval[0]);
	   Serial.print(" | AcY = "); Serial.print(imuval[1]);
	   Serial.print(" | AcZ = "); Serial.print(imuval[2]);
	   Serial.print(" | Tmp = "); Serial.print(imuval[3]);  
	   Serial.print(" | GyX = "); Serial.print(imuval[4]);
	   Serial.print(" | GyY = "); Serial.print(imuval[5]);
	   Serial.print(" | GyZ = "); Serial.println(imuval[6]);
	 */ 
	setDigits();      

}
void setDigits(){
	for (int indexa = 0; indexa < 8; indexa ++){
		for (int index = 0; index < 7; index++) {
			digitval[indexa][index]=0;      
		}
	}
	for (int indexa = 0; indexa < 7; indexa ++){
		if (imuval[indexa] < 0) {imuval[indexa] = (imuval[indexa] - (imuval[indexa] + imuval[indexa])); digitval[indexa][0] = 1;}
		else {digitval[indexa][0] = 0;}
		for(int index = 0; imuval[indexa] >= 100000; imuval[indexa] = (imuval[indexa] - 100000)) {index++;}
		for(int index = 0; imuval[indexa] >= 10000; imuval[indexa] = (imuval[indexa] - 10000)) {index ++;  digitval[indexa][1] = index; }
		for(int index = 0; imuval[indexa] >= 1000; imuval[indexa] = (imuval[indexa] - 1000)) { index ++; digitval[indexa][2] = index; }
		for(int index = 0; imuval[indexa] >= 100; imuval[indexa] = (imuval[indexa] - 100)) { index ++; digitval[indexa][3] = index; }
		for(int index = 0; imuval[indexa] >= 10; imuval[indexa] = (imuval[indexa] - 10)) { index ++; digitval[indexa][4] = index; }
		for(int index = 0; imuval[indexa] >= 1; imuval[indexa] = (imuval[indexa] - 1)) { index ++; digitval[indexa][5] = index; }
	} 
	for(int index = 0; index < 3; index ++){
		// lc.clearDisplay(index+1);  
		for(int i=0;i<6;i++) {
			if (i == 0){
				if (digitval[(index +4)][i] == 1) {lc.setRow(index+1,i,B00100100);}
				else {lc.setRow(index+1,i,B01110100);}
			}
			else {
				lc.setDigit(index+1,i,digitval[index + 4][i],false);
			}
		} 
	}
}