able to subscribe for >10hrs and still running

Dependencies:   ADE7758_v1 Crypto DHT11 MQTT MbedJSONValue SDFileSystem SPI_TFT_ILI9341 SWSPI SetRTC TFT_fonts Touch W5500Interface mbed-rtos mbed-src tuanpm

Fork of PB_emma_controller_mbed_src by Emma

Committer:
arsenalist
Date:
Thu Jul 23 07:15:51 2015 +0000
Revision:
23:fb369e171b7d
Parent:
22:e18d361bf688
Child:
24:5d58515ba510
Add execution result code.

Who changed what in which revision?

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