emma controller code in production board v1
Dependencies: ADE7758_v1 Crypto DHT11 MQTT MbedJSONValueEmma SDFileSystem TFT_ILI9341 SWSPI SetRTC TFT_fonts Touch W5500Interface mbed-rtos mbed-src SoftSerial
Fork of emma_controller_energy by
emmaCode.cpp@38:e44f35f8129d, 2015-08-19 (annotated)
- Committer:
- arsenalist
- Date:
- Wed Aug 19 12:20:07 2015 +0000
- Revision:
- 38:e44f35f8129d
- Parent:
- 37:93f196daf5cf
- Child:
- 39:f51aa948acee
change platformDOMAIN to mqttDOMAIN and other two params.; add appNAME, mqttSERVER, mqttPORT, restSERVER, restPORT params.; update emmaModeRegister with GET request for ethernet.
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
arsenalist | 0:f4e449fa34d7 | 1 | #include "emmaCode.h" |
arsenalist | 0:f4e449fa34d7 | 2 | |
arsenalist | 0:f4e449fa34d7 | 3 | //init debug port |
arsenalist | 0:f4e449fa34d7 | 4 | Serial DBG(PA_9, PA_10); //tx, rx |
arsenalist | 0:f4e449fa34d7 | 5 | |
arsenalist | 0:f4e449fa34d7 | 6 | //init wifi port |
arsenalist | 0:f4e449fa34d7 | 7 | Serial _ESP(PA_2, PA_3); //tx, rx |
arsenalist | 8:51a0ca9079ca | 8 | //init espduino - without ch_pd pin |
arsenalist | 8:51a0ca9079ca | 9 | ESP esp(&_ESP, &DBG, ESP_BAUD); |
arsenalist | 0:f4e449fa34d7 | 10 | //init wifi mqtt |
arsenalist | 27:562a95c120cc | 11 | //ESPMQTT mqtt(&esp); |
arsenalist | 0:f4e449fa34d7 | 12 | //init wifi rest |
arsenalist | 0:f4e449fa34d7 | 13 | REST rest(&esp); |
arsenalist | 0:f4e449fa34d7 | 14 | |
arsenalist | 0:f4e449fa34d7 | 15 | //init eth port |
arsenalist | 0:f4e449fa34d7 | 16 | SPI spi(PB_15, PB_14, PB_13); //mosi, miso, sck |
arsenalist | 0:f4e449fa34d7 | 17 | MQTTEthernet ipstack(&spi, PB_12, PC_6); //spi, cs, reset |
arsenalist | 37:93f196daf5cf | 18 | //MQTT::Client<MQTTEthernet, Countdown, MQTT_MAX_PACKET_SIZE> client(ipstack); |
arsenalist | 0:f4e449fa34d7 | 19 | |
arsenalist | 0:f4e449fa34d7 | 20 | //init sd card |
arsenalist | 8:51a0ca9079ca | 21 | SDFileSystem sd(PA_7, PA_6, PA_5, PB_3, "sd"); //mosi, miso, sck, cs |
arsenalist | 0:f4e449fa34d7 | 22 | |
arsenalist | 8:51a0ca9079ca | 23 | //init ade7758 - without cs pin |
arsenalist | 14:8287f0f5d987 | 24 | ADE7758 ADE(PB_6, PB_4, PB_5, PB_7); //mosi, miso, sck, irq |
arsenalist | 0:f4e449fa34d7 | 25 | |
arsenalist | 12:96f637ed37f9 | 26 | //init tft lcd |
arsenalist | 12:96f637ed37f9 | 27 | SPI_TFT_ILI9341 TFT(PA_7, PA_6, PA_5, PA_4, PC_5, PC_4,"TFT"); //mosi, miso, sclk, cs, reset, dc |
arsenalist | 12:96f637ed37f9 | 28 | //init touch screen - without cs pin |
arsenalist | 12:96f637ed37f9 | 29 | TouchScreenADS7843 TP(PB_10, PB_0, PB_1, PB_2, &TFT); //mosi, miso, sclk, irq, tft |
arsenalist | 12:96f637ed37f9 | 30 | |
arsenalist | 21:33bd8b82560f | 31 | //init dht sensor |
arsenalist | 21:33bd8b82560f | 32 | DHT11 d(PD_2); |
arsenalist | 21:33bd8b82560f | 33 | |
arsenalist | 0:f4e449fa34d7 | 34 | //emma settings |
arsenalist | 0:f4e449fa34d7 | 35 | string emmaUID; |
arsenalist | 4:76ab12e2f8a3 | 36 | string hmac; |
arsenalist | 38:e44f35f8129d | 37 | string appNAME; |
arsenalist | 38:e44f35f8129d | 38 | string mqttDOMAIN; |
arsenalist | 38:e44f35f8129d | 39 | string mqttKEY; |
arsenalist | 38:e44f35f8129d | 40 | string mqttSECRET; |
arsenalist | 38:e44f35f8129d | 41 | string mqttSERVER; |
arsenalist | 38:e44f35f8129d | 42 | string mqttPORT; |
arsenalist | 38:e44f35f8129d | 43 | string restSERVER; |
arsenalist | 38:e44f35f8129d | 44 | string restPORT; |
arsenalist | 0:f4e449fa34d7 | 45 | string wifiSSID; |
arsenalist | 0:f4e449fa34d7 | 46 | string wifiPASS; |
arsenalist | 0:f4e449fa34d7 | 47 | string gprsAPN; |
arsenalist | 0:f4e449fa34d7 | 48 | string proxySERVER; |
arsenalist | 0:f4e449fa34d7 | 49 | string proxyPORT; |
arsenalist | 0:f4e449fa34d7 | 50 | string proxyAUTH; |
arsenalist | 0:f4e449fa34d7 | 51 | |
arsenalist | 4:76ab12e2f8a3 | 52 | //nodes settings |
arsenalist | 4:76ab12e2f8a3 | 53 | class NODES { |
arsenalist | 4:76ab12e2f8a3 | 54 | public: |
arsenalist | 4:76ab12e2f8a3 | 55 | REST *restConn; |
arsenalist | 4:76ab12e2f8a3 | 56 | NODES(REST *r); |
arsenalist | 4:76ab12e2f8a3 | 57 | string macAddr; |
arsenalist | 4:76ab12e2f8a3 | 58 | string ipAddr; |
arsenalist | 4:76ab12e2f8a3 | 59 | }; |
arsenalist | 4:76ab12e2f8a3 | 60 | NODES::NODES(REST *r) { |
arsenalist | 4:76ab12e2f8a3 | 61 | restConn = r; |
arsenalist | 4:76ab12e2f8a3 | 62 | } |
arsenalist | 4:76ab12e2f8a3 | 63 | REST restObj[NODES_MAX] = {REST(&esp),REST(&esp),REST(&esp),REST(&esp),REST(&esp)}; |
arsenalist | 4:76ab12e2f8a3 | 64 | NODES nodes[NODES_MAX] = {NODES(&restObj[0]),NODES(&restObj[1]),NODES(&restObj[2]),NODES(&restObj[3]),NODES(&restObj[4])}; |
arsenalist | 4:76ab12e2f8a3 | 65 | |
arsenalist | 12:96f637ed37f9 | 66 | //mode box class for main menu |
arsenalist | 12:96f637ed37f9 | 67 | class modeBox { |
arsenalist | 12:96f637ed37f9 | 68 | public: |
arsenalist | 12:96f637ed37f9 | 69 | int xTL; //TopLeft |
arsenalist | 12:96f637ed37f9 | 70 | int yTL; |
arsenalist | 12:96f637ed37f9 | 71 | int xBR; //BottomRight |
arsenalist | 12:96f637ed37f9 | 72 | int yBR; |
arsenalist | 29:4d94a03d38e0 | 73 | string text; |
arsenalist | 29:4d94a03d38e0 | 74 | string name; |
arsenalist | 12:96f637ed37f9 | 75 | }; |
arsenalist | 12:96f637ed37f9 | 76 | |
arsenalist | 0:f4e449fa34d7 | 77 | //ade7758 variables |
arsenalist | 25:36c6a5db50ed | 78 | uint32_t AWattHrValue, BWattHrValue, CWattHrValue; |
arsenalist | 25:36c6a5db50ed | 79 | uint32_t AVAHrValue, BVAHrValue, CVAHrValue; |
arsenalist | 19:7e3e9332f719 | 80 | uint32_t AWattHrSum = 0; |
arsenalist | 19:7e3e9332f719 | 81 | uint32_t BWattHrSum = 0; |
arsenalist | 19:7e3e9332f719 | 82 | uint32_t CWattHrSum = 0; |
arsenalist | 0:f4e449fa34d7 | 83 | float AWattHr, BWattHr, CWattHr; |
arsenalist | 4:76ab12e2f8a3 | 84 | float AVrms, BVrms, CVrms; |
arsenalist | 4:76ab12e2f8a3 | 85 | float AIrms, BIrms, CIrms; |
arsenalist | 4:76ab12e2f8a3 | 86 | float AWatt, BWatt, CWatt; |
arsenalist | 4:76ab12e2f8a3 | 87 | float XWattHr,XVrms,XWatt; |
arsenalist | 0:f4e449fa34d7 | 88 | |
arsenalist | 0:f4e449fa34d7 | 89 | //variables |
arsenalist | 0:f4e449fa34d7 | 90 | bool ethAvailable = false; |
arsenalist | 0:f4e449fa34d7 | 91 | bool wifiAvailable = false; |
arsenalist | 0:f4e449fa34d7 | 92 | bool gprsAvailable = false; |
arsenalist | 0:f4e449fa34d7 | 93 | bool ethConnected = false; |
arsenalist | 0:f4e449fa34d7 | 94 | bool wifiConnected = false; |
arsenalist | 9:a58c04da4476 | 95 | bool gprsConnected = false; |
arsenalist | 0:f4e449fa34d7 | 96 | bool useProxy = false; |
arsenalist | 0:f4e449fa34d7 | 97 | bool newCommand = false; |
arsenalist | 37:93f196daf5cf | 98 | bool espFreeMemory = true; //for after bootup |
arsenalist | 27:562a95c120cc | 99 | bool espDHCPClientStart = false; |
arsenalist | 22:e18d361bf688 | 100 | bool newEnergyData = false; |
arsenalist | 0:f4e449fa34d7 | 101 | string globalCommand; |
arsenalist | 4:76ab12e2f8a3 | 102 | string rxBuf; |
arsenalist | 27:562a95c120cc | 103 | string rxLog; |
arsenalist | 27:562a95c120cc | 104 | string rxLogA; |
arsenalist | 0:f4e449fa34d7 | 105 | |
arsenalist | 12:96f637ed37f9 | 106 | /*start lcd and touch*/ |
arsenalist | 12:96f637ed37f9 | 107 | int emmaModeSelection(void) { |
arsenalist | 12:96f637ed37f9 | 108 | bool modeSelected = false; |
arsenalist | 12:96f637ed37f9 | 109 | int md=0; |
arsenalist | 12:96f637ed37f9 | 110 | int TPx; |
arsenalist | 12:96f637ed37f9 | 111 | int TPy; |
arsenalist | 31:e2abded4d85f | 112 | Timer t; |
arsenalist | 12:96f637ed37f9 | 113 | |
arsenalist | 12:96f637ed37f9 | 114 | TFT.background(Black); |
arsenalist | 12:96f637ed37f9 | 115 | TFT.foreground(White); |
arsenalist | 12:96f637ed37f9 | 116 | |
arsenalist | 12:96f637ed37f9 | 117 | TFT.set_font((unsigned char*) Arial12x12); |
arsenalist | 12:96f637ed37f9 | 118 | TFT.set_orientation(1); |
arsenalist | 12:96f637ed37f9 | 119 | TFT.cls(); |
arsenalist | 12:96f637ed37f9 | 120 | TFT.locate(0,0); |
arsenalist | 12:96f637ed37f9 | 121 | TFT.printf("Hello, I'm Emma!"); |
arsenalist | 13:e8adfe305dbc | 122 | wait(2); |
arsenalist | 12:96f637ed37f9 | 123 | TFT.cls(); |
arsenalist | 12:96f637ed37f9 | 124 | |
arsenalist | 12:96f637ed37f9 | 125 | Matrix matrix; |
arsenalist | 12:96f637ed37f9 | 126 | Coordinate ScreenSample[3]; |
arsenalist | 12:96f637ed37f9 | 127 | |
arsenalist | 12:96f637ed37f9 | 128 | matrix.An = 580; |
arsenalist | 12:96f637ed37f9 | 129 | matrix.Bn = 75980; |
arsenalist | 12:96f637ed37f9 | 130 | matrix.Cn = -3410580; |
arsenalist | 12:96f637ed37f9 | 131 | matrix.Dn = 57855; |
arsenalist | 12:96f637ed37f9 | 132 | matrix.En = -2465; |
arsenalist | 12:96f637ed37f9 | 133 | matrix.Fn = -3483515; |
arsenalist | 12:96f637ed37f9 | 134 | matrix.Divider = 209144; |
arsenalist | 12:96f637ed37f9 | 135 | |
arsenalist | 12:96f637ed37f9 | 136 | ScreenSample[0].x = 230; |
arsenalist | 12:96f637ed37f9 | 137 | ScreenSample[0].y = 167; |
arsenalist | 12:96f637ed37f9 | 138 | ScreenSample[1].x = 754; |
arsenalist | 12:96f637ed37f9 | 139 | ScreenSample[1].y = 163; |
arsenalist | 12:96f637ed37f9 | 140 | ScreenSample[2].x = 771; |
arsenalist | 12:96f637ed37f9 | 141 | ScreenSample[2].y = 562; |
arsenalist | 12:96f637ed37f9 | 142 | |
arsenalist | 12:96f637ed37f9 | 143 | TP.SetCalibration(&matrix, &ScreenSample[0]); |
arsenalist | 12:96f637ed37f9 | 144 | |
arsenalist | 12:96f637ed37f9 | 145 | //draw border |
arsenalist | 12:96f637ed37f9 | 146 | TFT.line(15,15,310,15,Orange); |
arsenalist | 12:96f637ed37f9 | 147 | TFT.line(310,15,310,250,Orange); |
arsenalist | 12:96f637ed37f9 | 148 | TFT.line(310,250,15,250,Orange); |
arsenalist | 12:96f637ed37f9 | 149 | TFT.line(15,250,15,15,Orange); |
arsenalist | 12:96f637ed37f9 | 150 | |
arsenalist | 12:96f637ed37f9 | 151 | //init main menu |
arsenalist | 12:96f637ed37f9 | 152 | modeBox menu[6]; |
arsenalist | 12:96f637ed37f9 | 153 | |
arsenalist | 12:96f637ed37f9 | 154 | //wifi config mode |
arsenalist | 12:96f637ed37f9 | 155 | menu[MODE_WIFI_CONFIG].xTL = 25; |
arsenalist | 12:96f637ed37f9 | 156 | menu[MODE_WIFI_CONFIG].yTL = 25; |
arsenalist | 12:96f637ed37f9 | 157 | menu[MODE_WIFI_CONFIG].xBR = 110; |
arsenalist | 12:96f637ed37f9 | 158 | menu[MODE_WIFI_CONFIG].yBR = 90; |
arsenalist | 29:4d94a03d38e0 | 159 | menu[MODE_WIFI_CONFIG].text = "1.wifi config"; |
arsenalist | 29:4d94a03d38e0 | 160 | menu[MODE_WIFI_CONFIG].name = "wifi config"; |
arsenalist | 12:96f637ed37f9 | 161 | |
arsenalist | 12:96f637ed37f9 | 162 | //setting mode |
arsenalist | 29:4d94a03d38e0 | 163 | menu[MODE_SETTINGS].xTL = 25; |
arsenalist | 29:4d94a03d38e0 | 164 | menu[MODE_SETTINGS].yTL = 100; |
arsenalist | 29:4d94a03d38e0 | 165 | menu[MODE_SETTINGS].xBR = 110; |
arsenalist | 29:4d94a03d38e0 | 166 | menu[MODE_SETTINGS].yBR = 165; |
arsenalist | 29:4d94a03d38e0 | 167 | menu[MODE_SETTINGS].text = "2.settings "; |
arsenalist | 29:4d94a03d38e0 | 168 | menu[MODE_SETTINGS].name = "settings"; |
arsenalist | 12:96f637ed37f9 | 169 | |
arsenalist | 12:96f637ed37f9 | 170 | //register mode |
arsenalist | 29:4d94a03d38e0 | 171 | menu[MODE_REGISTER].xTL = 120; |
arsenalist | 29:4d94a03d38e0 | 172 | menu[MODE_REGISTER].yTL = 25; |
arsenalist | 29:4d94a03d38e0 | 173 | menu[MODE_REGISTER].xBR = 205; |
arsenalist | 29:4d94a03d38e0 | 174 | menu[MODE_REGISTER].yBR = 90; |
arsenalist | 29:4d94a03d38e0 | 175 | menu[MODE_REGISTER].text = "3.register "; |
arsenalist | 29:4d94a03d38e0 | 176 | menu[MODE_REGISTER].name = "register"; |
arsenalist | 12:96f637ed37f9 | 177 | |
arsenalist | 12:96f637ed37f9 | 178 | //operational mode |
arsenalist | 12:96f637ed37f9 | 179 | menu[MODE_OPERATION].xTL = 120; |
arsenalist | 12:96f637ed37f9 | 180 | menu[MODE_OPERATION].yTL = 100; |
arsenalist | 12:96f637ed37f9 | 181 | menu[MODE_OPERATION].xBR = 205; |
arsenalist | 12:96f637ed37f9 | 182 | menu[MODE_OPERATION].yBR = 165; |
arsenalist | 29:4d94a03d38e0 | 183 | menu[MODE_OPERATION].text = "4.operation "; |
arsenalist | 29:4d94a03d38e0 | 184 | menu[MODE_OPERATION].name = "operation"; |
arsenalist | 12:96f637ed37f9 | 185 | |
arsenalist | 12:96f637ed37f9 | 186 | //firmware download mode |
arsenalist | 12:96f637ed37f9 | 187 | menu[MODE_FIRMWARE_DOWNLOAD].xTL = 215; |
arsenalist | 12:96f637ed37f9 | 188 | menu[MODE_FIRMWARE_DOWNLOAD].yTL = 25; |
arsenalist | 12:96f637ed37f9 | 189 | menu[MODE_FIRMWARE_DOWNLOAD].xBR = 300; |
arsenalist | 12:96f637ed37f9 | 190 | menu[MODE_FIRMWARE_DOWNLOAD].yBR = 90; |
arsenalist | 29:4d94a03d38e0 | 191 | menu[MODE_FIRMWARE_DOWNLOAD].text = "5.fw dwld "; |
arsenalist | 29:4d94a03d38e0 | 192 | menu[MODE_FIRMWARE_DOWNLOAD].name = "fw dwld"; |
arsenalist | 12:96f637ed37f9 | 193 | |
arsenalist | 12:96f637ed37f9 | 194 | //reserved mode |
arsenalist | 12:96f637ed37f9 | 195 | menu[5].xTL = 215; |
arsenalist | 12:96f637ed37f9 | 196 | menu[5].yTL = 100; |
arsenalist | 12:96f637ed37f9 | 197 | menu[5].xBR = 300; |
arsenalist | 12:96f637ed37f9 | 198 | menu[5].yBR = 165; |
arsenalist | 29:4d94a03d38e0 | 199 | menu[5].text = "6.reserved "; |
arsenalist | 29:4d94a03d38e0 | 200 | menu[5].name = "reserved"; |
arsenalist | 12:96f637ed37f9 | 201 | |
arsenalist | 17:b3ced0e67916 | 202 | //draw main menu |
arsenalist | 12:96f637ed37f9 | 203 | for(int i=0; i<6; i++) { |
arsenalist | 12:96f637ed37f9 | 204 | TFT.fillrect(menu[i].xTL,menu[i].yTL,menu[i].xBR,menu[i].yBR,Orange); |
arsenalist | 12:96f637ed37f9 | 205 | } |
arsenalist | 12:96f637ed37f9 | 206 | |
arsenalist | 17:b3ced0e67916 | 207 | //add text to main menu |
arsenalist | 17:b3ced0e67916 | 208 | for(int i=0; i<6; i++) { |
arsenalist | 17:b3ced0e67916 | 209 | TFT.locate(menu[i].xTL,menu[i].yTL); |
arsenalist | 31:e2abded4d85f | 210 | TFT.printf("%s",menu[i].text.c_str()); |
arsenalist | 31:e2abded4d85f | 211 | } |
arsenalist | 31:e2abded4d85f | 212 | |
arsenalist | 31:e2abded4d85f | 213 | //read emma settings |
arsenalist | 31:e2abded4d85f | 214 | emmaReadSettings(); |
arsenalist | 31:e2abded4d85f | 215 | |
arsenalist | 38:e44f35f8129d | 216 | //mqttDOMAIN is not empty -> has been registered |
arsenalist | 38:e44f35f8129d | 217 | if(!mqttDOMAIN.empty()) { |
arsenalist | 31:e2abded4d85f | 218 | TFT.locate(25,170); |
arsenalist | 31:e2abded4d85f | 219 | TFT.printf(" auto select enabled"); |
arsenalist | 31:e2abded4d85f | 220 | t.start(); |
arsenalist | 17:b3ced0e67916 | 221 | } |
arsenalist | 17:b3ced0e67916 | 222 | |
arsenalist | 12:96f637ed37f9 | 223 | while(!modeSelected) { |
arsenalist | 12:96f637ed37f9 | 224 | if(!TP._tp_irq) { |
arsenalist | 12:96f637ed37f9 | 225 | if(TP.Read_Ads7843()) { |
arsenalist | 12:96f637ed37f9 | 226 | TP.getDisplayPoint(); |
arsenalist | 12:96f637ed37f9 | 227 | TPx = TP.display.x; |
arsenalist | 12:96f637ed37f9 | 228 | TPy = TP.display.y; |
arsenalist | 12:96f637ed37f9 | 229 | TP.TP_DrawPoint(TPx,TPy, Blue); |
arsenalist | 12:96f637ed37f9 | 230 | |
arsenalist | 12:96f637ed37f9 | 231 | for(int i=0; i<6; i++) { |
arsenalist | 12:96f637ed37f9 | 232 | if((menu[i].xTL < TPx && TPx < menu[i].xBR) && (menu[i].yTL < TPy && TPy < menu[i].yBR)) { |
arsenalist | 12:96f637ed37f9 | 233 | md = i; |
arsenalist | 12:96f637ed37f9 | 234 | modeSelected = true; |
arsenalist | 12:96f637ed37f9 | 235 | } |
arsenalist | 12:96f637ed37f9 | 236 | } |
arsenalist | 12:96f637ed37f9 | 237 | } |
arsenalist | 31:e2abded4d85f | 238 | } |
arsenalist | 31:e2abded4d85f | 239 | |
arsenalist | 31:e2abded4d85f | 240 | //auto select (to emmaModeOperation) after some times |
arsenalist | 38:e44f35f8129d | 241 | if(!mqttDOMAIN.empty()) { |
arsenalist | 31:e2abded4d85f | 242 | if(t.read()>20) { |
arsenalist | 31:e2abded4d85f | 243 | md = MODE_OPERATION; |
arsenalist | 31:e2abded4d85f | 244 | modeSelected = true; |
arsenalist | 31:e2abded4d85f | 245 | t.stop(); |
arsenalist | 31:e2abded4d85f | 246 | t.reset(); |
arsenalist | 31:e2abded4d85f | 247 | } |
arsenalist | 31:e2abded4d85f | 248 | } |
arsenalist | 31:e2abded4d85f | 249 | |
arsenalist | 12:96f637ed37f9 | 250 | } |
arsenalist | 12:96f637ed37f9 | 251 | |
arsenalist | 12:96f637ed37f9 | 252 | TFT.locate(25,170); |
arsenalist | 12:96f637ed37f9 | 253 | TFT.printf(" "); |
arsenalist | 12:96f637ed37f9 | 254 | TFT.locate(25,170); |
arsenalist | 29:4d94a03d38e0 | 255 | TFT.printf("mode: %s is selected",menu[md].name.c_str()); |
arsenalist | 13:e8adfe305dbc | 256 | wait(2); |
arsenalist | 12:96f637ed37f9 | 257 | TFT.cls(); |
arsenalist | 12:96f637ed37f9 | 258 | |
arsenalist | 12:96f637ed37f9 | 259 | return md; |
arsenalist | 12:96f637ed37f9 | 260 | } |
arsenalist | 12:96f637ed37f9 | 261 | /*end lcd and touch*/ |
arsenalist | 12:96f637ed37f9 | 262 | |
arsenalist | 31:e2abded4d85f | 263 | /*start emma read settings*/ |
arsenalist | 31:e2abded4d85f | 264 | void emmaReadSettings(void) { |
arsenalist | 4:76ab12e2f8a3 | 265 | char s[64]; |
arsenalist | 0:f4e449fa34d7 | 266 | DBG.baud(19200); |
arsenalist | 31:e2abded4d85f | 267 | DBG.printf("\r\nemmaReadSettings\r\n"); |
arsenalist | 0:f4e449fa34d7 | 268 | |
arsenalist | 0:f4e449fa34d7 | 269 | //read settings |
arsenalist | 9:a58c04da4476 | 270 | emmaUID = readSetting("emmaUID"); |
arsenalist | 9:a58c04da4476 | 271 | //emmaUID = "066eff575349896767073038"; |
arsenalist | 0:f4e449fa34d7 | 272 | DBG.printf("emmaUID:%s\r\n",emmaUID.c_str()); |
arsenalist | 37:93f196daf5cf | 273 | |
arsenalist | 4:76ab12e2f8a3 | 274 | //calculate hmac |
arsenalist | 4:76ab12e2f8a3 | 275 | for(int i=0; i<sizeof(s); i++) { |
arsenalist | 4:76ab12e2f8a3 | 276 | s[i]=0; } |
arsenalist | 4:76ab12e2f8a3 | 277 | sprintf(s,"emma-%s",emmaUID.c_str()); |
arsenalist | 4:76ab12e2f8a3 | 278 | hmac = calculateMD5(s); |
arsenalist | 4:76ab12e2f8a3 | 279 | DBG.printf("hmac:%s\r\n",hmac.c_str()); |
arsenalist | 37:93f196daf5cf | 280 | |
arsenalist | 38:e44f35f8129d | 281 | appNAME = readSetting("appNAME"); |
arsenalist | 38:e44f35f8129d | 282 | DBG.printf("appNAME:%s\r\n",appNAME.c_str()); |
arsenalist | 38:e44f35f8129d | 283 | |
arsenalist | 38:e44f35f8129d | 284 | mqttDOMAIN = readSetting("mqttDOMAIN"); |
arsenalist | 38:e44f35f8129d | 285 | DBG.printf("mqttDOMAIN:%s\r\n",mqttDOMAIN.c_str()); |
arsenalist | 38:e44f35f8129d | 286 | mqttKEY = readSetting("mqttKEY"); |
arsenalist | 38:e44f35f8129d | 287 | DBG.printf("mqttKEY:%s\r\n",mqttKEY.c_str()); |
arsenalist | 38:e44f35f8129d | 288 | mqttSECRET = readSetting("mqttSECRET"); |
arsenalist | 38:e44f35f8129d | 289 | DBG.printf("mqttSECRET:%s\r\n",mqttSECRET.c_str()); |
arsenalist | 38:e44f35f8129d | 290 | mqttSERVER = readSetting("mqttSERVER"); |
arsenalist | 38:e44f35f8129d | 291 | DBG.printf("mqttSERVER:%s\r\n",mqttSERVER.c_str()); |
arsenalist | 38:e44f35f8129d | 292 | mqttPORT = readSetting("mqttPORT"); |
arsenalist | 38:e44f35f8129d | 293 | DBG.printf("mqttPORT:%s\r\n",mqttPORT.c_str()); |
arsenalist | 38:e44f35f8129d | 294 | |
arsenalist | 38:e44f35f8129d | 295 | restSERVER = readSetting("restSERVER"); |
arsenalist | 38:e44f35f8129d | 296 | DBG.printf("restSERVER:%s\r\n",restSERVER.c_str()); |
arsenalist | 38:e44f35f8129d | 297 | restPORT = readSetting("restPORT"); |
arsenalist | 38:e44f35f8129d | 298 | DBG.printf("restPORT:%s\r\n",restPORT.c_str()); |
arsenalist | 38:e44f35f8129d | 299 | |
arsenalist | 9:a58c04da4476 | 300 | proxySERVER = readSetting("proxySERVER"); |
arsenalist | 0:f4e449fa34d7 | 301 | DBG.printf("proxySERVER:%s\r\n",proxySERVER.c_str()); |
arsenalist | 9:a58c04da4476 | 302 | proxyPORT = readSetting("proxyPORT"); |
arsenalist | 0:f4e449fa34d7 | 303 | DBG.printf("proxyPORT:%s\r\n",proxyPORT.c_str()); |
arsenalist | 9:a58c04da4476 | 304 | proxyAUTH = readSetting("proxyAUTH"); |
arsenalist | 0:f4e449fa34d7 | 305 | DBG.printf("proxyAUTH:%s\r\n",proxyAUTH.c_str()); |
arsenalist | 28:7561035e3df5 | 306 | wifiSSID = readSetting("wifiSSID"); |
arsenalist | 28:7561035e3df5 | 307 | DBG.printf("wifiSSID:%s\r\n",wifiSSID.c_str()); |
arsenalist | 28:7561035e3df5 | 308 | wifiPASS = readSetting("wifiPASS"); |
arsenalist | 28:7561035e3df5 | 309 | DBG.printf("wifiPASS:%s\r\n",wifiPASS.c_str()); |
arsenalist | 31:e2abded4d85f | 310 | } |
arsenalist | 31:e2abded4d85f | 311 | /*end emma read settings*/ |
arsenalist | 31:e2abded4d85f | 312 | |
arsenalist | 31:e2abded4d85f | 313 | /*start emma mode*/ |
arsenalist | 31:e2abded4d85f | 314 | void emmaInit(int mode) { |
arsenalist | 31:e2abded4d85f | 315 | DBG.printf("\r\nemmaInit\r\n"); |
arsenalist | 31:e2abded4d85f | 316 | DBG.printf("mode:%d\r\n",mode); |
arsenalist | 0:f4e449fa34d7 | 317 | |
arsenalist | 0:f4e449fa34d7 | 318 | //check proxy |
arsenalist | 0:f4e449fa34d7 | 319 | if(!proxySERVER.empty() && !proxyPORT.empty() && !proxyAUTH.empty()) { |
arsenalist | 0:f4e449fa34d7 | 320 | useProxy = true; |
arsenalist | 0:f4e449fa34d7 | 321 | } else { |
arsenalist | 0:f4e449fa34d7 | 322 | useProxy = false; |
arsenalist | 0:f4e449fa34d7 | 323 | } |
arsenalist | 0:f4e449fa34d7 | 324 | //testing purpose |
arsenalist | 32:78633fb9b2a1 | 325 | //useProxy = false; |
arsenalist | 0:f4e449fa34d7 | 326 | DBG.printf("proxy:%d\r\n",useProxy); |
arsenalist | 0:f4e449fa34d7 | 327 | |
arsenalist | 8:51a0ca9079ca | 328 | //check available interface |
arsenalist | 8:51a0ca9079ca | 329 | isEthAvailable(); //check whether cable is connected |
arsenalist | 31:e2abded4d85f | 330 | wifiAvailable = true; //wifi module will always on the board |
arsenalist | 31:e2abded4d85f | 331 | gprsAvailable = true; //gprs module will always on the board |
arsenalist | 8:51a0ca9079ca | 332 | DBG.printf("eth:%d\r\n",ethAvailable); |
arsenalist | 8:51a0ca9079ca | 333 | DBG.printf("wifi:%d\r\n",wifiAvailable); |
arsenalist | 8:51a0ca9079ca | 334 | DBG.printf("gprs:%d\r\n",gprsAvailable); |
arsenalist | 0:f4e449fa34d7 | 335 | } |
arsenalist | 0:f4e449fa34d7 | 336 | void emmaModeWiFiConfig(void) { |
arsenalist | 0:f4e449fa34d7 | 337 | string str; |
arsenalist | 18:87f30ba9ddc5 | 338 | TFT.locate(0,0); |
arsenalist | 18:87f30ba9ddc5 | 339 | TFT.printf(" please wait"); |
arsenalist | 0:f4e449fa34d7 | 340 | |
arsenalist | 0:f4e449fa34d7 | 341 | if(wifiAvailable) { |
arsenalist | 0:f4e449fa34d7 | 342 | DBG.printf("emmaModeWiFiConfig\r\n"); |
arsenalist | 0:f4e449fa34d7 | 343 | |
arsenalist | 0:f4e449fa34d7 | 344 | //set wifi module to configuration |
arsenalist | 0:f4e449fa34d7 | 345 | _ESP.printf("MODE=C"); |
arsenalist | 0:f4e449fa34d7 | 346 | while(1) { |
arsenalist | 0:f4e449fa34d7 | 347 | char rcv[128] = {}; |
arsenalist | 0:f4e449fa34d7 | 348 | rcvReply(rcv,3000); |
arsenalist | 0:f4e449fa34d7 | 349 | str = rcv; |
arsenalist | 0:f4e449fa34d7 | 350 | if(str.find("SC_STATUS_FIND_CHANNEL") != std::string::npos) |
arsenalist | 0:f4e449fa34d7 | 351 | break; |
arsenalist | 0:f4e449fa34d7 | 352 | } |
arsenalist | 18:87f30ba9ddc5 | 353 | |
arsenalist | 18:87f30ba9ddc5 | 354 | TFT.locate(0,0); |
arsenalist | 18:87f30ba9ddc5 | 355 | TFT.printf(" emmaModeWiFiConfig"); |
arsenalist | 18:87f30ba9ddc5 | 356 | TFT.locate(0,20); |
arsenalist | 18:87f30ba9ddc5 | 357 | TFT.printf(" connect with emma app now"); |
arsenalist | 18:87f30ba9ddc5 | 358 | |
arsenalist | 0:f4e449fa34d7 | 359 | DBG.printf("entering wifi configuration mode\r\n"); |
arsenalist | 0:f4e449fa34d7 | 360 | while(1) { |
arsenalist | 0:f4e449fa34d7 | 361 | char rcv[128] = {}; |
arsenalist | 0:f4e449fa34d7 | 362 | rcvReply(rcv,3000); |
arsenalist | 0:f4e449fa34d7 | 363 | str = rcv; |
arsenalist | 0:f4e449fa34d7 | 364 | if(str.find("MODE=C OK") != std::string::npos) { |
arsenalist | 0:f4e449fa34d7 | 365 | //save wifiSSID and wifiPASS |
arsenalist | 0:f4e449fa34d7 | 366 | if(str.find("[") != std::string::npos && str.find("]") != std::string::npos) { |
arsenalist | 0:f4e449fa34d7 | 367 | str.erase(str.begin(),str.begin()+str.find("[")+1); |
arsenalist | 0:f4e449fa34d7 | 368 | str.erase(str.begin()+str.find("]"),str.end()); |
arsenalist | 0:f4e449fa34d7 | 369 | |
arsenalist | 0:f4e449fa34d7 | 370 | MbedJSONValue jsonValue; |
arsenalist | 0:f4e449fa34d7 | 371 | parse(jsonValue,str.c_str()); |
arsenalist | 0:f4e449fa34d7 | 372 | |
arsenalist | 0:f4e449fa34d7 | 373 | char *parameter[2] = {"wifiSSID","wifiPASS"}; |
arsenalist | 0:f4e449fa34d7 | 374 | |
arsenalist | 0:f4e449fa34d7 | 375 | for(int i=0; i<2; i++) { |
arsenalist | 0:f4e449fa34d7 | 376 | if(jsonValue.hasMember(parameter[i])) { |
arsenalist | 0:f4e449fa34d7 | 377 | string val = jsonValue[parameter[i]].get<std::string>(); |
arsenalist | 11:2311b2d5157d | 378 | int st = writeSetting(parameter[i],val.c_str()); |
arsenalist | 11:2311b2d5157d | 379 | if(st) { |
arsenalist | 11:2311b2d5157d | 380 | DBG.printf("%s is saved\r\n",parameter[i]); |
arsenalist | 18:87f30ba9ddc5 | 381 | TFT.locate(0,40); |
arsenalist | 37:93f196daf5cf | 382 | TFT.printf(" %s is saved",parameter[i]); |
arsenalist | 18:87f30ba9ddc5 | 383 | wait(3); |
arsenalist | 18:87f30ba9ddc5 | 384 | TFT.locate(0,40); |
arsenalist | 18:87f30ba9ddc5 | 385 | TFT.printf(" "); |
arsenalist | 11:2311b2d5157d | 386 | } else { |
arsenalist | 11:2311b2d5157d | 387 | DBG.printf("%s is not saved\r\n",parameter[i]); |
arsenalist | 18:87f30ba9ddc5 | 388 | TFT.locate(0,40); |
arsenalist | 37:93f196daf5cf | 389 | TFT.printf(" %s is not saved",parameter[i]); |
arsenalist | 18:87f30ba9ddc5 | 390 | wait(3); |
arsenalist | 18:87f30ba9ddc5 | 391 | TFT.locate(0,40); |
arsenalist | 18:87f30ba9ddc5 | 392 | TFT.printf(" "); |
arsenalist | 11:2311b2d5157d | 393 | } |
arsenalist | 0:f4e449fa34d7 | 394 | } |
arsenalist | 0:f4e449fa34d7 | 395 | } |
arsenalist | 18:87f30ba9ddc5 | 396 | |
arsenalist | 18:87f30ba9ddc5 | 397 | //wificonfig finish |
arsenalist | 18:87f30ba9ddc5 | 398 | TFT.locate(0,20); |
arsenalist | 18:87f30ba9ddc5 | 399 | TFT.printf(" "); |
arsenalist | 18:87f30ba9ddc5 | 400 | TFT.locate(0,20); |
arsenalist | 18:87f30ba9ddc5 | 401 | TFT.printf(" wificonfig finish. please restart."); |
arsenalist | 18:87f30ba9ddc5 | 402 | |
arsenalist | 0:f4e449fa34d7 | 403 | } |
arsenalist | 18:87f30ba9ddc5 | 404 | } else if(str.find("SC_STATUS_GETTING_SSID_PSWD") != std::string::npos){ |
arsenalist | 18:87f30ba9ddc5 | 405 | DBG.printf("app connected\r\n"); |
arsenalist | 18:87f30ba9ddc5 | 406 | TFT.locate(0,20); |
arsenalist | 18:87f30ba9ddc5 | 407 | TFT.printf(" "); |
arsenalist | 18:87f30ba9ddc5 | 408 | TFT.locate(0,20); |
arsenalist | 18:87f30ba9ddc5 | 409 | TFT.printf(" app connected"); |
arsenalist | 0:f4e449fa34d7 | 410 | } |
arsenalist | 0:f4e449fa34d7 | 411 | } |
arsenalist | 0:f4e449fa34d7 | 412 | } else { |
arsenalist | 0:f4e449fa34d7 | 413 | DBG.printf("no wifi found\r\n"); |
arsenalist | 18:87f30ba9ddc5 | 414 | TFT.locate(0,20); |
arsenalist | 18:87f30ba9ddc5 | 415 | TFT.printf(" no wifi found"); |
arsenalist | 0:f4e449fa34d7 | 416 | } |
arsenalist | 0:f4e449fa34d7 | 417 | } |
arsenalist | 0:f4e449fa34d7 | 418 | void emmaModeSettings(void) { |
arsenalist | 0:f4e449fa34d7 | 419 | bool clientIsConnected = false; |
arsenalist | 0:f4e449fa34d7 | 420 | bool serverIsListened = false; |
arsenalist | 0:f4e449fa34d7 | 421 | char s[32]; |
arsenalist | 0:f4e449fa34d7 | 422 | string str; |
arsenalist | 0:f4e449fa34d7 | 423 | |
arsenalist | 18:87f30ba9ddc5 | 424 | TFT.locate(0,0); |
arsenalist | 18:87f30ba9ddc5 | 425 | TFT.printf(" please wait"); |
arsenalist | 18:87f30ba9ddc5 | 426 | |
arsenalist | 8:51a0ca9079ca | 427 | //create settings dir |
arsenalist | 0:f4e449fa34d7 | 428 | mkdir("/sd/settings",0777); |
arsenalist | 8:51a0ca9079ca | 429 | |
arsenalist | 0:f4e449fa34d7 | 430 | //get and write emmaUID |
arsenalist | 0:f4e449fa34d7 | 431 | string uid = getUID(); |
arsenalist | 0:f4e449fa34d7 | 432 | sprintf(s,"(%s)",uid.c_str()); |
arsenalist | 0:f4e449fa34d7 | 433 | uid = s; |
arsenalist | 0:f4e449fa34d7 | 434 | writeSetting("emmaUID",uid); |
arsenalist | 0:f4e449fa34d7 | 435 | |
arsenalist | 8:51a0ca9079ca | 436 | if(ethAvailable) { |
arsenalist | 0:f4e449fa34d7 | 437 | DBG.printf("emmaModeSettings - eth\r\n"); |
arsenalist | 37:93f196daf5cf | 438 | wait(2); |
arsenalist | 37:93f196daf5cf | 439 | TFT.locate(0,0); |
arsenalist | 37:93f196daf5cf | 440 | TFT.printf(" "); |
arsenalist | 37:93f196daf5cf | 441 | TFT.locate(0,0); |
arsenalist | 37:93f196daf5cf | 442 | TFT.printf(" emmaModeSettings"); |
arsenalist | 0:f4e449fa34d7 | 443 | |
arsenalist | 0:f4e449fa34d7 | 444 | TCPSocketServer svr; |
arsenalist | 0:f4e449fa34d7 | 445 | TCPSocketConnection clientSock; |
arsenalist | 0:f4e449fa34d7 | 446 | |
arsenalist | 0:f4e449fa34d7 | 447 | if(svr.bind(SERVER_PORT) < 0) { |
arsenalist | 0:f4e449fa34d7 | 448 | DBG.printf("tcp server bind failed\r\n"); |
arsenalist | 0:f4e449fa34d7 | 449 | } else { |
arsenalist | 0:f4e449fa34d7 | 450 | DBG.printf("tcp server bind success\r\n"); |
arsenalist | 0:f4e449fa34d7 | 451 | serverIsListened = true; |
arsenalist | 0:f4e449fa34d7 | 452 | } |
arsenalist | 0:f4e449fa34d7 | 453 | |
arsenalist | 0:f4e449fa34d7 | 454 | DBG.printf("please connect to %s\r\n",ipstack.getEth().getIPAddress()); |
arsenalist | 0:f4e449fa34d7 | 455 | |
arsenalist | 0:f4e449fa34d7 | 456 | if(svr.listen(1) < 0) { |
arsenalist | 37:93f196daf5cf | 457 | DBG.printf("tcp server listen failed\r\n"); |
arsenalist | 37:93f196daf5cf | 458 | TFT.locate(0,20); |
arsenalist | 37:93f196daf5cf | 459 | TFT.printf(" settings error. please restart."); |
arsenalist | 37:93f196daf5cf | 460 | while(1); |
arsenalist | 0:f4e449fa34d7 | 461 | } else { |
arsenalist | 37:93f196daf5cf | 462 | DBG.printf("tcp server is listening...\r\n"); |
arsenalist | 37:93f196daf5cf | 463 | TFT.locate(0,20); |
arsenalist | 37:93f196daf5cf | 464 | TFT.printf(" connect with emma app now!"); |
arsenalist | 0:f4e449fa34d7 | 465 | } |
arsenalist | 0:f4e449fa34d7 | 466 | |
arsenalist | 0:f4e449fa34d7 | 467 | clientSock.set_blocking(false,30000); //timeout after 30sec |
arsenalist | 0:f4e449fa34d7 | 468 | |
arsenalist | 0:f4e449fa34d7 | 469 | //listening |
arsenalist | 0:f4e449fa34d7 | 470 | while (serverIsListened) { |
arsenalist | 0:f4e449fa34d7 | 471 | if(svr.accept(clientSock) < 0) { |
arsenalist | 37:93f196daf5cf | 472 | DBG.printf("failed to accept connection\r\n"); |
arsenalist | 37:93f196daf5cf | 473 | TFT.locate(0,20); |
arsenalist | 37:93f196daf5cf | 474 | TFT.printf(" "); |
arsenalist | 37:93f196daf5cf | 475 | TFT.locate(0,20); |
arsenalist | 37:93f196daf5cf | 476 | TFT.printf("failed to accept connection"); |
arsenalist | 0:f4e449fa34d7 | 477 | } else { |
arsenalist | 0:f4e449fa34d7 | 478 | DBG.printf("connection success!\r\nIP: %s\r\n",clientSock.get_address()); |
arsenalist | 37:93f196daf5cf | 479 | TFT.locate(0,20); |
arsenalist | 37:93f196daf5cf | 480 | TFT.printf(" "); |
arsenalist | 37:93f196daf5cf | 481 | TFT.locate(0,20); |
arsenalist | 37:93f196daf5cf | 482 | //TFT.printf(" connection success! IP: %s",clientSock.get_address()); |
arsenalist | 37:93f196daf5cf | 483 | TFT.printf(" connection success!"); |
arsenalist | 0:f4e449fa34d7 | 484 | clientIsConnected = true; |
arsenalist | 0:f4e449fa34d7 | 485 | |
arsenalist | 0:f4e449fa34d7 | 486 | while(clientIsConnected) { |
arsenalist | 0:f4e449fa34d7 | 487 | char buffer[1024] = {}; |
arsenalist | 0:f4e449fa34d7 | 488 | switch(clientSock.receive(buffer,1023)) { |
arsenalist | 0:f4e449fa34d7 | 489 | case 0: |
arsenalist | 0:f4e449fa34d7 | 490 | DBG.printf("received buffer is empty\r\n"); |
arsenalist | 0:f4e449fa34d7 | 491 | clientIsConnected = false; |
arsenalist | 0:f4e449fa34d7 | 492 | break; |
arsenalist | 0:f4e449fa34d7 | 493 | case -1: |
arsenalist | 0:f4e449fa34d7 | 494 | DBG.printf("failed to read data from client\r\n"); |
arsenalist | 0:f4e449fa34d7 | 495 | clientIsConnected = false; |
arsenalist | 0:f4e449fa34d7 | 496 | break; |
arsenalist | 0:f4e449fa34d7 | 497 | default: |
arsenalist | 0:f4e449fa34d7 | 498 | //DBG.printf("received data: %d\r\n%s\r\n",strlen(buffer),buffer); |
arsenalist | 0:f4e449fa34d7 | 499 | DBG.printf("\r\n"); |
arsenalist | 0:f4e449fa34d7 | 500 | |
arsenalist | 0:f4e449fa34d7 | 501 | str = buffer; |
arsenalist | 0:f4e449fa34d7 | 502 | if(str.find("[") != std::string::npos && str.find("]") != std::string::npos) { |
arsenalist | 0:f4e449fa34d7 | 503 | str.erase(str.begin(),str.begin()+str.find("[")+1); |
arsenalist | 0:f4e449fa34d7 | 504 | str.erase(str.begin()+str.find("]"),str.end()); |
arsenalist | 0:f4e449fa34d7 | 505 | |
arsenalist | 0:f4e449fa34d7 | 506 | MbedJSONValue jsonValue; |
arsenalist | 0:f4e449fa34d7 | 507 | parse(jsonValue,str.c_str()); |
arsenalist | 0:f4e449fa34d7 | 508 | |
arsenalist | 14:8287f0f5d987 | 509 | char *parameter[5] = {"gprsAPN","proxySERVER","proxyPORT","proxyAUTH","epochTime"}; |
arsenalist | 0:f4e449fa34d7 | 510 | |
arsenalist | 0:f4e449fa34d7 | 511 | for(int i=0; i<4; i++) { |
arsenalist | 0:f4e449fa34d7 | 512 | if(jsonValue.hasMember(parameter[i])) { |
arsenalist | 0:f4e449fa34d7 | 513 | string val = jsonValue[parameter[i]].get<std::string>(); |
arsenalist | 0:f4e449fa34d7 | 514 | int st = writeSetting(parameter[i],val.c_str()); |
arsenalist | 0:f4e449fa34d7 | 515 | if(st) { |
arsenalist | 0:f4e449fa34d7 | 516 | DBG.printf("%s: %s is saved\r\n",parameter[i],val.c_str()); |
arsenalist | 37:93f196daf5cf | 517 | TFT.locate(0,40); |
arsenalist | 37:93f196daf5cf | 518 | TFT.printf(" %s: %s is saved",parameter[i],val.c_str()); |
arsenalist | 37:93f196daf5cf | 519 | wait(1); |
arsenalist | 37:93f196daf5cf | 520 | TFT.locate(0,40); |
arsenalist | 37:93f196daf5cf | 521 | TFT.printf(" "); |
arsenalist | 0:f4e449fa34d7 | 522 | } else { |
arsenalist | 0:f4e449fa34d7 | 523 | DBG.printf("%s is not saved\r\n",parameter[i]); |
arsenalist | 37:93f196daf5cf | 524 | TFT.locate(0,40); |
arsenalist | 37:93f196daf5cf | 525 | TFT.printf(" %s is not saved",parameter[i]); |
arsenalist | 37:93f196daf5cf | 526 | wait(1); |
arsenalist | 37:93f196daf5cf | 527 | TFT.locate(0,40); |
arsenalist | 37:93f196daf5cf | 528 | TFT.printf(" "); |
arsenalist | 0:f4e449fa34d7 | 529 | } |
arsenalist | 0:f4e449fa34d7 | 530 | } |
arsenalist | 0:f4e449fa34d7 | 531 | } |
arsenalist | 14:8287f0f5d987 | 532 | |
arsenalist | 14:8287f0f5d987 | 533 | //set time |
arsenalist | 14:8287f0f5d987 | 534 | if(jsonValue.hasMember(parameter[4])) { |
arsenalist | 14:8287f0f5d987 | 535 | string epTime = jsonValue[parameter[4]].get<std::string>(); |
arsenalist | 20:ea14f175bbb4 | 536 | time_t seconds; |
arsenalist | 14:8287f0f5d987 | 537 | sscanf(epTime.c_str(),"%d",&seconds); |
arsenalist | 14:8287f0f5d987 | 538 | set_time(seconds); |
arsenalist | 14:8287f0f5d987 | 539 | DBG.printf("time is set\r\n"); |
arsenalist | 37:93f196daf5cf | 540 | TFT.locate(0,40); |
arsenalist | 37:93f196daf5cf | 541 | TFT.printf(" time is set"); |
arsenalist | 37:93f196daf5cf | 542 | wait(1); |
arsenalist | 37:93f196daf5cf | 543 | TFT.locate(0,40); |
arsenalist | 37:93f196daf5cf | 544 | TFT.printf(" "); |
arsenalist | 14:8287f0f5d987 | 545 | } |
arsenalist | 0:f4e449fa34d7 | 546 | } |
arsenalist | 0:f4e449fa34d7 | 547 | break; |
arsenalist | 0:f4e449fa34d7 | 548 | } |
arsenalist | 0:f4e449fa34d7 | 549 | } |
arsenalist | 0:f4e449fa34d7 | 550 | DBG.printf("close connection\r\n"); |
arsenalist | 37:93f196daf5cf | 551 | TFT.locate(0,20); |
arsenalist | 37:93f196daf5cf | 552 | TFT.printf(" "); |
arsenalist | 37:93f196daf5cf | 553 | TFT.locate(0,20); |
arsenalist | 37:93f196daf5cf | 554 | TFT.printf(" settings finish. please restart."); |
arsenalist | 0:f4e449fa34d7 | 555 | clientSock.close(); |
arsenalist | 0:f4e449fa34d7 | 556 | } |
arsenalist | 0:f4e449fa34d7 | 557 | } |
arsenalist | 8:51a0ca9079ca | 558 | } else if(wifiAvailable) { |
arsenalist | 8:51a0ca9079ca | 559 | DBG.printf("emmaModeSettings - wifi\r\n"); |
arsenalist | 8:51a0ca9079ca | 560 | |
arsenalist | 8:51a0ca9079ca | 561 | _ESP.printf("MODE=S"); |
arsenalist | 8:51a0ca9079ca | 562 | while(1) { |
arsenalist | 8:51a0ca9079ca | 563 | char rcv[128] = {}; |
arsenalist | 8:51a0ca9079ca | 564 | rcvReply(rcv,3000); |
arsenalist | 8:51a0ca9079ca | 565 | str = rcv; |
arsenalist | 8:51a0ca9079ca | 566 | if(str.find("MODE=S_OK") != std::string::npos) |
arsenalist | 8:51a0ca9079ca | 567 | break; |
arsenalist | 8:51a0ca9079ca | 568 | } |
arsenalist | 8:51a0ca9079ca | 569 | DBG.printf("entering settings mode\r\n"); |
arsenalist | 17:b3ced0e67916 | 570 | TFT.locate(0,0); |
arsenalist | 17:b3ced0e67916 | 571 | TFT.printf(" emmaModeSettings"); |
arsenalist | 17:b3ced0e67916 | 572 | TFT.locate(0,20); |
arsenalist | 37:93f196daf5cf | 573 | TFT.printf(" connect with emma app now!"); |
arsenalist | 17:b3ced0e67916 | 574 | |
arsenalist | 8:51a0ca9079ca | 575 | while(1) { |
arsenalist | 8:51a0ca9079ca | 576 | char rcv[512] = {}; |
arsenalist | 8:51a0ca9079ca | 577 | rcvReply(rcv,3000); |
arsenalist | 8:51a0ca9079ca | 578 | //DBG.printf("rcv:%s\r\n",rcv); |
arsenalist | 8:51a0ca9079ca | 579 | str = rcv; |
arsenalist | 8:51a0ca9079ca | 580 | if(str.find("MODE=S_Config") != std::string::npos) { |
arsenalist | 8:51a0ca9079ca | 581 | //save gprs and proxy setting |
arsenalist | 8:51a0ca9079ca | 582 | if(str.find("[") != std::string::npos && str.find("]") != std::string::npos) { |
arsenalist | 8:51a0ca9079ca | 583 | str.erase(str.begin(),str.begin()+str.find("[")+1); |
arsenalist | 8:51a0ca9079ca | 584 | str.erase(str.begin()+str.find("]"),str.end()); |
arsenalist | 8:51a0ca9079ca | 585 | |
arsenalist | 8:51a0ca9079ca | 586 | MbedJSONValue jsonValue; |
arsenalist | 8:51a0ca9079ca | 587 | parse(jsonValue,str.c_str()); |
arsenalist | 8:51a0ca9079ca | 588 | |
arsenalist | 14:8287f0f5d987 | 589 | char *parameter[5] = {"gprsAPN","proxySERVER","proxyPORT","proxyAUTH","epochTime"}; |
arsenalist | 8:51a0ca9079ca | 590 | |
arsenalist | 8:51a0ca9079ca | 591 | for(int i=0; i<4; i++) { |
arsenalist | 8:51a0ca9079ca | 592 | if(jsonValue.hasMember(parameter[i])) { |
arsenalist | 8:51a0ca9079ca | 593 | string val = jsonValue[parameter[i]].get<std::string>(); |
arsenalist | 8:51a0ca9079ca | 594 | int st = writeSetting(parameter[i],val.c_str()); |
arsenalist | 8:51a0ca9079ca | 595 | if(st) { |
arsenalist | 8:51a0ca9079ca | 596 | DBG.printf("%s: %s is saved\r\n",parameter[i],val.c_str()); |
arsenalist | 17:b3ced0e67916 | 597 | TFT.locate(0,40); |
arsenalist | 18:87f30ba9ddc5 | 598 | TFT.printf(" %s: %s is saved",parameter[i],val.c_str()); |
arsenalist | 37:93f196daf5cf | 599 | wait(1); |
arsenalist | 17:b3ced0e67916 | 600 | TFT.locate(0,40); |
arsenalist | 17:b3ced0e67916 | 601 | TFT.printf(" "); |
arsenalist | 8:51a0ca9079ca | 602 | } else { |
arsenalist | 8:51a0ca9079ca | 603 | DBG.printf("%s is not saved\r\n",parameter[i]); |
arsenalist | 17:b3ced0e67916 | 604 | TFT.locate(0,40); |
arsenalist | 18:87f30ba9ddc5 | 605 | TFT.printf(" %s is not saved",parameter[i]); |
arsenalist | 37:93f196daf5cf | 606 | wait(1); |
arsenalist | 17:b3ced0e67916 | 607 | TFT.locate(0,40); |
arsenalist | 17:b3ced0e67916 | 608 | TFT.printf(" "); |
arsenalist | 8:51a0ca9079ca | 609 | } |
arsenalist | 8:51a0ca9079ca | 610 | } |
arsenalist | 8:51a0ca9079ca | 611 | } |
arsenalist | 14:8287f0f5d987 | 612 | |
arsenalist | 14:8287f0f5d987 | 613 | //set time |
arsenalist | 14:8287f0f5d987 | 614 | if(jsonValue.hasMember(parameter[4])) { |
arsenalist | 14:8287f0f5d987 | 615 | string epTime = jsonValue[parameter[4]].get<std::string>(); |
arsenalist | 14:8287f0f5d987 | 616 | time_t seconds; |
arsenalist | 14:8287f0f5d987 | 617 | sscanf(epTime.c_str(),"%d",&seconds); |
arsenalist | 14:8287f0f5d987 | 618 | set_time(seconds); |
arsenalist | 14:8287f0f5d987 | 619 | DBG.printf("time is set\r\n"); |
arsenalist | 17:b3ced0e67916 | 620 | TFT.locate(0,40); |
arsenalist | 18:87f30ba9ddc5 | 621 | TFT.printf(" time is set"); |
arsenalist | 37:93f196daf5cf | 622 | wait(1); |
arsenalist | 17:b3ced0e67916 | 623 | TFT.locate(0,40); |
arsenalist | 17:b3ced0e67916 | 624 | TFT.printf(" "); |
arsenalist | 14:8287f0f5d987 | 625 | } |
arsenalist | 18:87f30ba9ddc5 | 626 | |
arsenalist | 18:87f30ba9ddc5 | 627 | //setting finish |
arsenalist | 18:87f30ba9ddc5 | 628 | TFT.locate(0,20); |
arsenalist | 18:87f30ba9ddc5 | 629 | TFT.printf(" "); |
arsenalist | 18:87f30ba9ddc5 | 630 | TFT.locate(0,20); |
arsenalist | 18:87f30ba9ddc5 | 631 | TFT.printf(" settings finish. please restart."); |
arsenalist | 8:51a0ca9079ca | 632 | } |
arsenalist | 8:51a0ca9079ca | 633 | } else if(str.find("connect") != std::string::npos) { |
arsenalist | 8:51a0ca9079ca | 634 | DBG.printf("connection success!\r\n"); |
arsenalist | 17:b3ced0e67916 | 635 | TFT.locate(0,20); |
arsenalist | 17:b3ced0e67916 | 636 | TFT.printf(" "); |
arsenalist | 17:b3ced0e67916 | 637 | TFT.locate(0,20); |
arsenalist | 37:93f196daf5cf | 638 | TFT.printf(" connection success!"); |
arsenalist | 8:51a0ca9079ca | 639 | } |
arsenalist | 8:51a0ca9079ca | 640 | } |
arsenalist | 0:f4e449fa34d7 | 641 | } else { |
arsenalist | 9:a58c04da4476 | 642 | DBG.printf("no eth or wifi is available\r\n"); |
arsenalist | 17:b3ced0e67916 | 643 | TFT.locate(0,0); |
arsenalist | 18:87f30ba9ddc5 | 644 | TFT.printf(" no iface avail, please restart!"); |
arsenalist | 0:f4e449fa34d7 | 645 | } |
arsenalist | 0:f4e449fa34d7 | 646 | } |
arsenalist | 0:f4e449fa34d7 | 647 | void emmaModeRegister(void) { |
arsenalist | 0:f4e449fa34d7 | 648 | bool emmaGetRegKey = false; |
arsenalist | 0:f4e449fa34d7 | 649 | bool emmaRegistered = false; |
arsenalist | 0:f4e449fa34d7 | 650 | char s[512]; |
arsenalist | 0:f4e449fa34d7 | 651 | char r[256]; |
arsenalist | 0:f4e449fa34d7 | 652 | int connPort; |
arsenalist | 0:f4e449fa34d7 | 653 | int loop = 0; |
arsenalist | 0:f4e449fa34d7 | 654 | string connData; |
arsenalist | 0:f4e449fa34d7 | 655 | string connHost; |
arsenalist | 0:f4e449fa34d7 | 656 | string str; |
arsenalist | 0:f4e449fa34d7 | 657 | string regKey; |
arsenalist | 0:f4e449fa34d7 | 658 | Timer t; |
arsenalist | 0:f4e449fa34d7 | 659 | |
arsenalist | 18:87f30ba9ddc5 | 660 | TFT.locate(0,0); |
arsenalist | 18:87f30ba9ddc5 | 661 | TFT.printf(" please wait"); |
arsenalist | 18:87f30ba9ddc5 | 662 | |
arsenalist | 0:f4e449fa34d7 | 663 | //check connected interface |
arsenalist | 8:51a0ca9079ca | 664 | isEthConnected(); |
arsenalist | 8:51a0ca9079ca | 665 | isWiFiConnected(); |
arsenalist | 8:51a0ca9079ca | 666 | isGprsConnected(); |
arsenalist | 0:f4e449fa34d7 | 667 | DBG.printf("ethConnected:%d\r\n",ethConnected); |
arsenalist | 0:f4e449fa34d7 | 668 | DBG.printf("wifiConnected:%d\r\n",wifiConnected); |
arsenalist | 0:f4e449fa34d7 | 669 | |
arsenalist | 9:a58c04da4476 | 670 | if(ethConnected) { |
arsenalist | 9:a58c04da4476 | 671 | DBG.printf("emmaModeRegister - eth\r\n"); |
arsenalist | 38:e44f35f8129d | 672 | wait(2); |
arsenalist | 38:e44f35f8129d | 673 | TFT.locate(0,0); |
arsenalist | 38:e44f35f8129d | 674 | TFT.printf(" "); |
arsenalist | 38:e44f35f8129d | 675 | TFT.locate(0,0); |
arsenalist | 38:e44f35f8129d | 676 | TFT.printf(" emmaModeRegister"); |
arsenalist | 9:a58c04da4476 | 677 | |
arsenalist | 9:a58c04da4476 | 678 | //set connHost, connPort, connData |
arsenalist | 9:a58c04da4476 | 679 | if(useProxy) { |
arsenalist | 9:a58c04da4476 | 680 | DBG.printf("use proxy\r\n"); |
arsenalist | 9:a58c04da4476 | 681 | connHost = proxySERVER; |
arsenalist | 9:a58c04da4476 | 682 | sscanf(proxyPORT.c_str(),"%d",&connPort); |
arsenalist | 9:a58c04da4476 | 683 | for(int i=0; i<sizeof(s); i++) { |
arsenalist | 9:a58c04da4476 | 684 | s[i]=0; } |
arsenalist | 38:e44f35f8129d | 685 | sprintf(s,"GET http://%s:%s/emma/api/controller/register?uid=%s&hmac=%s HTTP/1.0\nHost: %s\r\n\r\n",restSERVER.c_str(),restPORT.c_str(),emmaUID.c_str(),hmac.c_str(),restSERVER.c_str()); |
arsenalist | 9:a58c04da4476 | 686 | connData = s; |
arsenalist | 9:a58c04da4476 | 687 | } else { |
arsenalist | 9:a58c04da4476 | 688 | DBG.printf("no proxy\r\n"); |
arsenalist | 38:e44f35f8129d | 689 | connHost = restSERVER; |
arsenalist | 38:e44f35f8129d | 690 | //connPort = restPORT; |
arsenalist | 38:e44f35f8129d | 691 | sscanf(restPORT.c_str(),"%d",&connPort); |
arsenalist | 9:a58c04da4476 | 692 | for(int i=0; i<sizeof(s); i++) { |
arsenalist | 9:a58c04da4476 | 693 | s[i]=0; } |
arsenalist | 38:e44f35f8129d | 694 | sprintf(s,"GET /emma/api/controller/register?uid=%s&hmac=%s HTTP/1.0\nHost: %s\r\n\r\n",emmaUID.c_str(),hmac.c_str(),restSERVER.c_str()); |
arsenalist | 38:e44f35f8129d | 695 | //sprintf(s,"POST /emma/api/controller/register HTTP/1.0\nHost: %s\n\n{\"uid\":\"%s\",\"hmac\":\"%s\"}\r\n\r\n",restSERVER.c_str(),emmaUID.c_str(),hmac.c_str()); |
arsenalist | 9:a58c04da4476 | 696 | connData = s; |
arsenalist | 9:a58c04da4476 | 697 | } |
arsenalist | 9:a58c04da4476 | 698 | |
arsenalist | 9:a58c04da4476 | 699 | //register |
arsenalist | 9:a58c04da4476 | 700 | while(!emmaGetRegKey) { |
arsenalist | 38:e44f35f8129d | 701 | //DBG.printf("post:%s\r\n",s); |
arsenalist | 38:e44f35f8129d | 702 | str.clear(); |
arsenalist | 9:a58c04da4476 | 703 | str = ethGET(connHost,connPort,connData); |
arsenalist | 9:a58c04da4476 | 704 | DBG.printf("rsp reg:%s\r\n",str.c_str()); |
arsenalist | 9:a58c04da4476 | 705 | |
arsenalist | 38:e44f35f8129d | 706 | //check and save mqtt setting |
arsenalist | 9:a58c04da4476 | 707 | if(str.find("[") != std::string::npos && str.find("]") != std::string::npos) { |
arsenalist | 9:a58c04da4476 | 708 | str.erase(str.begin(),str.begin()+str.find("[")+1); |
arsenalist | 9:a58c04da4476 | 709 | str.erase(str.begin()+str.find("]"),str.end()); |
arsenalist | 9:a58c04da4476 | 710 | |
arsenalist | 9:a58c04da4476 | 711 | MbedJSONValue jsonValue; |
arsenalist | 9:a58c04da4476 | 712 | parse(jsonValue,str.c_str()); |
arsenalist | 9:a58c04da4476 | 713 | |
arsenalist | 38:e44f35f8129d | 714 | char *parameter[4] = {"mqttDOMAIN","mqttKEY","mqttSECRET","registrationKey"}; |
arsenalist | 9:a58c04da4476 | 715 | |
arsenalist | 38:e44f35f8129d | 716 | //save mqtt parameter |
arsenalist | 9:a58c04da4476 | 717 | writeSetting(parameter[0],"()"); //sd card need to be initialized |
arsenalist | 9:a58c04da4476 | 718 | for(int i=0; i<3; i++) { |
arsenalist | 9:a58c04da4476 | 719 | if(jsonValue.hasMember(parameter[i])) { |
arsenalist | 9:a58c04da4476 | 720 | string val = jsonValue[parameter[i]].get<std::string>(); |
arsenalist | 9:a58c04da4476 | 721 | int st = writeSetting(parameter[i],val.c_str()); |
arsenalist | 9:a58c04da4476 | 722 | if(st) { |
arsenalist | 9:a58c04da4476 | 723 | DBG.printf("%s: %s is saved\r\n",parameter[i],val.c_str()); |
arsenalist | 9:a58c04da4476 | 724 | } else { |
arsenalist | 9:a58c04da4476 | 725 | DBG.printf("%s is not saved\r\n",parameter[i]); |
arsenalist | 9:a58c04da4476 | 726 | } |
arsenalist | 9:a58c04da4476 | 727 | } |
arsenalist | 9:a58c04da4476 | 728 | } |
arsenalist | 9:a58c04da4476 | 729 | |
arsenalist | 9:a58c04da4476 | 730 | //get registrationKey |
arsenalist | 9:a58c04da4476 | 731 | if(jsonValue.hasMember(parameter[3])) { |
arsenalist | 9:a58c04da4476 | 732 | string val = jsonValue[parameter[3]].get<std::string>(); |
arsenalist | 9:a58c04da4476 | 733 | if(val.find("(") != std::string::npos && val.find(")") != std::string::npos) { |
arsenalist | 9:a58c04da4476 | 734 | val.erase(val.begin(),val.begin()+val.find("(")+1); |
arsenalist | 9:a58c04da4476 | 735 | val.erase(val.begin()+val.find(")"),val.end()); |
arsenalist | 9:a58c04da4476 | 736 | regKey = val; |
arsenalist | 9:a58c04da4476 | 737 | DBG.printf("%s: %s\r\n",parameter[3],regKey.c_str()); |
arsenalist | 38:e44f35f8129d | 738 | |
arsenalist | 38:e44f35f8129d | 739 | TFT.locate(0,20); |
arsenalist | 38:e44f35f8129d | 740 | TFT.printf(" %s: %s\r\n",parameter[3],regKey.c_str()); |
arsenalist | 38:e44f35f8129d | 741 | |
arsenalist | 9:a58c04da4476 | 742 | emmaGetRegKey = true; |
arsenalist | 9:a58c04da4476 | 743 | } |
arsenalist | 9:a58c04da4476 | 744 | } |
arsenalist | 9:a58c04da4476 | 745 | } |
arsenalist | 9:a58c04da4476 | 746 | } |
arsenalist | 9:a58c04da4476 | 747 | |
arsenalist | 9:a58c04da4476 | 748 | //calculate hmac |
arsenalist | 9:a58c04da4476 | 749 | for(int i=0; i<sizeof(r); i++) { |
arsenalist | 9:a58c04da4476 | 750 | r[i]=0; } |
arsenalist | 9:a58c04da4476 | 751 | sprintf(r,"emma-%s-%s",emmaUID.c_str(),regKey.c_str()); |
arsenalist | 9:a58c04da4476 | 752 | hmac = calculateMD5(r); |
arsenalist | 9:a58c04da4476 | 753 | DBG.printf("hmac:%s\r\n",hmac.c_str()); |
arsenalist | 9:a58c04da4476 | 754 | |
arsenalist | 9:a58c04da4476 | 755 | //set connData |
arsenalist | 9:a58c04da4476 | 756 | if(useProxy) { |
arsenalist | 9:a58c04da4476 | 757 | DBG.printf("use proxy\r\n"); |
arsenalist | 9:a58c04da4476 | 758 | for(int i=0; i<sizeof(s); i++) { |
arsenalist | 9:a58c04da4476 | 759 | s[i]=0; } |
arsenalist | 38:e44f35f8129d | 760 | sprintf(s,"GET http://%s:%s/emma/api/controller/verify?uid=%s®istrationKey=%s&hmac=%s HTTP/1.0\nHost: %s\r\n\r\n",restSERVER.c_str(),restPORT.c_str(),emmaUID.c_str(),regKey.c_str(),hmac.c_str(),restSERVER.c_str()); |
arsenalist | 9:a58c04da4476 | 761 | connData = s; |
arsenalist | 9:a58c04da4476 | 762 | } else { |
arsenalist | 9:a58c04da4476 | 763 | DBG.printf("no proxy\r\n"); |
arsenalist | 9:a58c04da4476 | 764 | for(int i=0; i<sizeof(s); i++) { |
arsenalist | 9:a58c04da4476 | 765 | s[i]=0; } |
arsenalist | 38:e44f35f8129d | 766 | sprintf(s,"GET /emma/api/controller/verify?uid=%s®istrationKey=%s&hmac=%s HTTP/1.0\nHost: %s\r\n\r\n",emmaUID.c_str(),regKey.c_str(),hmac.c_str(),restSERVER.c_str()); |
arsenalist | 9:a58c04da4476 | 767 | connData = s; |
arsenalist | 9:a58c04da4476 | 768 | } |
arsenalist | 9:a58c04da4476 | 769 | |
arsenalist | 9:a58c04da4476 | 770 | //verify registration |
arsenalist | 9:a58c04da4476 | 771 | while(!emmaRegistered && loop < 12){ |
arsenalist | 9:a58c04da4476 | 772 | str.clear(); |
arsenalist | 9:a58c04da4476 | 773 | str = ethGET(connHost,connPort,connData); |
arsenalist | 9:a58c04da4476 | 774 | DBG.printf("rsp vrf:%s\r\n",str.c_str()); |
arsenalist | 38:e44f35f8129d | 775 | |
arsenalist | 38:e44f35f8129d | 776 | TFT.locate(0,40); |
arsenalist | 38:e44f35f8129d | 777 | TFT.printf(" "); |
arsenalist | 38:e44f35f8129d | 778 | TFT.locate(0,40); |
arsenalist | 38:e44f35f8129d | 779 | TFT.printf(" wait:%d\r\n",loop); |
arsenalist | 9:a58c04da4476 | 780 | |
arsenalist | 9:a58c04da4476 | 781 | //check verification |
arsenalist | 9:a58c04da4476 | 782 | if(str.find("[") != std::string::npos && str.find("]") != std::string::npos) { |
arsenalist | 9:a58c04da4476 | 783 | str.erase(str.begin(),str.begin()+str.find("[")+1); |
arsenalist | 9:a58c04da4476 | 784 | str.erase(str.begin()+str.find("]"),str.end()); |
arsenalist | 9:a58c04da4476 | 785 | |
arsenalist | 9:a58c04da4476 | 786 | MbedJSONValue jsonValue; |
arsenalist | 9:a58c04da4476 | 787 | parse(jsonValue,str.c_str()); |
arsenalist | 9:a58c04da4476 | 788 | if(jsonValue.hasMember("user")) { |
arsenalist | 9:a58c04da4476 | 789 | string val = jsonValue["user"].get<std::string>(); |
arsenalist | 9:a58c04da4476 | 790 | DBG.printf("%s is registered\r\n",val.c_str()); |
arsenalist | 38:e44f35f8129d | 791 | TFT.locate(0,40); |
arsenalist | 38:e44f35f8129d | 792 | TFT.printf(" "); |
arsenalist | 38:e44f35f8129d | 793 | TFT.locate(0,40); |
arsenalist | 38:e44f35f8129d | 794 | TFT.printf(" %s is registered\r\n",val.c_str()); |
arsenalist | 9:a58c04da4476 | 795 | emmaRegistered = true; |
arsenalist | 9:a58c04da4476 | 796 | } |
arsenalist | 9:a58c04da4476 | 797 | } |
arsenalist | 9:a58c04da4476 | 798 | wait(5); |
arsenalist | 9:a58c04da4476 | 799 | loop++; |
arsenalist | 9:a58c04da4476 | 800 | } |
arsenalist | 9:a58c04da4476 | 801 | |
arsenalist | 9:a58c04da4476 | 802 | //check whether registration success |
arsenalist | 9:a58c04da4476 | 803 | if(emmaRegistered) { |
arsenalist | 9:a58c04da4476 | 804 | DBG.printf("registration successful\r\n"); |
arsenalist | 38:e44f35f8129d | 805 | TFT.locate(0,60); |
arsenalist | 38:e44f35f8129d | 806 | TFT.printf(" registration successful\r\n"); |
arsenalist | 9:a58c04da4476 | 807 | } else { |
arsenalist | 9:a58c04da4476 | 808 | DBG.printf("registration unsuccessful\r\n"); |
arsenalist | 38:e44f35f8129d | 809 | TFT.locate(0,60); |
arsenalist | 38:e44f35f8129d | 810 | TFT.printf(" registration unsuccessful. please restart.\r\n"); |
arsenalist | 9:a58c04da4476 | 811 | } |
arsenalist | 9:a58c04da4476 | 812 | while(1); |
arsenalist | 9:a58c04da4476 | 813 | |
arsenalist | 9:a58c04da4476 | 814 | } else if(wifiConnected) { |
arsenalist | 0:f4e449fa34d7 | 815 | DBG.printf("emmaModeRegister - wifi\r\n"); |
arsenalist | 0:f4e449fa34d7 | 816 | |
arsenalist | 0:f4e449fa34d7 | 817 | _ESP.printf("MODE=B"); |
arsenalist | 0:f4e449fa34d7 | 818 | wait(1); |
arsenalist | 0:f4e449fa34d7 | 819 | while(!esp.ready()); |
arsenalist | 0:f4e449fa34d7 | 820 | |
arsenalist | 0:f4e449fa34d7 | 821 | //set connHost, connPort |
arsenalist | 0:f4e449fa34d7 | 822 | if(useProxy) { |
arsenalist | 0:f4e449fa34d7 | 823 | connHost = proxySERVER; |
arsenalist | 0:f4e449fa34d7 | 824 | sscanf(proxyPORT.c_str(),"%d",&connPort); |
arsenalist | 0:f4e449fa34d7 | 825 | } else { |
arsenalist | 38:e44f35f8129d | 826 | connHost = restSERVER; |
arsenalist | 38:e44f35f8129d | 827 | //connPort = restPORT; |
arsenalist | 38:e44f35f8129d | 828 | sscanf(restPORT.c_str(),"%d",&connPort); |
arsenalist | 0:f4e449fa34d7 | 829 | } |
arsenalist | 18:87f30ba9ddc5 | 830 | TFT.locate(0,0); |
arsenalist | 18:87f30ba9ddc5 | 831 | TFT.printf(" emmaModeRegister"); |
arsenalist | 0:f4e449fa34d7 | 832 | |
arsenalist | 0:f4e449fa34d7 | 833 | //rest begin |
arsenalist | 0:f4e449fa34d7 | 834 | if(!rest.begin(connHost.c_str(),connPort,false)) { |
arsenalist | 0:f4e449fa34d7 | 835 | DBG.printf("EMMA: fail to setup rest"); |
arsenalist | 32:78633fb9b2a1 | 836 | TFT.locate(0,20); |
arsenalist | 32:78633fb9b2a1 | 837 | TFT.printf(" fail setup connection"); |
arsenalist | 32:78633fb9b2a1 | 838 | TFT.locate(0,40); |
arsenalist | 32:78633fb9b2a1 | 839 | TFT.printf(" check your wifi connection or"); |
arsenalist | 32:78633fb9b2a1 | 840 | TFT.locate(0,60); |
arsenalist | 32:78633fb9b2a1 | 841 | TFT.printf(" you should setup proxy!"); |
arsenalist | 0:f4e449fa34d7 | 842 | while(1); |
arsenalist | 0:f4e449fa34d7 | 843 | } |
arsenalist | 0:f4e449fa34d7 | 844 | //wifiConnected = true; //with custom firmware, wifi module should connect automatically |
arsenalist | 0:f4e449fa34d7 | 845 | |
arsenalist | 0:f4e449fa34d7 | 846 | esp.process(); |
arsenalist | 0:f4e449fa34d7 | 847 | if(wifiConnected) { |
arsenalist | 32:78633fb9b2a1 | 848 | //check proxy |
arsenalist | 0:f4e449fa34d7 | 849 | if(useProxy) { |
arsenalist | 38:e44f35f8129d | 850 | sprintf(r,"http://%s:%d/emma/api/controller/register",restSERVER.c_str(),restPORT.c_str()); |
arsenalist | 38:e44f35f8129d | 851 | //sprintf(r,"http://%s:%d/emma/api/controller/register HTTP/1.0\nHost: %s:%d\nProxy-Authorization: Basic %s\nCache-Control: no-cache\nContent-Length: %d\n\n",restSERVER,restPORT,restSERVER,restPORT,proxyAUTH.c_str(),76); |
arsenalist | 38:e44f35f8129d | 852 | //sprintf(r,"http://%s:%d/emma/api/controller/register HTTP/1.0\nAccept: */*\nAccept-Encoding: gzip,deflate\nContent-Length: %d\r\n\r\n",restSERVER,restPORT,76); |
arsenalist | 38:e44f35f8129d | 853 | //sprintf(r,"http://%s:%d/emma/coba",restSERVER,REST_SERVER_POR); |
arsenalist | 0:f4e449fa34d7 | 854 | } else { |
arsenalist | 32:78633fb9b2a1 | 855 | sprintf(r,"/emma/api/controller/register"); |
arsenalist | 0:f4e449fa34d7 | 856 | } |
arsenalist | 0:f4e449fa34d7 | 857 | |
arsenalist | 0:f4e449fa34d7 | 858 | //register |
arsenalist | 0:f4e449fa34d7 | 859 | while(!emmaGetRegKey) { |
arsenalist | 32:78633fb9b2a1 | 860 | sprintf(s,"{\"uid\":\"%s\",\"hmac\":\"%s\"}",emmaUID.c_str(),hmac.c_str()); |
arsenalist | 32:78633fb9b2a1 | 861 | DBG.printf("s:%s\r\n",s); |
arsenalist | 32:78633fb9b2a1 | 862 | //string iniStr = "{\"uid\":\"005300553533510334313732\",\"hmac\":\"45fc6a4447989a9434d1f21087a78061\"}"; |
arsenalist | 32:78633fb9b2a1 | 863 | //DBG.printf("s:%s\r\n",iniStr.c_str()); |
arsenalist | 32:78633fb9b2a1 | 864 | |
arsenalist | 32:78633fb9b2a1 | 865 | //rest.post(r,iniStr.c_str()); |
arsenalist | 32:78633fb9b2a1 | 866 | rest.post(r,s); |
arsenalist | 0:f4e449fa34d7 | 867 | for(int i=0; i<sizeof(s); i++) { |
arsenalist | 0:f4e449fa34d7 | 868 | s[i]=0; } |
arsenalist | 0:f4e449fa34d7 | 869 | rest.getResponse(s,sizeof(s)); |
arsenalist | 0:f4e449fa34d7 | 870 | DBG.printf("rsp reg:%s\r\n",s); |
arsenalist | 0:f4e449fa34d7 | 871 | |
arsenalist | 38:e44f35f8129d | 872 | //check and save mqtt setting |
arsenalist | 0:f4e449fa34d7 | 873 | str = s; |
arsenalist | 0:f4e449fa34d7 | 874 | if(str.find("[") != std::string::npos && str.find("]") != std::string::npos) { |
arsenalist | 0:f4e449fa34d7 | 875 | str.erase(str.begin(),str.begin()+str.find("[")+1); |
arsenalist | 0:f4e449fa34d7 | 876 | str.erase(str.begin()+str.find("]"),str.end()); |
arsenalist | 0:f4e449fa34d7 | 877 | |
arsenalist | 0:f4e449fa34d7 | 878 | MbedJSONValue jsonValue; |
arsenalist | 0:f4e449fa34d7 | 879 | parse(jsonValue,str.c_str()); |
arsenalist | 0:f4e449fa34d7 | 880 | |
arsenalist | 38:e44f35f8129d | 881 | char *parameter[4] = {"mqttDOMAIN","mqttKEY","mqttSECRET","registrationKey"}; |
arsenalist | 0:f4e449fa34d7 | 882 | |
arsenalist | 38:e44f35f8129d | 883 | //save mqtt parameter |
arsenalist | 0:f4e449fa34d7 | 884 | writeSetting(parameter[0],"()"); //sd card need to be initialized |
arsenalist | 0:f4e449fa34d7 | 885 | for(int i=0; i<3; i++) { |
arsenalist | 0:f4e449fa34d7 | 886 | if(jsonValue.hasMember(parameter[i])) { |
arsenalist | 0:f4e449fa34d7 | 887 | string val = jsonValue[parameter[i]].get<std::string>(); |
arsenalist | 0:f4e449fa34d7 | 888 | int st = writeSetting(parameter[i],val.c_str()); |
arsenalist | 0:f4e449fa34d7 | 889 | if(st) { |
arsenalist | 0:f4e449fa34d7 | 890 | DBG.printf("%s: %s is saved\r\n",parameter[i],val.c_str()); |
arsenalist | 0:f4e449fa34d7 | 891 | } else { |
arsenalist | 0:f4e449fa34d7 | 892 | DBG.printf("%s is not saved\r\n",parameter[i]); |
arsenalist | 0:f4e449fa34d7 | 893 | } |
arsenalist | 0:f4e449fa34d7 | 894 | } |
arsenalist | 0:f4e449fa34d7 | 895 | } |
arsenalist | 0:f4e449fa34d7 | 896 | |
arsenalist | 0:f4e449fa34d7 | 897 | //get registrationKey |
arsenalist | 0:f4e449fa34d7 | 898 | if(jsonValue.hasMember(parameter[3])) { |
arsenalist | 0:f4e449fa34d7 | 899 | string val = jsonValue[parameter[3]].get<std::string>(); |
arsenalist | 0:f4e449fa34d7 | 900 | if(val.find("(") != std::string::npos && val.find(")") != std::string::npos) { |
arsenalist | 0:f4e449fa34d7 | 901 | val.erase(val.begin(),val.begin()+val.find("(")+1); |
arsenalist | 0:f4e449fa34d7 | 902 | val.erase(val.begin()+val.find(")"),val.end()); |
arsenalist | 0:f4e449fa34d7 | 903 | regKey = val; |
arsenalist | 0:f4e449fa34d7 | 904 | DBG.printf("%s: %s\r\n",parameter[3],regKey.c_str()); |
arsenalist | 18:87f30ba9ddc5 | 905 | |
arsenalist | 18:87f30ba9ddc5 | 906 | TFT.locate(0,20); |
arsenalist | 18:87f30ba9ddc5 | 907 | TFT.printf(" %s: %s\r\n",parameter[3],regKey.c_str()); |
arsenalist | 18:87f30ba9ddc5 | 908 | |
arsenalist | 0:f4e449fa34d7 | 909 | emmaGetRegKey = true; |
arsenalist | 0:f4e449fa34d7 | 910 | } |
arsenalist | 0:f4e449fa34d7 | 911 | } |
arsenalist | 0:f4e449fa34d7 | 912 | } |
arsenalist | 32:78633fb9b2a1 | 913 | wait(1); |
arsenalist | 0:f4e449fa34d7 | 914 | } |
arsenalist | 0:f4e449fa34d7 | 915 | |
arsenalist | 0:f4e449fa34d7 | 916 | //calculate hmac |
arsenalist | 0:f4e449fa34d7 | 917 | for(int i=0; i<sizeof(r); i++) { |
arsenalist | 0:f4e449fa34d7 | 918 | r[i]=0; } |
arsenalist | 0:f4e449fa34d7 | 919 | sprintf(r,"emma-%s-%s",emmaUID.c_str(),regKey.c_str()); |
arsenalist | 0:f4e449fa34d7 | 920 | hmac = calculateMD5(r); |
arsenalist | 0:f4e449fa34d7 | 921 | DBG.printf("hmac:%s\r\n",hmac.c_str()); |
arsenalist | 0:f4e449fa34d7 | 922 | |
arsenalist | 32:78633fb9b2a1 | 923 | //check proxy |
arsenalist | 0:f4e449fa34d7 | 924 | if(useProxy) { |
arsenalist | 38:e44f35f8129d | 925 | sprintf(r,"http://%s:%d/emma/api/controller/verify",restSERVER.c_str(),restPORT.c_str()); |
arsenalist | 0:f4e449fa34d7 | 926 | } else { |
arsenalist | 32:78633fb9b2a1 | 927 | sprintf(r,"/emma/api/controller/verify"); |
arsenalist | 0:f4e449fa34d7 | 928 | } |
arsenalist | 0:f4e449fa34d7 | 929 | |
arsenalist | 0:f4e449fa34d7 | 930 | //verify registration |
arsenalist | 0:f4e449fa34d7 | 931 | while(!emmaRegistered && loop < 12){ |
arsenalist | 32:78633fb9b2a1 | 932 | sprintf(s,"{\"uid\":\"%s\",\"registrationKey\":\"%s\",\"hmac\":\"%s\"}",emmaUID.c_str(),regKey.c_str(),hmac.c_str()); |
arsenalist | 32:78633fb9b2a1 | 933 | rest.post(r,s); |
arsenalist | 0:f4e449fa34d7 | 934 | rest.getResponse(s,sizeof(s)); |
arsenalist | 0:f4e449fa34d7 | 935 | DBG.printf("rsp vrf:%s\r\n",s); |
arsenalist | 18:87f30ba9ddc5 | 936 | TFT.locate(0,40); |
arsenalist | 18:87f30ba9ddc5 | 937 | TFT.printf(" "); |
arsenalist | 18:87f30ba9ddc5 | 938 | TFT.locate(0,40); |
arsenalist | 18:87f30ba9ddc5 | 939 | TFT.printf(" wait:%d\r\n",loop); |
arsenalist | 0:f4e449fa34d7 | 940 | |
arsenalist | 0:f4e449fa34d7 | 941 | //check verification |
arsenalist | 0:f4e449fa34d7 | 942 | str = s; |
arsenalist | 0:f4e449fa34d7 | 943 | if(str.find("[") != std::string::npos && str.find("]") != std::string::npos) { |
arsenalist | 0:f4e449fa34d7 | 944 | str.erase(str.begin(),str.begin()+str.find("[")+1); |
arsenalist | 0:f4e449fa34d7 | 945 | str.erase(str.begin()+str.find("]"),str.end()); |
arsenalist | 0:f4e449fa34d7 | 946 | |
arsenalist | 0:f4e449fa34d7 | 947 | MbedJSONValue jsonValue; |
arsenalist | 0:f4e449fa34d7 | 948 | parse(jsonValue,str.c_str()); |
arsenalist | 0:f4e449fa34d7 | 949 | if(jsonValue.hasMember("user")) { |
arsenalist | 0:f4e449fa34d7 | 950 | string val = jsonValue["user"].get<std::string>(); |
arsenalist | 18:87f30ba9ddc5 | 951 | DBG.printf(" %s is registered\r\n",val.c_str()); |
arsenalist | 18:87f30ba9ddc5 | 952 | TFT.locate(0,40); |
arsenalist | 18:87f30ba9ddc5 | 953 | TFT.printf(" "); |
arsenalist | 18:87f30ba9ddc5 | 954 | TFT.locate(0,40); |
arsenalist | 18:87f30ba9ddc5 | 955 | TFT.printf(" %s is registered\r\n",val.c_str()); |
arsenalist | 0:f4e449fa34d7 | 956 | emmaRegistered = true; |
arsenalist | 0:f4e449fa34d7 | 957 | } |
arsenalist | 0:f4e449fa34d7 | 958 | } |
arsenalist | 0:f4e449fa34d7 | 959 | wait(5); |
arsenalist | 0:f4e449fa34d7 | 960 | loop++; |
arsenalist | 0:f4e449fa34d7 | 961 | } |
arsenalist | 0:f4e449fa34d7 | 962 | |
arsenalist | 0:f4e449fa34d7 | 963 | //check whether registration success |
arsenalist | 0:f4e449fa34d7 | 964 | if(emmaRegistered) { |
arsenalist | 0:f4e449fa34d7 | 965 | DBG.printf("registration successful\r\n"); |
arsenalist | 18:87f30ba9ddc5 | 966 | TFT.locate(0,60); |
arsenalist | 18:87f30ba9ddc5 | 967 | TFT.printf(" registration successful\r\n"); |
arsenalist | 0:f4e449fa34d7 | 968 | } else { |
arsenalist | 0:f4e449fa34d7 | 969 | DBG.printf("registration unsuccessful\r\n"); |
arsenalist | 18:87f30ba9ddc5 | 970 | TFT.locate(0,60); |
arsenalist | 38:e44f35f8129d | 971 | TFT.printf(" registration unsuccessful. please restart.\r\n"); |
arsenalist | 0:f4e449fa34d7 | 972 | } |
arsenalist | 0:f4e449fa34d7 | 973 | while(1); |
arsenalist | 0:f4e449fa34d7 | 974 | } |
arsenalist | 0:f4e449fa34d7 | 975 | |
arsenalist | 9:a58c04da4476 | 976 | } else if(gprsConnected) { |
arsenalist | 0:f4e449fa34d7 | 977 | DBG.printf("emmaModeRegister - gprs\r\n"); |
arsenalist | 0:f4e449fa34d7 | 978 | |
arsenalist | 0:f4e449fa34d7 | 979 | } else { |
arsenalist | 9:a58c04da4476 | 980 | DBG.printf("no eth, wifi, or gprs is connected\r\n"); |
arsenalist | 18:87f30ba9ddc5 | 981 | TFT.locate(0,60); |
arsenalist | 18:87f30ba9ddc5 | 982 | TFT.printf(" no iface connected. please restart.\r\n"); |
arsenalist | 0:f4e449fa34d7 | 983 | } |
arsenalist | 0:f4e449fa34d7 | 984 | } |
arsenalist | 0:f4e449fa34d7 | 985 | |
arsenalist | 0:f4e449fa34d7 | 986 | void emmaModeOperation(void) { |
arsenalist | 27:562a95c120cc | 987 | //char mqttClientId[32]; |
arsenalist | 22:e18d361bf688 | 988 | char p[64]; |
arsenalist | 14:8287f0f5d987 | 989 | char q[32]; |
arsenalist | 4:76ab12e2f8a3 | 990 | char r[32]; |
arsenalist | 34:8555d471b880 | 991 | char s[4096]; |
arsenalist | 38:e44f35f8129d | 992 | int connPort; |
arsenalist | 0:f4e449fa34d7 | 993 | int loop=0; |
arsenalist | 21:33bd8b82560f | 994 | int trial=0; |
arsenalist | 22:e18d361bf688 | 995 | string hmacTime; |
arsenalist | 23:fb369e171b7d | 996 | string hmacCmd; |
arsenalist | 0:f4e449fa34d7 | 997 | string str; |
arsenalist | 14:8287f0f5d987 | 998 | time_t seconds; |
arsenalist | 0:f4e449fa34d7 | 999 | Timer t; |
arsenalist | 24:5d58515ba510 | 1000 | Timer tPanelEnergy; |
arsenalist | 24:5d58515ba510 | 1001 | Timer tPanel; |
arsenalist | 4:76ab12e2f8a3 | 1002 | Timer tNodes; |
arsenalist | 0:f4e449fa34d7 | 1003 | |
arsenalist | 19:7e3e9332f719 | 1004 | TFT.locate(0,0); |
arsenalist | 19:7e3e9332f719 | 1005 | TFT.printf(" please wait"); |
arsenalist | 19:7e3e9332f719 | 1006 | |
arsenalist | 0:f4e449fa34d7 | 1007 | //check connected interface |
arsenalist | 8:51a0ca9079ca | 1008 | isEthConnected(); |
arsenalist | 8:51a0ca9079ca | 1009 | isWiFiConnected(); |
arsenalist | 8:51a0ca9079ca | 1010 | isGprsConnected(); |
arsenalist | 0:f4e449fa34d7 | 1011 | DBG.printf("ethConnected:%d\r\n",ethConnected); |
arsenalist | 0:f4e449fa34d7 | 1012 | DBG.printf("wifiConnected:%d\r\n",wifiConnected); |
arsenalist | 0:f4e449fa34d7 | 1013 | |
arsenalist | 13:e8adfe305dbc | 1014 | TFT.locate(0,0); |
arsenalist | 13:e8adfe305dbc | 1015 | TFT.printf(" emmaModeOperation"); |
arsenalist | 13:e8adfe305dbc | 1016 | |
arsenalist | 13:e8adfe305dbc | 1017 | TFT.locate(0,20); |
arsenalist | 13:e8adfe305dbc | 1018 | if(ethConnected) { |
arsenalist | 13:e8adfe305dbc | 1019 | TFT.printf("ETH:Avail"); |
arsenalist | 13:e8adfe305dbc | 1020 | } else { |
arsenalist | 13:e8adfe305dbc | 1021 | TFT.printf("ETH:N/A"); |
arsenalist | 13:e8adfe305dbc | 1022 | } |
arsenalist | 13:e8adfe305dbc | 1023 | |
arsenalist | 13:e8adfe305dbc | 1024 | TFT.locate(80,20); |
arsenalist | 13:e8adfe305dbc | 1025 | if(wifiConnected) { |
arsenalist | 13:e8adfe305dbc | 1026 | TFT.printf("WiFi:Avail"); |
arsenalist | 13:e8adfe305dbc | 1027 | } else { |
arsenalist | 13:e8adfe305dbc | 1028 | TFT.printf("WiFi:N/A"); |
arsenalist | 13:e8adfe305dbc | 1029 | } |
arsenalist | 13:e8adfe305dbc | 1030 | |
arsenalist | 13:e8adfe305dbc | 1031 | TFT.locate(160,20); |
arsenalist | 13:e8adfe305dbc | 1032 | if(gprsConnected) { |
arsenalist | 13:e8adfe305dbc | 1033 | TFT.printf("GPRS:Avail"); |
arsenalist | 13:e8adfe305dbc | 1034 | } else { |
arsenalist | 13:e8adfe305dbc | 1035 | TFT.printf("GPRS:N/A"); |
arsenalist | 13:e8adfe305dbc | 1036 | } |
arsenalist | 13:e8adfe305dbc | 1037 | |
arsenalist | 10:1dc69e0ce7fd | 1038 | if(ethConnected) { |
arsenalist | 10:1dc69e0ce7fd | 1039 | DBG.printf("emmaModeOperation - eth\r\n"); |
arsenalist | 10:1dc69e0ce7fd | 1040 | //DBG.printf("IP Address:%s\r\n",ipstack.getEth().getIPAddress()); |
arsenalist | 10:1dc69e0ce7fd | 1041 | //DBG.printf("MAC Address:%s\r\n",ipstack.getEth().getMACAddress()); |
arsenalist | 37:93f196daf5cf | 1042 | //ethMQTTAttemptConnect(&client, &ipstack); |
arsenalist | 36:ed696fd1b44e | 1043 | t.start(); |
arsenalist | 10:1dc69e0ce7fd | 1044 | DBG.printf("start\r\n"); |
arsenalist | 37:93f196daf5cf | 1045 | /* |
arsenalist | 10:1dc69e0ce7fd | 1046 | while(true) { |
arsenalist | 36:ed696fd1b44e | 1047 | if(!ipstack.getEth().linkstatus()) { |
arsenalist | 36:ed696fd1b44e | 1048 | NVIC_SystemReset(); |
arsenalist | 36:ed696fd1b44e | 1049 | } |
arsenalist | 36:ed696fd1b44e | 1050 | if(t.read_ms() > 5000) { |
arsenalist | 36:ed696fd1b44e | 1051 | if(publish(&client,&ipstack) != 0) |
arsenalist | 36:ed696fd1b44e | 1052 | ethMQTTAttemptConnect(&client, &ipstack); |
arsenalist | 36:ed696fd1b44e | 1053 | t.reset(); |
arsenalist | 36:ed696fd1b44e | 1054 | } |
arsenalist | 10:1dc69e0ce7fd | 1055 | client.yield(100); //allow MQTT client to receive message |
arsenalist | 10:1dc69e0ce7fd | 1056 | } |
arsenalist | 37:93f196daf5cf | 1057 | */ |
arsenalist | 10:1dc69e0ce7fd | 1058 | } else if(wifiConnected) { |
arsenalist | 0:f4e449fa34d7 | 1059 | DBG.printf("emmaModeOperation - wifi\r\n"); |
arsenalist | 29:4d94a03d38e0 | 1060 | |
arsenalist | 30:08d290158fa7 | 1061 | //start new log and dbg indicator |
arsenalist | 29:4d94a03d38e0 | 1062 | seconds = time(NULL); |
arsenalist | 29:4d94a03d38e0 | 1063 | strftime(q, 32, "%Y-%m-%d %H:%M:%S",localtime(&seconds)); |
arsenalist | 29:4d94a03d38e0 | 1064 | DBG.printf("newLog:%d\r\n",writeLog(q,"++++++++++++++++++++")); |
arsenalist | 36:ed696fd1b44e | 1065 | //DBG.printf("newDbg:%d\r\n",writeDbg(q,"++++++++++++++++++++")); |
arsenalist | 0:f4e449fa34d7 | 1066 | |
arsenalist | 0:f4e449fa34d7 | 1067 | //do not delete code below - indicator that esp need to MODE=B and esp.ready() to work |
arsenalist | 0:f4e449fa34d7 | 1068 | //_ESP.printf("MODE=B"); |
arsenalist | 0:f4e449fa34d7 | 1069 | //wait(1); |
arsenalist | 0:f4e449fa34d7 | 1070 | //while(!esp.ready()); |
arsenalist | 0:f4e449fa34d7 | 1071 | |
arsenalist | 24:5d58515ba510 | 1072 | /* |
arsenalist | 0:f4e449fa34d7 | 1073 | DBG.printf("emma: setup mqtt client\r\n"); |
arsenalist | 0:f4e449fa34d7 | 1074 | sprintf(mqttClientId,"emma/%s",emmaUID.c_str()); |
arsenalist | 0:f4e449fa34d7 | 1075 | |
arsenalist | 38:e44f35f8129d | 1076 | if(mqtt.begin(mqttClientId, mqttKEY.c_str(), mqttSECRET.c_str(), 120, 1)) { |
arsenalist | 0:f4e449fa34d7 | 1077 | mqtt.connectedCb.attach(&mqttConnected); |
arsenalist | 0:f4e449fa34d7 | 1078 | mqtt.disconnectedCb.attach(&mqttDisconnected); |
arsenalist | 38:e44f35f8129d | 1079 | mqtt.connect(mqttSERVER,mqttPORT,false); |
arsenalist | 13:e8adfe305dbc | 1080 | DBG.printf("emma: success to setup mqtt\r\n"); |
arsenalist | 13:e8adfe305dbc | 1081 | TFT.locate(0,40); |
arsenalist | 13:e8adfe305dbc | 1082 | TFT.printf("emma: success to setup mqtt"); |
arsenalist | 0:f4e449fa34d7 | 1083 | } |
arsenalist | 0:f4e449fa34d7 | 1084 | DBG.printf("emma: system started\r\n"); |
arsenalist | 24:5d58515ba510 | 1085 | */ |
arsenalist | 0:f4e449fa34d7 | 1086 | |
arsenalist | 24:5d58515ba510 | 1087 | //t.start(); |
arsenalist | 24:5d58515ba510 | 1088 | //while(t.read_ms() < 5000) { |
arsenalist | 24:5d58515ba510 | 1089 | // esp.process(); |
arsenalist | 24:5d58515ba510 | 1090 | //} |
arsenalist | 24:5d58515ba510 | 1091 | //t.stop(); |
arsenalist | 24:5d58515ba510 | 1092 | //t.reset(); |
arsenalist | 0:f4e449fa34d7 | 1093 | |
arsenalist | 0:f4e449fa34d7 | 1094 | //set ade7758 parameter |
arsenalist | 0:f4e449fa34d7 | 1095 | ADE.begin(); |
arsenalist | 0:f4e449fa34d7 | 1096 | |
arsenalist | 0:f4e449fa34d7 | 1097 | ADE.writeRMSOffset(AIRMSOFFSET, BIRMSOFFSET, CIRMSOFFSET, AVRMSOFFSET, BVRMSOFFSET, CVRMSOFFSET); |
arsenalist | 0:f4e449fa34d7 | 1098 | |
arsenalist | 0:f4e449fa34d7 | 1099 | ADE.write16bits(AWG, 0); |
arsenalist | 0:f4e449fa34d7 | 1100 | ADE.write16bits(BWG, 0); |
arsenalist | 0:f4e449fa34d7 | 1101 | ADE.write16bits(CWG, 0); |
arsenalist | 0:f4e449fa34d7 | 1102 | ADE.write16bits(AVAG, 0); |
arsenalist | 0:f4e449fa34d7 | 1103 | ADE.write16bits(BVAG, 0); |
arsenalist | 0:f4e449fa34d7 | 1104 | ADE.write16bits(CVAG, 0); |
arsenalist | 0:f4e449fa34d7 | 1105 | |
arsenalist | 4:76ab12e2f8a3 | 1106 | //init rest to server |
arsenalist | 38:e44f35f8129d | 1107 | sscanf(restPORT.c_str(),"%d",&connPort); |
arsenalist | 38:e44f35f8129d | 1108 | if(rest.begin(restSERVER.c_str(),connPort,false)) { |
arsenalist | 4:76ab12e2f8a3 | 1109 | DBG.printf("rest to server is created\r\n"); |
arsenalist | 13:e8adfe305dbc | 1110 | TFT.locate(0,40); |
arsenalist | 13:e8adfe305dbc | 1111 | TFT.printf(" "); |
arsenalist | 13:e8adfe305dbc | 1112 | TFT.locate(0,40); |
arsenalist | 13:e8adfe305dbc | 1113 | TFT.printf("rest to server is created"); |
arsenalist | 4:76ab12e2f8a3 | 1114 | } else { |
arsenalist | 4:76ab12e2f8a3 | 1115 | DBG.printf("rest to server is NOT created\r\n"); |
arsenalist | 13:e8adfe305dbc | 1116 | TFT.locate(0,40); |
arsenalist | 13:e8adfe305dbc | 1117 | TFT.printf(" "); |
arsenalist | 13:e8adfe305dbc | 1118 | TFT.locate(0,40); |
arsenalist | 13:e8adfe305dbc | 1119 | TFT.printf("rest to server is NOT created"); |
arsenalist | 4:76ab12e2f8a3 | 1120 | } |
arsenalist | 4:76ab12e2f8a3 | 1121 | |
arsenalist | 7:7e8c6ad3fd64 | 1122 | //check firmware update |
arsenalist | 7:7e8c6ad3fd64 | 1123 | |
arsenalist | 7:7e8c6ad3fd64 | 1124 | //execute last state of switches on board |
arsenalist | 7:7e8c6ad3fd64 | 1125 | |
arsenalist | 7:7e8c6ad3fd64 | 1126 | //get list of nodes from server |
arsenalist | 7:7e8c6ad3fd64 | 1127 | sprintf(s,"/emma/api/controller/remotes?uid=%s&hmac=%s",emmaUID.c_str(),hmac.c_str()); |
arsenalist | 7:7e8c6ad3fd64 | 1128 | rest.get(s); |
arsenalist | 7:7e8c6ad3fd64 | 1129 | for(int i=0; i<sizeof(s); i++) { |
arsenalist | 7:7e8c6ad3fd64 | 1130 | s[i]=0; } |
arsenalist | 7:7e8c6ad3fd64 | 1131 | rest.getResponse(s,sizeof(s)); |
arsenalist | 7:7e8c6ad3fd64 | 1132 | str = s; |
arsenalist | 7:7e8c6ad3fd64 | 1133 | if(str.rfind("[{\"mac\"") != std::string::npos) { |
arsenalist | 7:7e8c6ad3fd64 | 1134 | DBG.printf("get nodes from server\r\n"); |
arsenalist | 7:7e8c6ad3fd64 | 1135 | str.erase(str.begin(),str.begin()+str.rfind("[{\"mac\"")); |
arsenalist | 7:7e8c6ad3fd64 | 1136 | str.erase(str.begin()+str.rfind("}]")+2,str.end()); |
arsenalist | 7:7e8c6ad3fd64 | 1137 | |
arsenalist | 7:7e8c6ad3fd64 | 1138 | MbedJSONValue jsonValue; |
arsenalist | 7:7e8c6ad3fd64 | 1139 | parse(jsonValue,str.c_str()); |
arsenalist | 7:7e8c6ad3fd64 | 1140 | char *parameter[2] = {"mac","ip"}; |
arsenalist | 7:7e8c6ad3fd64 | 1141 | |
arsenalist | 13:e8adfe305dbc | 1142 | TFT.locate(0,40); |
arsenalist | 13:e8adfe305dbc | 1143 | TFT.printf(" "); |
arsenalist | 13:e8adfe305dbc | 1144 | TFT.locate(0,40); |
arsenalist | 13:e8adfe305dbc | 1145 | TFT.printf("get %d nodes from server",jsonValue.size()); |
arsenalist | 13:e8adfe305dbc | 1146 | wait(0.5); |
arsenalist | 13:e8adfe305dbc | 1147 | TFT.locate(0,40); |
arsenalist | 13:e8adfe305dbc | 1148 | TFT.printf(" "); |
arsenalist | 13:e8adfe305dbc | 1149 | |
arsenalist | 7:7e8c6ad3fd64 | 1150 | //check whether nodes valid |
arsenalist | 7:7e8c6ad3fd64 | 1151 | bool validNodes = true; |
arsenalist | 7:7e8c6ad3fd64 | 1152 | for(int i=0; i<jsonValue.size(); i++) { |
arsenalist | 7:7e8c6ad3fd64 | 1153 | for(int j=0; j<2; j++) { |
arsenalist | 7:7e8c6ad3fd64 | 1154 | validNodes = validNodes && jsonValue[i].hasMember(parameter[j]); |
arsenalist | 7:7e8c6ad3fd64 | 1155 | } |
arsenalist | 7:7e8c6ad3fd64 | 1156 | } |
arsenalist | 7:7e8c6ad3fd64 | 1157 | DBG.printf("nodes validity:%d\r\n",validNodes); |
arsenalist | 7:7e8c6ad3fd64 | 1158 | |
arsenalist | 7:7e8c6ad3fd64 | 1159 | if(validNodes) { |
arsenalist | 7:7e8c6ad3fd64 | 1160 | for(int i=0; i<jsonValue.size(); i++) { |
arsenalist | 7:7e8c6ad3fd64 | 1161 | string macValue = jsonValue[i][parameter[0]].get<std::string>(); |
arsenalist | 7:7e8c6ad3fd64 | 1162 | string ipValue = jsonValue[i][parameter[1]].get<std::string>(); |
arsenalist | 7:7e8c6ad3fd64 | 1163 | nodes[i].macAddr = macValue; |
arsenalist | 7:7e8c6ad3fd64 | 1164 | nodes[i].ipAddr = ipValue; |
arsenalist | 13:e8adfe305dbc | 1165 | DBG.printf("nodes[%d]mac:%s\r\n",i,nodes[i].macAddr.c_str()); |
arsenalist | 13:e8adfe305dbc | 1166 | DBG.printf("nodes[%d]ip:%s\r\n",i,nodes[i].ipAddr.c_str()); |
arsenalist | 7:7e8c6ad3fd64 | 1167 | } |
arsenalist | 7:7e8c6ad3fd64 | 1168 | } |
arsenalist | 7:7e8c6ad3fd64 | 1169 | |
arsenalist | 7:7e8c6ad3fd64 | 1170 | } else { |
arsenalist | 7:7e8c6ad3fd64 | 1171 | DBG.printf("no nodes from server\r\n"); |
arsenalist | 7:7e8c6ad3fd64 | 1172 | } |
arsenalist | 7:7e8c6ad3fd64 | 1173 | |
arsenalist | 24:5d58515ba510 | 1174 | /* |
arsenalist | 36:ed696fd1b44e | 1175 | //working |
arsenalist | 24:5d58515ba510 | 1176 | DBG.printf("emma: setup mqtt client\r\n"); |
arsenalist | 24:5d58515ba510 | 1177 | sprintf(mqttClientId,"emma/%s",emmaUID.c_str()); |
arsenalist | 38:e44f35f8129d | 1178 | if(mqtt.begin(mqttClientId, mqttKEY.c_str(), mqttSECRET.c_str(), 120, 1)) { |
arsenalist | 24:5d58515ba510 | 1179 | mqtt.connectedCb.attach(&mqttConnected); |
arsenalist | 24:5d58515ba510 | 1180 | mqtt.disconnectedCb.attach(&mqttDisconnected); |
arsenalist | 38:e44f35f8129d | 1181 | mqtt.connect(mqttSERVER,mqttPORT,false); |
arsenalist | 24:5d58515ba510 | 1182 | DBG.printf("emma: success to setup mqtt\r\n"); |
arsenalist | 24:5d58515ba510 | 1183 | TFT.locate(0,40); |
arsenalist | 24:5d58515ba510 | 1184 | TFT.printf("emma: success to setup mqtt"); |
arsenalist | 24:5d58515ba510 | 1185 | } |
arsenalist | 24:5d58515ba510 | 1186 | DBG.printf("emma: system started\r\n"); |
arsenalist | 24:5d58515ba510 | 1187 | |
arsenalist | 24:5d58515ba510 | 1188 | t.start(); |
arsenalist | 24:5d58515ba510 | 1189 | while(t.read_ms() < 5000) { |
arsenalist | 24:5d58515ba510 | 1190 | esp.process(); |
arsenalist | 24:5d58515ba510 | 1191 | } |
arsenalist | 24:5d58515ba510 | 1192 | t.stop(); |
arsenalist | 24:5d58515ba510 | 1193 | t.reset(); |
arsenalist | 24:5d58515ba510 | 1194 | */ |
arsenalist | 7:7e8c6ad3fd64 | 1195 | |
arsenalist | 4:76ab12e2f8a3 | 1196 | //init rest to remotes |
arsenalist | 4:76ab12e2f8a3 | 1197 | for(int i=0; i<NODES_MAX; i++) { |
arsenalist | 4:76ab12e2f8a3 | 1198 | if(!nodes[i].ipAddr.empty()) { |
arsenalist | 4:76ab12e2f8a3 | 1199 | DBG.printf("restConn nodes[%d] is created\r\n",i); |
arsenalist | 4:76ab12e2f8a3 | 1200 | nodes[i].restConn->begin(nodes[i].ipAddr.c_str(),16038,false); |
arsenalist | 4:76ab12e2f8a3 | 1201 | wait(1); |
arsenalist | 4:76ab12e2f8a3 | 1202 | } else { |
arsenalist | 4:76ab12e2f8a3 | 1203 | DBG.printf("restConn nodes[%d] is NOT created\r\n",i); |
arsenalist | 4:76ab12e2f8a3 | 1204 | wait(1); |
arsenalist | 4:76ab12e2f8a3 | 1205 | } |
arsenalist | 4:76ab12e2f8a3 | 1206 | } |
arsenalist | 4:76ab12e2f8a3 | 1207 | |
arsenalist | 4:76ab12e2f8a3 | 1208 | _ESP.attach(&rxInterrupt,Serial::RxIrq); |
arsenalist | 4:76ab12e2f8a3 | 1209 | |
arsenalist | 4:76ab12e2f8a3 | 1210 | //define thread |
arsenalist | 17:b3ced0e67916 | 1211 | osThreadDef(energyThread, osPriorityBelowNormal, (8*DEFAULT_STACK_SIZE)); |
arsenalist | 0:f4e449fa34d7 | 1212 | //create thread |
arsenalist | 2:fdfdeb5fd6fd | 1213 | osThreadCreate(osThread(energyThread),NULL); |
arsenalist | 0:f4e449fa34d7 | 1214 | |
arsenalist | 24:5d58515ba510 | 1215 | tPanelEnergy.start(); |
arsenalist | 24:5d58515ba510 | 1216 | tPanel.start(); |
arsenalist | 4:76ab12e2f8a3 | 1217 | tNodes.start(); |
arsenalist | 4:76ab12e2f8a3 | 1218 | wait(1); |
arsenalist | 0:f4e449fa34d7 | 1219 | while(1) { |
arsenalist | 4:76ab12e2f8a3 | 1220 | checkRxBuffer(); |
arsenalist | 20:ea14f175bbb4 | 1221 | checkVoltagePower(); |
arsenalist | 20:ea14f175bbb4 | 1222 | |
arsenalist | 24:5d58515ba510 | 1223 | //whether espFreeMemory occurs |
arsenalist | 24:5d58515ba510 | 1224 | if(espFreeMemory) { |
arsenalist | 30:08d290158fa7 | 1225 | //logging |
arsenalist | 27:562a95c120cc | 1226 | seconds = time(NULL); |
arsenalist | 27:562a95c120cc | 1227 | strftime(q, 32, "%Y-%m-%d %H:%M:%S",localtime(&seconds)); |
arsenalist | 27:562a95c120cc | 1228 | DBG.printf("logFreeMemory:%d\r\n",writeLog(q,rxLog.c_str())); |
arsenalist | 24:5d58515ba510 | 1229 | |
arsenalist | 27:562a95c120cc | 1230 | espFreeMemory = false; |
arsenalist | 27:562a95c120cc | 1231 | } |
arsenalist | 27:562a95c120cc | 1232 | |
arsenalist | 27:562a95c120cc | 1233 | //whether espDHCPClientStart occurs |
arsenalist | 27:562a95c120cc | 1234 | if(espDHCPClientStart) { |
arsenalist | 30:08d290158fa7 | 1235 | //logging |
arsenalist | 27:562a95c120cc | 1236 | seconds = time(NULL); |
arsenalist | 27:562a95c120cc | 1237 | strftime(q, 32, "%Y-%m-%d %H:%M:%S",localtime(&seconds)); |
arsenalist | 27:562a95c120cc | 1238 | DBG.printf("logDHCPClientStart:%d\r\n",writeLog(q,rxLogA.c_str())); |
arsenalist | 27:562a95c120cc | 1239 | |
arsenalist | 27:562a95c120cc | 1240 | _ESP.printf("MODE=B"); |
arsenalist | 27:562a95c120cc | 1241 | wait(2); |
arsenalist | 27:562a95c120cc | 1242 | espDHCPClientStart = false; |
arsenalist | 24:5d58515ba510 | 1243 | } |
arsenalist | 24:5d58515ba510 | 1244 | |
arsenalist | 4:76ab12e2f8a3 | 1245 | //panelEnergy, panelVoltage, and panelPower |
arsenalist | 24:5d58515ba510 | 1246 | if(tPanelEnergy.read() > 30.0f) { |
arsenalist | 4:76ab12e2f8a3 | 1247 | DBG.printf("[%d]WattHR for each phase: %.2f, %.2f, %.2f\r\n", loop, AWattHr, BWattHr, CWattHr); |
arsenalist | 13:e8adfe305dbc | 1248 | TFT.locate(0,60); |
arsenalist | 13:e8adfe305dbc | 1249 | TFT.printf(" "); |
arsenalist | 13:e8adfe305dbc | 1250 | TFT.locate(0,60); |
arsenalist | 13:e8adfe305dbc | 1251 | TFT.printf("[%d]WHR: %.1f, %.1f, %.1f", loop, AWattHr, BWattHr, CWattHr); |
arsenalist | 13:e8adfe305dbc | 1252 | |
arsenalist | 4:76ab12e2f8a3 | 1253 | DBG.printf("VRMS for each phase: %.2f, %.2f, %.2f\r\n", AVrms, BVrms, CVrms); |
arsenalist | 13:e8adfe305dbc | 1254 | TFT.locate(0,80); |
arsenalist | 13:e8adfe305dbc | 1255 | TFT.printf(" "); |
arsenalist | 13:e8adfe305dbc | 1256 | TFT.locate(0,80); |
arsenalist | 13:e8adfe305dbc | 1257 | TFT.printf("VRMS: %.1f, %.1f, %.1f", AVrms, BVrms, CVrms); |
arsenalist | 13:e8adfe305dbc | 1258 | |
arsenalist | 4:76ab12e2f8a3 | 1259 | DBG.printf("Watt for each phase: %.2f, %.2f, %.2f\r\n", AWatt, BWatt, CWatt); |
arsenalist | 13:e8adfe305dbc | 1260 | TFT.locate(0,100); |
arsenalist | 13:e8adfe305dbc | 1261 | TFT.printf(" "); |
arsenalist | 13:e8adfe305dbc | 1262 | TFT.locate(0,100); |
arsenalist | 13:e8adfe305dbc | 1263 | TFT.printf("Watt: %.1f, %.1f, %.1f", AWatt, BWatt, CWatt); |
arsenalist | 4:76ab12e2f8a3 | 1264 | |
arsenalist | 22:e18d361bf688 | 1265 | if(newEnergyData) { |
arsenalist | 22:e18d361bf688 | 1266 | //for(int i=1; i<4; i++) { |
arsenalist | 22:e18d361bf688 | 1267 | for(int i=1; i<2; i++) { |
arsenalist | 22:e18d361bf688 | 1268 | DBG.printf("sending channel: %d\r\n",i); |
arsenalist | 22:e18d361bf688 | 1269 | if(i==1){ |
arsenalist | 22:e18d361bf688 | 1270 | XWattHr = AWattHr; |
arsenalist | 22:e18d361bf688 | 1271 | XVrms = AVrms; |
arsenalist | 22:e18d361bf688 | 1272 | XWatt = AWatt; |
arsenalist | 22:e18d361bf688 | 1273 | } else if(i==2) { |
arsenalist | 22:e18d361bf688 | 1274 | XWattHr = BWattHr; |
arsenalist | 22:e18d361bf688 | 1275 | XVrms = BVrms; |
arsenalist | 22:e18d361bf688 | 1276 | XWatt = BWatt; |
arsenalist | 22:e18d361bf688 | 1277 | } else { |
arsenalist | 22:e18d361bf688 | 1278 | XWattHr = CWattHr; |
arsenalist | 22:e18d361bf688 | 1279 | XVrms = CVrms; |
arsenalist | 22:e18d361bf688 | 1280 | XWatt = CWatt; |
arsenalist | 22:e18d361bf688 | 1281 | } |
arsenalist | 24:5d58515ba510 | 1282 | |
arsenalist | 24:5d58515ba510 | 1283 | if(XWattHr != 0.0f) { |
arsenalist | 22:e18d361bf688 | 1284 | |
arsenalist | 24:5d58515ba510 | 1285 | sprintf(r,"/emma/api/controller/energy/%d",i); |
arsenalist | 24:5d58515ba510 | 1286 | seconds = time(NULL); |
arsenalist | 24:5d58515ba510 | 1287 | //for(int j=0; j<sizeof(q); j++) { |
arsenalist | 24:5d58515ba510 | 1288 | // q[j]=0; } |
arsenalist | 24:5d58515ba510 | 1289 | strftime(q, 32, "%Y-%m-%d %H:%M:%S",localtime(&seconds)); |
arsenalist | 24:5d58515ba510 | 1290 | |
arsenalist | 24:5d58515ba510 | 1291 | //calculate hmacTime |
arsenalist | 24:5d58515ba510 | 1292 | for(int j=0; j<sizeof(p); j++) { |
arsenalist | 24:5d58515ba510 | 1293 | p[j]=0; } |
arsenalist | 24:5d58515ba510 | 1294 | sprintf(p,"emma-%s-%s",emmaUID.c_str(),q); |
arsenalist | 24:5d58515ba510 | 1295 | hmacTime = calculateMD5(p); |
arsenalist | 22:e18d361bf688 | 1296 | |
arsenalist | 24:5d58515ba510 | 1297 | sprintf(s,"{\"uid\":\"%s\",\"hmac\":\"%s\",\"time\":\"%s\",\"energy\":%.2f,\"voltage\":%.2f,\"power\":%.2f}", |
arsenalist | 24:5d58515ba510 | 1298 | emmaUID.c_str(),hmacTime.c_str(),q,XWattHr,XVrms,XWatt); |
arsenalist | 24:5d58515ba510 | 1299 | //DBG.printf("dataEnergy:\r\n%s\r\n",s); |
arsenalist | 24:5d58515ba510 | 1300 | rest.post(r,s); |
arsenalist | 24:5d58515ba510 | 1301 | wait(2); |
arsenalist | 24:5d58515ba510 | 1302 | if(rxBuf.find("\"status\":\"success\"") != std::string::npos) { |
arsenalist | 27:562a95c120cc | 1303 | //logging purpose |
arsenalist | 27:562a95c120cc | 1304 | seconds = time(NULL); |
arsenalist | 27:562a95c120cc | 1305 | strftime(q, 32, "%Y-%m-%d %H:%M:%S",localtime(&seconds)); |
arsenalist | 27:562a95c120cc | 1306 | DBG.printf("logPE:%d\r\n",writeLog(q,"sendEnergyData success")); |
arsenalist | 27:562a95c120cc | 1307 | |
arsenalist | 24:5d58515ba510 | 1308 | DBG.printf("send channel: %d success\r\n",i); |
arsenalist | 24:5d58515ba510 | 1309 | TFT.foreground(Green); |
arsenalist | 24:5d58515ba510 | 1310 | TFT.locate(0,120); |
arsenalist | 24:5d58515ba510 | 1311 | TFT.printf(" "); |
arsenalist | 24:5d58515ba510 | 1312 | TFT.locate(0,120); |
arsenalist | 24:5d58515ba510 | 1313 | TFT.printf("send ch%d success",i); |
arsenalist | 24:5d58515ba510 | 1314 | wait(1); |
arsenalist | 24:5d58515ba510 | 1315 | TFT.locate(0,120); |
arsenalist | 24:5d58515ba510 | 1316 | TFT.printf(" "); |
arsenalist | 24:5d58515ba510 | 1317 | TFT.foreground(White); |
arsenalist | 24:5d58515ba510 | 1318 | } else { |
arsenalist | 27:562a95c120cc | 1319 | //logging purpose |
arsenalist | 27:562a95c120cc | 1320 | seconds = time(NULL); |
arsenalist | 27:562a95c120cc | 1321 | strftime(q, 32, "%Y-%m-%d %H:%M:%S",localtime(&seconds)); |
arsenalist | 27:562a95c120cc | 1322 | DBG.printf("logPE:%d\r\n",writeLog(q,"sendEnergyData failed")); |
arsenalist | 27:562a95c120cc | 1323 | |
arsenalist | 24:5d58515ba510 | 1324 | DBG.printf("send channel: %d failed\r\n",i); |
arsenalist | 24:5d58515ba510 | 1325 | TFT.foreground(Red); |
arsenalist | 24:5d58515ba510 | 1326 | TFT.locate(0,120); |
arsenalist | 24:5d58515ba510 | 1327 | TFT.printf(" "); |
arsenalist | 24:5d58515ba510 | 1328 | TFT.locate(0,120); |
arsenalist | 24:5d58515ba510 | 1329 | TFT.printf("send ch%d failed",i); |
arsenalist | 24:5d58515ba510 | 1330 | wait(1); |
arsenalist | 24:5d58515ba510 | 1331 | TFT.locate(0,120); |
arsenalist | 24:5d58515ba510 | 1332 | TFT.printf(" "); |
arsenalist | 24:5d58515ba510 | 1333 | TFT.foreground(White); |
arsenalist | 24:5d58515ba510 | 1334 | } |
arsenalist | 22:e18d361bf688 | 1335 | } |
arsenalist | 4:76ab12e2f8a3 | 1336 | } |
arsenalist | 22:e18d361bf688 | 1337 | |
arsenalist | 22:e18d361bf688 | 1338 | newEnergyData = false; |
arsenalist | 0:f4e449fa34d7 | 1339 | } |
arsenalist | 22:e18d361bf688 | 1340 | |
arsenalist | 24:5d58515ba510 | 1341 | tPanelEnergy.reset(); |
arsenalist | 4:76ab12e2f8a3 | 1342 | loop++; |
arsenalist | 0:f4e449fa34d7 | 1343 | } |
arsenalist | 0:f4e449fa34d7 | 1344 | |
arsenalist | 21:33bd8b82560f | 1345 | //panel environment |
arsenalist | 5:d00233dd36f5 | 1346 | checkRxBuffer(); |
arsenalist | 25:36c6a5db50ed | 1347 | if(tPanel.read() > 900.0f) { //900 is 15 minutes |
arsenalist | 21:33bd8b82560f | 1348 | int dTemp=0; |
arsenalist | 21:33bd8b82560f | 1349 | int dHum=0; |
arsenalist | 21:33bd8b82560f | 1350 | int dGas=0; |
arsenalist | 21:33bd8b82560f | 1351 | |
arsenalist | 21:33bd8b82560f | 1352 | DBG.printf("getPanelEnvironment\r\n"); |
arsenalist | 21:33bd8b82560f | 1353 | |
arsenalist | 21:33bd8b82560f | 1354 | //get environment sensor |
arsenalist | 21:33bd8b82560f | 1355 | trial=0; |
arsenalist | 21:33bd8b82560f | 1356 | while(1) { |
arsenalist | 21:33bd8b82560f | 1357 | if(trial>=2) { //two times trial |
arsenalist | 21:33bd8b82560f | 1358 | break; |
arsenalist | 21:33bd8b82560f | 1359 | } |
arsenalist | 21:33bd8b82560f | 1360 | if(d.readData() == DHT11::OK) { |
arsenalist | 21:33bd8b82560f | 1361 | dTemp = d.readTemperature(); |
arsenalist | 21:33bd8b82560f | 1362 | dHum = d.readHumidity(); |
arsenalist | 21:33bd8b82560f | 1363 | break; |
arsenalist | 21:33bd8b82560f | 1364 | } |
arsenalist | 21:33bd8b82560f | 1365 | trial++; |
arsenalist | 21:33bd8b82560f | 1366 | wait(3); |
arsenalist | 21:33bd8b82560f | 1367 | } |
arsenalist | 21:33bd8b82560f | 1368 | |
arsenalist | 21:33bd8b82560f | 1369 | //send environment sensor |
arsenalist | 24:5d58515ba510 | 1370 | if(dTemp!=0 && dHum!=0) { |
arsenalist | 24:5d58515ba510 | 1371 | seconds = time(NULL); |
arsenalist | 24:5d58515ba510 | 1372 | strftime(q, 32, "%Y-%m-%d %H:%M:%S",localtime(&seconds)); |
arsenalist | 22:e18d361bf688 | 1373 | |
arsenalist | 24:5d58515ba510 | 1374 | //calculate hmacTime |
arsenalist | 24:5d58515ba510 | 1375 | for(int j=0; j<sizeof(p); j++) { |
arsenalist | 24:5d58515ba510 | 1376 | p[j]=0; } |
arsenalist | 24:5d58515ba510 | 1377 | sprintf(p,"emma-%s-%s",emmaUID.c_str(),q); |
arsenalist | 24:5d58515ba510 | 1378 | hmacTime = calculateMD5(p); |
arsenalist | 22:e18d361bf688 | 1379 | |
arsenalist | 24:5d58515ba510 | 1380 | sprintf(s,"{\"uid\":\"%s\",\"hmac\":\"%s\",\"time\":\"%s\",\"temp\":%d,\"hum\":%d,\"gas\":%d}", |
arsenalist | 24:5d58515ba510 | 1381 | emmaUID.c_str(),hmacTime.c_str(),q,dTemp,dHum,dGas); |
arsenalist | 24:5d58515ba510 | 1382 | //DBG.printf("dataEnvironment:\r\n%s\r\n",s); |
arsenalist | 24:5d58515ba510 | 1383 | rest.post("/emma/api/controller/environment",s); |
arsenalist | 24:5d58515ba510 | 1384 | wait(2); |
arsenalist | 24:5d58515ba510 | 1385 | str = rxBuf; |
arsenalist | 24:5d58515ba510 | 1386 | if(str.rfind("/environment") != std::string::npos) { |
arsenalist | 24:5d58515ba510 | 1387 | str.erase(str.begin(),str.begin()+str.rfind("/environment")); |
arsenalist | 24:5d58515ba510 | 1388 | if(str.find("\"status\":\"success\"") != std::string::npos) { |
arsenalist | 27:562a95c120cc | 1389 | //logging purpose |
arsenalist | 27:562a95c120cc | 1390 | seconds = time(NULL); |
arsenalist | 27:562a95c120cc | 1391 | strftime(q, 32, "%Y-%m-%d %H:%M:%S",localtime(&seconds)); |
arsenalist | 27:562a95c120cc | 1392 | DBG.printf("logPEnv:%d\r\n",writeLog(q,"sendPanelEnv success")); |
arsenalist | 24:5d58515ba510 | 1393 | DBG.printf("send panel environment success\r\n"); |
arsenalist | 24:5d58515ba510 | 1394 | } else { |
arsenalist | 27:562a95c120cc | 1395 | //logging purpose |
arsenalist | 27:562a95c120cc | 1396 | seconds = time(NULL); |
arsenalist | 27:562a95c120cc | 1397 | strftime(q, 32, "%Y-%m-%d %H:%M:%S",localtime(&seconds)); |
arsenalist | 27:562a95c120cc | 1398 | DBG.printf("logPEnv:%d\r\n",writeLog(q,"sendPanelEnv failed")); |
arsenalist | 24:5d58515ba510 | 1399 | DBG.printf("send panel environment failed\r\n"); |
arsenalist | 24:5d58515ba510 | 1400 | } |
arsenalist | 21:33bd8b82560f | 1401 | } |
arsenalist | 24:5d58515ba510 | 1402 | checkRxBuffer(); |
arsenalist | 21:33bd8b82560f | 1403 | } |
arsenalist | 21:33bd8b82560f | 1404 | tPanel.reset(); |
arsenalist | 21:33bd8b82560f | 1405 | } |
arsenalist | 21:33bd8b82560f | 1406 | |
arsenalist | 0:f4e449fa34d7 | 1407 | //nodeTemp |
arsenalist | 21:33bd8b82560f | 1408 | checkRxBuffer(); |
arsenalist | 25:36c6a5db50ed | 1409 | if(tNodes.read() > 900.0f) { //900 is 15 minutes |
arsenalist | 5:d00233dd36f5 | 1410 | DBG.printf("getNodesTemperature\r\n"); |
arsenalist | 5:d00233dd36f5 | 1411 | |
arsenalist | 5:d00233dd36f5 | 1412 | for(int i=0; i<NODES_MAX; i++) { |
arsenalist | 5:d00233dd36f5 | 1413 | if(!nodes[i].ipAddr.empty()) { |
arsenalist | 5:d00233dd36f5 | 1414 | //get node's temp |
arsenalist | 5:d00233dd36f5 | 1415 | string temp; |
arsenalist | 5:d00233dd36f5 | 1416 | nodes[i].restConn->get("/","<?xml version=\"1.0\" encoding=\"utf-8\"?><app_cmd cmd=\"2\"/>\r\n"); |
arsenalist | 5:d00233dd36f5 | 1417 | wait(2); |
arsenalist | 5:d00233dd36f5 | 1418 | temp = rxBuf; |
arsenalist | 5:d00233dd36f5 | 1419 | if(temp.rfind(nodes[i].ipAddr) != std::string::npos) { |
arsenalist | 5:d00233dd36f5 | 1420 | temp.erase(temp.begin(),temp.begin()+temp.rfind(nodes[i].ipAddr)); |
arsenalist | 5:d00233dd36f5 | 1421 | if(temp.rfind("temp=") != std::string::npos) { |
arsenalist | 5:d00233dd36f5 | 1422 | temp.erase(temp.begin(),temp.begin()+temp.rfind("temp=")+6); |
arsenalist | 5:d00233dd36f5 | 1423 | temp.erase(temp.begin()+temp.find("\""),temp.end()); |
arsenalist | 5:d00233dd36f5 | 1424 | } else { |
arsenalist | 5:d00233dd36f5 | 1425 | temp = "0"; //connect to node, but receive none |
arsenalist | 5:d00233dd36f5 | 1426 | } |
arsenalist | 5:d00233dd36f5 | 1427 | } else { |
arsenalist | 5:d00233dd36f5 | 1428 | temp = "0"; //not connected to node |
arsenalist | 5:d00233dd36f5 | 1429 | } |
arsenalist | 0:f4e449fa34d7 | 1430 | |
arsenalist | 5:d00233dd36f5 | 1431 | DBG.printf("nodeTemp[%d]:%s\r\n",i,temp.c_str()); |
arsenalist | 5:d00233dd36f5 | 1432 | |
arsenalist | 5:d00233dd36f5 | 1433 | //send node's temp |
arsenalist | 25:36c6a5db50ed | 1434 | if(temp != "0") { |
arsenalist | 25:36c6a5db50ed | 1435 | seconds = time(NULL); |
arsenalist | 25:36c6a5db50ed | 1436 | strftime(q, 32, "%Y-%m-%d %H:%M:%S",localtime(&seconds)); |
arsenalist | 22:e18d361bf688 | 1437 | |
arsenalist | 25:36c6a5db50ed | 1438 | //calculate hmacTime |
arsenalist | 25:36c6a5db50ed | 1439 | for(int j=0; j<sizeof(p); j++) { |
arsenalist | 25:36c6a5db50ed | 1440 | p[j]=0; } |
arsenalist | 25:36c6a5db50ed | 1441 | sprintf(p,"emma-%s-%s",emmaUID.c_str(),q); |
arsenalist | 25:36c6a5db50ed | 1442 | hmacTime = calculateMD5(p); |
arsenalist | 22:e18d361bf688 | 1443 | |
arsenalist | 25:36c6a5db50ed | 1444 | sprintf(s,"{\"uid\":\"%s\",\"hmac\":\"%s\",\"time\":\"%s\",\"mac\":\"%s\",\"value\":%s}", |
arsenalist | 25:36c6a5db50ed | 1445 | emmaUID.c_str(),hmacTime.c_str(),q,nodes[i].macAddr.c_str(),temp.c_str()); |
arsenalist | 25:36c6a5db50ed | 1446 | //DBG.printf("dataNodeTemp:\r\n%s\r\n",s); |
arsenalist | 25:36c6a5db50ed | 1447 | rest.post("/emma/api/controller/nodetemp",s); |
arsenalist | 25:36c6a5db50ed | 1448 | wait(2); |
arsenalist | 25:36c6a5db50ed | 1449 | str = rxBuf; |
arsenalist | 25:36c6a5db50ed | 1450 | if(str.rfind("/nodetemp") != std::string::npos) { |
arsenalist | 25:36c6a5db50ed | 1451 | str.erase(str.begin(),str.begin()+str.rfind("/nodetemp")); |
arsenalist | 25:36c6a5db50ed | 1452 | if(str.find("\"status\":\"success\"") != std::string::npos) { |
arsenalist | 25:36c6a5db50ed | 1453 | DBG.printf("send nodeTemp success\r\n"); |
arsenalist | 25:36c6a5db50ed | 1454 | } else { |
arsenalist | 25:36c6a5db50ed | 1455 | DBG.printf("send nodeTemp failed\r\n"); |
arsenalist | 25:36c6a5db50ed | 1456 | } |
arsenalist | 5:d00233dd36f5 | 1457 | } |
arsenalist | 25:36c6a5db50ed | 1458 | checkRxBuffer(); |
arsenalist | 5:d00233dd36f5 | 1459 | } |
arsenalist | 5:d00233dd36f5 | 1460 | } |
arsenalist | 0:f4e449fa34d7 | 1461 | } |
arsenalist | 19:7e3e9332f719 | 1462 | tNodes.reset(); |
arsenalist | 19:7e3e9332f719 | 1463 | } |
arsenalist | 21:33bd8b82560f | 1464 | |
arsenalist | 21:33bd8b82560f | 1465 | //command |
arsenalist | 27:562a95c120cc | 1466 | rest.get("/emma/api/controller/command"); |
arsenalist | 5:d00233dd36f5 | 1467 | checkRxBuffer(); |
arsenalist | 0:f4e449fa34d7 | 1468 | if(newCommand) { |
arsenalist | 5:d00233dd36f5 | 1469 | DBG.printf("newCommand:\r\n%s\r\n",globalCommand.c_str()); |
arsenalist | 13:e8adfe305dbc | 1470 | TFT.locate(0,160); |
arsenalist | 13:e8adfe305dbc | 1471 | TFT.printf(" "); |
arsenalist | 13:e8adfe305dbc | 1472 | TFT.locate(0,160); |
arsenalist | 13:e8adfe305dbc | 1473 | TFT.printf("newCommand"); |
arsenalist | 13:e8adfe305dbc | 1474 | |
arsenalist | 0:f4e449fa34d7 | 1475 | MbedJSONValue jsonValue; |
arsenalist | 0:f4e449fa34d7 | 1476 | parse(jsonValue,globalCommand.c_str()); |
arsenalist | 15:136526c28afb | 1477 | char *parameter[5] = {"name","nType","nAddr","dType","cmd"}; |
arsenalist | 0:f4e449fa34d7 | 1478 | |
arsenalist | 7:7e8c6ad3fd64 | 1479 | //check whether command is valid |
arsenalist | 0:f4e449fa34d7 | 1480 | bool validCommand = true; |
arsenalist | 15:136526c28afb | 1481 | for(int i=0; i<5; i++) { |
arsenalist | 0:f4e449fa34d7 | 1482 | validCommand = validCommand && jsonValue.hasMember(parameter[i]); |
arsenalist | 0:f4e449fa34d7 | 1483 | } |
arsenalist | 0:f4e449fa34d7 | 1484 | DBG.printf("command validity:%d\r\n",validCommand); |
arsenalist | 0:f4e449fa34d7 | 1485 | |
arsenalist | 0:f4e449fa34d7 | 1486 | if(validCommand) { |
arsenalist | 15:136526c28afb | 1487 | string commandName = jsonValue[parameter[0]].get<std::string>(); |
arsenalist | 15:136526c28afb | 1488 | string commandNType = jsonValue[parameter[1]].get<std::string>(); |
arsenalist | 15:136526c28afb | 1489 | string commandNAddr = jsonValue[parameter[2]].get<std::string>(); |
arsenalist | 15:136526c28afb | 1490 | string commandDType = jsonValue[parameter[3]].get<std::string>(); |
arsenalist | 15:136526c28afb | 1491 | string commandCmd = jsonValue[parameter[4]].get<std::string>(); |
arsenalist | 0:f4e449fa34d7 | 1492 | |
arsenalist | 0:f4e449fa34d7 | 1493 | if(commandNType == "0") { //switch on panel controller |
arsenalist | 0:f4e449fa34d7 | 1494 | DBG.printf("command for switch\r\n"); |
arsenalist | 0:f4e449fa34d7 | 1495 | } |
arsenalist | 0:f4e449fa34d7 | 1496 | else if(commandNType == "1") { //node with mac address |
arsenalist | 0:f4e449fa34d7 | 1497 | DBG.printf("command for node\r\n"); |
arsenalist | 0:f4e449fa34d7 | 1498 | //get node ip address based on node mac address |
arsenalist | 5:d00233dd36f5 | 1499 | //string nodeIP; |
arsenalist | 1:d314a43ae6f7 | 1500 | //nodeIp = readNodeIP(commandNAddr); |
arsenalist | 5:d00233dd36f5 | 1501 | //nodeIP = "192.168.2.15"; |
arsenalist | 0:f4e449fa34d7 | 1502 | //DBG.printf("nodeIP: %s\r\n",nodeIP.c_str()); |
arsenalist | 5:d00233dd36f5 | 1503 | |
arsenalist | 5:d00233dd36f5 | 1504 | //get index of node list based on mac address |
arsenalist | 5:d00233dd36f5 | 1505 | int idx = NODES_INVALID; |
arsenalist | 5:d00233dd36f5 | 1506 | for(int i=0; i<NODES_MAX; i++) { |
arsenalist | 5:d00233dd36f5 | 1507 | if(!nodes[i].macAddr.compare(commandNAddr)) { |
arsenalist | 5:d00233dd36f5 | 1508 | idx = i; |
arsenalist | 5:d00233dd36f5 | 1509 | } |
arsenalist | 5:d00233dd36f5 | 1510 | } |
arsenalist | 5:d00233dd36f5 | 1511 | |
arsenalist | 5:d00233dd36f5 | 1512 | //execution process |
arsenalist | 21:33bd8b82560f | 1513 | //int trial; |
arsenalist | 15:136526c28afb | 1514 | string execResult = "failed"; |
arsenalist | 5:d00233dd36f5 | 1515 | if(idx != NODES_INVALID) { |
arsenalist | 5:d00233dd36f5 | 1516 | DBG.printf("index found at %d\r\n",idx); |
arsenalist | 0:f4e449fa34d7 | 1517 | |
arsenalist | 5:d00233dd36f5 | 1518 | //get cmd string based on device type and command number |
arsenalist | 5:d00233dd36f5 | 1519 | string nodeCmd; |
arsenalist | 14:8287f0f5d987 | 1520 | nodeCmd = readNodeCmd(commandDType,commandCmd); |
arsenalist | 14:8287f0f5d987 | 1521 | //nodeCmd = "020129A0163B161315131613153C151316131514143C153C16141414141415151315141414141514141415141414143D1514143D141415141414143D14000D"; //turn off |
arsenalist | 5:d00233dd36f5 | 1522 | //DBG.printf("nodeCmd: %s\r\n",nodeCmd.c_str()); |
arsenalist | 0:f4e449fa34d7 | 1523 | |
arsenalist | 5:d00233dd36f5 | 1524 | //execute command |
arsenalist | 5:d00233dd36f5 | 1525 | DBG.printf("executing command\r\n"); |
arsenalist | 0:f4e449fa34d7 | 1526 | sprintf(s,"<?xml version=\"1.0\" encoding=\"utf-8\"?><app_cmd cmd=\"5\" /><app_data code=\"%s\"/>\r\n",nodeCmd.c_str()); |
arsenalist | 0:f4e449fa34d7 | 1527 | |
arsenalist | 5:d00233dd36f5 | 1528 | trial=0; |
arsenalist | 0:f4e449fa34d7 | 1529 | while(1) { |
arsenalist | 35:b8ba2b73201b | 1530 | rxBuf.clear(); |
arsenalist | 5:d00233dd36f5 | 1531 | //cmdExecuted = false; |
arsenalist | 5:d00233dd36f5 | 1532 | if(trial>=2) { //two times trial |
arsenalist | 0:f4e449fa34d7 | 1533 | DBG.printf("cmd is not executed\r\n"); |
arsenalist | 13:e8adfe305dbc | 1534 | TFT.foreground(Red); |
arsenalist | 13:e8adfe305dbc | 1535 | TFT.locate(0,180); |
arsenalist | 13:e8adfe305dbc | 1536 | TFT.printf(" "); |
arsenalist | 13:e8adfe305dbc | 1537 | TFT.locate(0,180); |
arsenalist | 13:e8adfe305dbc | 1538 | TFT.printf("cmd is not executed"); |
arsenalist | 14:8287f0f5d987 | 1539 | wait(1); |
arsenalist | 13:e8adfe305dbc | 1540 | TFT.locate(0,180); |
arsenalist | 13:e8adfe305dbc | 1541 | TFT.printf(" "); |
arsenalist | 13:e8adfe305dbc | 1542 | TFT.foreground(White); |
arsenalist | 0:f4e449fa34d7 | 1543 | break; |
arsenalist | 0:f4e449fa34d7 | 1544 | } |
arsenalist | 5:d00233dd36f5 | 1545 | nodes[idx].restConn->get("/",s); |
arsenalist | 5:d00233dd36f5 | 1546 | wait(2); |
arsenalist | 35:b8ba2b73201b | 1547 | if(rxBuf.find("REST: status = 200") != std::string::npos) { |
arsenalist | 13:e8adfe305dbc | 1548 | DBG.printf("cmd is executed\r\n"); |
arsenalist | 13:e8adfe305dbc | 1549 | TFT.foreground(Green); |
arsenalist | 13:e8adfe305dbc | 1550 | TFT.locate(0,180); |
arsenalist | 13:e8adfe305dbc | 1551 | TFT.printf(" "); |
arsenalist | 13:e8adfe305dbc | 1552 | TFT.locate(0,180); |
arsenalist | 13:e8adfe305dbc | 1553 | TFT.printf("cmd is executed"); |
arsenalist | 14:8287f0f5d987 | 1554 | wait(1); |
arsenalist | 13:e8adfe305dbc | 1555 | TFT.locate(0,180); |
arsenalist | 13:e8adfe305dbc | 1556 | TFT.printf(" "); |
arsenalist | 13:e8adfe305dbc | 1557 | TFT.foreground(White); |
arsenalist | 15:136526c28afb | 1558 | execResult = "success"; |
arsenalist | 5:d00233dd36f5 | 1559 | break; |
arsenalist | 5:d00233dd36f5 | 1560 | } |
arsenalist | 0:f4e449fa34d7 | 1561 | trial++; |
arsenalist | 5:d00233dd36f5 | 1562 | } |
arsenalist | 14:8287f0f5d987 | 1563 | } else { |
arsenalist | 14:8287f0f5d987 | 1564 | TFT.foreground(Red); |
arsenalist | 14:8287f0f5d987 | 1565 | TFT.locate(0,180); |
arsenalist | 14:8287f0f5d987 | 1566 | TFT.printf(" "); |
arsenalist | 14:8287f0f5d987 | 1567 | TFT.locate(0,180); |
arsenalist | 14:8287f0f5d987 | 1568 | TFT.printf("node is invalid"); |
arsenalist | 14:8287f0f5d987 | 1569 | wait(1); |
arsenalist | 14:8287f0f5d987 | 1570 | TFT.locate(0,180); |
arsenalist | 14:8287f0f5d987 | 1571 | TFT.printf(" "); |
arsenalist | 14:8287f0f5d987 | 1572 | TFT.foreground(White); |
arsenalist | 5:d00233dd36f5 | 1573 | } |
arsenalist | 5:d00233dd36f5 | 1574 | |
arsenalist | 5:d00233dd36f5 | 1575 | wait(2); |
arsenalist | 5:d00233dd36f5 | 1576 | //send execution result |
arsenalist | 21:33bd8b82560f | 1577 | //DBG.printf("send execution result\r\n"); |
arsenalist | 23:fb369e171b7d | 1578 | |
arsenalist | 23:fb369e171b7d | 1579 | //calculate hmacCmd |
arsenalist | 23:fb369e171b7d | 1580 | for(int j=0; j<sizeof(p); j++) { |
arsenalist | 23:fb369e171b7d | 1581 | p[j]=0; } |
arsenalist | 23:fb369e171b7d | 1582 | sprintf(p,"emma-%s-%s",emmaUID.c_str(),commandCmd.c_str()); |
arsenalist | 23:fb369e171b7d | 1583 | hmacCmd = calculateMD5(p); |
arsenalist | 23:fb369e171b7d | 1584 | |
arsenalist | 23:fb369e171b7d | 1585 | sprintf(s,"{\"uid\":\"%s\",\"nType\":\"%s\",\"nAddr\":\"%s\",\"dType\":\"%s\",\"cmd\":\"%s\",\"name\":\"%s\",\"result\":\"%s\",\"hmac\":\"%s\"}", |
arsenalist | 23:fb369e171b7d | 1586 | emmaUID.c_str(), commandNType.c_str(),commandNAddr.c_str(),commandDType.c_str(),commandCmd.c_str(),commandName.c_str(),execResult.c_str(),hmacCmd.c_str()); |
arsenalist | 5:d00233dd36f5 | 1587 | |
arsenalist | 5:d00233dd36f5 | 1588 | trial=0; |
arsenalist | 5:d00233dd36f5 | 1589 | while(1) { |
arsenalist | 5:d00233dd36f5 | 1590 | if(trial>=2) { //two times trial |
arsenalist | 23:fb369e171b7d | 1591 | DBG.printf("failed to send execution result\r\n"); |
arsenalist | 5:d00233dd36f5 | 1592 | break; |
arsenalist | 0:f4e449fa34d7 | 1593 | } |
arsenalist | 23:fb369e171b7d | 1594 | rest.post("/emma/api/controller/result",s); |
arsenalist | 5:d00233dd36f5 | 1595 | wait(2); |
arsenalist | 23:fb369e171b7d | 1596 | str = rxBuf; |
arsenalist | 23:fb369e171b7d | 1597 | if(str.rfind("/result") != std::string::npos) { |
arsenalist | 23:fb369e171b7d | 1598 | str.erase(str.begin(),str.begin()+str.rfind("/result")); |
arsenalist | 23:fb369e171b7d | 1599 | if(str.find("\"status\":\"success\"") != std::string::npos) { |
arsenalist | 23:fb369e171b7d | 1600 | DBG.printf("success to send execution result\r\n"); |
arsenalist | 23:fb369e171b7d | 1601 | break; |
arsenalist | 23:fb369e171b7d | 1602 | } |
arsenalist | 0:f4e449fa34d7 | 1603 | } |
arsenalist | 23:fb369e171b7d | 1604 | checkRxBuffer(); |
arsenalist | 5:d00233dd36f5 | 1605 | trial++; |
arsenalist | 0:f4e449fa34d7 | 1606 | } |
arsenalist | 0:f4e449fa34d7 | 1607 | } |
arsenalist | 0:f4e449fa34d7 | 1608 | } |
arsenalist | 13:e8adfe305dbc | 1609 | |
arsenalist | 13:e8adfe305dbc | 1610 | //clear text on lcd |
arsenalist | 13:e8adfe305dbc | 1611 | TFT.locate(0,160); |
arsenalist | 13:e8adfe305dbc | 1612 | TFT.printf(" "); |
arsenalist | 13:e8adfe305dbc | 1613 | |
arsenalist | 0:f4e449fa34d7 | 1614 | newCommand = false; |
arsenalist | 2:fdfdeb5fd6fd | 1615 | } |
arsenalist | 30:08d290158fa7 | 1616 | |
arsenalist | 4:76ab12e2f8a3 | 1617 | osDelay(5000); |
arsenalist | 0:f4e449fa34d7 | 1618 | } |
arsenalist | 0:f4e449fa34d7 | 1619 | } |
arsenalist | 0:f4e449fa34d7 | 1620 | } |
arsenalist | 0:f4e449fa34d7 | 1621 | void emmaModeFirmwareDownload(void) { |
arsenalist | 0:f4e449fa34d7 | 1622 | bool emmaGetFirmwareParam = false; |
arsenalist | 0:f4e449fa34d7 | 1623 | |
arsenalist | 0:f4e449fa34d7 | 1624 | DBG.printf("emmaModeFirmwareDownload\r\n"); |
arsenalist | 0:f4e449fa34d7 | 1625 | |
arsenalist | 0:f4e449fa34d7 | 1626 | char s[384]; |
arsenalist | 0:f4e449fa34d7 | 1627 | string str; |
arsenalist | 0:f4e449fa34d7 | 1628 | string connData; |
arsenalist | 0:f4e449fa34d7 | 1629 | string chunk; |
arsenalist | 0:f4e449fa34d7 | 1630 | |
arsenalist | 0:f4e449fa34d7 | 1631 | //firmware parameter |
arsenalist | 0:f4e449fa34d7 | 1632 | string firmwareVer; |
arsenalist | 0:f4e449fa34d7 | 1633 | string firmwareName; |
arsenalist | 0:f4e449fa34d7 | 1634 | int numPart; |
arsenalist | 0:f4e449fa34d7 | 1635 | |
arsenalist | 0:f4e449fa34d7 | 1636 | //downloading |
arsenalist | 0:f4e449fa34d7 | 1637 | string firmwarePart; |
arsenalist | 0:f4e449fa34d7 | 1638 | string calcMD5; |
arsenalist | 0:f4e449fa34d7 | 1639 | string srvrMD5; |
arsenalist | 0:f4e449fa34d7 | 1640 | bool nextPart; |
arsenalist | 0:f4e449fa34d7 | 1641 | |
arsenalist | 0:f4e449fa34d7 | 1642 | //set wifi to mode bridge |
arsenalist | 0:f4e449fa34d7 | 1643 | _ESP.printf("MODE=B"); |
arsenalist | 0:f4e449fa34d7 | 1644 | DBG.printf("set mode bridge\r\n"); |
arsenalist | 0:f4e449fa34d7 | 1645 | while(1) { |
arsenalist | 0:f4e449fa34d7 | 1646 | char rcv[128] = {}; |
arsenalist | 0:f4e449fa34d7 | 1647 | rcvReply(rcv,3000); |
arsenalist | 0:f4e449fa34d7 | 1648 | str = rcv; |
arsenalist | 0:f4e449fa34d7 | 1649 | if(str.find("MODE=B_OK") != std::string::npos) |
arsenalist | 0:f4e449fa34d7 | 1650 | break; |
arsenalist | 0:f4e449fa34d7 | 1651 | } |
arsenalist | 0:f4e449fa34d7 | 1652 | DBG.printf("MODE=B\r\n"); |
arsenalist | 0:f4e449fa34d7 | 1653 | |
arsenalist | 0:f4e449fa34d7 | 1654 | esp.enable(); |
arsenalist | 0:f4e449fa34d7 | 1655 | wait(1); |
arsenalist | 0:f4e449fa34d7 | 1656 | while(!esp.ready()); |
arsenalist | 0:f4e449fa34d7 | 1657 | |
arsenalist | 0:f4e449fa34d7 | 1658 | if(!rest.begin("candra.tritronik.com",3128,false)) { |
arsenalist | 0:f4e449fa34d7 | 1659 | DBG.printf("EMMA: fail to setup rest"); |
arsenalist | 0:f4e449fa34d7 | 1660 | while(1); |
arsenalist | 0:f4e449fa34d7 | 1661 | } |
arsenalist | 0:f4e449fa34d7 | 1662 | |
arsenalist | 0:f4e449fa34d7 | 1663 | //wifiConnected = true; //with custom firmware, panel should connect wifi automatically |
arsenalist | 0:f4e449fa34d7 | 1664 | useProxy = true; |
arsenalist | 0:f4e449fa34d7 | 1665 | |
arsenalist | 0:f4e449fa34d7 | 1666 | esp.process(); |
arsenalist | 0:f4e449fa34d7 | 1667 | //set connData |
arsenalist | 0:f4e449fa34d7 | 1668 | if(useProxy) { |
arsenalist | 0:f4e449fa34d7 | 1669 | for(int i=0; i<sizeof(s); i++) { |
arsenalist | 0:f4e449fa34d7 | 1670 | s[i]=0; } |
arsenalist | 38:e44f35f8129d | 1671 | //sprintf(s,"http://%s:%d/emma/api/controller/register?uid=%s&hmac=%s",restSERVER,restPORT,emmaUID.c_str(),hmac.c_str()); |
arsenalist | 0:f4e449fa34d7 | 1672 | sprintf(s,"http://192.168.128.69/emmaController/firmware/firmwareParameter"); |
arsenalist | 0:f4e449fa34d7 | 1673 | connData = s; |
arsenalist | 0:f4e449fa34d7 | 1674 | } else { |
arsenalist | 0:f4e449fa34d7 | 1675 | for(int i=0; i<sizeof(s); i++) { |
arsenalist | 0:f4e449fa34d7 | 1676 | s[i]=0; } |
arsenalist | 0:f4e449fa34d7 | 1677 | //sprintf(s,"/emma/api/controller/register?uid=%s&hmac=%s",emmaUID.c_str(),hmac.c_str()); |
arsenalist | 0:f4e449fa34d7 | 1678 | sprintf(s,"/emmaController/firmware/firmwareParameter"); |
arsenalist | 0:f4e449fa34d7 | 1679 | connData = s; |
arsenalist | 0:f4e449fa34d7 | 1680 | } |
arsenalist | 0:f4e449fa34d7 | 1681 | |
arsenalist | 0:f4e449fa34d7 | 1682 | //get parameter of firmware to be downloaded |
arsenalist | 0:f4e449fa34d7 | 1683 | while(!emmaGetFirmwareParam) { |
arsenalist | 0:f4e449fa34d7 | 1684 | rest.get(connData.c_str()); |
arsenalist | 0:f4e449fa34d7 | 1685 | for(int i=0; i<sizeof(s); i++) { |
arsenalist | 0:f4e449fa34d7 | 1686 | s[i]=0; } |
arsenalist | 0:f4e449fa34d7 | 1687 | rest.getResponse(s,sizeof(s)); |
arsenalist | 0:f4e449fa34d7 | 1688 | //DBG.printf("rsp param:%s\r\n",s); |
arsenalist | 0:f4e449fa34d7 | 1689 | |
arsenalist | 0:f4e449fa34d7 | 1690 | str = s; |
arsenalist | 0:f4e449fa34d7 | 1691 | if(str.find("[") != std::string::npos && str.find("]") != std::string::npos) { |
arsenalist | 0:f4e449fa34d7 | 1692 | str.erase(str.begin(),str.begin()+str.find("[")+1); |
arsenalist | 0:f4e449fa34d7 | 1693 | str.erase(str.begin()+str.find("]"),str.end()); |
arsenalist | 0:f4e449fa34d7 | 1694 | |
arsenalist | 0:f4e449fa34d7 | 1695 | MbedJSONValue jsonValue; |
arsenalist | 0:f4e449fa34d7 | 1696 | parse(jsonValue,str.c_str()); |
arsenalist | 0:f4e449fa34d7 | 1697 | |
arsenalist | 0:f4e449fa34d7 | 1698 | char *parameter[2] = {"firmwareVer","numPart"}; |
arsenalist | 0:f4e449fa34d7 | 1699 | |
arsenalist | 0:f4e449fa34d7 | 1700 | for(int i=0; i<2; i++) { |
arsenalist | 0:f4e449fa34d7 | 1701 | if(jsonValue.hasMember(parameter[i])) { |
arsenalist | 0:f4e449fa34d7 | 1702 | string val = jsonValue[parameter[i]].get<std::string>(); |
arsenalist | 0:f4e449fa34d7 | 1703 | if(i==0) { |
arsenalist | 0:f4e449fa34d7 | 1704 | firmwareVer = val; |
arsenalist | 0:f4e449fa34d7 | 1705 | } else if(i==1) { |
arsenalist | 0:f4e449fa34d7 | 1706 | sscanf(val.c_str(),"%d",&numPart); |
arsenalist | 0:f4e449fa34d7 | 1707 | } |
arsenalist | 0:f4e449fa34d7 | 1708 | } |
arsenalist | 0:f4e449fa34d7 | 1709 | } |
arsenalist | 0:f4e449fa34d7 | 1710 | |
arsenalist | 0:f4e449fa34d7 | 1711 | if(!firmwareVer.empty() && numPart!=0) { |
arsenalist | 0:f4e449fa34d7 | 1712 | emmaGetFirmwareParam = true; |
arsenalist | 0:f4e449fa34d7 | 1713 | } |
arsenalist | 0:f4e449fa34d7 | 1714 | } |
arsenalist | 0:f4e449fa34d7 | 1715 | } |
arsenalist | 0:f4e449fa34d7 | 1716 | DBG.printf("firmwareVer:%s\r\n",firmwareVer.c_str()); |
arsenalist | 0:f4e449fa34d7 | 1717 | DBG.printf("numPart:%d\r\n",numPart); |
arsenalist | 0:f4e449fa34d7 | 1718 | |
arsenalist | 0:f4e449fa34d7 | 1719 | //clear firmware file |
arsenalist | 0:f4e449fa34d7 | 1720 | while(1) { |
arsenalist | 0:f4e449fa34d7 | 1721 | if(clearFirmware()){ |
arsenalist | 0:f4e449fa34d7 | 1722 | DBG.printf("clear firmware on sd card\r\n\r\n"); |
arsenalist | 0:f4e449fa34d7 | 1723 | break; |
arsenalist | 0:f4e449fa34d7 | 1724 | } |
arsenalist | 0:f4e449fa34d7 | 1725 | wait(1); |
arsenalist | 0:f4e449fa34d7 | 1726 | } |
arsenalist | 0:f4e449fa34d7 | 1727 | |
arsenalist | 0:f4e449fa34d7 | 1728 | //set connData |
arsenalist | 0:f4e449fa34d7 | 1729 | if(useProxy) { |
arsenalist | 0:f4e449fa34d7 | 1730 | for(int i=0; i<sizeof(s); i++) { |
arsenalist | 0:f4e449fa34d7 | 1731 | s[i]=0; } |
arsenalist | 0:f4e449fa34d7 | 1732 | sprintf(s,"http://192.168.128.69/emmaController/firmware/%s",firmwareVer.c_str()); |
arsenalist | 0:f4e449fa34d7 | 1733 | connData = s; |
arsenalist | 0:f4e449fa34d7 | 1734 | } else { |
arsenalist | 0:f4e449fa34d7 | 1735 | for(int i=0; i<sizeof(s); i++) { |
arsenalist | 0:f4e449fa34d7 | 1736 | s[i]=0; } |
arsenalist | 0:f4e449fa34d7 | 1737 | sprintf(s,"/emmaController/firmware/%s",firmwareVer.c_str()); |
arsenalist | 0:f4e449fa34d7 | 1738 | connData = s; |
arsenalist | 0:f4e449fa34d7 | 1739 | } |
arsenalist | 0:f4e449fa34d7 | 1740 | |
arsenalist | 0:f4e449fa34d7 | 1741 | //download firmware |
arsenalist | 0:f4e449fa34d7 | 1742 | for(int n=0; n<numPart; n++) { |
arsenalist | 0:f4e449fa34d7 | 1743 | nextPart = false; |
arsenalist | 0:f4e449fa34d7 | 1744 | while(!nextPart) { |
arsenalist | 0:f4e449fa34d7 | 1745 | for(int i=0; i<sizeof(s); i++) { |
arsenalist | 0:f4e449fa34d7 | 1746 | s[i]=0; } |
arsenalist | 0:f4e449fa34d7 | 1747 | sprintf(s,"%s/firmware_Hex_%s_%d",connData.c_str(),firmwareVer.c_str(),n); |
arsenalist | 0:f4e449fa34d7 | 1748 | rest.get(s); |
arsenalist | 0:f4e449fa34d7 | 1749 | for(int i=0; i<sizeof(s); i++) { |
arsenalist | 0:f4e449fa34d7 | 1750 | s[i]=0; } |
arsenalist | 0:f4e449fa34d7 | 1751 | rest.getResponse(s,sizeof(s)); |
arsenalist | 0:f4e449fa34d7 | 1752 | //DBG.printf("rsp[%d]:%s\r\n",n,s); |
arsenalist | 0:f4e449fa34d7 | 1753 | |
arsenalist | 0:f4e449fa34d7 | 1754 | str = s; |
arsenalist | 0:f4e449fa34d7 | 1755 | if(str.find("{") != std::string::npos && str.find("}") != std::string::npos) { |
arsenalist | 0:f4e449fa34d7 | 1756 | str.erase(str.begin(),str.begin()+str.find("{")+1); |
arsenalist | 0:f4e449fa34d7 | 1757 | str.erase(str.begin()+str.find("}"),str.end()); |
arsenalist | 0:f4e449fa34d7 | 1758 | //DBG.printf("firmwarePart[%d]:%s\r\n",n,str.c_str()); |
arsenalist | 0:f4e449fa34d7 | 1759 | firmwarePart = str; |
arsenalist | 0:f4e449fa34d7 | 1760 | |
arsenalist | 0:f4e449fa34d7 | 1761 | //calculated MD5 |
arsenalist | 0:f4e449fa34d7 | 1762 | calcMD5 = calculateMD5(firmwarePart); |
arsenalist | 0:f4e449fa34d7 | 1763 | //DBG.printf("calcMD5[%d]:%s\r\n",n,calcMD5.c_str()); |
arsenalist | 0:f4e449fa34d7 | 1764 | |
arsenalist | 0:f4e449fa34d7 | 1765 | //MD5 from server |
arsenalist | 0:f4e449fa34d7 | 1766 | for(int i=0; i<sizeof(s); i++) { |
arsenalist | 0:f4e449fa34d7 | 1767 | s[i]=0; } |
arsenalist | 0:f4e449fa34d7 | 1768 | sprintf(s,"%s/MD5/firmware_MD5_%s_%d",connData.c_str(),firmwareVer.c_str(),n); |
arsenalist | 0:f4e449fa34d7 | 1769 | rest.get(s); |
arsenalist | 0:f4e449fa34d7 | 1770 | for(int i=0; i<sizeof(s); i++) { |
arsenalist | 0:f4e449fa34d7 | 1771 | s[i]=0; } |
arsenalist | 0:f4e449fa34d7 | 1772 | rest.getResponse(s,sizeof(s)); |
arsenalist | 0:f4e449fa34d7 | 1773 | |
arsenalist | 0:f4e449fa34d7 | 1774 | str = s; |
arsenalist | 0:f4e449fa34d7 | 1775 | if(str.find("{") != std::string::npos && str.find("}") != std::string::npos) { |
arsenalist | 0:f4e449fa34d7 | 1776 | str.erase(str.begin(),str.begin()+str.find("{")+1); |
arsenalist | 0:f4e449fa34d7 | 1777 | str.erase(str.begin()+str.find("}"),str.end()); |
arsenalist | 0:f4e449fa34d7 | 1778 | srvrMD5 = str; |
arsenalist | 0:f4e449fa34d7 | 1779 | //DBG.printf("srvrMD5[%d]:%s\r\n",n,srvrMD5.c_str()); |
arsenalist | 0:f4e449fa34d7 | 1780 | |
arsenalist | 0:f4e449fa34d7 | 1781 | //compare original MD5 vs MD5 from server |
arsenalist | 0:f4e449fa34d7 | 1782 | if(strcmp(calcMD5.c_str(),srvrMD5.c_str()) == 0) { |
arsenalist | 0:f4e449fa34d7 | 1783 | //DBG.printf("MD5 correct\r\n"); |
arsenalist | 0:f4e449fa34d7 | 1784 | |
arsenalist | 0:f4e449fa34d7 | 1785 | //save to sd card |
arsenalist | 0:f4e449fa34d7 | 1786 | int st = writeFirmwareHexToChar(firmwarePart); |
arsenalist | 0:f4e449fa34d7 | 1787 | if(st) { |
arsenalist | 0:f4e449fa34d7 | 1788 | DBG.printf("firmwarePart[%d/%d] written\r\n",n,numPart-1); |
arsenalist | 0:f4e449fa34d7 | 1789 | nextPart = true; |
arsenalist | 0:f4e449fa34d7 | 1790 | } |
arsenalist | 0:f4e449fa34d7 | 1791 | |
arsenalist | 0:f4e449fa34d7 | 1792 | } else { |
arsenalist | 0:f4e449fa34d7 | 1793 | DBG.printf("MD5 incorrect\r\n"); |
arsenalist | 0:f4e449fa34d7 | 1794 | } |
arsenalist | 0:f4e449fa34d7 | 1795 | } |
arsenalist | 0:f4e449fa34d7 | 1796 | } else { |
arsenalist | 0:f4e449fa34d7 | 1797 | DBG.printf("retry to fetch firmwarePart[%d]\r\n",n); |
arsenalist | 0:f4e449fa34d7 | 1798 | } |
arsenalist | 0:f4e449fa34d7 | 1799 | wait(0.5); |
arsenalist | 0:f4e449fa34d7 | 1800 | } |
arsenalist | 0:f4e449fa34d7 | 1801 | } |
arsenalist | 0:f4e449fa34d7 | 1802 | DBG.printf("download finished\r\n"); |
arsenalist | 0:f4e449fa34d7 | 1803 | } |
arsenalist | 12:96f637ed37f9 | 1804 | /*end emma mode*/ |
arsenalist | 0:f4e449fa34d7 | 1805 | |
arsenalist | 4:76ab12e2f8a3 | 1806 | /*start energy related*/ |
arsenalist | 0:f4e449fa34d7 | 1807 | void energyThread(void const*) { |
arsenalist | 19:7e3e9332f719 | 1808 | Timer tEnergy; |
arsenalist | 19:7e3e9332f719 | 1809 | |
arsenalist | 19:7e3e9332f719 | 1810 | while(1) { |
arsenalist | 19:7e3e9332f719 | 1811 | tEnergy.start(); |
arsenalist | 19:7e3e9332f719 | 1812 | DBG.printf("energyThread-start\r\n"); |
arsenalist | 19:7e3e9332f719 | 1813 | |
arsenalist | 19:7e3e9332f719 | 1814 | AWattHrSum = 0; |
arsenalist | 19:7e3e9332f719 | 1815 | BWattHrSum = 0; |
arsenalist | 19:7e3e9332f719 | 1816 | CWattHrSum = 0; |
arsenalist | 19:7e3e9332f719 | 1817 | |
arsenalist | 20:ea14f175bbb4 | 1818 | while(tEnergy.read() < 1*60.0) { |
arsenalist | 19:7e3e9332f719 | 1819 | AWattHrValue = ADE.getWattHR(PHASE_A); |
arsenalist | 19:7e3e9332f719 | 1820 | BWattHrValue = ADE.getWattHR(PHASE_B); |
arsenalist | 19:7e3e9332f719 | 1821 | CWattHrValue = ADE.getWattHR(PHASE_C); |
arsenalist | 19:7e3e9332f719 | 1822 | |
arsenalist | 19:7e3e9332f719 | 1823 | AWattHrSum += AWattHrValue; |
arsenalist | 19:7e3e9332f719 | 1824 | BWattHrSum += BWattHrValue; |
arsenalist | 20:ea14f175bbb4 | 1825 | CWattHrSum += CWattHrValue; |
arsenalist | 20:ea14f175bbb4 | 1826 | |
arsenalist | 20:ea14f175bbb4 | 1827 | |
arsenalist | 20:ea14f175bbb4 | 1828 | //start check voltage and power |
arsenalist | 21:33bd8b82560f | 1829 | AVrms = ADE.VRMS(PHASE_A) * 0.000124f; //0.000158; //constants are from calculateVRMS function |
arsenalist | 21:33bd8b82560f | 1830 | BVrms = ADE.VRMS(PHASE_B) * 0.000123f; |
arsenalist | 21:33bd8b82560f | 1831 | CVrms = ADE.VRMS(PHASE_C) * 0.000122f; |
arsenalist | 20:ea14f175bbb4 | 1832 | |
arsenalist | 21:33bd8b82560f | 1833 | AIrms = ADE.IRMS(PHASE_A) * 0.00001006f; //0.0000125f; //constants are from calculateIRMS function |
arsenalist | 21:33bd8b82560f | 1834 | BIrms = ADE.IRMS(PHASE_B) * 0.00001005f; |
arsenalist | 21:33bd8b82560f | 1835 | CIrms = ADE.IRMS(PHASE_C) * 0.00001004f; |
arsenalist | 20:ea14f175bbb4 | 1836 | |
arsenalist | 20:ea14f175bbb4 | 1837 | AWatt = AVrms * AIrms; |
arsenalist | 20:ea14f175bbb4 | 1838 | BWatt = BVrms * BIrms; |
arsenalist | 20:ea14f175bbb4 | 1839 | CWatt = CVrms * CIrms; |
arsenalist | 20:ea14f175bbb4 | 1840 | //end check voltage and power |
arsenalist | 20:ea14f175bbb4 | 1841 | |
arsenalist | 19:7e3e9332f719 | 1842 | } |
arsenalist | 19:7e3e9332f719 | 1843 | |
arsenalist | 25:36c6a5db50ed | 1844 | AWattHr = AWattHrSum * 0.000044169f; //0.0000198f; |
arsenalist | 25:36c6a5db50ed | 1845 | BWattHr = BWattHrSum * 0.000044168f; //0.0000197f; |
arsenalist | 25:36c6a5db50ed | 1846 | CWattHr = CWattHrSum * 0.000044167f; //0.0000196f; |
arsenalist | 19:7e3e9332f719 | 1847 | |
arsenalist | 22:e18d361bf688 | 1848 | newEnergyData = true; |
arsenalist | 22:e18d361bf688 | 1849 | |
arsenalist | 19:7e3e9332f719 | 1850 | tEnergy.stop(); |
arsenalist | 19:7e3e9332f719 | 1851 | tEnergy.reset(); |
arsenalist | 19:7e3e9332f719 | 1852 | DBG.printf("energyThread-finish\r\n"); |
arsenalist | 19:7e3e9332f719 | 1853 | } |
arsenalist | 0:f4e449fa34d7 | 1854 | } |
arsenalist | 21:33bd8b82560f | 1855 | void checkVoltagePower(void) { |
arsenalist | 4:76ab12e2f8a3 | 1856 | //check if voltage or power violates threshold |
arsenalist | 22:e18d361bf688 | 1857 | char p[64]; |
arsenalist | 20:ea14f175bbb4 | 1858 | char q[32]; |
arsenalist | 4:76ab12e2f8a3 | 1859 | char s[256]; |
arsenalist | 22:e18d361bf688 | 1860 | string hmacTime; |
arsenalist | 4:76ab12e2f8a3 | 1861 | string str; |
arsenalist | 20:ea14f175bbb4 | 1862 | time_t seconds; |
arsenalist | 4:76ab12e2f8a3 | 1863 | |
arsenalist | 4:76ab12e2f8a3 | 1864 | //DBG.printf("checkVoltagePower-start\r\n"); |
arsenalist | 4:76ab12e2f8a3 | 1865 | |
arsenalist | 20:ea14f175bbb4 | 1866 | //vrms and irms might be placed inside energy calculation routine |
arsenalist | 20:ea14f175bbb4 | 1867 | /* |
arsenalist | 19:7e3e9332f719 | 1868 | AVrms = ADE.VRMS(PHASE_A) * 0.000128f; //0.000158; //constants are from calculateVRMS function |
arsenalist | 19:7e3e9332f719 | 1869 | BVrms = ADE.VRMS(PHASE_B) * 0.000127f; //0.000157; |
arsenalist | 19:7e3e9332f719 | 1870 | CVrms = ADE.VRMS(PHASE_C) * 0.000126f; //0.000156; |
arsenalist | 19:7e3e9332f719 | 1871 | |
arsenalist | 19:7e3e9332f719 | 1872 | AIrms = ADE.IRMS(PHASE_A) * 0.0000125f; //constants are from calculateIRMS function |
arsenalist | 19:7e3e9332f719 | 1873 | BIrms = ADE.IRMS(PHASE_B) * 0.0000123f; |
arsenalist | 19:7e3e9332f719 | 1874 | CIrms = ADE.IRMS(PHASE_C) * 0.0000124f; |
arsenalist | 4:76ab12e2f8a3 | 1875 | |
arsenalist | 4:76ab12e2f8a3 | 1876 | AWatt = AVrms * AIrms; |
arsenalist | 4:76ab12e2f8a3 | 1877 | BWatt = BVrms * BIrms; |
arsenalist | 4:76ab12e2f8a3 | 1878 | CWatt = CVrms * CIrms; |
arsenalist | 20:ea14f175bbb4 | 1879 | */ |
arsenalist | 4:76ab12e2f8a3 | 1880 | |
arsenalist | 21:33bd8b82560f | 1881 | //DBG.printf("Vrms of each phase:%.2f - %.2f - %.2f\r\n", AVrms, BVrms, CVrms); |
arsenalist | 21:33bd8b82560f | 1882 | //DBG.printf("Watt of each phase:%.2f - %.2f - %.2f\r\n", AWatt, BWatt, CWatt); |
arsenalist | 21:33bd8b82560f | 1883 | //wait(1); |
arsenalist | 19:7e3e9332f719 | 1884 | |
arsenalist | 20:ea14f175bbb4 | 1885 | //get time |
arsenalist | 20:ea14f175bbb4 | 1886 | seconds = time(NULL); |
arsenalist | 20:ea14f175bbb4 | 1887 | strftime(q, 32, "%Y-%m-%d %H:%M:%S",localtime(&seconds)); |
arsenalist | 20:ea14f175bbb4 | 1888 | |
arsenalist | 22:e18d361bf688 | 1889 | //calculate hmacTime |
arsenalist | 22:e18d361bf688 | 1890 | for(int j=0; j<sizeof(p); j++) { |
arsenalist | 22:e18d361bf688 | 1891 | p[j]=0; } |
arsenalist | 22:e18d361bf688 | 1892 | sprintf(p,"emma-%s-%s",emmaUID.c_str(),q); |
arsenalist | 22:e18d361bf688 | 1893 | hmacTime = calculateMD5(p); |
arsenalist | 22:e18d361bf688 | 1894 | |
arsenalist | 4:76ab12e2f8a3 | 1895 | if(AVrms > VRMSTHRESHOLD || AWatt > WATTTHRESHOLD) { |
arsenalist | 4:76ab12e2f8a3 | 1896 | DBG.printf("alert on ch1\r\n"); |
arsenalist | 20:ea14f175bbb4 | 1897 | sprintf(s,"{\"uid\":\"%s\",\"hmac\":\"%s\",\"time\":\"%s\",\"voltage\":%.2f,\"power\":%.2f}", |
arsenalist | 22:e18d361bf688 | 1898 | emmaUID.c_str(),hmacTime.c_str(),q,AVrms,AWatt); |
arsenalist | 4:76ab12e2f8a3 | 1899 | rest.post("/emma/api/controller/alert/1",s); |
arsenalist | 4:76ab12e2f8a3 | 1900 | wait(2); |
arsenalist | 4:76ab12e2f8a3 | 1901 | str = rxBuf; |
arsenalist | 4:76ab12e2f8a3 | 1902 | if(str.rfind("/alert/1") != std::string::npos) { |
arsenalist | 4:76ab12e2f8a3 | 1903 | str.erase(str.begin(),str.begin()+str.rfind("/alert/1")); |
arsenalist | 4:76ab12e2f8a3 | 1904 | if(str.find("\"status\":\"success\"") != std::string::npos) { |
arsenalist | 4:76ab12e2f8a3 | 1905 | DBG.printf("send alert ch1 success\r\n"); |
arsenalist | 4:76ab12e2f8a3 | 1906 | } else { |
arsenalist | 4:76ab12e2f8a3 | 1907 | DBG.printf("send alert ch1 failed\r\n"); |
arsenalist | 4:76ab12e2f8a3 | 1908 | } |
arsenalist | 4:76ab12e2f8a3 | 1909 | } |
arsenalist | 4:76ab12e2f8a3 | 1910 | } |
arsenalist | 4:76ab12e2f8a3 | 1911 | |
arsenalist | 4:76ab12e2f8a3 | 1912 | if(BVrms > VRMSTHRESHOLD || BWatt > WATTTHRESHOLD) { |
arsenalist | 4:76ab12e2f8a3 | 1913 | DBG.printf("alert on ch2\r\n"); |
arsenalist | 20:ea14f175bbb4 | 1914 | sprintf(s,"{\"uid\":\"%s\",\"hmac\":\"%s\",\"time\":\"%s\",\"voltage\":%.2f,\"power\":%.2f}", |
arsenalist | 22:e18d361bf688 | 1915 | emmaUID.c_str(),hmacTime.c_str(),q,BVrms,BWatt); |
arsenalist | 4:76ab12e2f8a3 | 1916 | rest.post("/emma/api/controller/alert/2",s); |
arsenalist | 4:76ab12e2f8a3 | 1917 | wait(2); |
arsenalist | 4:76ab12e2f8a3 | 1918 | str = rxBuf; |
arsenalist | 4:76ab12e2f8a3 | 1919 | if(str.rfind("/alert/2") != std::string::npos) { |
arsenalist | 4:76ab12e2f8a3 | 1920 | str.erase(str.begin(),str.begin()+str.rfind("/alert/2")); |
arsenalist | 4:76ab12e2f8a3 | 1921 | if(str.find("\"status\":\"success\"") != std::string::npos) { |
arsenalist | 4:76ab12e2f8a3 | 1922 | DBG.printf("send alert ch2 success\r\n"); |
arsenalist | 4:76ab12e2f8a3 | 1923 | } else { |
arsenalist | 4:76ab12e2f8a3 | 1924 | DBG.printf("send alert ch2 failed\r\n"); |
arsenalist | 4:76ab12e2f8a3 | 1925 | } |
arsenalist | 4:76ab12e2f8a3 | 1926 | } |
arsenalist | 4:76ab12e2f8a3 | 1927 | } |
arsenalist | 4:76ab12e2f8a3 | 1928 | |
arsenalist | 4:76ab12e2f8a3 | 1929 | if(CVrms > VRMSTHRESHOLD || CWatt > WATTTHRESHOLD) { |
arsenalist | 7:7e8c6ad3fd64 | 1930 | DBG.printf("alert on ch3\r\n"); |
arsenalist | 4:76ab12e2f8a3 | 1931 | DBG.printf("alert on ch3\r\n"); |
arsenalist | 20:ea14f175bbb4 | 1932 | sprintf(s,"{\"uid\":\"%s\",\"hmac\":\"%s\",\"time\":\"%s\",\"voltage\":%.2f,\"power\":%.2f}", |
arsenalist | 22:e18d361bf688 | 1933 | emmaUID.c_str(),hmacTime.c_str(),q,CVrms,CWatt); |
arsenalist | 4:76ab12e2f8a3 | 1934 | rest.post("/emma/api/controller/alert/3",s); |
arsenalist | 4:76ab12e2f8a3 | 1935 | wait(2); |
arsenalist | 4:76ab12e2f8a3 | 1936 | str = rxBuf; |
arsenalist | 4:76ab12e2f8a3 | 1937 | if(str.rfind("/alert/3") != std::string::npos) { |
arsenalist | 4:76ab12e2f8a3 | 1938 | str.erase(str.begin(),str.begin()+str.rfind("/alert/3")); |
arsenalist | 4:76ab12e2f8a3 | 1939 | if(str.find("\"status\":\"success\"") != std::string::npos) { |
arsenalist | 4:76ab12e2f8a3 | 1940 | DBG.printf("send alert ch3 success\r\n"); |
arsenalist | 4:76ab12e2f8a3 | 1941 | } else { |
arsenalist | 4:76ab12e2f8a3 | 1942 | DBG.printf("send alert ch3 failed\r\n"); |
arsenalist | 4:76ab12e2f8a3 | 1943 | } |
arsenalist | 4:76ab12e2f8a3 | 1944 | } |
arsenalist | 4:76ab12e2f8a3 | 1945 | } |
arsenalist | 4:76ab12e2f8a3 | 1946 | //DBG.printf("checkVoltagePower-finish\r\n"); |
arsenalist | 4:76ab12e2f8a3 | 1947 | } |
arsenalist | 4:76ab12e2f8a3 | 1948 | /*end energy related*/ |
arsenalist | 0:f4e449fa34d7 | 1949 | |
arsenalist | 0:f4e449fa34d7 | 1950 | /*start wifi mqtt*/ |
arsenalist | 0:f4e449fa34d7 | 1951 | void mqttConnected(void* response) { |
arsenalist | 1:d314a43ae6f7 | 1952 | DBG.printf("MQTT Connected\r\n"); |
arsenalist | 0:f4e449fa34d7 | 1953 | char mqttTopic[64]; |
arsenalist | 38:e44f35f8129d | 1954 | sprintf(mqttTopic,"%s/%s/command",mqttDOMAIN.c_str(),emmaUID.c_str()); |
arsenalist | 27:562a95c120cc | 1955 | //mqtt.subscribe(mqttTopic); |
arsenalist | 0:f4e449fa34d7 | 1956 | } |
arsenalist | 0:f4e449fa34d7 | 1957 | void mqttDisconnected(void* response) { |
arsenalist | 1:d314a43ae6f7 | 1958 | DBG.printf("MQTT Disconnected\r\n"); |
arsenalist | 0:f4e449fa34d7 | 1959 | } |
arsenalist | 0:f4e449fa34d7 | 1960 | /*end wifi mqtt*/ |
arsenalist | 0:f4e449fa34d7 | 1961 | |
arsenalist | 0:f4e449fa34d7 | 1962 | /*start wifi rest*/ |
arsenalist | 27:562a95c120cc | 1963 | void wifiCb(void* response) { |
arsenalist | 27:562a95c120cc | 1964 | uint32_t status; |
arsenalist | 27:562a95c120cc | 1965 | RESPONSE res(response); |
arsenalist | 27:562a95c120cc | 1966 | |
arsenalist | 27:562a95c120cc | 1967 | if(res.getArgc() == 1) { |
arsenalist | 27:562a95c120cc | 1968 | res.popArgs((uint8_t*)&status,4); |
arsenalist | 27:562a95c120cc | 1969 | if(status == STATION_GOT_IP) { |
arsenalist | 27:562a95c120cc | 1970 | DBG.printf("WIFI Connected\r\n"); |
arsenalist | 27:562a95c120cc | 1971 | //wifiConnected = true; |
arsenalist | 27:562a95c120cc | 1972 | } |
arsenalist | 27:562a95c120cc | 1973 | else { |
arsenalist | 27:562a95c120cc | 1974 | //wifiConnected = false; |
arsenalist | 27:562a95c120cc | 1975 | } |
arsenalist | 27:562a95c120cc | 1976 | } |
arsenalist | 27:562a95c120cc | 1977 | } |
arsenalist | 27:562a95c120cc | 1978 | |
arsenalist | 4:76ab12e2f8a3 | 1979 | void rxInterrupt(void) { |
arsenalist | 4:76ab12e2f8a3 | 1980 | char c; |
arsenalist | 4:76ab12e2f8a3 | 1981 | |
arsenalist | 4:76ab12e2f8a3 | 1982 | while(_ESP.readable()) { |
arsenalist | 4:76ab12e2f8a3 | 1983 | c = _ESP.getc(); |
arsenalist | 4:76ab12e2f8a3 | 1984 | if(c != 0) { //char is not null |
arsenalist | 4:76ab12e2f8a3 | 1985 | rxBuf += c; |
arsenalist | 4:76ab12e2f8a3 | 1986 | } |
arsenalist | 4:76ab12e2f8a3 | 1987 | } |
arsenalist | 4:76ab12e2f8a3 | 1988 | } |
arsenalist | 4:76ab12e2f8a3 | 1989 | void checkRxBuffer(void) { |
arsenalist | 4:76ab12e2f8a3 | 1990 | //check new command |
arsenalist | 4:76ab12e2f8a3 | 1991 | if(rxBuf.rfind("/command") != std::string::npos) { |
arsenalist | 4:76ab12e2f8a3 | 1992 | rxBuf.erase(rxBuf.begin(),rxBuf.begin()+rxBuf.rfind("/command")); |
arsenalist | 4:76ab12e2f8a3 | 1993 | if(rxBuf.find("[{") != std::string::npos && rxBuf.find("}]") != std::string::npos) { |
arsenalist | 4:76ab12e2f8a3 | 1994 | rxBuf.erase(rxBuf.begin(),rxBuf.begin()+rxBuf.find("[{")+1); |
arsenalist | 4:76ab12e2f8a3 | 1995 | rxBuf.erase(rxBuf.begin()+rxBuf.find("]"),rxBuf.end()); |
arsenalist | 4:76ab12e2f8a3 | 1996 | globalCommand = rxBuf; |
arsenalist | 4:76ab12e2f8a3 | 1997 | //DBG.printf("gC:%s\r\n",globalCommand.c_str()); |
arsenalist | 4:76ab12e2f8a3 | 1998 | newCommand = true; |
arsenalist | 4:76ab12e2f8a3 | 1999 | } |
arsenalist | 4:76ab12e2f8a3 | 2000 | } |
arsenalist | 4:76ab12e2f8a3 | 2001 | |
arsenalist | 24:5d58515ba510 | 2002 | //check free memory -> reinitialize mqtt connection |
arsenalist | 27:562a95c120cc | 2003 | if(rxBuf.rfind("Free memory") != std::string::npos) { |
arsenalist | 27:562a95c120cc | 2004 | rxLog = "Free memory-" + rxBuf; |
arsenalist | 24:5d58515ba510 | 2005 | espFreeMemory = true; |
arsenalist | 24:5d58515ba510 | 2006 | } |
arsenalist | 24:5d58515ba510 | 2007 | |
arsenalist | 27:562a95c120cc | 2008 | //check dhcp client start -> initialize all connection |
arsenalist | 27:562a95c120cc | 2009 | if(rxBuf.rfind("dhcp client start") != std::string::npos) { |
arsenalist | 27:562a95c120cc | 2010 | rxLogA = "dhcp client start-" + rxBuf; |
arsenalist | 27:562a95c120cc | 2011 | espDHCPClientStart = true; |
arsenalist | 27:562a95c120cc | 2012 | } |
arsenalist | 27:562a95c120cc | 2013 | |
arsenalist | 4:76ab12e2f8a3 | 2014 | //clear rxBuf |
arsenalist | 4:76ab12e2f8a3 | 2015 | rxBuf.clear(); |
arsenalist | 4:76ab12e2f8a3 | 2016 | } |
arsenalist | 0:f4e449fa34d7 | 2017 | /*end wifi rest*/ |
arsenalist | 0:f4e449fa34d7 | 2018 | |
arsenalist | 36:ed696fd1b44e | 2019 | int publish(MQTT::Client<MQTTEthernet, Countdown, MQTT_MAX_PACKET_SIZE>* client, MQTTEthernet* ipstack) |
arsenalist | 36:ed696fd1b44e | 2020 | { |
arsenalist | 36:ed696fd1b44e | 2021 | MQTT::Message message; |
arsenalist | 38:e44f35f8129d | 2022 | char* topic = new char[strlen(mqttDOMAIN.c_str())+strlen(emmaUID.c_str())+9]; |
arsenalist | 36:ed696fd1b44e | 2023 | *topic = '\0'; |
arsenalist | 38:e44f35f8129d | 2024 | strcat(topic, mqttDOMAIN.c_str()); |
arsenalist | 36:ed696fd1b44e | 2025 | strcat(topic, "/"); |
arsenalist | 36:ed696fd1b44e | 2026 | strcat(topic, emmaUID.c_str()); |
arsenalist | 36:ed696fd1b44e | 2027 | strcat(topic, "/dummy"); |
arsenalist | 36:ed696fd1b44e | 2028 | |
arsenalist | 36:ed696fd1b44e | 2029 | const char buf[25] = "{\"d\":{\"myName\":\"EMMA\"}}"; |
arsenalist | 36:ed696fd1b44e | 2030 | |
arsenalist | 36:ed696fd1b44e | 2031 | message.qos = MQTT::QOS2; |
arsenalist | 36:ed696fd1b44e | 2032 | message.retained = false; |
arsenalist | 36:ed696fd1b44e | 2033 | message.dup = false; |
arsenalist | 36:ed696fd1b44e | 2034 | message.payload = (void*)buf; |
arsenalist | 36:ed696fd1b44e | 2035 | message.payloadlen = strlen(buf); |
arsenalist | 36:ed696fd1b44e | 2036 | |
arsenalist | 36:ed696fd1b44e | 2037 | DBG.printf("Publishing %s\r\n", buf); |
arsenalist | 36:ed696fd1b44e | 2038 | return client->publish(topic, &message); |
arsenalist | 36:ed696fd1b44e | 2039 | } |
arsenalist | 36:ed696fd1b44e | 2040 | |
arsenalist | 0:f4e449fa34d7 | 2041 | /*start eth mqtt*/ |
arsenalist | 0:f4e449fa34d7 | 2042 | void ethMQTTMessageArrived(MQTT::MessageData& md) { |
arsenalist | 0:f4e449fa34d7 | 2043 | MQTT::Message &message = md.message; |
arsenalist | 36:ed696fd1b44e | 2044 | char topic[md.topicName.lenstring.len + 1]; |
arsenalist | 36:ed696fd1b44e | 2045 | string str; |
arsenalist | 36:ed696fd1b44e | 2046 | sprintf(topic, "%.*s", md.topicName.lenstring.len, md.topicName.lenstring.data); |
arsenalist | 36:ed696fd1b44e | 2047 | |
arsenalist | 36:ed696fd1b44e | 2048 | DBG.printf("Message arrived on topic %s: %.*s\r\n", topic, message.payloadlen, message.payload); |
arsenalist | 36:ed696fd1b44e | 2049 | char *s = (char*)message.payload; |
arsenalist | 36:ed696fd1b44e | 2050 | string sp(s); |
arsenalist | 36:ed696fd1b44e | 2051 | if(sp.find("[") != std::string::npos && sp.find("]") != std::string::npos) { |
arsenalist | 36:ed696fd1b44e | 2052 | sp.erase(sp.begin(),sp.begin()+sp.find("[")+1); |
arsenalist | 36:ed696fd1b44e | 2053 | sp.erase(sp.begin()+sp.find("]"),sp.end()); |
arsenalist | 36:ed696fd1b44e | 2054 | } |
arsenalist | 36:ed696fd1b44e | 2055 | else { |
arsenalist | 36:ed696fd1b44e | 2056 | DBG.printf("Invalid MQTT command"); |
arsenalist | 36:ed696fd1b44e | 2057 | return; |
arsenalist | 36:ed696fd1b44e | 2058 | } |
arsenalist | 36:ed696fd1b44e | 2059 | |
arsenalist | 36:ed696fd1b44e | 2060 | MbedJSONValue jsonValue; |
arsenalist | 36:ed696fd1b44e | 2061 | parse(jsonValue, sp.c_str()); |
arsenalist | 36:ed696fd1b44e | 2062 | const char *parameter[5] = {"name","nType","nAddr","dType","cmd"}; |
arsenalist | 36:ed696fd1b44e | 2063 | |
arsenalist | 36:ed696fd1b44e | 2064 | //check if command is valid |
arsenalist | 36:ed696fd1b44e | 2065 | bool validCommand = true; |
arsenalist | 36:ed696fd1b44e | 2066 | for(int i=0; i<5; i++) { |
arsenalist | 36:ed696fd1b44e | 2067 | validCommand = validCommand && jsonValue.hasMember(parameter[i]); |
arsenalist | 36:ed696fd1b44e | 2068 | } |
arsenalist | 36:ed696fd1b44e | 2069 | DBG.printf("command validity:%d\r\n",validCommand); |
arsenalist | 36:ed696fd1b44e | 2070 | |
arsenalist | 36:ed696fd1b44e | 2071 | //check for new command |
arsenalist | 36:ed696fd1b44e | 2072 | if(validCommand) { |
arsenalist | 36:ed696fd1b44e | 2073 | string commandId = jsonValue[parameter[0]].get<std::string>(); |
arsenalist | 36:ed696fd1b44e | 2074 | string commandNType = jsonValue[parameter[1]].get<std::string>(); |
arsenalist | 36:ed696fd1b44e | 2075 | string commandNAddr = jsonValue[parameter[2]].get<std::string>(); |
arsenalist | 36:ed696fd1b44e | 2076 | string commandDType = jsonValue[parameter[3]].get<std::string>(); |
arsenalist | 36:ed696fd1b44e | 2077 | string commandCmd = jsonValue[parameter[4]].get<std::string>(); |
arsenalist | 36:ed696fd1b44e | 2078 | |
arsenalist | 36:ed696fd1b44e | 2079 | if(commandNType == "0") { //switch on panel controller |
arsenalist | 36:ed696fd1b44e | 2080 | DBG.printf("command for switch\r\n"); |
arsenalist | 36:ed696fd1b44e | 2081 | } |
arsenalist | 36:ed696fd1b44e | 2082 | else if(commandNType == "1") { //node with mac address |
arsenalist | 36:ed696fd1b44e | 2083 | DBG.printf("command for node\r\n"); |
arsenalist | 36:ed696fd1b44e | 2084 | //get node ip address based on node mac address |
arsenalist | 36:ed696fd1b44e | 2085 | string nodeIP = readNodeIP(commandNAddr); |
arsenalist | 36:ed696fd1b44e | 2086 | //DBG.printf("nodeIP: %s\r\n",nodeIP.c_str()); |
arsenalist | 36:ed696fd1b44e | 2087 | |
arsenalist | 36:ed696fd1b44e | 2088 | //get cmd string based on device type and command number |
arsenalist | 36:ed696fd1b44e | 2089 | string nodeCmd = readNodeCmd(commandDType,commandCmd); |
arsenalist | 36:ed696fd1b44e | 2090 | //DBG.printf("nodeCmd: %s\r\n",nodeCmd.c_str()); |
arsenalist | 36:ed696fd1b44e | 2091 | //execute command |
arsenalist | 36:ed696fd1b44e | 2092 | int trial=0; |
arsenalist | 36:ed696fd1b44e | 2093 | trial = 0; |
arsenalist | 36:ed696fd1b44e | 2094 | bool execStatus=false; |
arsenalist | 36:ed696fd1b44e | 2095 | |
arsenalist | 36:ed696fd1b44e | 2096 | while( !execStatus ) { |
arsenalist | 36:ed696fd1b44e | 2097 | sprintf(s,"<?xml version=\"1.0\" encoding=\"utf-8\"?><app_cmd cmd=\"5\" /><app_data code=\"%s\"/>\r\n",nodeCmd.c_str()); |
arsenalist | 36:ed696fd1b44e | 2098 | str.assign(s); |
arsenalist | 36:ed696fd1b44e | 2099 | DBG.printf("str value:%s\r\n",str.c_str()); |
arsenalist | 36:ed696fd1b44e | 2100 | string rcv = ethGET(nodeIP,REMOTE_TCP_PORT,str); // cause mqtt to stop |
arsenalist | 36:ed696fd1b44e | 2101 | DBG.printf("response:%s\r\n",rcv.c_str()); |
arsenalist | 36:ed696fd1b44e | 2102 | str = rcv; |
arsenalist | 36:ed696fd1b44e | 2103 | if(str.find("OK") != std::string::npos) { |
arsenalist | 36:ed696fd1b44e | 2104 | DBG.printf("CMD executed successfully\r\n"); |
arsenalist | 36:ed696fd1b44e | 2105 | execStatus = true; |
arsenalist | 36:ed696fd1b44e | 2106 | break; |
arsenalist | 36:ed696fd1b44e | 2107 | } |
arsenalist | 36:ed696fd1b44e | 2108 | if(trial>5) { //two times trial |
arsenalist | 36:ed696fd1b44e | 2109 | DBG.printf("cmd is not executed\r\n"); |
arsenalist | 36:ed696fd1b44e | 2110 | execStatus = false; |
arsenalist | 36:ed696fd1b44e | 2111 | } |
arsenalist | 36:ed696fd1b44e | 2112 | DBG.printf("Trial++\r\n"); |
arsenalist | 36:ed696fd1b44e | 2113 | trial++; |
arsenalist | 36:ed696fd1b44e | 2114 | wait(3); |
arsenalist | 36:ed696fd1b44e | 2115 | } |
arsenalist | 36:ed696fd1b44e | 2116 | DBG.printf("Send execution status\r\n"); |
arsenalist | 36:ed696fd1b44e | 2117 | //send execution status |
arsenalist | 36:ed696fd1b44e | 2118 | } |
arsenalist | 36:ed696fd1b44e | 2119 | } |
arsenalist | 36:ed696fd1b44e | 2120 | DBG.printf("Finish processing new command\r\n"); |
arsenalist | 36:ed696fd1b44e | 2121 | |
arsenalist | 36:ed696fd1b44e | 2122 | /* |
arsenalist | 36:ed696fd1b44e | 2123 | MQTT::Message &message = md.message; |
arsenalist | 0:f4e449fa34d7 | 2124 | DBG.printf("Message arrived: qos %d, retained %d, dup %d, packetid %d\r\n", |
arsenalist | 0:f4e449fa34d7 | 2125 | message.qos, message.retained, message.dup, message.id); |
arsenalist | 0:f4e449fa34d7 | 2126 | DBG.printf("Payload: %.*s\r\n", message.payloadlen, (char*)message.payload); |
arsenalist | 0:f4e449fa34d7 | 2127 | //DBG.printf("Payload %s\r\n",message.payload); |
arsenalist | 0:f4e449fa34d7 | 2128 | |
arsenalist | 0:f4e449fa34d7 | 2129 | |
arsenalist | 0:f4e449fa34d7 | 2130 | //check whether cmd is json |
arsenalist | 0:f4e449fa34d7 | 2131 | //char r[255]; |
arsenalist | 0:f4e449fa34d7 | 2132 | char *s = (char*)message.payload; |
arsenalist | 0:f4e449fa34d7 | 2133 | string sp(s); |
arsenalist | 0:f4e449fa34d7 | 2134 | //sprintf(s,"%.*s",message.payloadlen, (char*)message.payload); |
arsenalist | 0:f4e449fa34d7 | 2135 | //sprintf(globCmd,"%s",s); |
arsenalist | 0:f4e449fa34d7 | 2136 | //DBG.printf("Payload: %s\r\n", r); |
arsenalist | 0:f4e449fa34d7 | 2137 | //string cmd = r; |
arsenalist | 0:f4e449fa34d7 | 2138 | //globalCommand = cmd; |
arsenalist | 10:1dc69e0ce7fd | 2139 | |
arsenalist | 10:1dc69e0ce7fd | 2140 | //globalCommand = sp; |
arsenalist | 10:1dc69e0ce7fd | 2141 | |
arsenalist | 0:f4e449fa34d7 | 2142 | //globCmd = (char*)message.payload; |
arsenalist | 0:f4e449fa34d7 | 2143 | //string globCmd((char*)message.payload); |
arsenalist | 0:f4e449fa34d7 | 2144 | //std::string *sp = static_cast<std::char*>(message.payload); |
arsenalist | 0:f4e449fa34d7 | 2145 | //string sp((char*)message.payload); |
arsenalist | 10:1dc69e0ce7fd | 2146 | |
arsenalist | 10:1dc69e0ce7fd | 2147 | //DBG.printf("String: %s\r\n",sp.c_str()); |
arsenalist | 10:1dc69e0ce7fd | 2148 | |
arsenalist | 0:f4e449fa34d7 | 2149 | //globCmd = sp; |
arsenalist | 0:f4e449fa34d7 | 2150 | |
arsenalist | 10:1dc69e0ce7fd | 2151 | //newCommand = true; |
arsenalist | 10:1dc69e0ce7fd | 2152 | if(sp.find("[") != std::string::npos && sp.find("]") != std::string::npos) { |
arsenalist | 10:1dc69e0ce7fd | 2153 | sp.erase(sp.begin(),sp.begin()+sp.find("[")+1); |
arsenalist | 10:1dc69e0ce7fd | 2154 | sp.erase(sp.begin()+sp.find("]"),sp.end()); |
arsenalist | 10:1dc69e0ce7fd | 2155 | globalCommand = sp; |
arsenalist | 0:f4e449fa34d7 | 2156 | newCommand = true; |
arsenalist | 0:f4e449fa34d7 | 2157 | } |
arsenalist | 10:1dc69e0ce7fd | 2158 | sp.clear(); |
arsenalist | 36:ed696fd1b44e | 2159 | */ |
arsenalist | 0:f4e449fa34d7 | 2160 | } |
arsenalist | 0:f4e449fa34d7 | 2161 | |
arsenalist | 0:f4e449fa34d7 | 2162 | int ethMQTTConnect(MQTT::Client<MQTTEthernet, Countdown, MQTT_MAX_PACKET_SIZE>* client, MQTTEthernet* ipstack) { |
arsenalist | 38:e44f35f8129d | 2163 | char *pMqttServer = &mqttSERVER[0u]; |
arsenalist | 38:e44f35f8129d | 2164 | int connPort; |
arsenalist | 38:e44f35f8129d | 2165 | sscanf(mqttPORT.c_str(),"%d",&connPort); |
arsenalist | 38:e44f35f8129d | 2166 | int rc = ipstack->connect(pMqttServer, connPort); |
arsenalist | 0:f4e449fa34d7 | 2167 | |
arsenalist | 0:f4e449fa34d7 | 2168 | if(rc!=0) |
arsenalist | 0:f4e449fa34d7 | 2169 | return rc; |
arsenalist | 0:f4e449fa34d7 | 2170 | |
arsenalist | 0:f4e449fa34d7 | 2171 | //MQTT Connect |
arsenalist | 36:ed696fd1b44e | 2172 | char clientId [64]; |
arsenalist | 0:f4e449fa34d7 | 2173 | sprintf(clientId,"emma/%s",emmaUID.c_str()); |
arsenalist | 0:f4e449fa34d7 | 2174 | //DBG.printf("clientId:%s\r\n",clientId); |
arsenalist | 36:ed696fd1b44e | 2175 | |
arsenalist | 0:f4e449fa34d7 | 2176 | MQTTPacket_connectData data = MQTTPacket_connectData_initializer; |
arsenalist | 0:f4e449fa34d7 | 2177 | data.MQTTVersion = 3; |
arsenalist | 0:f4e449fa34d7 | 2178 | data.clientID.cstring = clientId; |
arsenalist | 0:f4e449fa34d7 | 2179 | data.username.cstring = "761b233e-a49a-4830-a8ae-87cec3dc1086"; |
arsenalist | 0:f4e449fa34d7 | 2180 | data.password.cstring = "ef25cf4567fbc07113252f8d72b7faf2"; |
arsenalist | 0:f4e449fa34d7 | 2181 | |
arsenalist | 0:f4e449fa34d7 | 2182 | if((rc = client->connect(&data)) == 0) { |
arsenalist | 36:ed696fd1b44e | 2183 | DBG.printf("ethMQTT connected\r\n"); |
arsenalist | 0:f4e449fa34d7 | 2184 | } |
arsenalist | 0:f4e449fa34d7 | 2185 | |
arsenalist | 0:f4e449fa34d7 | 2186 | //MQTT Subscribe |
arsenalist | 36:ed696fd1b44e | 2187 | //char s[64]; |
arsenalist | 38:e44f35f8129d | 2188 | //sprintf(s,"%s/%s/command",mqttDOMAIN.c_str(),emmaUID.c_str()); |
arsenalist | 36:ed696fd1b44e | 2189 | //string topic = s; |
arsenalist | 38:e44f35f8129d | 2190 | char* topic = new char[strlen(mqttDOMAIN.c_str())+strlen(emmaUID.c_str())+9]; |
arsenalist | 36:ed696fd1b44e | 2191 | *topic = '\0'; |
arsenalist | 38:e44f35f8129d | 2192 | strcat(topic, mqttDOMAIN.c_str()); |
arsenalist | 36:ed696fd1b44e | 2193 | strcat(topic, "/"); |
arsenalist | 36:ed696fd1b44e | 2194 | strcat(topic, emmaUID.c_str()); |
arsenalist | 36:ed696fd1b44e | 2195 | strcat(topic, "/command"); |
arsenalist | 36:ed696fd1b44e | 2196 | DBG.printf("topic:%s\r\n",topic); |
arsenalist | 36:ed696fd1b44e | 2197 | |
arsenalist | 36:ed696fd1b44e | 2198 | if((rc=client->subscribe(topic,MQTT::QOS0,ethMQTTMessageArrived)) == 0) { |
arsenalist | 0:f4e449fa34d7 | 2199 | DBG.printf("subscribe success!\r\n"); |
arsenalist | 0:f4e449fa34d7 | 2200 | } |
arsenalist | 0:f4e449fa34d7 | 2201 | return rc; |
arsenalist | 0:f4e449fa34d7 | 2202 | } |
arsenalist | 0:f4e449fa34d7 | 2203 | void ethMQTTAttemptConnect(MQTT::Client<MQTTEthernet, Countdown, MQTT_MAX_PACKET_SIZE>* client, MQTTEthernet* ipstack) { |
arsenalist | 0:f4e449fa34d7 | 2204 | int retryAttempt = 0; |
arsenalist | 0:f4e449fa34d7 | 2205 | |
arsenalist | 0:f4e449fa34d7 | 2206 | while(!ipstack->getEth().linkstatus()) { |
arsenalist | 0:f4e449fa34d7 | 2207 | DBG.printf("Ethernet link not present. Check cable connection\r\n"); |
arsenalist | 0:f4e449fa34d7 | 2208 | wait(1); |
arsenalist | 0:f4e449fa34d7 | 2209 | } |
arsenalist | 0:f4e449fa34d7 | 2210 | |
arsenalist | 0:f4e449fa34d7 | 2211 | while(ethMQTTConnect(client,ipstack) != 0) { |
arsenalist | 0:f4e449fa34d7 | 2212 | int timeout = 3; |
arsenalist | 0:f4e449fa34d7 | 2213 | DBG.printf("Retry attempt number %d waiting %d\r\n", retryAttempt, timeout); |
arsenalist | 0:f4e449fa34d7 | 2214 | wait(timeout); |
arsenalist | 0:f4e449fa34d7 | 2215 | retryAttempt++; |
arsenalist | 0:f4e449fa34d7 | 2216 | } |
arsenalist | 0:f4e449fa34d7 | 2217 | } |
arsenalist | 0:f4e449fa34d7 | 2218 | /*end eth mqtt*/ |
arsenalist | 0:f4e449fa34d7 | 2219 | |
arsenalist | 0:f4e449fa34d7 | 2220 | /*start emma settings*/ |
arsenalist | 0:f4e449fa34d7 | 2221 | string getUID(void) { |
arsenalist | 0:f4e449fa34d7 | 2222 | char s[32]; |
arsenalist | 0:f4e449fa34d7 | 2223 | unsigned long *unique = (unsigned long *)BASE_ADDR; |
arsenalist | 0:f4e449fa34d7 | 2224 | sprintf(s,"%08x%08x%08x",unique[0], unique[1], unique[2]); |
arsenalist | 0:f4e449fa34d7 | 2225 | return s; |
arsenalist | 0:f4e449fa34d7 | 2226 | } |
arsenalist | 0:f4e449fa34d7 | 2227 | |
arsenalist | 0:f4e449fa34d7 | 2228 | string readSetting(string parameter) { |
arsenalist | 0:f4e449fa34d7 | 2229 | FILE *fp; |
arsenalist | 0:f4e449fa34d7 | 2230 | signed char c; |
arsenalist | 0:f4e449fa34d7 | 2231 | int i=0; |
arsenalist | 0:f4e449fa34d7 | 2232 | char s[64]; |
arsenalist | 0:f4e449fa34d7 | 2233 | string strS; |
arsenalist | 0:f4e449fa34d7 | 2234 | |
arsenalist | 0:f4e449fa34d7 | 2235 | sprintf(s,"/sd/settings/%s.txt",parameter.c_str()); |
arsenalist | 0:f4e449fa34d7 | 2236 | |
arsenalist | 0:f4e449fa34d7 | 2237 | fp = fopen(s,"r"); |
arsenalist | 0:f4e449fa34d7 | 2238 | memset(s,0,sizeof(s)); |
arsenalist | 0:f4e449fa34d7 | 2239 | if(fp != NULL) { |
arsenalist | 0:f4e449fa34d7 | 2240 | while(1) { |
arsenalist | 0:f4e449fa34d7 | 2241 | c = fgetc(fp); |
arsenalist | 0:f4e449fa34d7 | 2242 | if(c == EOF){ |
arsenalist | 0:f4e449fa34d7 | 2243 | break; |
arsenalist | 0:f4e449fa34d7 | 2244 | } |
arsenalist | 0:f4e449fa34d7 | 2245 | s[i] = c; |
arsenalist | 0:f4e449fa34d7 | 2246 | i++; |
arsenalist | 0:f4e449fa34d7 | 2247 | } |
arsenalist | 0:f4e449fa34d7 | 2248 | strS = s; |
arsenalist | 0:f4e449fa34d7 | 2249 | if(strS.find("(") != std::string::npos && strS.find(")") != std::string::npos) { |
arsenalist | 0:f4e449fa34d7 | 2250 | strS.erase(strS.begin(),strS.begin()+strS.find("(")+1); |
arsenalist | 0:f4e449fa34d7 | 2251 | strS.erase(strS.begin()+strS.find(")"),strS.end()); |
arsenalist | 0:f4e449fa34d7 | 2252 | } else { |
arsenalist | 0:f4e449fa34d7 | 2253 | strS = ""; |
arsenalist | 0:f4e449fa34d7 | 2254 | } |
arsenalist | 0:f4e449fa34d7 | 2255 | } |
arsenalist | 0:f4e449fa34d7 | 2256 | fclose(fp); |
arsenalist | 30:08d290158fa7 | 2257 | free(fp); |
arsenalist | 0:f4e449fa34d7 | 2258 | return strS; |
arsenalist | 0:f4e449fa34d7 | 2259 | } |
arsenalist | 0:f4e449fa34d7 | 2260 | |
arsenalist | 0:f4e449fa34d7 | 2261 | bool writeSetting(string parameter, string value) { |
arsenalist | 0:f4e449fa34d7 | 2262 | FILE *fp; |
arsenalist | 0:f4e449fa34d7 | 2263 | char s[255]; |
arsenalist | 0:f4e449fa34d7 | 2264 | |
arsenalist | 0:f4e449fa34d7 | 2265 | sprintf(s,"/sd/settings/%s.txt",parameter.c_str()); |
arsenalist | 0:f4e449fa34d7 | 2266 | fp = fopen(s,"w"); |
arsenalist | 0:f4e449fa34d7 | 2267 | if(fp != NULL) { |
arsenalist | 0:f4e449fa34d7 | 2268 | fprintf(fp,value.c_str()); |
arsenalist | 0:f4e449fa34d7 | 2269 | fclose(fp); |
arsenalist | 30:08d290158fa7 | 2270 | free(fp); |
arsenalist | 0:f4e449fa34d7 | 2271 | return true; |
arsenalist | 0:f4e449fa34d7 | 2272 | } |
arsenalist | 30:08d290158fa7 | 2273 | fclose(fp); |
arsenalist | 30:08d290158fa7 | 2274 | free(fp); |
arsenalist | 0:f4e449fa34d7 | 2275 | return false; |
arsenalist | 0:f4e449fa34d7 | 2276 | } |
arsenalist | 0:f4e449fa34d7 | 2277 | /*end emma settings*/ |
arsenalist | 0:f4e449fa34d7 | 2278 | |
arsenalist | 0:f4e449fa34d7 | 2279 | /*start emma node*/ |
arsenalist | 0:f4e449fa34d7 | 2280 | string readNodeIP(string macAddr) { |
arsenalist | 0:f4e449fa34d7 | 2281 | FILE *fp; |
arsenalist | 0:f4e449fa34d7 | 2282 | signed char c; |
arsenalist | 0:f4e449fa34d7 | 2283 | int i=0; |
arsenalist | 0:f4e449fa34d7 | 2284 | char s[64]; |
arsenalist | 0:f4e449fa34d7 | 2285 | string strS; |
arsenalist | 0:f4e449fa34d7 | 2286 | |
arsenalist | 0:f4e449fa34d7 | 2287 | sprintf(s,"/sd/nodeList/%s/nodeIP.txt",macAddr.c_str()); |
arsenalist | 0:f4e449fa34d7 | 2288 | |
arsenalist | 0:f4e449fa34d7 | 2289 | fp = fopen(s,"r"); |
arsenalist | 0:f4e449fa34d7 | 2290 | memset(s,0,sizeof(s)); |
arsenalist | 0:f4e449fa34d7 | 2291 | if(fp != NULL) { |
arsenalist | 0:f4e449fa34d7 | 2292 | while(1) { |
arsenalist | 0:f4e449fa34d7 | 2293 | c = fgetc(fp); |
arsenalist | 0:f4e449fa34d7 | 2294 | if(c == EOF){ |
arsenalist | 0:f4e449fa34d7 | 2295 | break; |
arsenalist | 0:f4e449fa34d7 | 2296 | } |
arsenalist | 0:f4e449fa34d7 | 2297 | s[i] = c; |
arsenalist | 0:f4e449fa34d7 | 2298 | i++; |
arsenalist | 0:f4e449fa34d7 | 2299 | } |
arsenalist | 0:f4e449fa34d7 | 2300 | strS = s; |
arsenalist | 0:f4e449fa34d7 | 2301 | if(strS.find("(") != std::string::npos && strS.find(")") != std::string::npos) { |
arsenalist | 0:f4e449fa34d7 | 2302 | strS.erase(strS.begin(),strS.begin()+strS.find("(")+1); |
arsenalist | 0:f4e449fa34d7 | 2303 | strS.erase(strS.begin()+strS.find(")"),strS.end()); |
arsenalist | 0:f4e449fa34d7 | 2304 | } else { |
arsenalist | 0:f4e449fa34d7 | 2305 | strS = ""; |
arsenalist | 0:f4e449fa34d7 | 2306 | } |
arsenalist | 0:f4e449fa34d7 | 2307 | } |
arsenalist | 0:f4e449fa34d7 | 2308 | fclose(fp); |
arsenalist | 30:08d290158fa7 | 2309 | free(fp); |
arsenalist | 0:f4e449fa34d7 | 2310 | return strS; |
arsenalist | 0:f4e449fa34d7 | 2311 | } |
arsenalist | 0:f4e449fa34d7 | 2312 | |
arsenalist | 0:f4e449fa34d7 | 2313 | string readNodeCmd(string dType, string cmd) { |
arsenalist | 0:f4e449fa34d7 | 2314 | FILE *fp; |
arsenalist | 0:f4e449fa34d7 | 2315 | signed char c; |
arsenalist | 0:f4e449fa34d7 | 2316 | int i=0; |
arsenalist | 34:8555d471b880 | 2317 | char s[2048]; |
arsenalist | 0:f4e449fa34d7 | 2318 | string strS; |
arsenalist | 0:f4e449fa34d7 | 2319 | |
arsenalist | 0:f4e449fa34d7 | 2320 | sprintf(s,"/sd/nodeCode/%s/%s.txt",dType.c_str(),cmd.c_str()); |
arsenalist | 0:f4e449fa34d7 | 2321 | |
arsenalist | 0:f4e449fa34d7 | 2322 | fp = fopen(s,"r"); |
arsenalist | 0:f4e449fa34d7 | 2323 | memset(s,0,sizeof(s)); |
arsenalist | 0:f4e449fa34d7 | 2324 | if(fp != NULL) { |
arsenalist | 0:f4e449fa34d7 | 2325 | while(1) { |
arsenalist | 0:f4e449fa34d7 | 2326 | c = fgetc(fp); |
arsenalist | 0:f4e449fa34d7 | 2327 | if(c == EOF){ |
arsenalist | 0:f4e449fa34d7 | 2328 | break; |
arsenalist | 0:f4e449fa34d7 | 2329 | } |
arsenalist | 0:f4e449fa34d7 | 2330 | s[i] = c; |
arsenalist | 0:f4e449fa34d7 | 2331 | i++; |
arsenalist | 0:f4e449fa34d7 | 2332 | } |
arsenalist | 0:f4e449fa34d7 | 2333 | strS = s; |
arsenalist | 0:f4e449fa34d7 | 2334 | if(strS.find("(") != std::string::npos && strS.find(")") != std::string::npos) { |
arsenalist | 0:f4e449fa34d7 | 2335 | strS.erase(strS.begin(),strS.begin()+strS.find("(")+1); |
arsenalist | 0:f4e449fa34d7 | 2336 | strS.erase(strS.begin()+strS.find(")"),strS.end()); |
arsenalist | 0:f4e449fa34d7 | 2337 | } else { |
arsenalist | 0:f4e449fa34d7 | 2338 | strS = ""; |
arsenalist | 0:f4e449fa34d7 | 2339 | } |
arsenalist | 0:f4e449fa34d7 | 2340 | } |
arsenalist | 0:f4e449fa34d7 | 2341 | fclose(fp); |
arsenalist | 30:08d290158fa7 | 2342 | free(fp); |
arsenalist | 0:f4e449fa34d7 | 2343 | return strS; |
arsenalist | 0:f4e449fa34d7 | 2344 | } |
arsenalist | 0:f4e449fa34d7 | 2345 | |
arsenalist | 0:f4e449fa34d7 | 2346 | string *readNodeList(void) { |
arsenalist | 0:f4e449fa34d7 | 2347 | static string nd[10]; //max node |
arsenalist | 0:f4e449fa34d7 | 2348 | DIR *d; |
arsenalist | 0:f4e449fa34d7 | 2349 | struct dirent *p; |
arsenalist | 0:f4e449fa34d7 | 2350 | string q; |
arsenalist | 0:f4e449fa34d7 | 2351 | int i=0; |
arsenalist | 0:f4e449fa34d7 | 2352 | |
arsenalist | 0:f4e449fa34d7 | 2353 | d = opendir("/sd/nodeList"); |
arsenalist | 0:f4e449fa34d7 | 2354 | if(d != NULL) { |
arsenalist | 0:f4e449fa34d7 | 2355 | while((p = readdir(d)) != NULL) { |
arsenalist | 0:f4e449fa34d7 | 2356 | q = p->d_name; |
arsenalist | 0:f4e449fa34d7 | 2357 | nd[i] = q; |
arsenalist | 0:f4e449fa34d7 | 2358 | i++; |
arsenalist | 0:f4e449fa34d7 | 2359 | } |
arsenalist | 0:f4e449fa34d7 | 2360 | } |
arsenalist | 0:f4e449fa34d7 | 2361 | closedir(d); |
arsenalist | 30:08d290158fa7 | 2362 | free(d); |
arsenalist | 0:f4e449fa34d7 | 2363 | return nd; |
arsenalist | 0:f4e449fa34d7 | 2364 | } |
arsenalist | 0:f4e449fa34d7 | 2365 | |
arsenalist | 0:f4e449fa34d7 | 2366 | string wifiGetNodeTemp(string macAddr) { |
arsenalist | 0:f4e449fa34d7 | 2367 | int trial=0; |
arsenalist | 0:f4e449fa34d7 | 2368 | string nodeIP = readNodeIP(macAddr); |
arsenalist | 0:f4e449fa34d7 | 2369 | string str; |
arsenalist | 0:f4e449fa34d7 | 2370 | string temp = "0"; |
arsenalist | 0:f4e449fa34d7 | 2371 | |
arsenalist | 0:f4e449fa34d7 | 2372 | if(rest.begin(nodeIP.c_str(),REMOTE_TCP_PORT,false)) { |
arsenalist | 0:f4e449fa34d7 | 2373 | while(1) { |
arsenalist | 0:f4e449fa34d7 | 2374 | char rcv[256] = {}; |
arsenalist | 0:f4e449fa34d7 | 2375 | rest.get("/","<?xml version=\"1.0\" encoding=\"utf-8\"?><app_cmd cmd=\"2\"/>\r\n"); |
arsenalist | 0:f4e449fa34d7 | 2376 | rest.getResponse(rcv,sizeof(rcv)); |
arsenalist | 0:f4e449fa34d7 | 2377 | str = rcv; |
arsenalist | 0:f4e449fa34d7 | 2378 | if(str.find("temp=") != std::string::npos) { |
arsenalist | 0:f4e449fa34d7 | 2379 | str.erase(str.begin(),str.begin()+str.find("temp=")+6); |
arsenalist | 0:f4e449fa34d7 | 2380 | str.erase(str.begin()+str.find("\""),str.end()); |
arsenalist | 0:f4e449fa34d7 | 2381 | temp = str; |
arsenalist | 0:f4e449fa34d7 | 2382 | break; |
arsenalist | 0:f4e449fa34d7 | 2383 | } |
arsenalist | 0:f4e449fa34d7 | 2384 | if(trial>1) { //three times trial |
arsenalist | 0:f4e449fa34d7 | 2385 | break; |
arsenalist | 0:f4e449fa34d7 | 2386 | } |
arsenalist | 0:f4e449fa34d7 | 2387 | trial++; |
arsenalist | 0:f4e449fa34d7 | 2388 | wait(2); |
arsenalist | 0:f4e449fa34d7 | 2389 | } |
arsenalist | 0:f4e449fa34d7 | 2390 | } |
arsenalist | 0:f4e449fa34d7 | 2391 | return temp; |
arsenalist | 0:f4e449fa34d7 | 2392 | } |
arsenalist | 0:f4e449fa34d7 | 2393 | /*end emma node*/ |
arsenalist | 0:f4e449fa34d7 | 2394 | |
arsenalist | 0:f4e449fa34d7 | 2395 | /*start emma connection function*/ |
arsenalist | 0:f4e449fa34d7 | 2396 | string ethGET(string host, int port, string url) { |
arsenalist | 0:f4e449fa34d7 | 2397 | char buf[1024]; |
arsenalist | 0:f4e449fa34d7 | 2398 | char s[256]; |
arsenalist | 0:f4e449fa34d7 | 2399 | int ret; |
arsenalist | 0:f4e449fa34d7 | 2400 | TCPSocketConnection sock; |
arsenalist | 0:f4e449fa34d7 | 2401 | Timer t; |
arsenalist | 0:f4e449fa34d7 | 2402 | |
arsenalist | 0:f4e449fa34d7 | 2403 | sprintf(s,"%s",url.c_str()); |
arsenalist | 0:f4e449fa34d7 | 2404 | sock.connect(host.c_str(),port); |
arsenalist | 0:f4e449fa34d7 | 2405 | sock.send_all(s,sizeof(s)-1); |
arsenalist | 0:f4e449fa34d7 | 2406 | wait(2); |
arsenalist | 0:f4e449fa34d7 | 2407 | |
arsenalist | 0:f4e449fa34d7 | 2408 | //receive return |
arsenalist | 0:f4e449fa34d7 | 2409 | t.start(); |
arsenalist | 0:f4e449fa34d7 | 2410 | while(1) { |
arsenalist | 0:f4e449fa34d7 | 2411 | ret = sock.receive(buf, sizeof(buf)); |
arsenalist | 0:f4e449fa34d7 | 2412 | if(ret<=0 || t.read_ms() > 10000) { |
arsenalist | 0:f4e449fa34d7 | 2413 | t.stop(); |
arsenalist | 0:f4e449fa34d7 | 2414 | break; |
arsenalist | 0:f4e449fa34d7 | 2415 | } |
arsenalist | 0:f4e449fa34d7 | 2416 | } |
arsenalist | 0:f4e449fa34d7 | 2417 | sock.close(); |
arsenalist | 0:f4e449fa34d7 | 2418 | return buf; |
arsenalist | 0:f4e449fa34d7 | 2419 | } |
arsenalist | 0:f4e449fa34d7 | 2420 | /*end emma connection function*/ |
arsenalist | 0:f4e449fa34d7 | 2421 | |
arsenalist | 0:f4e449fa34d7 | 2422 | /*start emma private function*/ |
arsenalist | 8:51a0ca9079ca | 2423 | void isEthAvailable(void) { |
arsenalist | 8:51a0ca9079ca | 2424 | if(ipstack.getEth().linkstatus()) { |
arsenalist | 8:51a0ca9079ca | 2425 | ethAvailable = true; |
arsenalist | 8:51a0ca9079ca | 2426 | } else { |
arsenalist | 8:51a0ca9079ca | 2427 | ethAvailable = false; |
arsenalist | 8:51a0ca9079ca | 2428 | } |
arsenalist | 8:51a0ca9079ca | 2429 | } |
arsenalist | 8:51a0ca9079ca | 2430 | |
arsenalist | 8:51a0ca9079ca | 2431 | void isEthConnected(void) { |
arsenalist | 8:51a0ca9079ca | 2432 | char s[512]; |
arsenalist | 8:51a0ca9079ca | 2433 | int connPort; |
arsenalist | 8:51a0ca9079ca | 2434 | string connHost; |
arsenalist | 8:51a0ca9079ca | 2435 | string str; |
arsenalist | 8:51a0ca9079ca | 2436 | Timer t; |
arsenalist | 8:51a0ca9079ca | 2437 | |
arsenalist | 8:51a0ca9079ca | 2438 | if(ethAvailable) { |
arsenalist | 8:51a0ca9079ca | 2439 | if(useProxy) { |
arsenalist | 8:51a0ca9079ca | 2440 | connHost = proxySERVER; |
arsenalist | 8:51a0ca9079ca | 2441 | sscanf(proxyPORT.c_str(),"%d",&connPort); |
arsenalist | 8:51a0ca9079ca | 2442 | for(int i=0; i<sizeof(s); i++) { |
arsenalist | 8:51a0ca9079ca | 2443 | s[i]=0; } |
arsenalist | 38:e44f35f8129d | 2444 | sprintf(s,"GET http://%s:%s/emma/api/controller/test HTTP/1.0\nHost: %s\r\n\r\n",restSERVER.c_str(),restPORT.c_str(),restSERVER.c_str()); |
arsenalist | 8:51a0ca9079ca | 2445 | } else { |
arsenalist | 38:e44f35f8129d | 2446 | connHost = restSERVER; |
arsenalist | 38:e44f35f8129d | 2447 | //connPort = restPORT; |
arsenalist | 38:e44f35f8129d | 2448 | sscanf(restPORT.c_str(),"%d",&connPort); |
arsenalist | 8:51a0ca9079ca | 2449 | for(int i=0; i<sizeof(s); i++) { |
arsenalist | 8:51a0ca9079ca | 2450 | s[i]=0; } |
arsenalist | 8:51a0ca9079ca | 2451 | strcpy(s,"GET /emma/api/controller/test HTTP/1.0\nHost: %s\r\n\r\n"); |
arsenalist | 8:51a0ca9079ca | 2452 | } |
arsenalist | 8:51a0ca9079ca | 2453 | |
arsenalist | 8:51a0ca9079ca | 2454 | t.start(); |
arsenalist | 8:51a0ca9079ca | 2455 | while(1) { |
arsenalist | 8:51a0ca9079ca | 2456 | str = ethGET(connHost,connPort,s); |
arsenalist | 8:51a0ca9079ca | 2457 | if(str.find("OK") != std::string::npos) { |
arsenalist | 8:51a0ca9079ca | 2458 | t.stop(); |
arsenalist | 8:51a0ca9079ca | 2459 | ethConnected = true; |
arsenalist | 8:51a0ca9079ca | 2460 | break; |
arsenalist | 8:51a0ca9079ca | 2461 | } |
arsenalist | 8:51a0ca9079ca | 2462 | if(t.read_ms() > 5000) { |
arsenalist | 8:51a0ca9079ca | 2463 | t.stop(); |
arsenalist | 8:51a0ca9079ca | 2464 | ethConnected = false; |
arsenalist | 8:51a0ca9079ca | 2465 | break; |
arsenalist | 8:51a0ca9079ca | 2466 | } |
arsenalist | 8:51a0ca9079ca | 2467 | } |
arsenalist | 8:51a0ca9079ca | 2468 | } else { |
arsenalist | 8:51a0ca9079ca | 2469 | ethConnected = false; |
arsenalist | 8:51a0ca9079ca | 2470 | } |
arsenalist | 8:51a0ca9079ca | 2471 | } |
arsenalist | 8:51a0ca9079ca | 2472 | |
arsenalist | 8:51a0ca9079ca | 2473 | void isWiFiConnected(void) { //WARNING: should be run in emmaModeRegister and emmaModeOperation only - limitation with esp, after MODE=B, cannot go to MODE=S |
arsenalist | 8:51a0ca9079ca | 2474 | char s[512]; |
arsenalist | 8:51a0ca9079ca | 2475 | int connPort; |
arsenalist | 8:51a0ca9079ca | 2476 | string connHost; |
arsenalist | 8:51a0ca9079ca | 2477 | string str; |
arsenalist | 8:51a0ca9079ca | 2478 | Timer t; |
arsenalist | 8:51a0ca9079ca | 2479 | |
arsenalist | 29:4d94a03d38e0 | 2480 | /* |
arsenalist | 27:562a95c120cc | 2481 | esp.enable(); |
arsenalist | 27:562a95c120cc | 2482 | wait(1); |
arsenalist | 27:562a95c120cc | 2483 | esp.reset(); |
arsenalist | 27:562a95c120cc | 2484 | wait(1); |
arsenalist | 27:562a95c120cc | 2485 | while(!esp.ready()); |
arsenalist | 27:562a95c120cc | 2486 | |
arsenalist | 27:562a95c120cc | 2487 | //rest begin |
arsenalist | 38:e44f35f8129d | 2488 | if(!rest.begin(restSERVER,restPORT,false)) { |
arsenalist | 27:562a95c120cc | 2489 | DBG.printf("EMMA: fail to setup rest\r\n"); |
arsenalist | 27:562a95c120cc | 2490 | TFT.locate(0,20); |
arsenalist | 27:562a95c120cc | 2491 | TFT.printf("EMMA: fail to setup rest"); |
arsenalist | 27:562a95c120cc | 2492 | while(1); |
arsenalist | 27:562a95c120cc | 2493 | } |
arsenalist | 27:562a95c120cc | 2494 | |
arsenalist | 27:562a95c120cc | 2495 | //setup wifi |
arsenalist | 27:562a95c120cc | 2496 | DBG.printf("EMMA: setup wifi\r\n"); |
arsenalist | 27:562a95c120cc | 2497 | TFT.locate(0,20); |
arsenalist | 27:562a95c120cc | 2498 | TFT.printf("EMMA: setup wifi"); |
arsenalist | 27:562a95c120cc | 2499 | wait(1); |
arsenalist | 27:562a95c120cc | 2500 | esp.wifiCb.attach(&wifiCb); |
arsenalist | 28:7561035e3df5 | 2501 | //esp.wifiConnect("Tritronik Mobile","Tri12@11"); |
arsenalist | 28:7561035e3df5 | 2502 | esp.wifiConnect(wifiSSID.c_str(),wifiPASS.c_str()); |
arsenalist | 27:562a95c120cc | 2503 | DBG.printf("EMMA: system started\r\n"); |
arsenalist | 27:562a95c120cc | 2504 | TFT.locate(0,20); |
arsenalist | 27:562a95c120cc | 2505 | TFT.printf("EMMA: system started"); |
arsenalist | 27:562a95c120cc | 2506 | t.start(); |
arsenalist | 28:7561035e3df5 | 2507 | while(t.read() < 20); |
arsenalist | 27:562a95c120cc | 2508 | t.stop(); |
arsenalist | 27:562a95c120cc | 2509 | t.reset(); |
arsenalist | 28:7561035e3df5 | 2510 | TFT.locate(0,20); |
arsenalist | 28:7561035e3df5 | 2511 | TFT.printf(" "); |
arsenalist | 29:4d94a03d38e0 | 2512 | */ |
arsenalist | 27:562a95c120cc | 2513 | |
arsenalist | 8:51a0ca9079ca | 2514 | if(wifiAvailable) { |
arsenalist | 8:51a0ca9079ca | 2515 | _ESP.printf("MODE=B"); |
arsenalist | 8:51a0ca9079ca | 2516 | if(useProxy) { |
arsenalist | 8:51a0ca9079ca | 2517 | connHost = proxySERVER; |
arsenalist | 8:51a0ca9079ca | 2518 | sscanf(proxyPORT.c_str(),"%d",&connPort); |
arsenalist | 8:51a0ca9079ca | 2519 | for(int i=0; i<sizeof(s); i++) { |
arsenalist | 8:51a0ca9079ca | 2520 | s[i]=0; } |
arsenalist | 38:e44f35f8129d | 2521 | sprintf(s,"http://%s:%s/emma/api/controller/test HTTP/1.0\nHost: %s\r\n\r\n",restSERVER.c_str(),restPORT.c_str(),restSERVER.c_str()); |
arsenalist | 8:51a0ca9079ca | 2522 | } else { |
arsenalist | 38:e44f35f8129d | 2523 | connHost = restSERVER; |
arsenalist | 38:e44f35f8129d | 2524 | //connPort = restPORT; |
arsenalist | 38:e44f35f8129d | 2525 | sscanf(restPORT.c_str(),"%d",&connPort); |
arsenalist | 8:51a0ca9079ca | 2526 | for(int i=0; i<sizeof(s); i++) { |
arsenalist | 8:51a0ca9079ca | 2527 | s[i]=0; } |
arsenalist | 8:51a0ca9079ca | 2528 | sprintf(s,"/emma/api/controller/test"); |
arsenalist | 8:51a0ca9079ca | 2529 | } |
arsenalist | 27:562a95c120cc | 2530 | wait(2); |
arsenalist | 8:51a0ca9079ca | 2531 | t.start(); |
arsenalist | 28:7561035e3df5 | 2532 | while(!esp.ready() && t.read() < 20); |
arsenalist | 8:51a0ca9079ca | 2533 | t.stop(); |
arsenalist | 27:562a95c120cc | 2534 | t.reset(); |
arsenalist | 8:51a0ca9079ca | 2535 | if(rest.begin(connHost.c_str(),connPort,false)) { |
arsenalist | 27:562a95c120cc | 2536 | DBG.printf("rest begin\r\n"); |
arsenalist | 8:51a0ca9079ca | 2537 | esp.process(); |
arsenalist | 8:51a0ca9079ca | 2538 | rest.get(s); |
arsenalist | 8:51a0ca9079ca | 2539 | for(int i=0; i<sizeof(s); i++) { |
arsenalist | 8:51a0ca9079ca | 2540 | s[i]=0; } |
arsenalist | 8:51a0ca9079ca | 2541 | rest.getResponse(s,sizeof(s)); |
arsenalist | 8:51a0ca9079ca | 2542 | str = s; |
arsenalist | 27:562a95c120cc | 2543 | DBG.printf("response:%s\r\n",s); |
arsenalist | 8:51a0ca9079ca | 2544 | if(str.find("OK") != std::string::npos) { |
arsenalist | 8:51a0ca9079ca | 2545 | wifiConnected = true; |
arsenalist | 8:51a0ca9079ca | 2546 | } |
arsenalist | 8:51a0ca9079ca | 2547 | } else { |
arsenalist | 8:51a0ca9079ca | 2548 | wifiConnected = false; |
arsenalist | 8:51a0ca9079ca | 2549 | } |
arsenalist | 8:51a0ca9079ca | 2550 | } else { |
arsenalist | 8:51a0ca9079ca | 2551 | wifiConnected = false; |
arsenalist | 8:51a0ca9079ca | 2552 | } |
arsenalist | 8:51a0ca9079ca | 2553 | } |
arsenalist | 8:51a0ca9079ca | 2554 | |
arsenalist | 8:51a0ca9079ca | 2555 | void isGprsConnected(void) { |
arsenalist | 8:51a0ca9079ca | 2556 | |
arsenalist | 8:51a0ca9079ca | 2557 | } |
arsenalist | 0:f4e449fa34d7 | 2558 | |
arsenalist | 0:f4e449fa34d7 | 2559 | void addChar(char *s, char c) { |
arsenalist | 0:f4e449fa34d7 | 2560 | uint16_t k; //customized for EMS |
arsenalist | 0:f4e449fa34d7 | 2561 | k = strlen(s); |
arsenalist | 0:f4e449fa34d7 | 2562 | s[k] = c; |
arsenalist | 0:f4e449fa34d7 | 2563 | s[k + 1] = 0; |
arsenalist | 0:f4e449fa34d7 | 2564 | } |
arsenalist | 0:f4e449fa34d7 | 2565 | |
arsenalist | 0:f4e449fa34d7 | 2566 | void rcvReply(char *r, int to) { |
arsenalist | 0:f4e449fa34d7 | 2567 | Timer t; |
arsenalist | 0:f4e449fa34d7 | 2568 | bool ended = false; |
arsenalist | 0:f4e449fa34d7 | 2569 | char c; |
arsenalist | 0:f4e449fa34d7 | 2570 | |
arsenalist | 0:f4e449fa34d7 | 2571 | strcpy(r,""); |
arsenalist | 0:f4e449fa34d7 | 2572 | t.start(); |
arsenalist | 0:f4e449fa34d7 | 2573 | while(!ended) { |
arsenalist | 0:f4e449fa34d7 | 2574 | if(_ESP.readable()) { |
arsenalist | 0:f4e449fa34d7 | 2575 | c = _ESP.getc(); |
arsenalist | 0:f4e449fa34d7 | 2576 | addChar(r,c); |
arsenalist | 0:f4e449fa34d7 | 2577 | t.start(); |
arsenalist | 0:f4e449fa34d7 | 2578 | } |
arsenalist | 0:f4e449fa34d7 | 2579 | if(t.read_ms() > to) { |
arsenalist | 0:f4e449fa34d7 | 2580 | ended = true; |
arsenalist | 0:f4e449fa34d7 | 2581 | } |
arsenalist | 0:f4e449fa34d7 | 2582 | } |
arsenalist | 0:f4e449fa34d7 | 2583 | addChar(r, 0x00); |
arsenalist | 0:f4e449fa34d7 | 2584 | } |
arsenalist | 0:f4e449fa34d7 | 2585 | |
arsenalist | 0:f4e449fa34d7 | 2586 | string calculateMD5(string text) { |
arsenalist | 0:f4e449fa34d7 | 2587 | char s[64]; |
arsenalist | 0:f4e449fa34d7 | 2588 | memset(s,0,sizeof(s)); //for unknown reason, after reading UID, the 's' will contaion UID data |
arsenalist | 0:f4e449fa34d7 | 2589 | uint8_t hash[16]; |
arsenalist | 0:f4e449fa34d7 | 2590 | MD5::computeHash(hash, (uint8_t*)text.c_str(), strlen(text.c_str())); |
arsenalist | 0:f4e449fa34d7 | 2591 | for(int i=0; i<16; ++i) { |
arsenalist | 0:f4e449fa34d7 | 2592 | sprintf(s,"%s%02x",s,hash[i]); |
arsenalist | 0:f4e449fa34d7 | 2593 | } |
arsenalist | 0:f4e449fa34d7 | 2594 | return s; |
arsenalist | 0:f4e449fa34d7 | 2595 | } |
arsenalist | 0:f4e449fa34d7 | 2596 | |
arsenalist | 0:f4e449fa34d7 | 2597 | bool writeFirmwareHexToChar(string value) { |
arsenalist | 0:f4e449fa34d7 | 2598 | FILE *fp; |
arsenalist | 0:f4e449fa34d7 | 2599 | char s[32]; |
arsenalist | 0:f4e449fa34d7 | 2600 | int number; |
arsenalist | 0:f4e449fa34d7 | 2601 | string chunk; |
arsenalist | 0:f4e449fa34d7 | 2602 | |
arsenalist | 0:f4e449fa34d7 | 2603 | sprintf(s,"/sd/newFirmware/firmware.bin"); |
arsenalist | 0:f4e449fa34d7 | 2604 | fp = fopen(s,"a"); |
arsenalist | 0:f4e449fa34d7 | 2605 | if(fp != NULL) { |
arsenalist | 0:f4e449fa34d7 | 2606 | for(int ch=0; ch<value.size(); ch+=2) { |
arsenalist | 0:f4e449fa34d7 | 2607 | chunk = value.substr(ch,2); |
arsenalist | 0:f4e449fa34d7 | 2608 | sscanf(chunk.c_str(),"%x",&number); |
arsenalist | 0:f4e449fa34d7 | 2609 | fprintf(fp,"%c",number); |
arsenalist | 0:f4e449fa34d7 | 2610 | } |
arsenalist | 0:f4e449fa34d7 | 2611 | fclose(fp); |
arsenalist | 30:08d290158fa7 | 2612 | free(fp); |
arsenalist | 0:f4e449fa34d7 | 2613 | return true; |
arsenalist | 0:f4e449fa34d7 | 2614 | } |
arsenalist | 30:08d290158fa7 | 2615 | fclose(fp); |
arsenalist | 30:08d290158fa7 | 2616 | free(fp); |
arsenalist | 0:f4e449fa34d7 | 2617 | return false; |
arsenalist | 0:f4e449fa34d7 | 2618 | } |
arsenalist | 0:f4e449fa34d7 | 2619 | |
arsenalist | 0:f4e449fa34d7 | 2620 | bool clearFirmware(void) { |
arsenalist | 0:f4e449fa34d7 | 2621 | FILE *fp; |
arsenalist | 0:f4e449fa34d7 | 2622 | char s[32]; |
arsenalist | 0:f4e449fa34d7 | 2623 | |
arsenalist | 0:f4e449fa34d7 | 2624 | sprintf(s,"/sd/newFirmware/firmware.bin"); |
arsenalist | 0:f4e449fa34d7 | 2625 | fp = fopen(s,"w"); |
arsenalist | 0:f4e449fa34d7 | 2626 | if(fp != NULL) { |
arsenalist | 0:f4e449fa34d7 | 2627 | fprintf(fp,""); |
arsenalist | 0:f4e449fa34d7 | 2628 | fclose(fp); |
arsenalist | 30:08d290158fa7 | 2629 | free(fp); |
arsenalist | 0:f4e449fa34d7 | 2630 | return true; |
arsenalist | 0:f4e449fa34d7 | 2631 | } |
arsenalist | 30:08d290158fa7 | 2632 | fclose(fp); |
arsenalist | 30:08d290158fa7 | 2633 | free(fp); |
arsenalist | 0:f4e449fa34d7 | 2634 | return false; |
arsenalist | 0:f4e449fa34d7 | 2635 | } |
arsenalist | 27:562a95c120cc | 2636 | |
arsenalist | 27:562a95c120cc | 2637 | bool writeLog(string logTime, string logData) { |
arsenalist | 27:562a95c120cc | 2638 | FILE *fp; |
arsenalist | 27:562a95c120cc | 2639 | char s[255]; |
arsenalist | 27:562a95c120cc | 2640 | string logAll; |
arsenalist | 27:562a95c120cc | 2641 | logAll = logTime + "\t" + logData + "\r\n"; |
arsenalist | 27:562a95c120cc | 2642 | |
arsenalist | 27:562a95c120cc | 2643 | sprintf(s,"/sd/log.txt"); |
arsenalist | 27:562a95c120cc | 2644 | fp = fopen(s,"a"); |
arsenalist | 27:562a95c120cc | 2645 | if(fp != NULL) { |
arsenalist | 27:562a95c120cc | 2646 | fprintf(fp,logAll.c_str()); |
arsenalist | 27:562a95c120cc | 2647 | fclose(fp); |
arsenalist | 30:08d290158fa7 | 2648 | free(fp); |
arsenalist | 27:562a95c120cc | 2649 | return true; |
arsenalist | 27:562a95c120cc | 2650 | } |
arsenalist | 30:08d290158fa7 | 2651 | fclose(fp); |
arsenalist | 30:08d290158fa7 | 2652 | free(fp); |
arsenalist | 30:08d290158fa7 | 2653 | return false; |
arsenalist | 30:08d290158fa7 | 2654 | } |
arsenalist | 30:08d290158fa7 | 2655 | |
arsenalist | 30:08d290158fa7 | 2656 | bool writeDbg(string dbgTime, string dbgData) { |
arsenalist | 30:08d290158fa7 | 2657 | FILE *fp; |
arsenalist | 30:08d290158fa7 | 2658 | char s[255]; |
arsenalist | 30:08d290158fa7 | 2659 | string dbgAll; |
arsenalist | 30:08d290158fa7 | 2660 | dbgAll = dbgTime + "\t" + dbgData + "\r\n"; |
arsenalist | 30:08d290158fa7 | 2661 | |
arsenalist | 30:08d290158fa7 | 2662 | sprintf(s,"/sd/dbg.txt"); |
arsenalist | 30:08d290158fa7 | 2663 | fp = fopen(s,"a"); |
arsenalist | 30:08d290158fa7 | 2664 | if(fp != NULL) { |
arsenalist | 30:08d290158fa7 | 2665 | fprintf(fp,dbgAll.c_str()); |
arsenalist | 30:08d290158fa7 | 2666 | fclose(fp); |
arsenalist | 30:08d290158fa7 | 2667 | free(fp); |
arsenalist | 30:08d290158fa7 | 2668 | return true; |
arsenalist | 30:08d290158fa7 | 2669 | } |
arsenalist | 30:08d290158fa7 | 2670 | fclose(fp); |
arsenalist | 30:08d290158fa7 | 2671 | free(fp); |
arsenalist | 27:562a95c120cc | 2672 | return false; |
arsenalist | 27:562a95c120cc | 2673 | } |
arsenalist | 0:f4e449fa34d7 | 2674 | /*end emma private function*/ |