// LORA_ARM_TX made from from AEStest and SPITEST // #define JOB_TX 1 #define JOB_MAILBOX 2 #define JOB_TEMP 3 #define JOB_TEST1 4 #define JOB JOB_TEST1 // from SPITest par 23jul18 rfm95 comms // reset=PA3=8, NSS=PA4=7, MOSI=PA7=4, CLK=PB0=3, MISO=PA6=5, DIO0=PB12=31 #define RESET 8 #define NSS 7 #define MOSI 4 #define CLK 3 #define MISO 5 #define DIO0PIN 31 // RGB led pins acive high #define RLED 17 #define GLED 18 #define BLED 19 #define ASENSE 12 #define BSENSE 13 #define CSENSE 15 #define NSENSE 14 #define ADRIVE 10 #define BDRIVE 9 #define CDRIVE 11 #define MAPLELED 33 #define DHT22 26 // pins used for mode selction options // opt0 = enable serial comms for debug // opt1 = enable fast transmit rate #define OPTION1 30 #define OPTION2 29 #define OPTION3 28 #define OPTION4 27 #define IRDRIVE 9 // REGISTERS in RFM95 #define REG_FIFO 0x00 #define REG_MODE 0x01 #define REG_FREQ_H 0x06 #define REG_FREQ_M 0x07 #define REG_FREQ_L 0x08 #define REG_PACONFIG 0x09 #define REG_FIFOADDRPTR 0x0D #define REG_FIFOTXBASEADDR 0X0E #define REG_FIFORXBASEADDR 0x0F #define REG_MODEMCONFIG 0x1D #define REG_MODEMCONFIG2 0x1E #define REG_SYMBTIMEOUT 0x1F #define REG_PREAMBLE_MSB 0x20 #define REG_PREAMBLE_LSB 0x21 #define REG_PAYLOADLENGTH 0x22 #define REG_MODEMCONFIG3 0x26 #define REG_NODEADR 0x33 #define REG_SYNC 0x39 #define REG_IMAGECAL 0x3B #define REG_DIOMAPPING1 0x40 // Mode constants #define MODE_SLEEP 0x00 #define MODE_STANDBY 0x01 #define MODE_LORA_SLEEP 0x80 #define MODE_LORA_STANDBY 0x81 #define MODE_LORA_TX 0x83 int fb1,fb2,fb3; // LOCATION WHERE FRAME COUNTER IS STORED in EEPROM #define count_addr 0 unsigned int MyFrameCounter = 0; #include int optSerial=0,optFast=0,optIR=0,optResetCounter=0; void readFrameCounter() { int l = EEPROM.read(count_addr) & 255; int h = EEPROM.read(count_addr+1) & 255; MyFrameCounter = l | h<<8; } void writeFrameCounter() { unsigned char l = MyFrameCounter & 255; unsigned char h = (MyFrameCounter >> 8) & 255; EEPROM.write(count_addr,l); EEPROM.write(count_addr+1,h); } void swait() // tiny delays { int y=10; // was 100 while(y--); } int xfr(unsigned char iswrite,unsigned char addr,unsigned char data) { int d1; digitalWrite(NSS,0); swait(); swait(); d1 = addr & 127; if(iswrite!=0) d1 |= 128; swait(); int m=128; for(int bit=0;bit<8;bit++) { if( d1 & m) digitalWrite(MOSI,1); else digitalWrite(MOSI,0); swait(); digitalWrite(CLK,1); swait(); digitalWrite(CLK,0); swait(); m = (m >> 1) & 127; } m = 128; int d2=data,res=0; for(int bit=0;bit<8;bit++) { if((d2 & m)>0) digitalWrite(MOSI,1); else digitalWrite(MOSI,0); swait(); res = res << 1; digitalWrite(CLK,1); if(digitalRead(MISO)>0) res |= 1; swait(); digitalWrite(CLK,0); m >>= 1; } digitalWrite(NSS,1); swait(); return res; } void writer(unsigned char addr, unsigned char data) { xfr(1,addr,data); } unsigned char reader(unsigned char addr) { return xfr(0,addr,0); } void spiInit() { // using my own SPI code pinMode(RESET,OUTPUT); pinMode(NSS,OUTPUT); pinMode(CLK,OUTPUT); pinMode(MOSI,OUTPUT); pinMode(MISO,INPUT); pinMode(DIO0PIN,INPUT); digitalWrite(CLK,0); digitalWrite(NSS,1); digitalWrite(MOSI,0); digitalWrite(RESET,0); delay(1000); digitalWrite(RESET,1); } void optionInit() // one-time decision about operating mode required, set on links { pinMode(OPTION1,INPUT_PULLUP); pinMode(OPTION2,INPUT_PULLUP); pinMode(OPTION3,INPUT_PULLUP); pinMode(OPTION4,INPUT_PULLUP); delay(10); optSerial = digitalRead(OPTION1)==0; optFast = digitalRead(OPTION2)==0; optIR = digitalRead(OPTION3)==0; } ///////////////////////////////////////////////////////////////////// /* * AES TEST EXAMPLE Copied from "CLE's" ATtiny85 + RFM95 Temperature Sensor */ unsigned char NwkSkey[16] = { 0xBB, 0x80, 0x64, 0x68, 0xF1, 0xE2, 0x3D, 0x06, 0xC0, 0xAF, 0x11, 0x9C, 0xAF, 0x4B, 0x07, 0xE5 }; unsigned char AppSkey[16] = { 0xE9, 0x74, 0x8A, 0xA3, 0xAA, 0x2F, 0x28, 0x4D, 0xD9, 0xFB, 0x2A, 0xEE, 0xDA, 0xD2, 0x9D, 0x7C }; unsigned char DevAddr[4] = { 0x26, 0x00, 0x13, 0x8D }; //unsigned int Frame_Counter_Tx = 0x0000; // after char PROGMEM static const unsigned char PROGMEM S_Table[16][16] = { {0x63,0x7C,0x77,0x7B,0xF2,0x6B,0x6F,0xC5,0x30,0x01,0x67,0x2B,0xFE,0xD7,0xAB,0x76}, {0xCA,0x82,0xC9,0x7D,0xFA,0x59,0x47,0xF0,0xAD,0xD4,0xA2,0xAF,0x9C,0xA4,0x72,0xC0}, {0xB7,0xFD,0x93,0x26,0x36,0x3F,0xF7,0xCC,0x34,0xA5,0xE5,0xF1,0x71,0xD8,0x31,0x15}, {0x04,0xC7,0x23,0xC3,0x18,0x96,0x05,0x9A,0x07,0x12,0x80,0xE2,0xEB,0x27,0xB2,0x75}, {0x09,0x83,0x2C,0x1A,0x1B,0x6E,0x5A,0xA0,0x52,0x3B,0xD6,0xB3,0x29,0xE3,0x2F,0x84}, {0x53,0xD1,0x00,0xED,0x20,0xFC,0xB1,0x5B,0x6A,0xCB,0xBE,0x39,0x4A,0x4C,0x58,0xCF}, {0xD0,0xEF,0xAA,0xFB,0x43,0x4D,0x33,0x85,0x45,0xF9,0x02,0x7F,0x50,0x3C,0x9F,0xA8}, {0x51,0xA3,0x40,0x8F,0x92,0x9D,0x38,0xF5,0xBC,0xB6,0xDA,0x21,0x10,0xFF,0xF3,0xD2}, {0xCD,0x0C,0x13,0xEC,0x5F,0x97,0x44,0x17,0xC4,0xA7,0x7E,0x3D,0x64,0x5D,0x19,0x73}, {0x60,0x81,0x4F,0xDC,0x22,0x2A,0x90,0x88,0x46,0xEE,0xB8,0x14,0xDE,0x5E,0x0B,0xDB}, {0xE0,0x32,0x3A,0x0A,0x49,0x06,0x24,0x5C,0xC2,0xD3,0xAC,0x62,0x91,0x95,0xE4,0x79}, {0xE7,0xC8,0x37,0x6D,0x8D,0xD5,0x4E,0xA9,0x6C,0x56,0xF4,0xEA,0x65,0x7A,0xAE,0x08}, {0xBA,0x78,0x25,0x2E,0x1C,0xA6,0xB4,0xC6,0xE8,0xDD,0x74,0x1F,0x4B,0xBD,0x8B,0x8A}, {0x70,0x3E,0xB5,0x66,0x48,0x03,0xF6,0x0E,0x61,0x35,0x57,0xB9,0x86,0xC1,0x1D,0x9E}, {0xE1,0xF8,0x98,0x11,0x69,0xD9,0x8E,0x94,0x9B,0x1E,0x87,0xE9,0xCE,0x55,0x28,0xDF}, {0x8C,0xA1,0x89,0x0D,0xBF,0xE6,0x42,0x68,0x41,0x99,0x2D,0x0F,0xB0,0x54,0xBB,0x16} }; // definitions becvause soiurce i n reverse def order void Encrypt_Payload(unsigned char *Data, unsigned char Data_Length, unsigned int Frame_Counter, unsigned char Direction); void Calculate_MIC(unsigned char *Data, unsigned char *Final_MIC, unsigned char Data_Length, unsigned int Frame_Counter, unsigned char Direction); void RFM_Send_Package(unsigned char *RFM_Tx_Package, unsigned char Package_Length); void AES_Encrypt(unsigned char *Data, unsigned char *Key); void Generate_Keys(unsigned char *K1, unsigned char *K2); void XOR(unsigned char *New_Data,unsigned char *Old_Data); void Shift_Left(unsigned char *Data); void AES_Add_Round_Key(unsigned char *Round_Key, unsigned char (*State)[4]); unsigned char AES_Sub_Byte(unsigned char Byte); void AES_Shift_Rows(unsigned char (*State)[4]); void AES_Mix_Collums(unsigned char (*State)[4]); void AES_Calculate_Round_Key(unsigned char Round, unsigned char *Round_Key); int DIO0() { return digitalRead(DIO0PIN); } void memcpy(char *dest,char *src,int len) { while(len--) { *dest++ = *src++; } } /* ***************************************************************************************** * Description : Function contstructs a LoRaWAN package and sends it * * Arguments : *Data pointer to the array of data that will be transmitted * Data_Length nuber of bytes to be transmitted * Frame_Counter_Up Frame counter of upstream frames ***************************************************************************************** */ void LORA_Send_Data(unsigned char *Data, unsigned char Data_Length, unsigned int Frame_Counter_Tx) { //Define variables unsigned char i; //Direction of frame is up unsigned char Direction = 0x00; unsigned char RFM_Data[64]; unsigned char RFM_Package_Length; unsigned char MIC[4]; //Unconfirmed data up unsigned char Mac_Header = 0x40; unsigned char Frame_Control = 0x00; unsigned char Frame_Port = 0x01; //Encrypt the data Encrypt_Payload(Data, Data_Length, Frame_Counter_Tx, Direction); //Build the Radio Package RFM_Data[0] = Mac_Header; RFM_Data[1] = DevAddr[3]; RFM_Data[2] = DevAddr[2]; RFM_Data[3] = DevAddr[1]; RFM_Data[4] = DevAddr[0]; RFM_Data[5] = Frame_Control; RFM_Data[6] = (Frame_Counter_Tx & 0x00FF); RFM_Data[7] = ((Frame_Counter_Tx >> 8) & 0x00FF); RFM_Data[8] = Frame_Port; //Set Current package length RFM_Package_Length = 9; //Load Data for(i = 0; i < Data_Length; i++) { RFM_Data[RFM_Package_Length + i] = Data[i]; } //Add data Lenth to package length RFM_Package_Length = RFM_Package_Length + Data_Length; //Calculate MIC Calculate_MIC(RFM_Data, MIC, RFM_Package_Length, Frame_Counter_Tx, Direction); //Load MIC in package for(i = 0; i < 4; i++) { RFM_Data[i + RFM_Package_Length] = MIC[i]; } //Add MIC length to RFM package length RFM_Package_Length = RFM_Package_Length + 4; //Send Package RFM_Send_Package(RFM_Data, RFM_Package_Length); } void RFM_Write(char w,char d) { writer(w,d); // calls my SPI code } void SetMode(unsigned char d) { writer(REG_MODE,d); } unsigned char GetMode() { return reader(REG_MODE); } void WriteFIFO(unsigned char d) { writer(REG_FIFO,d); } void msg(char *m) { if(optSerial){ if(Serial) Serial.print(m); } } void RFM_Init() { digitalWrite(RESET,0); delay(1000); digitalWrite(RESET,1); delay(100); //Switch RFM to sleep SetMode(MODE_SLEEP); delay(10); //Set RFM in LoRa mode SetMode(MODE_LORA_SLEEP); // WAS LORA SLEEP delay(100); //Set RFM in Standby mode wait on mode ready SetMode(MODE_LORA_STANDBY); delay(100); char wk[100]; sprintf(wk,"Expect lstby, Mode now %02X\n",GetMode()); msg(wk); /* while (digitalRead(DIO5) == LOW) { } */ delay(10); //Set carrier frequency // 868.100 MHz / 61.035 Hz = 14222987 = 0xD9068B RFM_Write(REG_FREQ_H,0xD9); RFM_Write(REG_FREQ_M,0x06); RFM_Write(REG_FREQ_L,0x8B); RFM_Write(REG_PACONFIG,0xff); // ff is max //PA pin (maximal power) RFM_Write(REG_MODEMCONFIG,0x72); //BW = 125 kHz, Coding rate 4/5, Explicit header mode RFM_Write(REG_MODEMCONFIG2,0xB4); //Spreading factor 7, PayloadCRC On RFM_Write(REG_SYMBTIMEOUT,0x25); //Rx Timeout set to 37 symbols RFM_Write(REG_PREAMBLE_MSB,0x00); RFM_Write(REG_PREAMBLE_LSB,0x08); //Preamble length set to 8 symbols 0x0008 + 4 = 12 RFM_Write(REG_MODEMCONFIG3,0x0C); //Low datarate optimization off AGC auto on RFM_Write(0x39,0x34); //Set LoRa sync word //Set IQ to normal values RFM_Write(0x33,0x27); RFM_Write(0x3B,0x1D); //Set FIFO pointers RFM_Write(REG_FIFOTXBASEADDR,0x80); RFM_Write(REG_FIFORXBASEADDR,0x00); SetMode(MODE_LORA_SLEEP); } void setFreq(double freq) { double d = freq*1.0e6/61.035; int l = (int)d; fb1 = l >> 16 & 255; fb2 = l >> 8 & 255; fb3 = l & 255; } /* ***************************************************************************************** * Description : Function for sending a package with the RFM * * Arguments : *RFM_Tx_Package Pointer to arry with data to be send * Package_Length Length of the package to send ***************************************************************************************** */ void RFM_Send_Package(unsigned char *RFM_Tx_Package, unsigned char Package_Length) { unsigned char i; unsigned char RFM_Tx_Location = 0x00; //Set RFM in Standby mode wait on mode ready SetMode(MODE_SLEEP); SetMode(MODE_LORA_SLEEP); SetMode(MODE_LORA_STANDBY); /* while (digitalRead(DIO5) == LOW) { } */ delay(100); //Switch DIO0 to TxDone //RFM_Write(0x40,0x40); //Set carrier frequency 868.100 MHz / 61.035 Hz = 14222987 = 0xD9068B //RFM_Write(REG_FREQ_H,0xD9); //RFM_Write(REG_FREQ_M,0x06); //RFM_Write(REG_FREQ_L,0x8B); RFM_Write(REG_FREQ_H,fb1); RFM_Write(REG_FREQ_M,fb2); RFM_Write(REG_FREQ_L,fb3); // RE ORDR NEXT 2 LINES RFM_Write(REG_MODEMCONFIG,0x72); //125 kHz 4/5 coding rate explicit header mode //RFM_Write(REG_MODEMCONFIG2, 0x74); //SF7 CRC On (LOOKS OK) RFM_Write(REG_MODEMCONFIG2,0x70); //SF7 CRC On (LOOKS OK) //RFM_Write(REG_MODEMCONFIG3,0x04); //Low datarate optimization off AGC auto on RFM_Write(REG_MODEMCONFIG3,0x00); //Low datarate optimization off AGC auto on RFM_Write(REG_PACONFIG,0xff); // ff is maxc POWER LEVEL //Set IQ to normal values // RFM_Write(0x33,0x27); // TAKE OUT 2 LINES //RFM_Write(0x3B,0x1D); RFM_Write(REG_PREAMBLE_MSB,0x00); RFM_Write(REG_PREAMBLE_LSB,13); //Preamble length set to 12 +4 RFM_Write(REG_SYNC,0x34); // newer RFM_Write(REG_PAYLOADLENGTH,Package_Length); RFM_Tx_Location = reader(REG_FIFOTXBASEADDR); //Get location of Tx part of FiFo RFM_Write(REG_FIFOADDRPTR,RFM_Tx_Location); //Set SPI pointer to start of Tx part in FiFo RFM_Write(REG_FIFOADDRPTR,0x80); /// new RFM_Write(REG_FIFOTXBASEADDR,0x80); /// new //Write Payload to FiFo for (i = 0;i < Package_Length; i++) WriteFIFO(*RFM_Tx_Package++); char wk[100]; int wt = 0,m=0; //sprintf(wk,"Before tx starts, DIO0 is %d, mode is %02X, pkglen %d\n",DIO0(),GetMode(),Package_Length); //msg(wk); //Wait for TxDone //Switch RFM to Tx SetMode(MODE_LORA_TX); m = GetMode(); while(GetMode()==MODE_LORA_TX) // was DIO0()==0 { wt++; }; sprintf(wk,"count %d mode %02X ",wt,m); msg(wk); //Switch RFM to sleep SetMode(MODE_LORA_SLEEP); } void Encrypt_Payload(unsigned char *Data, unsigned char Data_Length, unsigned int Frame_Counter, unsigned char Direction) { unsigned char i = 0x00; unsigned char j; unsigned char Number_of_Blocks = 0x00; unsigned char Incomplete_Block_Size = 0x00; unsigned char Block_A[16]; //Calculate number of blocks Number_of_Blocks = Data_Length / 16; Incomplete_Block_Size = Data_Length % 16; if(Incomplete_Block_Size != 0) { Number_of_Blocks++; } for(i = 1; i <= Number_of_Blocks; i++) { Block_A[0] = 0x01; Block_A[1] = 0x00; Block_A[2] = 0x00; Block_A[3] = 0x00; Block_A[4] = 0x00; Block_A[5] = Direction; Block_A[6] = DevAddr[3]; Block_A[7] = DevAddr[2]; Block_A[8] = DevAddr[1]; Block_A[9] = DevAddr[0]; Block_A[10] = (Frame_Counter & 0x00FF); Block_A[11] = ((Frame_Counter >> 8) & 0x00FF); Block_A[12] = 0x00; //Frame counter upper Bytes Block_A[13] = 0x00; Block_A[14] = 0x00; Block_A[15] = i; //Calculate S AES_Encrypt(Block_A,AppSkey); //original //Check for last block if(i != Number_of_Blocks) { for(j = 0; j < 16; j++) { *Data = *Data ^ Block_A[j]; Data++; } } else { if(Incomplete_Block_Size == 0) { Incomplete_Block_Size = 16; } for(j = 0; j < Incomplete_Block_Size; j++) { *Data = *Data ^ Block_A[j]; Data++; } } } } void Calculate_MIC(unsigned char *Data, unsigned char *Final_MIC, unsigned char Data_Length, unsigned int Frame_Counter, unsigned char Direction) { unsigned char i; unsigned char Block_B[16]; unsigned char Key_K1[16] = { 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 }; unsigned char Key_K2[16] = { 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 }; //unsigned char Data_Copy[16]; unsigned char Old_Data[16] = { 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 }; unsigned char New_Data[16] = { 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 }; unsigned char Number_of_Blocks = 0x00; unsigned char Incomplete_Block_Size = 0x00; unsigned char Block_Counter = 0x01; //Create Block_B Block_B[0] = 0x49; Block_B[1] = 0x00; Block_B[2] = 0x00; Block_B[3] = 0x00; Block_B[4] = 0x00; Block_B[5] = Direction; Block_B[6] = DevAddr[3]; Block_B[7] = DevAddr[2]; Block_B[8] = DevAddr[1]; Block_B[9] = DevAddr[0]; Block_B[10] = (Frame_Counter & 0x00FF); Block_B[11] = ((Frame_Counter >> 8) & 0x00FF); Block_B[12] = 0x00; //Frame counter upper bytes Block_B[13] = 0x00; Block_B[14] = 0x00; Block_B[15] = Data_Length; //Calculate number of Blocks and blocksize of last block Number_of_Blocks = Data_Length / 16; Incomplete_Block_Size = Data_Length % 16; if(Incomplete_Block_Size != 0) { Number_of_Blocks++; } Generate_Keys(Key_K1, Key_K2); //Preform Calculation on Block B0 //Preform AES encryption AES_Encrypt(Block_B,NwkSkey); //Copy Block_B to Old_Data for(i = 0; i < 16; i++) { Old_Data[i] = Block_B[i]; } //Preform full calculating until n-1 messsage blocks while(Block_Counter < Number_of_Blocks) { //Copy data into array for(i = 0; i < 16; i++) { New_Data[i] = *Data; Data++; } //Preform XOR with old data XOR(New_Data,Old_Data); //Preform AES encryption AES_Encrypt(New_Data,NwkSkey); //Copy New_Data to Old_Data for(i = 0; i < 16; i++) { Old_Data[i] = New_Data[i]; } //Raise Block counter Block_Counter++; } //Perform calculation on last block //Check if Datalength is a multiple of 16 if(Incomplete_Block_Size == 0) { //Copy last data into array for(i = 0; i < 16; i++) { New_Data[i] = *Data; Data++; } //Preform XOR with Key 1 XOR(New_Data,Key_K1); //Preform XOR with old data XOR(New_Data,Old_Data); //Preform last AES routine // read NwkSkey from PROGMEM AES_Encrypt(New_Data,NwkSkey); } else { //Copy the remaining data and fill the rest for(i = 0; i < 16; i++) { if(i < Incomplete_Block_Size) { New_Data[i] = *Data; Data++; } if(i == Incomplete_Block_Size) { New_Data[i] = 0x80; } if(i > Incomplete_Block_Size) { New_Data[i] = 0x00; } } //Preform XOR with Key 2 XOR(New_Data,Key_K2); //Preform XOR with Old data XOR(New_Data,Old_Data); //Preform last AES routine AES_Encrypt(New_Data,NwkSkey); } Final_MIC[0] = New_Data[0]; Final_MIC[1] = New_Data[1]; Final_MIC[2] = New_Data[2]; Final_MIC[3] = New_Data[3]; } void Generate_Keys(unsigned char *K1, unsigned char *K2) { unsigned char i; unsigned char MSB_Key; //Encrypt the zeros in K1 with the NwkSkey AES_Encrypt(K1,NwkSkey); //Create K1 //Check if MSB is 1 if((K1[0] & 0x80) == 0x80) { MSB_Key = 1; } else { MSB_Key = 0; } //Shift K1 one bit left Shift_Left(K1); //if MSB was 1 if(MSB_Key == 1) { K1[15] = K1[15] ^ 0x87; } //Copy K1 to K2 for( i = 0; i < 16; i++) { K2[i] = K1[i]; } //Check if MSB is 1 if((K2[0] & 0x80) == 0x80) { MSB_Key = 1; } else { MSB_Key = 0; } //Shift K2 one bit left Shift_Left(K2); //Check if MSB was 1 if(MSB_Key == 1) { K2[15] = K2[15] ^ 0x87; } } void Shift_Left(unsigned char *Data) { unsigned char i; unsigned char Overflow = 0; //unsigned char High_Byte, Low_Byte; for(i = 0; i < 16; i++) { //Check for overflow on next byte except for the last byte if(i < 15) { //Check if upper bit is one if((Data[i+1] & 0x80) == 0x80) { Overflow = 1; } else { Overflow = 0; } } else { Overflow = 0; } //Shift one left Data[i] = (Data[i] << 1) + Overflow; } } void XOR(unsigned char *New_Data,unsigned char *Old_Data) { unsigned char i; for(i = 0; i < 16; i++) { New_Data[i] = New_Data[i] ^ Old_Data[i]; } } /* ***************************************************************************************** * Title : AES_Encrypt * Description : ***************************************************************************************** */ void AES_Encrypt(unsigned char *Data, unsigned char *Key) { unsigned char Row, Column, Round = 0; unsigned char Round_Key[16]; unsigned char State[4][4]; // Copy input to State arry for( Column = 0; Column < 4; Column++ ) { for( Row = 0; Row < 4; Row++ ) { State[Row][Column] = Data[Row + (Column << 2)]; } } // Copy key to round key memcpy( &Round_Key[0], &Key[0], 16 ); // Add round key AES_Add_Round_Key( Round_Key, State ); // Preform 9 full rounds with mixed collums for( Round = 1 ; Round < 10 ; Round++ ) { // Perform Byte substitution with S table for( Column = 0 ; Column < 4 ; Column++ ) { for( Row = 0 ; Row < 4 ; Row++ ) { State[Row][Column] = AES_Sub_Byte( State[Row][Column] ); } } // Perform Row Shift AES_Shift_Rows(State); // Mix Collums AES_Mix_Collums(State); // Calculate new round key AES_Calculate_Round_Key(Round, Round_Key); // Add the round key to the Round_key AES_Add_Round_Key(Round_Key, State); } // Perform Byte substitution with S table whitout mix collums for( Column = 0 ; Column < 4 ; Column++ ) { for( Row = 0; Row < 4; Row++ ) { State[Row][Column] = AES_Sub_Byte(State[Row][Column]); } } // Shift rows AES_Shift_Rows(State); // Calculate new round key AES_Calculate_Round_Key( Round, Round_Key ); // Add round key AES_Add_Round_Key( Round_Key, State ); // Copy the State into the data array for( Column = 0; Column < 4; Column++ ) { for( Row = 0; Row < 4; Row++ ) { Data[Row + (Column << 2)] = State[Row][Column]; } } } // AES_Encrypt /* ***************************************************************************************** * Title : AES_Add_Round_Key * Description : ***************************************************************************************** */ void AES_Add_Round_Key(unsigned char *Round_Key, unsigned char (*State)[4]) { unsigned char Row, Collum; for(Collum = 0; Collum < 4; Collum++) { for(Row = 0; Row < 4; Row++) { State[Row][Collum] ^= Round_Key[Row + (Collum << 2)]; } } } // AES_Add_Round_Key /* ***************************************************************************************** * Title : AES_Sub_Byte * Description : ***************************************************************************************** */ unsigned char AES_Sub_Byte(unsigned char Byte) { // unsigned char S_Row,S_Collum; // unsigned char S_Byte; // // S_Row = ((Byte >> 4) & 0x0F); // S_Collum = ((Byte >> 0) & 0x0F); // S_Byte = S_Table [S_Row][S_Collum]; //return S_Table [ ((Byte >> 4) & 0x0F) ] [ ((Byte >> 0) & 0x0F) ]; // original return S_Table [((Byte >> 4) & 0x0F)] [((Byte >> 0) & 0x0F)]; } // AES_Sub_Byte /* ***************************************************************************************** * Title : AES_Shift_Rows * Description : ***************************************************************************************** */ void AES_Shift_Rows(unsigned char (*State)[4]) { unsigned char Buffer; //Store firt byte in buffer Buffer = State[1][0]; //Shift all bytes State[1][0] = State[1][1]; State[1][1] = State[1][2]; State[1][2] = State[1][3]; State[1][3] = Buffer; Buffer = State[2][0]; State[2][0] = State[2][2]; State[2][2] = Buffer; Buffer = State[2][1]; State[2][1] = State[2][3]; State[2][3] = Buffer; Buffer = State[3][3]; State[3][3] = State[3][2]; State[3][2] = State[3][1]; State[3][1] = State[3][0]; State[3][0] = Buffer; } // AES_Shift_Rows /* ***************************************************************************************** * Title : AES_Mix_Collums * Description : ***************************************************************************************** */ void AES_Mix_Collums(unsigned char (*State)[4]) { unsigned char Row,Collum; unsigned char a[4], b[4]; for(Collum = 0; Collum < 4; Collum++) { for(Row = 0; Row < 4; Row++) { a[Row] = State[Row][Collum]; b[Row] = (State[Row][Collum] << 1); if((State[Row][Collum] & 0x80) == 0x80) { b[Row] ^= 0x1B; } } State[0][Collum] = b[0] ^ a[1] ^ b[1] ^ a[2] ^ a[3]; State[1][Collum] = a[0] ^ b[1] ^ a[2] ^ b[2] ^ a[3]; State[2][Collum] = a[0] ^ a[1] ^ b[2] ^ a[3] ^ b[3]; State[3][Collum] = a[0] ^ b[0] ^ a[1] ^ a[2] ^ b[3]; } } // AES_Mix_Collums /* ***************************************************************************************** * Title : AES_Calculate_Round_Key * Description : ***************************************************************************************** */ void AES_Calculate_Round_Key(unsigned char Round, unsigned char *Round_Key) { unsigned char i, j, b, Rcon; unsigned char Temp[4]; //Calculate Rcon Rcon = 0x01; while(Round != 1) { b = Rcon & 0x80; Rcon = Rcon << 1; if(b == 0x80) { Rcon ^= 0x1b; } Round--; } // Calculate first Temp // Copy laste byte from previous key and subsitute the byte, but shift the array contents around by 1. Temp[0] = AES_Sub_Byte( Round_Key[12 + 1] ); Temp[1] = AES_Sub_Byte( Round_Key[12 + 2] ); Temp[2] = AES_Sub_Byte( Round_Key[12 + 3] ); Temp[3] = AES_Sub_Byte( Round_Key[12 + 0] ); // XOR with Rcon Temp[0] ^= Rcon; // Calculate new key for(i = 0; i < 4; i++) { for(j = 0; j < 4; j++) { Round_Key[j + (i << 2)] ^= Temp[j]; Temp[j] = Round_Key[j + (i << 2)]; } } } // AES_Calculate_Round_Key float readThermistor() { return 25.0f; } void DoMessage() { uint16_t temp; uint8_t Data[32]; uint8_t Data_Length; //temp = (int)(readThermistor() * 100); //Data[0] = (temp >> 8) & 0xff; //Data[1] = temp & 0xff; Data_Length = 5; memcpy(Data,"windy!",Data_Length); LORA_Send_Data(Data, Data_Length, MyFrameCounter); MyFrameCounter++; writeFrameCounter(); // save counter to EEPROM } void DoMessage_Temp(int temperature) { uint16_t temp; uint8_t Data[32]; uint8_t Data_Length; temp = temperature; Data[0] = (temp >> 8) & 0xff; // high byte first Data[1] = temp & 0xff; Data_Length = 2; LORA_Send_Data(Data, Data_Length, MyFrameCounter); MyFrameCounter++; writeFrameCounter(); // save counter to EEPROM } double readerd(unsigned int addr) { int n = (int)reader(addr); return (double)n; } double getFreqMHz() { return 61.035e-6*(readerd(8)+readerd(7)*256.0+readerd(6)*256.0*256.0); } // IR section #define AIN1 6 int diff,previousdiff = 0; void irTest() { char buf[80]; int n0A,n0B,n0C,n1A,n1B,n1C; digitalWrite(NSENSE,0); // sensors all on digitalWrite(ADRIVE,1); digitalWrite(BDRIVE,1); // off digitalWrite(CDRIVE,1); digitalWrite(GLED,1); delay(10); n0A = analogRead(ASENSE); n0B = analogRead(BSENSE); n0C = analogRead(CSENSE); sprintf(buf,"LED off : %5d %5d %5d\n",n0A,n0B,n0C); msg(buf); digitalWrite(ADRIVE,0); digitalWrite(BDRIVE,0); // on digitalWrite(CDRIVE,0); delay(10); n1A = analogRead(ASENSE); n1B = analogRead(BSENSE); n1C = analogRead(CSENSE); diff = abs(n1B-n0B); digitalWrite(ADRIVE,1); digitalWrite(BDRIVE,1); // off digitalWrite(CDRIVE,1); sprintf(buf,"LED ON : %5d %5d %5d \n",n1A,n1B,n1C); msg(buf); if(abs(diff-previousdiff)>30) { sprintf(buf,"******* BIG CHANGE \n"); msg(buf); } previousdiff = diff; } void MapleLED(int n) { digitalWrite(MAPLELED,n); } void otest() { char buf[80]; int o1,o2,o3,o4; while(1) { o1 = digitalRead(OPTION1); o2 = digitalRead(OPTION2); o3 = digitalRead(OPTION3); o4 = digitalRead(OPTION4); sprintf(buf," %d %d %d %d\n",o1,o2,o3,o4); msg(buf); } } void t_test() { char mess[80]; int temp = 143; sprintf(mess,"Faked Temperature %5.1f decimal %d\n",(float)temp/10.0,temp); msg(mess); DoMessage_Temp(temp); // read DHT22 temperature and send it } void t_test2() { char mess[80]; int i,dat[40],lo,hi,d,n,w0,w1,mask,by[5],b,ptr,bit,thr; sprintf(mess,"Reading DHT22\n"); msg(mess); pinMode(DHT22,OUTPUT); digitalWrite(DHT22,0); delay(18); digitalWrite(DHT22,1); pinMode(DHT22,INPUT); lo = hi = 0; while(digitalRead(DHT22)==1); // expect low for 50us, then high for 50us // then 40 lots of 50us low, 26/70us high while(digitalRead(DHT22)==0) lo++; while(digitalRead(DHT22)==1) hi++; for(d=0;d<40;d++) { n = 0; while(digitalRead(DHT22)==0) n++; n = 0; while(digitalRead(DHT22)==1) n++; dat[d]=n; } delay(100); pinMode(DHT22,OUTPUT); thr = lo/2; ptr = 0; // array walk for(b=0;b<5;b++){ mask = 0x80; by[b]=0; for(bit=0;bit<8;bit++) { if(dat[ptr]>thr) by[b] |= mask; mask = mask >> 1; ptr ++; } } //sprintf(mess,"bytes %d %d %d %d %d, sum%d \n",by[0],by[1],by[2],by[3],by[4],(by[0]+by[1]+by[2]+by[3]) % 256); //msg(mess); sprintf(mess,"RH %d%% Temp %dC\n",by[0],by[2]); msg(mess); } void test1() { char mess[80]; int i,v; #define NN 1000000 sprintf(mess,"START %d ",NN); msg(mess); for(i=0;i0;i--) { if(i % 5 == 0 || i<5 ) { sprintf(buf,"%d ",i); msg(buf); } delay(1000); } msg("\n"); } break; case JOB_MAILBOX: { msg("IR Sensor B only\n"); delay(1000); irTest(); } break; case JOB_TEMP: { msg("Temperature/Humidity\n"); delay(1000); t_test2(); delay(3000); //delay(60000); } break; case JOB_TEST1: { msg("TEST1 - see how fast it samples\n"); test1(); } break; default: break; } } // end