Emma / PB_emma_controller_mbed_src

emma controller code in production board v1

Dependencies:   ADE7758_v1 Crypto DHT11 MQTT MbedJSONValueEmma SDFileSystem TFT_ILI9341 SWSPI SetRTC TFT_fonts Touch W5500Interface mbed-rtos mbed-src SoftSerial

Fork of emma_controller_energy by Emma

emmaCode.cpp@22:e18d361bf688, 2015-07-23 (annotated)

Committer:
arsenalist
Date:
Thu Jul 23 05:21:10 2015 +0000
Revision:
22:e18d361bf688
Parent:
21:33bd8b82560f
Child:
23:fb369e171b7d
Use hmacTime to send sensor data.; Tested on send panel environment data.

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 0:f4e449fa34d7 896 string str;
arsenalist 14:8287f0f5d987 897 time_t seconds;
arsenalist 0:f4e449fa34d7 898 Timer t;
arsenalist 4:76ab12e2f8a3 899 Timer tNodes;
arsenalist 21:33bd8b82560f 900 Timer tPanel;
arsenalist 0:f4e449fa34d7 901
arsenalist 19:7e3e9332f719 902 TFT.locate(0,0);
arsenalist 19:7e3e9332f719 903 TFT.printf(" please wait");
arsenalist 19:7e3e9332f719 904
arsenalist 0:f4e449fa34d7 905 //check connected interface
arsenalist 8:51a0ca9079ca 906 //connectedIface();
arsenalist 8:51a0ca9079ca 907 isEthConnected();
arsenalist 8:51a0ca9079ca 908 isWiFiConnected();
arsenalist 8:51a0ca9079ca 909 isGprsConnected();
arsenalist 0:f4e449fa34d7 910 DBG.printf("ethConnected:%d\r\n",ethConnected);
arsenalist 0:f4e449fa34d7 911 DBG.printf("wifiConnected:%d\r\n",wifiConnected);
arsenalist 0:f4e449fa34d7 912
arsenalist 13:e8adfe305dbc 913 TFT.locate(0,0);
arsenalist 13:e8adfe305dbc 914 TFT.printf(" emmaModeOperation");
arsenalist 13:e8adfe305dbc 915
arsenalist 13:e8adfe305dbc 916 TFT.locate(0,20);
arsenalist 13:e8adfe305dbc 917 if(ethConnected) {
arsenalist 13:e8adfe305dbc 918 TFT.printf("ETH:Avail");
arsenalist 13:e8adfe305dbc 919 } else {
arsenalist 13:e8adfe305dbc 920 TFT.printf("ETH:N/A");
arsenalist 13:e8adfe305dbc 921 }
arsenalist 13:e8adfe305dbc 922
arsenalist 13:e8adfe305dbc 923 TFT.locate(80,20);
arsenalist 13:e8adfe305dbc 924 if(wifiConnected) {
arsenalist 13:e8adfe305dbc 925 TFT.printf("WiFi:Avail");
arsenalist 13:e8adfe305dbc 926 } else {
arsenalist 13:e8adfe305dbc 927 TFT.printf("WiFi:N/A");
arsenalist 13:e8adfe305dbc 928 }
arsenalist 13:e8adfe305dbc 929
arsenalist 13:e8adfe305dbc 930 TFT.locate(160,20);
arsenalist 13:e8adfe305dbc 931 if(gprsConnected) {
arsenalist 13:e8adfe305dbc 932 TFT.printf("GPRS:Avail");
arsenalist 13:e8adfe305dbc 933 } else {
arsenalist 13:e8adfe305dbc 934 TFT.printf("GPRS:N/A");
arsenalist 13:e8adfe305dbc 935 }
arsenalist 13:e8adfe305dbc 936
arsenalist 0:f4e449fa34d7 937 //calculate hmac
arsenalist 4:76ab12e2f8a3 938 //for(int j=0; j<sizeof(s); j++) {
arsenalist 4:76ab12e2f8a3 939 // s[j]=0; }
arsenalist 4:76ab12e2f8a3 940 //sprintf(s,"emma-%s",emmaUID.c_str());
arsenalist 4:76ab12e2f8a3 941 //hmac = calculateMD5(s);
arsenalist 4:76ab12e2f8a3 942 //DBG.printf("hmac:%s\r\n",hmac.c_str());
arsenalist 0:f4e449fa34d7 943
arsenalist 10:1dc69e0ce7fd 944 if(ethConnected) {
arsenalist 10:1dc69e0ce7fd 945 DBG.printf("emmaModeOperation - eth\r\n");
arsenalist 10:1dc69e0ce7fd 946 //DBG.printf("IP Address:%s\r\n",ipstack.getEth().getIPAddress());
arsenalist 10:1dc69e0ce7fd 947 //DBG.printf("MAC Address:%s\r\n",ipstack.getEth().getMACAddress());
arsenalist 10:1dc69e0ce7fd 948 ethMQTTAttemptConnect(&client, &ipstack);
arsenalist 10:1dc69e0ce7fd 949 //t.start();
arsenalist 10:1dc69e0ce7fd 950 DBG.printf("start\r\n");
arsenalist 10:1dc69e0ce7fd 951 while(true) {
arsenalist 10:1dc69e0ce7fd 952 //if(!ipstack.getEth().linkstatus()) {
arsenalist 10:1dc69e0ce7fd 953 // NVIC_SystemReset();
arsenalist 10:1dc69e0ce7fd 954 //}
arsenalist 10:1dc69e0ce7fd 955 //if(t.read_ms() > 5000) {
arsenalist 10:1dc69e0ce7fd 956 // if(publish(&client,&ipstack) != 0)
arsenalist 10:1dc69e0ce7fd 957 // ethMQTTAttemptConnect(&client, &ipstack);
arsenalist 10:1dc69e0ce7fd 958 // t.reset();
arsenalist 10:1dc69e0ce7fd 959 //}
arsenalist 10:1dc69e0ce7fd 960
arsenalist 10:1dc69e0ce7fd 961 //check for new command
arsenalist 10:1dc69e0ce7fd 962 if(newCommand) {
arsenalist 10:1dc69e0ce7fd 963 DBG.printf("newCommand\r\n");
arsenalist 10:1dc69e0ce7fd 964 //DBG.printf("globalCommand: %s\r\n",globalCommand.c_str());
arsenalist 10:1dc69e0ce7fd 965 //string qw(globCmd);
arsenalist 10:1dc69e0ce7fd 966
arsenalist 10:1dc69e0ce7fd 967 //if(cmd.find("[") != std::string::npos && cmd.find("]") != std::string::npos) {
arsenalist 10:1dc69e0ce7fd 968 // cmd.erase(cmd.begin(),cmd.begin()+cmd.find("[")+1);
arsenalist 10:1dc69e0ce7fd 969 // cmd.erase(cmd.begin()+cmd.find("]"),cmd.end());
arsenalist 10:1dc69e0ce7fd 970 //globalCommand = cmd;
arsenalist 10:1dc69e0ce7fd 971 //newCommand = true;
arsenalist 10:1dc69e0ce7fd 972 //}
arsenalist 10:1dc69e0ce7fd 973 /*
arsenalist 10:1dc69e0ce7fd 974 MbedJSONValue jsonValue;
arsenalist 10:1dc69e0ce7fd 975 parse(jsonValue,globalCommand.c_str());
arsenalist 10:1dc69e0ce7fd 976 char *parameter[5] = {"id","nType","nAddr","dType","cmd"};
arsenalist 10:1dc69e0ce7fd 977
arsenalist 10:1dc69e0ce7fd 978 //check if command is valid
arsenalist 10:1dc69e0ce7fd 979 bool validCommand = true;
arsenalist 10:1dc69e0ce7fd 980 for(int i=0; i<5; i++) {
arsenalist 10:1dc69e0ce7fd 981 validCommand = validCommand && jsonValue.hasMember(parameter[i]);
arsenalist 10:1dc69e0ce7fd 982 }
arsenalist 10:1dc69e0ce7fd 983 DBG.printf("command validity:%d\r\n",validCommand);
arsenalist 10:1dc69e0ce7fd 984
arsenalist 10:1dc69e0ce7fd 985 if(validCommand) {
arsenalist 10:1dc69e0ce7fd 986 string commandId = jsonValue[parameter[0]].get<std::string>();
arsenalist 10:1dc69e0ce7fd 987 string commandNType = jsonValue[parameter[1]].get<std::string>();
arsenalist 10:1dc69e0ce7fd 988 string commandNAddr = jsonValue[parameter[2]].get<std::string>();
arsenalist 10:1dc69e0ce7fd 989 string commandDType = jsonValue[parameter[3]].get<std::string>();
arsenalist 10:1dc69e0ce7fd 990 string commandCmd = jsonValue[parameter[4]].get<std::string>();
arsenalist 10:1dc69e0ce7fd 991
arsenalist 10:1dc69e0ce7fd 992 if(commandNType == "0") { //switch on panel controller
arsenalist 10:1dc69e0ce7fd 993 DBG.printf("command for switch\r\n");
arsenalist 10:1dc69e0ce7fd 994 }
arsenalist 10:1dc69e0ce7fd 995 else if(commandNType == "1") { //node with mac address
arsenalist 10:1dc69e0ce7fd 996 DBG.printf("command for node\r\n");
arsenalist 10:1dc69e0ce7fd 997 //get node ip address based on node mac address
arsenalist 10:1dc69e0ce7fd 998 string nodeIP = readNodeIP(commandNAddr);
arsenalist 10:1dc69e0ce7fd 999 DBG.printf("nodeIP: %s\r\n",nodeIP.c_str());
arsenalist 10:1dc69e0ce7fd 1000
arsenalist 10:1dc69e0ce7fd 1001 //get cmd string based on device type and command number
arsenalist 10:1dc69e0ce7fd 1002 string nodeCmd = readNodeCmd(commandDType,commandCmd);
arsenalist 10:1dc69e0ce7fd 1003 DBG.printf("nodeCmd: %s\r\n",nodeCmd.c_str());
arsenalist 10:1dc69e0ce7fd 1004
arsenalist 10:1dc69e0ce7fd 1005 //execute command
arsenalist 21:33bd8b82560f 1006 //int trial=0;
arsenalist 21:33bd8b82560f 1007 trial = 0;
arsenalist 10:1dc69e0ce7fd 1008 string execStatus="failed";
arsenalist 10:1dc69e0ce7fd 1009
arsenalist 10:1dc69e0ce7fd 1010 while(1) {
arsenalist 10:1dc69e0ce7fd 1011 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 1012 str = s;
arsenalist 10:1dc69e0ce7fd 1013 string rcv = ethGET(nodeIP,REMOTE_TCP_PORT,str);
arsenalist 10:1dc69e0ce7fd 1014 DBG.printf("response:%s\r\n",rcv.c_str());
arsenalist 10:1dc69e0ce7fd 1015 str = rcv;
arsenalist 10:1dc69e0ce7fd 1016 if(str.find("OK") != std::string::npos) {
arsenalist 10:1dc69e0ce7fd 1017 DBG.printf("cmd executed\r\n");
arsenalist 10:1dc69e0ce7fd 1018 execStatus = "success";
arsenalist 10:1dc69e0ce7fd 1019 break;
arsenalist 10:1dc69e0ce7fd 1020 }
arsenalist 10:1dc69e0ce7fd 1021 if(trial>0) { //two times trial
arsenalist 10:1dc69e0ce7fd 1022 DBG.printf("cmd is not executed\r\n");
arsenalist 10:1dc69e0ce7fd 1023 break;
arsenalist 10:1dc69e0ce7fd 1024 }
arsenalist 10:1dc69e0ce7fd 1025 trial++;
arsenalist 10:1dc69e0ce7fd 1026 wait(3);
arsenalist 10:1dc69e0ce7fd 1027 }
arsenalist 10:1dc69e0ce7fd 1028
arsenalist 10:1dc69e0ce7fd 1029 //send execution status
arsenalist 10:1dc69e0ce7fd 1030 }
arsenalist 10:1dc69e0ce7fd 1031 }
arsenalist 10:1dc69e0ce7fd 1032 */
arsenalist 10:1dc69e0ce7fd 1033 newCommand = false;
arsenalist 10:1dc69e0ce7fd 1034 }
arsenalist 10:1dc69e0ce7fd 1035 client.yield(100); //allow MQTT client to receive message
arsenalist 10:1dc69e0ce7fd 1036 }
arsenalist 10:1dc69e0ce7fd 1037 } else if(wifiConnected) {
arsenalist 0:f4e449fa34d7 1038 DBG.printf("emmaModeOperation - wifi\r\n");
arsenalist 0:f4e449fa34d7 1039
arsenalist 0:f4e449fa34d7 1040 //do not delete code below - indicator that esp need to MODE=B and esp.ready() to work
arsenalist 0:f4e449fa34d7 1041 //_ESP.printf("MODE=B");
arsenalist 0:f4e449fa34d7 1042 //wait(1);
arsenalist 0:f4e449fa34d7 1043 //while(!esp.ready());
arsenalist 0:f4e449fa34d7 1044
arsenalist 0:f4e449fa34d7 1045 DBG.printf("emma: setup mqtt client\r\n");
arsenalist 0:f4e449fa34d7 1046 sprintf(mqttClientId,"emma/%s",emmaUID.c_str());
arsenalist 0:f4e449fa34d7 1047
arsenalist 0:f4e449fa34d7 1048 if(mqtt.begin(mqttClientId, platformKEY.c_str(), platformSECRET.c_str(), 120, 1)) {
arsenalist 0:f4e449fa34d7 1049 mqtt.connectedCb.attach(&mqttConnected);
arsenalist 0:f4e449fa34d7 1050 mqtt.disconnectedCb.attach(&mqttDisconnected);
arsenalist 0:f4e449fa34d7 1051 mqtt.connect(MQTT_HOST,MQTT_PORT,false);
arsenalist 13:e8adfe305dbc 1052 DBG.printf("emma: success to setup mqtt\r\n");
arsenalist 13:e8adfe305dbc 1053 TFT.locate(0,40);
arsenalist 13:e8adfe305dbc 1054 TFT.printf("emma: success to setup mqtt");
arsenalist 0:f4e449fa34d7 1055 }
arsenalist 0:f4e449fa34d7 1056 DBG.printf("emma: system started\r\n");
arsenalist 0:f4e449fa34d7 1057
arsenalist 4:76ab12e2f8a3 1058 t.start();
arsenalist 4:76ab12e2f8a3 1059 while(t.read_ms() < 5000) {
arsenalist 4:76ab12e2f8a3 1060 esp.process();
arsenalist 4:76ab12e2f8a3 1061 }
arsenalist 4:76ab12e2f8a3 1062 t.stop();
arsenalist 4:76ab12e2f8a3 1063 t.reset();
arsenalist 0:f4e449fa34d7 1064
arsenalist 0:f4e449fa34d7 1065 //set ade7758 parameter
arsenalist 0:f4e449fa34d7 1066 ADE.begin();
arsenalist 20:ea14f175bbb4 1067 //ADE.AVRMSCalib = 1526873.00;
arsenalist 20:ea14f175bbb4 1068 //ADE.BVRMSCalib = 534202.00;
arsenalist 20:ea14f175bbb4 1069 //ADE.CVRMSCalib = 456990.00;
arsenalist 20:ea14f175bbb4 1070 //ADE.AIRMSCalib = 39248.00;
arsenalist 20:ea14f175bbb4 1071 //ADE.BIRMSCalib = 654.00;
arsenalist 20:ea14f175bbb4 1072 //ADE.CIRMSCalib = 111.00;
arsenalist 0:f4e449fa34d7 1073
arsenalist 0:f4e449fa34d7 1074 ADE.writeRMSOffset(AIRMSOFFSET, BIRMSOFFSET, CIRMSOFFSET, AVRMSOFFSET, BVRMSOFFSET, CVRMSOFFSET);
arsenalist 0:f4e449fa34d7 1075
arsenalist 0:f4e449fa34d7 1076 ADE.write16bits(AWG, 0);
arsenalist 0:f4e449fa34d7 1077 ADE.write16bits(BWG, 0);
arsenalist 0:f4e449fa34d7 1078 ADE.write16bits(CWG, 0);
arsenalist 0:f4e449fa34d7 1079 ADE.write16bits(AVAG, 0);
arsenalist 0:f4e449fa34d7 1080 ADE.write16bits(BVAG, 0);
arsenalist 0:f4e449fa34d7 1081 ADE.write16bits(CVAG, 0);
arsenalist 0:f4e449fa34d7 1082
arsenalist 16:3c8d0142bf63 1083 //ADE.AWhLSB = 0.000001192;//0.00006025556;
arsenalist 20:ea14f175bbb4 1084 //ADE.AWhLSB = 0.00002109;
arsenalist 20:ea14f175bbb4 1085 //ADE.BWhLSB = 0.25075167;
arsenalist 20:ea14f175bbb4 1086 //ADE.CWhLSB = 0.25075167;
arsenalist 0:f4e449fa34d7 1087
arsenalist 20:ea14f175bbb4 1088 //ADE.AVAhLSB = 0.00008370;
arsenalist 20:ea14f175bbb4 1089 //ADE.BVAhLSB = 0;
arsenalist 20:ea14f175bbb4 1090 //ADE.CVAhLSB = 0;
arsenalist 0:f4e449fa34d7 1091
arsenalist 4:76ab12e2f8a3 1092 //init rest to server
arsenalist 7:7e8c6ad3fd64 1093 if(rest.begin(EMMA_SERVER_HOST,EMMA_SERVER_PORT,false)) {
arsenalist 4:76ab12e2f8a3 1094 DBG.printf("rest to server is created\r\n");
arsenalist 13:e8adfe305dbc 1095 TFT.locate(0,40);
arsenalist 13:e8adfe305dbc 1096 TFT.printf(" ");
arsenalist 13:e8adfe305dbc 1097 TFT.locate(0,40);
arsenalist 13:e8adfe305dbc 1098 TFT.printf("rest to server is created");
arsenalist 4:76ab12e2f8a3 1099 } else {
arsenalist 4:76ab12e2f8a3 1100 DBG.printf("rest to server is NOT created\r\n");
arsenalist 13:e8adfe305dbc 1101 TFT.locate(0,40);
arsenalist 13:e8adfe305dbc 1102 TFT.printf(" ");
arsenalist 13:e8adfe305dbc 1103 TFT.locate(0,40);
arsenalist 13:e8adfe305dbc 1104 TFT.printf("rest to server is NOT created");
arsenalist 4:76ab12e2f8a3 1105 }
arsenalist 4:76ab12e2f8a3 1106
arsenalist 7:7e8c6ad3fd64 1107 //check firmware update
arsenalist 7:7e8c6ad3fd64 1108
arsenalist 7:7e8c6ad3fd64 1109 //execute last state of switches on board
arsenalist 7:7e8c6ad3fd64 1110
arsenalist 7:7e8c6ad3fd64 1111 //get list of nodes from server
arsenalist 7:7e8c6ad3fd64 1112 sprintf(s,"/emma/api/controller/remotes?uid=%s&hmac=%s",emmaUID.c_str(),hmac.c_str());
arsenalist 7:7e8c6ad3fd64 1113 rest.get(s);
arsenalist 7:7e8c6ad3fd64 1114 for(int i=0; i<sizeof(s); i++) {
arsenalist 7:7e8c6ad3fd64 1115 s[i]=0; }
arsenalist 7:7e8c6ad3fd64 1116 rest.getResponse(s,sizeof(s));
arsenalist 7:7e8c6ad3fd64 1117 str = s;
arsenalist 7:7e8c6ad3fd64 1118 if(str.rfind("[{\"mac\"") != std::string::npos) {
arsenalist 7:7e8c6ad3fd64 1119 DBG.printf("get nodes from server\r\n");
arsenalist 7:7e8c6ad3fd64 1120 str.erase(str.begin(),str.begin()+str.rfind("[{\"mac\""));
arsenalist 7:7e8c6ad3fd64 1121 str.erase(str.begin()+str.rfind("}]")+2,str.end());
arsenalist 7:7e8c6ad3fd64 1122
arsenalist 7:7e8c6ad3fd64 1123 MbedJSONValue jsonValue;
arsenalist 7:7e8c6ad3fd64 1124 parse(jsonValue,str.c_str());
arsenalist 7:7e8c6ad3fd64 1125 char *parameter[2] = {"mac","ip"};
arsenalist 7:7e8c6ad3fd64 1126
arsenalist 13:e8adfe305dbc 1127 TFT.locate(0,40);
arsenalist 13:e8adfe305dbc 1128 TFT.printf(" ");
arsenalist 13:e8adfe305dbc 1129 TFT.locate(0,40);
arsenalist 13:e8adfe305dbc 1130 TFT.printf("get %d nodes from server",jsonValue.size());
arsenalist 13:e8adfe305dbc 1131 wait(0.5);
arsenalist 13:e8adfe305dbc 1132 TFT.locate(0,40);
arsenalist 13:e8adfe305dbc 1133 TFT.printf(" ");
arsenalist 13:e8adfe305dbc 1134
arsenalist 7:7e8c6ad3fd64 1135 //check whether nodes valid
arsenalist 7:7e8c6ad3fd64 1136 bool validNodes = true;
arsenalist 7:7e8c6ad3fd64 1137 for(int i=0; i<jsonValue.size(); i++) {
arsenalist 7:7e8c6ad3fd64 1138 for(int j=0; j<2; j++) {
arsenalist 7:7e8c6ad3fd64 1139 validNodes = validNodes && jsonValue[i].hasMember(parameter[j]);
arsenalist 7:7e8c6ad3fd64 1140 }
arsenalist 7:7e8c6ad3fd64 1141 }
arsenalist 7:7e8c6ad3fd64 1142 DBG.printf("nodes validity:%d\r\n",validNodes);
arsenalist 7:7e8c6ad3fd64 1143
arsenalist 7:7e8c6ad3fd64 1144 if(validNodes) {
arsenalist 7:7e8c6ad3fd64 1145 for(int i=0; i<jsonValue.size(); i++) {
arsenalist 7:7e8c6ad3fd64 1146 string macValue = jsonValue[i][parameter[0]].get<std::string>();
arsenalist 7:7e8c6ad3fd64 1147 string ipValue = jsonValue[i][parameter[1]].get<std::string>();
arsenalist 7:7e8c6ad3fd64 1148 nodes[i].macAddr = macValue;
arsenalist 7:7e8c6ad3fd64 1149 nodes[i].ipAddr = ipValue;
arsenalist 13:e8adfe305dbc 1150 DBG.printf("nodes[%d]mac:%s\r\n",i,nodes[i].macAddr.c_str());
arsenalist 13:e8adfe305dbc 1151 DBG.printf("nodes[%d]ip:%s\r\n",i,nodes[i].ipAddr.c_str());
arsenalist 7:7e8c6ad3fd64 1152 }
arsenalist 7:7e8c6ad3fd64 1153 }
arsenalist 7:7e8c6ad3fd64 1154
arsenalist 7:7e8c6ad3fd64 1155 } else {
arsenalist 7:7e8c6ad3fd64 1156 DBG.printf("no nodes from server\r\n");
arsenalist 7:7e8c6ad3fd64 1157 }
arsenalist 7:7e8c6ad3fd64 1158
arsenalist 7:7e8c6ad3fd64 1159
arsenalist 4:76ab12e2f8a3 1160 //preset nodes' macAddr and ipAddr
arsenalist 7:7e8c6ad3fd64 1161 //nodes[0].macAddr = "002629034222";
arsenalist 7:7e8c6ad3fd64 1162 //nodes[0].ipAddr = "192.168.2.15";
arsenalist 7:7e8c6ad3fd64 1163 //nodes[1].macAddr = "00262903424e";
arsenalist 7:7e8c6ad3fd64 1164 //nodes[1].ipAddr = "192.168.2.32";
arsenalist 4:76ab12e2f8a3 1165
arsenalist 4:76ab12e2f8a3 1166 //init rest to remotes
arsenalist 4:76ab12e2f8a3 1167 for(int i=0; i<NODES_MAX; i++) {
arsenalist 4:76ab12e2f8a3 1168 if(!nodes[i].ipAddr.empty()) {
arsenalist 4:76ab12e2f8a3 1169 DBG.printf("restConn nodes[%d] is created\r\n",i);
arsenalist 4:76ab12e2f8a3 1170 nodes[i].restConn->begin(nodes[i].ipAddr.c_str(),16038,false);
arsenalist 4:76ab12e2f8a3 1171 wait(1);
arsenalist 4:76ab12e2f8a3 1172 } else {
arsenalist 4:76ab12e2f8a3 1173 DBG.printf("restConn nodes[%d] is NOT created\r\n",i);
arsenalist 4:76ab12e2f8a3 1174 wait(1);
arsenalist 4:76ab12e2f8a3 1175 }
arsenalist 4:76ab12e2f8a3 1176 }
arsenalist 4:76ab12e2f8a3 1177
arsenalist 4:76ab12e2f8a3 1178 _ESP.attach(&rxInterrupt,Serial::RxIrq);
arsenalist 4:76ab12e2f8a3 1179
arsenalist 4:76ab12e2f8a3 1180 //define thread
arsenalist 17:b3ced0e67916 1181 osThreadDef(energyThread, osPriorityBelowNormal, (8*DEFAULT_STACK_SIZE));
arsenalist 0:f4e449fa34d7 1182 //create thread
arsenalist 2:fdfdeb5fd6fd 1183 osThreadCreate(osThread(energyThread),NULL);
arsenalist 0:f4e449fa34d7 1184
arsenalist 0:f4e449fa34d7 1185 t.start();
arsenalist 4:76ab12e2f8a3 1186 tNodes.start();
arsenalist 21:33bd8b82560f 1187 tPanel.start();
arsenalist 4:76ab12e2f8a3 1188 wait(1);
arsenalist 0:f4e449fa34d7 1189 while(1) {
arsenalist 4:76ab12e2f8a3 1190 checkRxBuffer();
arsenalist 20:ea14f175bbb4 1191 checkVoltagePower();
arsenalist 20:ea14f175bbb4 1192
arsenalist 4:76ab12e2f8a3 1193 //panelEnergy, panelVoltage, and panelPower
arsenalist 20:ea14f175bbb4 1194 if(t.read() > 30.0f) {
arsenalist 4:76ab12e2f8a3 1195 DBG.printf("[%d]WattHR for each phase: %.2f, %.2f, %.2f\r\n", loop, AWattHr, BWattHr, CWattHr);
arsenalist 13:e8adfe305dbc 1196 TFT.locate(0,60);
arsenalist 13:e8adfe305dbc 1197 TFT.printf(" ");
arsenalist 13:e8adfe305dbc 1198 TFT.locate(0,60);
arsenalist 13:e8adfe305dbc 1199 TFT.printf("[%d]WHR: %.1f, %.1f, %.1f", loop, AWattHr, BWattHr, CWattHr);
arsenalist 13:e8adfe305dbc 1200
arsenalist 4:76ab12e2f8a3 1201 DBG.printf("VRMS for each phase: %.2f, %.2f, %.2f\r\n", AVrms, BVrms, CVrms);
arsenalist 13:e8adfe305dbc 1202 TFT.locate(0,80);
arsenalist 13:e8adfe305dbc 1203 TFT.printf(" ");
arsenalist 13:e8adfe305dbc 1204 TFT.locate(0,80);
arsenalist 13:e8adfe305dbc 1205 TFT.printf("VRMS: %.1f, %.1f, %.1f", AVrms, BVrms, CVrms);
arsenalist 13:e8adfe305dbc 1206
arsenalist 4:76ab12e2f8a3 1207 DBG.printf("Watt for each phase: %.2f, %.2f, %.2f\r\n", AWatt, BWatt, CWatt);
arsenalist 13:e8adfe305dbc 1208 TFT.locate(0,100);
arsenalist 13:e8adfe305dbc 1209 TFT.printf(" ");
arsenalist 13:e8adfe305dbc 1210 TFT.locate(0,100);
arsenalist 13:e8adfe305dbc 1211 TFT.printf("Watt: %.1f, %.1f, %.1f", AWatt, BWatt, CWatt);
arsenalist 4:76ab12e2f8a3 1212
arsenalist 22:e18d361bf688 1213 if(newEnergyData) {
arsenalist 22:e18d361bf688 1214 //for(int i=1; i<4; i++) {
arsenalist 22:e18d361bf688 1215 for(int i=1; i<2; i++) {
arsenalist 22:e18d361bf688 1216 DBG.printf("sending channel: %d\r\n",i);
arsenalist 22:e18d361bf688 1217 if(i==1){
arsenalist 22:e18d361bf688 1218 XWattHr = AWattHr;
arsenalist 22:e18d361bf688 1219 XVrms = AVrms;
arsenalist 22:e18d361bf688 1220 XWatt = AWatt;
arsenalist 22:e18d361bf688 1221 } else if(i==2) {
arsenalist 22:e18d361bf688 1222 XWattHr = BWattHr;
arsenalist 22:e18d361bf688 1223 XVrms = BVrms;
arsenalist 22:e18d361bf688 1224 XWatt = BWatt;
arsenalist 22:e18d361bf688 1225 } else {
arsenalist 22:e18d361bf688 1226 XWattHr = CWattHr;
arsenalist 22:e18d361bf688 1227 XVrms = CVrms;
arsenalist 22:e18d361bf688 1228 XWatt = CWatt;
arsenalist 22:e18d361bf688 1229 }
arsenalist 22:e18d361bf688 1230 sprintf(r,"/emma/api/controller/energy/%d",i);
arsenalist 22:e18d361bf688 1231 seconds = time(NULL);
arsenalist 22:e18d361bf688 1232 //for(int j=0; j<sizeof(q); j++) {
arsenalist 22:e18d361bf688 1233 // q[j]=0; }
arsenalist 22:e18d361bf688 1234 strftime(q, 32, "%Y-%m-%d %H:%M:%S",localtime(&seconds));
arsenalist 22:e18d361bf688 1235
arsenalist 22:e18d361bf688 1236 //calculate hmacTime
arsenalist 22:e18d361bf688 1237 for(int j=0; j<sizeof(p); j++) {
arsenalist 22:e18d361bf688 1238 p[j]=0; }
arsenalist 22:e18d361bf688 1239 sprintf(p,"emma-%s-%s",emmaUID.c_str(),q);
arsenalist 22:e18d361bf688 1240 hmacTime = calculateMD5(p);
arsenalist 22:e18d361bf688 1241
arsenalist 22:e18d361bf688 1242 sprintf(s,"{\"uid\":\"%s\",\"hmac\":\"%s\",\"time\":\"%s\",\"energy\":%.2f,\"voltage\":%.2f,\"power\":%.2f}",
arsenalist 22:e18d361bf688 1243 emmaUID.c_str(),hmacTime.c_str(),q,XWattHr,XVrms,XWatt);
arsenalist 22:e18d361bf688 1244 //DBG.printf("dataEnergy:\r\n%s\r\n",s);
arsenalist 22:e18d361bf688 1245 rest.post(r,s);
arsenalist 22:e18d361bf688 1246 wait(2);
arsenalist 22:e18d361bf688 1247 if(rxBuf.find("\"status\":\"success\"") != std::string::npos) {
arsenalist 22:e18d361bf688 1248 DBG.printf("send channel: %d success\r\n",i);
arsenalist 22:e18d361bf688 1249 TFT.foreground(Green);
arsenalist 22:e18d361bf688 1250 TFT.locate(0,120);
arsenalist 22:e18d361bf688 1251 TFT.printf(" ");
arsenalist 22:e18d361bf688 1252 TFT.locate(0,120);
arsenalist 22:e18d361bf688 1253 TFT.printf("send ch%d success",i);
arsenalist 22:e18d361bf688 1254 wait(1);
arsenalist 22:e18d361bf688 1255 TFT.locate(0,120);
arsenalist 22:e18d361bf688 1256 TFT.printf(" ");
arsenalist 22:e18d361bf688 1257 TFT.foreground(White);
arsenalist 22:e18d361bf688 1258 } else {
arsenalist 22:e18d361bf688 1259 DBG.printf("send channel: %d failed\r\n",i);
arsenalist 22:e18d361bf688 1260 TFT.foreground(Red);
arsenalist 22:e18d361bf688 1261 TFT.locate(0,120);
arsenalist 22:e18d361bf688 1262 TFT.printf(" ");
arsenalist 22:e18d361bf688 1263 TFT.locate(0,120);
arsenalist 22:e18d361bf688 1264 TFT.printf("send ch%d failed",i);
arsenalist 22:e18d361bf688 1265 wait(1);
arsenalist 22:e18d361bf688 1266 TFT.locate(0,120);
arsenalist 22:e18d361bf688 1267 TFT.printf(" ");
arsenalist 22:e18d361bf688 1268 TFT.foreground(White);
arsenalist 22:e18d361bf688 1269 }
arsenalist 4:76ab12e2f8a3 1270 }
arsenalist 22:e18d361bf688 1271
arsenalist 22:e18d361bf688 1272 newEnergyData = false;
arsenalist 0:f4e449fa34d7 1273 }
arsenalist 22:e18d361bf688 1274
arsenalist 4:76ab12e2f8a3 1275 t.reset();
arsenalist 4:76ab12e2f8a3 1276 loop++;
arsenalist 0:f4e449fa34d7 1277 }
arsenalist 0:f4e449fa34d7 1278
arsenalist 21:33bd8b82560f 1279 //panel environment
arsenalist 5:d00233dd36f5 1280 checkRxBuffer();
arsenalist 21:33bd8b82560f 1281 if(tPanel.read() > 60.0f) {
arsenalist 21:33bd8b82560f 1282 int dTemp=0;
arsenalist 21:33bd8b82560f 1283 int dHum=0;
arsenalist 21:33bd8b82560f 1284 int dGas=0;
arsenalist 21:33bd8b82560f 1285
arsenalist 21:33bd8b82560f 1286 DBG.printf("getPanelEnvironment\r\n");
arsenalist 21:33bd8b82560f 1287
arsenalist 21:33bd8b82560f 1288 //get environment sensor
arsenalist 21:33bd8b82560f 1289 trial=0;
arsenalist 21:33bd8b82560f 1290 while(1) {
arsenalist 21:33bd8b82560f 1291 if(trial>=2) { //two times trial
arsenalist 21:33bd8b82560f 1292 break;
arsenalist 21:33bd8b82560f 1293 }
arsenalist 21:33bd8b82560f 1294 if(d.readData() == DHT11::OK) {
arsenalist 21:33bd8b82560f 1295 dTemp = d.readTemperature();
arsenalist 21:33bd8b82560f 1296 dHum = d.readHumidity();
arsenalist 21:33bd8b82560f 1297 break;
arsenalist 21:33bd8b82560f 1298 }
arsenalist 21:33bd8b82560f 1299 trial++;
arsenalist 21:33bd8b82560f 1300 wait(3);
arsenalist 21:33bd8b82560f 1301 }
arsenalist 21:33bd8b82560f 1302
arsenalist 21:33bd8b82560f 1303 //send environment sensor
arsenalist 21:33bd8b82560f 1304 seconds = time(NULL);
arsenalist 21:33bd8b82560f 1305 strftime(q, 32, "%Y-%m-%d %H:%M:%S",localtime(&seconds));
arsenalist 22:e18d361bf688 1306
arsenalist 22:e18d361bf688 1307 //calculate hmacTime
arsenalist 22:e18d361bf688 1308 for(int j=0; j<sizeof(p); j++) {
arsenalist 22:e18d361bf688 1309 p[j]=0; }
arsenalist 22:e18d361bf688 1310 sprintf(p,"emma-%s-%s",emmaUID.c_str(),q);
arsenalist 22:e18d361bf688 1311 hmacTime = calculateMD5(p);
arsenalist 22:e18d361bf688 1312
arsenalist 21:33bd8b82560f 1313 sprintf(s,"{\"uid\":\"%s\",\"hmac\":\"%s\",\"time\":\"%s\",\"temp\":%d,\"hum\":%d,\"gas\":%d}",
arsenalist 22:e18d361bf688 1314 emmaUID.c_str(),hmacTime.c_str(),q,dTemp,dHum,dGas);
arsenalist 21:33bd8b82560f 1315 DBG.printf("dataEnvironment:\r\n%s\r\n",s);
arsenalist 21:33bd8b82560f 1316 rest.post("/emma/api/controller/environment",s);
arsenalist 21:33bd8b82560f 1317 wait(2);
arsenalist 21:33bd8b82560f 1318 str = rxBuf;
arsenalist 21:33bd8b82560f 1319 if(str.rfind("/environment") != std::string::npos) {
arsenalist 21:33bd8b82560f 1320 str.erase(str.begin(),str.begin()+str.rfind("/environment"));
arsenalist 21:33bd8b82560f 1321 if(str.find("\"status\":\"success\"") != std::string::npos) {
arsenalist 21:33bd8b82560f 1322 DBG.printf("send panel environment success\r\n");
arsenalist 21:33bd8b82560f 1323 } else {
arsenalist 21:33bd8b82560f 1324 DBG.printf("send panel environment failed\r\n");
arsenalist 21:33bd8b82560f 1325 }
arsenalist 21:33bd8b82560f 1326 }
arsenalist 21:33bd8b82560f 1327 checkRxBuffer();
arsenalist 21:33bd8b82560f 1328 tPanel.reset();
arsenalist 21:33bd8b82560f 1329 }
arsenalist 21:33bd8b82560f 1330
arsenalist 0:f4e449fa34d7 1331 //nodeTemp
arsenalist 21:33bd8b82560f 1332 checkRxBuffer();
arsenalist 19:7e3e9332f719 1333 if(tNodes.read() > 120.0f) {
arsenalist 5:d00233dd36f5 1334 DBG.printf("getNodesTemperature\r\n");
arsenalist 5:d00233dd36f5 1335
arsenalist 5:d00233dd36f5 1336 for(int i=0; i<NODES_MAX; i++) {
arsenalist 5:d00233dd36f5 1337 if(!nodes[i].ipAddr.empty()) {
arsenalist 5:d00233dd36f5 1338 //get node's temp
arsenalist 5:d00233dd36f5 1339 string temp;
arsenalist 5:d00233dd36f5 1340 nodes[i].restConn->get("/","<?xml version=\"1.0\" encoding=\"utf-8\"?><app_cmd cmd=\"2\"/>\r\n");
arsenalist 5:d00233dd36f5 1341 wait(2);
arsenalist 5:d00233dd36f5 1342 temp = rxBuf;
arsenalist 5:d00233dd36f5 1343 if(temp.rfind(nodes[i].ipAddr) != std::string::npos) {
arsenalist 5:d00233dd36f5 1344 temp.erase(temp.begin(),temp.begin()+temp.rfind(nodes[i].ipAddr));
arsenalist 5:d00233dd36f5 1345 if(temp.rfind("temp=") != std::string::npos) {
arsenalist 5:d00233dd36f5 1346 temp.erase(temp.begin(),temp.begin()+temp.rfind("temp=")+6);
arsenalist 5:d00233dd36f5 1347 temp.erase(temp.begin()+temp.find("\""),temp.end());
arsenalist 5:d00233dd36f5 1348 } else {
arsenalist 5:d00233dd36f5 1349 temp = "0"; //connect to node, but receive none
arsenalist 5:d00233dd36f5 1350 }
arsenalist 5:d00233dd36f5 1351 } else {
arsenalist 5:d00233dd36f5 1352 temp = "0"; //not connected to node
arsenalist 5:d00233dd36f5 1353 }
arsenalist 0:f4e449fa34d7 1354
arsenalist 5:d00233dd36f5 1355 DBG.printf("nodeTemp[%d]:%s\r\n",i,temp.c_str());
arsenalist 5:d00233dd36f5 1356
arsenalist 5:d00233dd36f5 1357 //send node's temp
arsenalist 14:8287f0f5d987 1358 seconds = time(NULL);
arsenalist 22:e18d361bf688 1359 //for(int j=0; j<sizeof(q); j++) {
arsenalist 22:e18d361bf688 1360 // q[j]=0; }
arsenalist 20:ea14f175bbb4 1361 strftime(q, 32, "%Y-%m-%d %H:%M:%S",localtime(&seconds));
arsenalist 22:e18d361bf688 1362
arsenalist 22:e18d361bf688 1363 //calculate hmacTime
arsenalist 22:e18d361bf688 1364 for(int j=0; j<sizeof(p); j++) {
arsenalist 22:e18d361bf688 1365 p[j]=0; }
arsenalist 22:e18d361bf688 1366 sprintf(p,"emma-%s-%s",emmaUID.c_str(),q);
arsenalist 22:e18d361bf688 1367 hmacTime = calculateMD5(p);
arsenalist 22:e18d361bf688 1368
arsenalist 14:8287f0f5d987 1369 sprintf(s,"{\"uid\":\"%s\",\"hmac\":\"%s\",\"time\":\"%s\",\"mac\":\"%s\",\"value\":%s}",
arsenalist 22:e18d361bf688 1370 emmaUID.c_str(),hmacTime.c_str(),q,nodes[i].macAddr.c_str(),temp.c_str());
arsenalist 19:7e3e9332f719 1371 //DBG.printf("dataNodeTemp:\r\n%s\r\n",s);
arsenalist 0:f4e449fa34d7 1372 rest.post("/emma/api/controller/nodetemp",s);
arsenalist 5:d00233dd36f5 1373 wait(2);
arsenalist 21:33bd8b82560f 1374 str = rxBuf;
arsenalist 21:33bd8b82560f 1375 if(str.rfind("/nodetemp") != std::string::npos) {
arsenalist 21:33bd8b82560f 1376 str.erase(str.begin(),str.begin()+str.rfind("/nodetemp"));
arsenalist 21:33bd8b82560f 1377 if(str.find("\"status\":\"success\"") != std::string::npos) {
arsenalist 5:d00233dd36f5 1378 DBG.printf("send nodeTemp success\r\n");
arsenalist 5:d00233dd36f5 1379 } else {
arsenalist 5:d00233dd36f5 1380 DBG.printf("send nodeTemp failed\r\n");
arsenalist 5:d00233dd36f5 1381 }
arsenalist 5:d00233dd36f5 1382 }
arsenalist 6:45f50f1177db 1383 checkRxBuffer();
arsenalist 5:d00233dd36f5 1384 }
arsenalist 0:f4e449fa34d7 1385 }
arsenalist 19:7e3e9332f719 1386 tNodes.reset();
arsenalist 19:7e3e9332f719 1387 }
arsenalist 21:33bd8b82560f 1388
arsenalist 21:33bd8b82560f 1389 //command
arsenalist 5:d00233dd36f5 1390 checkRxBuffer();
arsenalist 0:f4e449fa34d7 1391 if(newCommand) {
arsenalist 5:d00233dd36f5 1392 DBG.printf("newCommand:\r\n%s\r\n",globalCommand.c_str());
arsenalist 13:e8adfe305dbc 1393 TFT.locate(0,160);
arsenalist 13:e8adfe305dbc 1394 TFT.printf(" ");
arsenalist 13:e8adfe305dbc 1395 TFT.locate(0,160);
arsenalist 13:e8adfe305dbc 1396 TFT.printf("newCommand");
arsenalist 13:e8adfe305dbc 1397
arsenalist 0:f4e449fa34d7 1398 MbedJSONValue jsonValue;
arsenalist 0:f4e449fa34d7 1399 parse(jsonValue,globalCommand.c_str());
arsenalist 15:136526c28afb 1400 char *parameter[5] = {"name","nType","nAddr","dType","cmd"};
arsenalist 0:f4e449fa34d7 1401
arsenalist 7:7e8c6ad3fd64 1402 //check whether command is valid
arsenalist 0:f4e449fa34d7 1403 bool validCommand = true;
arsenalist 15:136526c28afb 1404 for(int i=0; i<5; i++) {
arsenalist 0:f4e449fa34d7 1405 validCommand = validCommand && jsonValue.hasMember(parameter[i]);
arsenalist 0:f4e449fa34d7 1406 }
arsenalist 0:f4e449fa34d7 1407 DBG.printf("command validity:%d\r\n",validCommand);
arsenalist 0:f4e449fa34d7 1408
arsenalist 0:f4e449fa34d7 1409 if(validCommand) {
arsenalist 15:136526c28afb 1410 string commandName = jsonValue[parameter[0]].get<std::string>();
arsenalist 15:136526c28afb 1411 string commandNType = jsonValue[parameter[1]].get<std::string>();
arsenalist 15:136526c28afb 1412 string commandNAddr = jsonValue[parameter[2]].get<std::string>();
arsenalist 15:136526c28afb 1413 string commandDType = jsonValue[parameter[3]].get<std::string>();
arsenalist 15:136526c28afb 1414 string commandCmd = jsonValue[parameter[4]].get<std::string>();
arsenalist 0:f4e449fa34d7 1415
arsenalist 0:f4e449fa34d7 1416 if(commandNType == "0") { //switch on panel controller
arsenalist 0:f4e449fa34d7 1417 DBG.printf("command for switch\r\n");
arsenalist 0:f4e449fa34d7 1418 }
arsenalist 0:f4e449fa34d7 1419 else if(commandNType == "1") { //node with mac address
arsenalist 0:f4e449fa34d7 1420 DBG.printf("command for node\r\n");
arsenalist 0:f4e449fa34d7 1421 //get node ip address based on node mac address
arsenalist 5:d00233dd36f5 1422 //string nodeIP;
arsenalist 1:d314a43ae6f7 1423 //nodeIp = readNodeIP(commandNAddr);
arsenalist 5:d00233dd36f5 1424 //nodeIP = "192.168.2.15";
arsenalist 0:f4e449fa34d7 1425 //DBG.printf("nodeIP: %s\r\n",nodeIP.c_str());
arsenalist 5:d00233dd36f5 1426
arsenalist 5:d00233dd36f5 1427 //get index of node list based on mac address
arsenalist 5:d00233dd36f5 1428 int idx = NODES_INVALID;
arsenalist 5:d00233dd36f5 1429 for(int i=0; i<NODES_MAX; i++) {
arsenalist 5:d00233dd36f5 1430 if(!nodes[i].macAddr.compare(commandNAddr)) {
arsenalist 5:d00233dd36f5 1431 idx = i;
arsenalist 5:d00233dd36f5 1432 }
arsenalist 5:d00233dd36f5 1433 }
arsenalist 5:d00233dd36f5 1434
arsenalist 5:d00233dd36f5 1435 //execution process
arsenalist 21:33bd8b82560f 1436 //int trial;
arsenalist 15:136526c28afb 1437 string execResult = "failed";
arsenalist 5:d00233dd36f5 1438 if(idx != NODES_INVALID) {
arsenalist 5:d00233dd36f5 1439 DBG.printf("index found at %d\r\n",idx);
arsenalist 0:f4e449fa34d7 1440
arsenalist 5:d00233dd36f5 1441 //get cmd string based on device type and command number
arsenalist 5:d00233dd36f5 1442 string nodeCmd;
arsenalist 14:8287f0f5d987 1443 nodeCmd = readNodeCmd(commandDType,commandCmd);
arsenalist 14:8287f0f5d987 1444 //nodeCmd = "020129A0163B161315131613153C151316131514143C153C16141414141415151315141414141514141415141414143D1514143D141415141414143D14000D"; //turn off
arsenalist 5:d00233dd36f5 1445 //DBG.printf("nodeCmd: %s\r\n",nodeCmd.c_str());
arsenalist 0:f4e449fa34d7 1446
arsenalist 5:d00233dd36f5 1447 //execute command
arsenalist 5:d00233dd36f5 1448 DBG.printf("executing command\r\n");
arsenalist 0:f4e449fa34d7 1449 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 1450
arsenalist 5:d00233dd36f5 1451 trial=0;
arsenalist 0:f4e449fa34d7 1452 while(1) {
arsenalist 5:d00233dd36f5 1453 //cmdExecuted = false;
arsenalist 5:d00233dd36f5 1454 if(trial>=2) { //two times trial
arsenalist 0:f4e449fa34d7 1455 DBG.printf("cmd is not executed\r\n");
arsenalist 13:e8adfe305dbc 1456 TFT.foreground(Red);
arsenalist 13:e8adfe305dbc 1457 TFT.locate(0,180);
arsenalist 13:e8adfe305dbc 1458 TFT.printf(" ");
arsenalist 13:e8adfe305dbc 1459 TFT.locate(0,180);
arsenalist 13:e8adfe305dbc 1460 TFT.printf("cmd is not executed");
arsenalist 14:8287f0f5d987 1461 wait(1);
arsenalist 13:e8adfe305dbc 1462 TFT.locate(0,180);
arsenalist 13:e8adfe305dbc 1463 TFT.printf(" ");
arsenalist 13:e8adfe305dbc 1464 TFT.foreground(White);
arsenalist 0:f4e449fa34d7 1465 break;
arsenalist 0:f4e449fa34d7 1466 }
arsenalist 5:d00233dd36f5 1467 nodes[idx].restConn->get("/",s);
arsenalist 5:d00233dd36f5 1468 wait(2);
arsenalist 5:d00233dd36f5 1469 if(rxBuf.find("REST: Sent") != std::string::npos) {
arsenalist 13:e8adfe305dbc 1470 DBG.printf("cmd is executed\r\n");
arsenalist 13:e8adfe305dbc 1471 TFT.foreground(Green);
arsenalist 13:e8adfe305dbc 1472 TFT.locate(0,180);
arsenalist 13:e8adfe305dbc 1473 TFT.printf(" ");
arsenalist 13:e8adfe305dbc 1474 TFT.locate(0,180);
arsenalist 13:e8adfe305dbc 1475 TFT.printf("cmd is executed");
arsenalist 14:8287f0f5d987 1476 wait(1);
arsenalist 13:e8adfe305dbc 1477 TFT.locate(0,180);
arsenalist 13:e8adfe305dbc 1478 TFT.printf(" ");
arsenalist 13:e8adfe305dbc 1479 TFT.foreground(White);
arsenalist 15:136526c28afb 1480 execResult = "success";
arsenalist 5:d00233dd36f5 1481 break;
arsenalist 5:d00233dd36f5 1482 }
arsenalist 0:f4e449fa34d7 1483 trial++;
arsenalist 5:d00233dd36f5 1484 }
arsenalist 14:8287f0f5d987 1485 } else {
arsenalist 14:8287f0f5d987 1486 TFT.foreground(Red);
arsenalist 14:8287f0f5d987 1487 TFT.locate(0,180);
arsenalist 14:8287f0f5d987 1488 TFT.printf(" ");
arsenalist 14:8287f0f5d987 1489 TFT.locate(0,180);
arsenalist 14:8287f0f5d987 1490 TFT.printf("node is invalid");
arsenalist 14:8287f0f5d987 1491 wait(1);
arsenalist 14:8287f0f5d987 1492 TFT.locate(0,180);
arsenalist 14:8287f0f5d987 1493 TFT.printf(" ");
arsenalist 14:8287f0f5d987 1494 TFT.foreground(White);
arsenalist 5:d00233dd36f5 1495 }
arsenalist 5:d00233dd36f5 1496
arsenalist 5:d00233dd36f5 1497 wait(2);
arsenalist 5:d00233dd36f5 1498 //send execution result
arsenalist 21:33bd8b82560f 1499 //DBG.printf("send execution result\r\n");
arsenalist 15:136526c28afb 1500 sprintf(s,"{\"uid\":\"%s\",\"nType\":\"%s\",\"nAddr\":\"%s\",\"dType\":\"%s\",\"cmd\":\"%s\",\"result\":\"%s\",\"name\":\"%s\"}",
arsenalist 15:136526c28afb 1501 emmaUID.c_str(), commandNType.c_str(),commandNAddr.c_str(),commandDType.c_str(),commandCmd.c_str(),execResult.c_str(),commandName.c_str());
arsenalist 5:d00233dd36f5 1502
arsenalist 5:d00233dd36f5 1503 trial=0;
arsenalist 5:d00233dd36f5 1504 while(1) {
arsenalist 5:d00233dd36f5 1505 if(trial>=2) { //two times trial
arsenalist 5:d00233dd36f5 1506 DBG.printf("send execution result failed\r\n");
arsenalist 5:d00233dd36f5 1507 break;
arsenalist 0:f4e449fa34d7 1508 }
arsenalist 5:d00233dd36f5 1509 rest.post("/emma/api/controller/test",s);
arsenalist 5:d00233dd36f5 1510 wait(2);
arsenalist 5:d00233dd36f5 1511 if(rxBuf.find("\"status\":\"OK\"") != std::string::npos) {
arsenalist 5:d00233dd36f5 1512 DBG.printf("send execution result success\r\n");
arsenalist 5:d00233dd36f5 1513 break;
arsenalist 0:f4e449fa34d7 1514 }
arsenalist 5:d00233dd36f5 1515 trial++;
arsenalist 0:f4e449fa34d7 1516 }
arsenalist 0:f4e449fa34d7 1517 }
arsenalist 0:f4e449fa34d7 1518 }
arsenalist 13:e8adfe305dbc 1519
arsenalist 13:e8adfe305dbc 1520 //clear text on lcd
arsenalist 13:e8adfe305dbc 1521 TFT.locate(0,160);
arsenalist 13:e8adfe305dbc 1522 TFT.printf(" ");
arsenalist 13:e8adfe305dbc 1523
arsenalist 0:f4e449fa34d7 1524 newCommand = false;
arsenalist 2:fdfdeb5fd6fd 1525 }
arsenalist 4:76ab12e2f8a3 1526 osDelay(5000);
arsenalist 0:f4e449fa34d7 1527 }
arsenalist 0:f4e449fa34d7 1528 }
arsenalist 0:f4e449fa34d7 1529 }
arsenalist 0:f4e449fa34d7 1530 void emmaModeFirmwareDownload(void) {
arsenalist 0:f4e449fa34d7 1531 bool emmaGetFirmwareParam = false;
arsenalist 0:f4e449fa34d7 1532
arsenalist 0:f4e449fa34d7 1533 DBG.printf("emmaModeFirmwareDownload\r\n");
arsenalist 0:f4e449fa34d7 1534
arsenalist 0:f4e449fa34d7 1535 char s[384];
arsenalist 0:f4e449fa34d7 1536 string str;
arsenalist 0:f4e449fa34d7 1537 string connData;
arsenalist 0:f4e449fa34d7 1538 string chunk;
arsenalist 0:f4e449fa34d7 1539
arsenalist 0:f4e449fa34d7 1540 //firmware parameter
arsenalist 0:f4e449fa34d7 1541 string firmwareVer;
arsenalist 0:f4e449fa34d7 1542 string firmwareName;
arsenalist 0:f4e449fa34d7 1543 int numPart;
arsenalist 0:f4e449fa34d7 1544
arsenalist 0:f4e449fa34d7 1545 //downloading
arsenalist 0:f4e449fa34d7 1546 string firmwarePart;
arsenalist 0:f4e449fa34d7 1547 string calcMD5;
arsenalist 0:f4e449fa34d7 1548 string srvrMD5;
arsenalist 0:f4e449fa34d7 1549 bool nextPart;
arsenalist 0:f4e449fa34d7 1550
arsenalist 0:f4e449fa34d7 1551 //set wifi to mode bridge
arsenalist 0:f4e449fa34d7 1552 _ESP.printf("MODE=B");
arsenalist 0:f4e449fa34d7 1553 DBG.printf("set mode bridge\r\n");
arsenalist 0:f4e449fa34d7 1554 while(1) {
arsenalist 0:f4e449fa34d7 1555 char rcv[128] = {};
arsenalist 0:f4e449fa34d7 1556 rcvReply(rcv,3000);
arsenalist 0:f4e449fa34d7 1557 str = rcv;
arsenalist 0:f4e449fa34d7 1558 if(str.find("MODE=B_OK") != std::string::npos)
arsenalist 0:f4e449fa34d7 1559 break;
arsenalist 0:f4e449fa34d7 1560 }
arsenalist 0:f4e449fa34d7 1561 DBG.printf("MODE=B\r\n");
arsenalist 0:f4e449fa34d7 1562
arsenalist 0:f4e449fa34d7 1563 esp.enable();
arsenalist 0:f4e449fa34d7 1564 wait(1);
arsenalist 0:f4e449fa34d7 1565 while(!esp.ready());
arsenalist 0:f4e449fa34d7 1566
arsenalist 0:f4e449fa34d7 1567 if(!rest.begin("candra.tritronik.com",3128,false)) {
arsenalist 0:f4e449fa34d7 1568 DBG.printf("EMMA: fail to setup rest");
arsenalist 0:f4e449fa34d7 1569 while(1);
arsenalist 0:f4e449fa34d7 1570 }
arsenalist 0:f4e449fa34d7 1571
arsenalist 0:f4e449fa34d7 1572 //wifiConnected = true; //with custom firmware, panel should connect wifi automatically
arsenalist 0:f4e449fa34d7 1573 useProxy = true;
arsenalist 0:f4e449fa34d7 1574
arsenalist 0:f4e449fa34d7 1575 esp.process();
arsenalist 0:f4e449fa34d7 1576 //set connData
arsenalist 0:f4e449fa34d7 1577 if(useProxy) {
arsenalist 0:f4e449fa34d7 1578 for(int i=0; i<sizeof(s); i++) {
arsenalist 0:f4e449fa34d7 1579 s[i]=0; }
arsenalist 0:f4e449fa34d7 1580 //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 1581 sprintf(s,"http://192.168.128.69/emmaController/firmware/firmwareParameter");
arsenalist 0:f4e449fa34d7 1582 connData = s;
arsenalist 0:f4e449fa34d7 1583 } else {
arsenalist 0:f4e449fa34d7 1584 for(int i=0; i<sizeof(s); i++) {
arsenalist 0:f4e449fa34d7 1585 s[i]=0; }
arsenalist 0:f4e449fa34d7 1586 //sprintf(s,"/emma/api/controller/register?uid=%s&hmac=%s",emmaUID.c_str(),hmac.c_str());
arsenalist 0:f4e449fa34d7 1587 sprintf(s,"/emmaController/firmware/firmwareParameter");
arsenalist 0:f4e449fa34d7 1588 connData = s;
arsenalist 0:f4e449fa34d7 1589 }
arsenalist 0:f4e449fa34d7 1590
arsenalist 0:f4e449fa34d7 1591 //get parameter of firmware to be downloaded
arsenalist 0:f4e449fa34d7 1592 while(!emmaGetFirmwareParam) {
arsenalist 0:f4e449fa34d7 1593 rest.get(connData.c_str());
arsenalist 0:f4e449fa34d7 1594 for(int i=0; i<sizeof(s); i++) {
arsenalist 0:f4e449fa34d7 1595 s[i]=0; }
arsenalist 0:f4e449fa34d7 1596 rest.getResponse(s,sizeof(s));
arsenalist 0:f4e449fa34d7 1597 //DBG.printf("rsp param:%s\r\n",s);
arsenalist 0:f4e449fa34d7 1598
arsenalist 0:f4e449fa34d7 1599 str = s;
arsenalist 0:f4e449fa34d7 1600 if(str.find("[") != std::string::npos && str.find("]") != std::string::npos) {
arsenalist 0:f4e449fa34d7 1601 str.erase(str.begin(),str.begin()+str.find("[")+1);
arsenalist 0:f4e449fa34d7 1602 str.erase(str.begin()+str.find("]"),str.end());
arsenalist 0:f4e449fa34d7 1603
arsenalist 0:f4e449fa34d7 1604 MbedJSONValue jsonValue;
arsenalist 0:f4e449fa34d7 1605 parse(jsonValue,str.c_str());
arsenalist 0:f4e449fa34d7 1606
arsenalist 0:f4e449fa34d7 1607 char *parameter[2] = {"firmwareVer","numPart"};
arsenalist 0:f4e449fa34d7 1608
arsenalist 0:f4e449fa34d7 1609 for(int i=0; i<2; i++) {
arsenalist 0:f4e449fa34d7 1610 if(jsonValue.hasMember(parameter[i])) {
arsenalist 0:f4e449fa34d7 1611 string val = jsonValue[parameter[i]].get<std::string>();
arsenalist 0:f4e449fa34d7 1612 if(i==0) {
arsenalist 0:f4e449fa34d7 1613 firmwareVer = val;
arsenalist 0:f4e449fa34d7 1614 } else if(i==1) {
arsenalist 0:f4e449fa34d7 1615 sscanf(val.c_str(),"%d",&numPart);
arsenalist 0:f4e449fa34d7 1616 }
arsenalist 0:f4e449fa34d7 1617 }
arsenalist 0:f4e449fa34d7 1618 }
arsenalist 0:f4e449fa34d7 1619
arsenalist 0:f4e449fa34d7 1620 if(!firmwareVer.empty() && numPart!=0) {
arsenalist 0:f4e449fa34d7 1621 emmaGetFirmwareParam = true;
arsenalist 0:f4e449fa34d7 1622 }
arsenalist 0:f4e449fa34d7 1623 }
arsenalist 0:f4e449fa34d7 1624 }
arsenalist 0:f4e449fa34d7 1625 DBG.printf("firmwareVer:%s\r\n",firmwareVer.c_str());
arsenalist 0:f4e449fa34d7 1626 DBG.printf("numPart:%d\r\n",numPart);
arsenalist 0:f4e449fa34d7 1627
arsenalist 0:f4e449fa34d7 1628 //clear firmware file
arsenalist 0:f4e449fa34d7 1629 while(1) {
arsenalist 0:f4e449fa34d7 1630 if(clearFirmware()){
arsenalist 0:f4e449fa34d7 1631 DBG.printf("clear firmware on sd card\r\n\r\n");
arsenalist 0:f4e449fa34d7 1632 break;
arsenalist 0:f4e449fa34d7 1633 }
arsenalist 0:f4e449fa34d7 1634 wait(1);
arsenalist 0:f4e449fa34d7 1635 }
arsenalist 0:f4e449fa34d7 1636
arsenalist 0:f4e449fa34d7 1637 //set connData
arsenalist 0:f4e449fa34d7 1638 if(useProxy) {
arsenalist 0:f4e449fa34d7 1639 for(int i=0; i<sizeof(s); i++) {
arsenalist 0:f4e449fa34d7 1640 s[i]=0; }
arsenalist 0:f4e449fa34d7 1641 sprintf(s,"http://192.168.128.69/emmaController/firmware/%s",firmwareVer.c_str());
arsenalist 0:f4e449fa34d7 1642 connData = s;
arsenalist 0:f4e449fa34d7 1643 } else {
arsenalist 0:f4e449fa34d7 1644 for(int i=0; i<sizeof(s); i++) {
arsenalist 0:f4e449fa34d7 1645 s[i]=0; }
arsenalist 0:f4e449fa34d7 1646 sprintf(s,"/emmaController/firmware/%s",firmwareVer.c_str());
arsenalist 0:f4e449fa34d7 1647 connData = s;
arsenalist 0:f4e449fa34d7 1648 }
arsenalist 0:f4e449fa34d7 1649
arsenalist 0:f4e449fa34d7 1650 //download firmware
arsenalist 0:f4e449fa34d7 1651 for(int n=0; n<numPart; n++) {
arsenalist 0:f4e449fa34d7 1652 nextPart = false;
arsenalist 0:f4e449fa34d7 1653 while(!nextPart) {
arsenalist 0:f4e449fa34d7 1654 for(int i=0; i<sizeof(s); i++) {
arsenalist 0:f4e449fa34d7 1655 s[i]=0; }
arsenalist 0:f4e449fa34d7 1656 sprintf(s,"%s/firmware_Hex_%s_%d",connData.c_str(),firmwareVer.c_str(),n);
arsenalist 0:f4e449fa34d7 1657 rest.get(s);
arsenalist 0:f4e449fa34d7 1658 for(int i=0; i<sizeof(s); i++) {
arsenalist 0:f4e449fa34d7 1659 s[i]=0; }
arsenalist 0:f4e449fa34d7 1660 rest.getResponse(s,sizeof(s));
arsenalist 0:f4e449fa34d7 1661 //DBG.printf("rsp[%d]:%s\r\n",n,s);
arsenalist 0:f4e449fa34d7 1662
arsenalist 0:f4e449fa34d7 1663 str = s;
arsenalist 0:f4e449fa34d7 1664 if(str.find("{") != std::string::npos && str.find("}") != std::string::npos) {
arsenalist 0:f4e449fa34d7 1665 str.erase(str.begin(),str.begin()+str.find("{")+1);
arsenalist 0:f4e449fa34d7 1666 str.erase(str.begin()+str.find("}"),str.end());
arsenalist 0:f4e449fa34d7 1667 //DBG.printf("firmwarePart[%d]:%s\r\n",n,str.c_str());
arsenalist 0:f4e449fa34d7 1668 firmwarePart = str;
arsenalist 0:f4e449fa34d7 1669
arsenalist 0:f4e449fa34d7 1670 //calculated MD5
arsenalist 0:f4e449fa34d7 1671 calcMD5 = calculateMD5(firmwarePart);
arsenalist 0:f4e449fa34d7 1672 //DBG.printf("calcMD5[%d]:%s\r\n",n,calcMD5.c_str());
arsenalist 0:f4e449fa34d7 1673
arsenalist 0:f4e449fa34d7 1674 //MD5 from server
arsenalist 0:f4e449fa34d7 1675 for(int i=0; i<sizeof(s); i++) {
arsenalist 0:f4e449fa34d7 1676 s[i]=0; }
arsenalist 0:f4e449fa34d7 1677 sprintf(s,"%s/MD5/firmware_MD5_%s_%d",connData.c_str(),firmwareVer.c_str(),n);
arsenalist 0:f4e449fa34d7 1678 rest.get(s);
arsenalist 0:f4e449fa34d7 1679 for(int i=0; i<sizeof(s); i++) {
arsenalist 0:f4e449fa34d7 1680 s[i]=0; }
arsenalist 0:f4e449fa34d7 1681 rest.getResponse(s,sizeof(s));
arsenalist 0:f4e449fa34d7 1682
arsenalist 0:f4e449fa34d7 1683 str = s;
arsenalist 0:f4e449fa34d7 1684 if(str.find("{") != std::string::npos && str.find("}") != std::string::npos) {
arsenalist 0:f4e449fa34d7 1685 str.erase(str.begin(),str.begin()+str.find("{")+1);
arsenalist 0:f4e449fa34d7 1686 str.erase(str.begin()+str.find("}"),str.end());
arsenalist 0:f4e449fa34d7 1687 srvrMD5 = str;
arsenalist 0:f4e449fa34d7 1688 //DBG.printf("srvrMD5[%d]:%s\r\n",n,srvrMD5.c_str());
arsenalist 0:f4e449fa34d7 1689
arsenalist 0:f4e449fa34d7 1690 //compare original MD5 vs MD5 from server
arsenalist 0:f4e449fa34d7 1691 if(strcmp(calcMD5.c_str(),srvrMD5.c_str()) == 0) {
arsenalist 0:f4e449fa34d7 1692 //DBG.printf("MD5 correct\r\n");
arsenalist 0:f4e449fa34d7 1693
arsenalist 0:f4e449fa34d7 1694 //save to sd card
arsenalist 0:f4e449fa34d7 1695 int st = writeFirmwareHexToChar(firmwarePart);
arsenalist 0:f4e449fa34d7 1696 if(st) {
arsenalist 0:f4e449fa34d7 1697 DBG.printf("firmwarePart[%d/%d] written\r\n",n,numPart-1);
arsenalist 0:f4e449fa34d7 1698 nextPart = true;
arsenalist 0:f4e449fa34d7 1699 }
arsenalist 0:f4e449fa34d7 1700
arsenalist 0:f4e449fa34d7 1701 } else {
arsenalist 0:f4e449fa34d7 1702 DBG.printf("MD5 incorrect\r\n");
arsenalist 0:f4e449fa34d7 1703 }
arsenalist 0:f4e449fa34d7 1704 }
arsenalist 0:f4e449fa34d7 1705 } else {
arsenalist 0:f4e449fa34d7 1706 DBG.printf("retry to fetch firmwarePart[%d]\r\n",n);
arsenalist 0:f4e449fa34d7 1707 }
arsenalist 0:f4e449fa34d7 1708 wait(0.5);
arsenalist 0:f4e449fa34d7 1709 }
arsenalist 0:f4e449fa34d7 1710 }
arsenalist 0:f4e449fa34d7 1711 DBG.printf("download finished\r\n");
arsenalist 0:f4e449fa34d7 1712 }
arsenalist 12:96f637ed37f9 1713 /*end emma mode*/
arsenalist 0:f4e449fa34d7 1714
arsenalist 4:76ab12e2f8a3 1715 /*start energy related*/
arsenalist 0:f4e449fa34d7 1716 void energyThread(void const*) {
arsenalist 19:7e3e9332f719 1717 Timer tEnergy;
arsenalist 19:7e3e9332f719 1718
arsenalist 19:7e3e9332f719 1719 while(1) {
arsenalist 19:7e3e9332f719 1720 tEnergy.start();
arsenalist 19:7e3e9332f719 1721 DBG.printf("energyThread-start\r\n");
arsenalist 19:7e3e9332f719 1722
arsenalist 19:7e3e9332f719 1723 AWattHrSum = 0;
arsenalist 19:7e3e9332f719 1724 BWattHrSum = 0;
arsenalist 19:7e3e9332f719 1725 CWattHrSum = 0;
arsenalist 19:7e3e9332f719 1726
arsenalist 20:ea14f175bbb4 1727 while(tEnergy.read() < 1*60.0) {
arsenalist 19:7e3e9332f719 1728 AWattHrValue = ADE.getWattHR(PHASE_A);
arsenalist 19:7e3e9332f719 1729 BWattHrValue = ADE.getWattHR(PHASE_B);
arsenalist 19:7e3e9332f719 1730 CWattHrValue = ADE.getWattHR(PHASE_C);
arsenalist 19:7e3e9332f719 1731
arsenalist 19:7e3e9332f719 1732 AWattHrSum += AWattHrValue;
arsenalist 19:7e3e9332f719 1733 BWattHrSum += BWattHrValue;
arsenalist 20:ea14f175bbb4 1734 CWattHrSum += CWattHrValue;
arsenalist 20:ea14f175bbb4 1735
arsenalist 20:ea14f175bbb4 1736
arsenalist 20:ea14f175bbb4 1737 //start check voltage and power
arsenalist 21:33bd8b82560f 1738 AVrms = ADE.VRMS(PHASE_A) * 0.000124f; //0.000158; //constants are from calculateVRMS function
arsenalist 21:33bd8b82560f 1739 BVrms = ADE.VRMS(PHASE_B) * 0.000123f;
arsenalist 21:33bd8b82560f 1740 CVrms = ADE.VRMS(PHASE_C) * 0.000122f;
arsenalist 20:ea14f175bbb4 1741
arsenalist 21:33bd8b82560f 1742 AIrms = ADE.IRMS(PHASE_A) * 0.00001006f; //0.0000125f; //constants are from calculateIRMS function
arsenalist 21:33bd8b82560f 1743 BIrms = ADE.IRMS(PHASE_B) * 0.00001005f;
arsenalist 21:33bd8b82560f 1744 CIrms = ADE.IRMS(PHASE_C) * 0.00001004f;
arsenalist 20:ea14f175bbb4 1745
arsenalist 20:ea14f175bbb4 1746 AWatt = AVrms * AIrms;
arsenalist 20:ea14f175bbb4 1747 BWatt = BVrms * BIrms;
arsenalist 20:ea14f175bbb4 1748 CWatt = CVrms * CIrms;
arsenalist 20:ea14f175bbb4 1749 //end check voltage and power
arsenalist 20:ea14f175bbb4 1750
arsenalist 19:7e3e9332f719 1751 }
arsenalist 19:7e3e9332f719 1752
arsenalist 19:7e3e9332f719 1753 AWattHr = AWattHrSum * 0.0000198f;
arsenalist 19:7e3e9332f719 1754 BWattHr = BWattHrSum * 0.0000197f;
arsenalist 19:7e3e9332f719 1755 CWattHr = CWattHrSum * 0.0000196f;
arsenalist 19:7e3e9332f719 1756
arsenalist 22:e18d361bf688 1757 newEnergyData = true;
arsenalist 22:e18d361bf688 1758
arsenalist 19:7e3e9332f719 1759 tEnergy.stop();
arsenalist 19:7e3e9332f719 1760 tEnergy.reset();
arsenalist 19:7e3e9332f719 1761 DBG.printf("energyThread-finish\r\n");
arsenalist 19:7e3e9332f719 1762 }
arsenalist 0:f4e449fa34d7 1763 }
arsenalist 21:33bd8b82560f 1764 void checkVoltagePower(void) {
arsenalist 4:76ab12e2f8a3 1765 //check if voltage or power violates threshold
arsenalist 22:e18d361bf688 1766 char p[64];
arsenalist 20:ea14f175bbb4 1767 char q[32];
arsenalist 4:76ab12e2f8a3 1768 char s[256];
arsenalist 22:e18d361bf688 1769 string hmacTime;
arsenalist 4:76ab12e2f8a3 1770 string str;
arsenalist 20:ea14f175bbb4 1771 time_t seconds;
arsenalist 4:76ab12e2f8a3 1772
arsenalist 4:76ab12e2f8a3 1773 //DBG.printf("checkVoltagePower-start\r\n");
arsenalist 4:76ab12e2f8a3 1774
arsenalist 20:ea14f175bbb4 1775 //vrms and irms might be placed inside energy calculation routine
arsenalist 20:ea14f175bbb4 1776 /*
arsenalist 19:7e3e9332f719 1777 AVrms = ADE.VRMS(PHASE_A) * 0.000128f; //0.000158; //constants are from calculateVRMS function
arsenalist 19:7e3e9332f719 1778 BVrms = ADE.VRMS(PHASE_B) * 0.000127f; //0.000157;
arsenalist 19:7e3e9332f719 1779 CVrms = ADE.VRMS(PHASE_C) * 0.000126f; //0.000156;
arsenalist 19:7e3e9332f719 1780
arsenalist 19:7e3e9332f719 1781 AIrms = ADE.IRMS(PHASE_A) * 0.0000125f; //constants are from calculateIRMS function
arsenalist 19:7e3e9332f719 1782 BIrms = ADE.IRMS(PHASE_B) * 0.0000123f;
arsenalist 19:7e3e9332f719 1783 CIrms = ADE.IRMS(PHASE_C) * 0.0000124f;
arsenalist 4:76ab12e2f8a3 1784
arsenalist 4:76ab12e2f8a3 1785 AWatt = AVrms * AIrms;
arsenalist 4:76ab12e2f8a3 1786 BWatt = BVrms * BIrms;
arsenalist 4:76ab12e2f8a3 1787 CWatt = CVrms * CIrms;
arsenalist 20:ea14f175bbb4 1788 */
arsenalist 4:76ab12e2f8a3 1789
arsenalist 21:33bd8b82560f 1790 //DBG.printf("Vrms of each phase:%.2f - %.2f - %.2f\r\n", AVrms, BVrms, CVrms);
arsenalist 21:33bd8b82560f 1791 //DBG.printf("Watt of each phase:%.2f - %.2f - %.2f\r\n", AWatt, BWatt, CWatt);
arsenalist 21:33bd8b82560f 1792 //wait(1);
arsenalist 19:7e3e9332f719 1793
arsenalist 20:ea14f175bbb4 1794 //get time
arsenalist 20:ea14f175bbb4 1795 seconds = time(NULL);
arsenalist 20:ea14f175bbb4 1796 strftime(q, 32, "%Y-%m-%d %H:%M:%S",localtime(&seconds));
arsenalist 20:ea14f175bbb4 1797
arsenalist 22:e18d361bf688 1798 //calculate hmacTime
arsenalist 22:e18d361bf688 1799 for(int j=0; j<sizeof(p); j++) {
arsenalist 22:e18d361bf688 1800 p[j]=0; }
arsenalist 22:e18d361bf688 1801 sprintf(p,"emma-%s-%s",emmaUID.c_str(),q);
arsenalist 22:e18d361bf688 1802 hmacTime = calculateMD5(p);
arsenalist 22:e18d361bf688 1803
arsenalist 4:76ab12e2f8a3 1804 if(AVrms > VRMSTHRESHOLD || AWatt > WATTTHRESHOLD) {
arsenalist 4:76ab12e2f8a3 1805 DBG.printf("alert on ch1\r\n");
arsenalist 20:ea14f175bbb4 1806 sprintf(s,"{\"uid\":\"%s\",\"hmac\":\"%s\",\"time\":\"%s\",\"voltage\":%.2f,\"power\":%.2f}",
arsenalist 22:e18d361bf688 1807 emmaUID.c_str(),hmacTime.c_str(),q,AVrms,AWatt);
arsenalist 4:76ab12e2f8a3 1808 rest.post("/emma/api/controller/alert/1",s);
arsenalist 4:76ab12e2f8a3 1809 wait(2);
arsenalist 4:76ab12e2f8a3 1810 str = rxBuf;
arsenalist 4:76ab12e2f8a3 1811 if(str.rfind("/alert/1") != std::string::npos) {
arsenalist 4:76ab12e2f8a3 1812 str.erase(str.begin(),str.begin()+str.rfind("/alert/1"));
arsenalist 4:76ab12e2f8a3 1813 if(str.find("\"status\":\"success\"") != std::string::npos) {
arsenalist 4:76ab12e2f8a3 1814 DBG.printf("send alert ch1 success\r\n");
arsenalist 4:76ab12e2f8a3 1815 } else {
arsenalist 4:76ab12e2f8a3 1816 DBG.printf("send alert ch1 failed\r\n");
arsenalist 4:76ab12e2f8a3 1817 }
arsenalist 4:76ab12e2f8a3 1818 }
arsenalist 4:76ab12e2f8a3 1819 }
arsenalist 4:76ab12e2f8a3 1820
arsenalist 4:76ab12e2f8a3 1821 if(BVrms > VRMSTHRESHOLD || BWatt > WATTTHRESHOLD) {
arsenalist 4:76ab12e2f8a3 1822 DBG.printf("alert on ch2\r\n");
arsenalist 20:ea14f175bbb4 1823 sprintf(s,"{\"uid\":\"%s\",\"hmac\":\"%s\",\"time\":\"%s\",\"voltage\":%.2f,\"power\":%.2f}",
arsenalist 22:e18d361bf688 1824 emmaUID.c_str(),hmacTime.c_str(),q,BVrms,BWatt);
arsenalist 4:76ab12e2f8a3 1825 rest.post("/emma/api/controller/alert/2",s);
arsenalist 4:76ab12e2f8a3 1826 wait(2);
arsenalist 4:76ab12e2f8a3 1827 str = rxBuf;
arsenalist 4:76ab12e2f8a3 1828 if(str.rfind("/alert/2") != std::string::npos) {
arsenalist 4:76ab12e2f8a3 1829 str.erase(str.begin(),str.begin()+str.rfind("/alert/2"));
arsenalist 4:76ab12e2f8a3 1830 if(str.find("\"status\":\"success\"") != std::string::npos) {
arsenalist 4:76ab12e2f8a3 1831 DBG.printf("send alert ch2 success\r\n");
arsenalist 4:76ab12e2f8a3 1832 } else {
arsenalist 4:76ab12e2f8a3 1833 DBG.printf("send alert ch2 failed\r\n");
arsenalist 4:76ab12e2f8a3 1834 }
arsenalist 4:76ab12e2f8a3 1835 }
arsenalist 4:76ab12e2f8a3 1836 }
arsenalist 4:76ab12e2f8a3 1837
arsenalist 4:76ab12e2f8a3 1838 if(CVrms > VRMSTHRESHOLD || CWatt > WATTTHRESHOLD) {
arsenalist 7:7e8c6ad3fd64 1839 DBG.printf("alert on ch3\r\n");
arsenalist 4:76ab12e2f8a3 1840 DBG.printf("alert on ch3\r\n");
arsenalist 20:ea14f175bbb4 1841 sprintf(s,"{\"uid\":\"%s\",\"hmac\":\"%s\",\"time\":\"%s\",\"voltage\":%.2f,\"power\":%.2f}",
arsenalist 22:e18d361bf688 1842 emmaUID.c_str(),hmacTime.c_str(),q,CVrms,CWatt);
arsenalist 4:76ab12e2f8a3 1843 rest.post("/emma/api/controller/alert/3",s);
arsenalist 4:76ab12e2f8a3 1844 wait(2);
arsenalist 4:76ab12e2f8a3 1845 str = rxBuf;
arsenalist 4:76ab12e2f8a3 1846 if(str.rfind("/alert/3") != std::string::npos) {
arsenalist 4:76ab12e2f8a3 1847 str.erase(str.begin(),str.begin()+str.rfind("/alert/3"));
arsenalist 4:76ab12e2f8a3 1848 if(str.find("\"status\":\"success\"") != std::string::npos) {
arsenalist 4:76ab12e2f8a3 1849 DBG.printf("send alert ch3 success\r\n");
arsenalist 4:76ab12e2f8a3 1850 } else {
arsenalist 4:76ab12e2f8a3 1851 DBG.printf("send alert ch3 failed\r\n");
arsenalist 4:76ab12e2f8a3 1852 }
arsenalist 4:76ab12e2f8a3 1853 }
arsenalist 4:76ab12e2f8a3 1854 }
arsenalist 4:76ab12e2f8a3 1855 //DBG.printf("checkVoltagePower-finish\r\n");
arsenalist 4:76ab12e2f8a3 1856 }
arsenalist 4:76ab12e2f8a3 1857 /*end energy related*/
arsenalist 0:f4e449fa34d7 1858
arsenalist 0:f4e449fa34d7 1859 /*start wifi mqtt*/
arsenalist 0:f4e449fa34d7 1860 void mqttConnected(void* response) {
arsenalist 1:d314a43ae6f7 1861 DBG.printf("MQTT Connected\r\n");
arsenalist 0:f4e449fa34d7 1862 char mqttTopic[64];
arsenalist 0:f4e449fa34d7 1863 sprintf(mqttTopic,"%s/%s/command",platformDOMAIN.c_str(),emmaUID.c_str());
arsenalist 0:f4e449fa34d7 1864 mqtt.subscribe(mqttTopic);
arsenalist 0:f4e449fa34d7 1865 }
arsenalist 0:f4e449fa34d7 1866 void mqttDisconnected(void* response) {
arsenalist 1:d314a43ae6f7 1867 DBG.printf("MQTT Disconnected\r\n");
arsenalist 0:f4e449fa34d7 1868 }
arsenalist 0:f4e449fa34d7 1869 /*end wifi mqtt*/
arsenalist 0:f4e449fa34d7 1870
arsenalist 0:f4e449fa34d7 1871 /*start wifi rest*/
arsenalist 4:76ab12e2f8a3 1872 void rxInterrupt(void) {
arsenalist 4:76ab12e2f8a3 1873 char c;
arsenalist 4:76ab12e2f8a3 1874
arsenalist 4:76ab12e2f8a3 1875 while(_ESP.readable()) {
arsenalist 4:76ab12e2f8a3 1876 c = _ESP.getc();
arsenalist 4:76ab12e2f8a3 1877 if(c != 0) { //char is not null
arsenalist 4:76ab12e2f8a3 1878 rxBuf += c;
arsenalist 4:76ab12e2f8a3 1879 }
arsenalist 4:76ab12e2f8a3 1880 }
arsenalist 4:76ab12e2f8a3 1881 }
arsenalist 4:76ab12e2f8a3 1882 void checkRxBuffer(void) {
arsenalist 4:76ab12e2f8a3 1883 //check new command
arsenalist 4:76ab12e2f8a3 1884 if(rxBuf.rfind("/command") != std::string::npos) {
arsenalist 4:76ab12e2f8a3 1885 rxBuf.erase(rxBuf.begin(),rxBuf.begin()+rxBuf.rfind("/command"));
arsenalist 4:76ab12e2f8a3 1886 if(rxBuf.find("[{") != std::string::npos && rxBuf.find("}]") != std::string::npos) {
arsenalist 4:76ab12e2f8a3 1887 rxBuf.erase(rxBuf.begin(),rxBuf.begin()+rxBuf.find("[{")+1);
arsenalist 4:76ab12e2f8a3 1888 rxBuf.erase(rxBuf.begin()+rxBuf.find("]"),rxBuf.end());
arsenalist 4:76ab12e2f8a3 1889 globalCommand = rxBuf;
arsenalist 4:76ab12e2f8a3 1890 //DBG.printf("gC:%s\r\n",globalCommand.c_str());
arsenalist 4:76ab12e2f8a3 1891 newCommand = true;
arsenalist 4:76ab12e2f8a3 1892 }
arsenalist 4:76ab12e2f8a3 1893 }
arsenalist 4:76ab12e2f8a3 1894
arsenalist 4:76ab12e2f8a3 1895 //clear rxBuf
arsenalist 4:76ab12e2f8a3 1896 rxBuf.clear();
arsenalist 4:76ab12e2f8a3 1897 }
arsenalist 0:f4e449fa34d7 1898 /*end wifi rest*/
arsenalist 0:f4e449fa34d7 1899
arsenalist 0:f4e449fa34d7 1900 /*start eth mqtt*/
arsenalist 0:f4e449fa34d7 1901 void ethMQTTMessageArrived(MQTT::MessageData& md) {
arsenalist 0:f4e449fa34d7 1902 MQTT::Message &message = md.message;
arsenalist 0:f4e449fa34d7 1903 DBG.printf("Message arrived: qos %d, retained %d, dup %d, packetid %d\r\n",
arsenalist 0:f4e449fa34d7 1904 message.qos, message.retained, message.dup, message.id);
arsenalist 0:f4e449fa34d7 1905 DBG.printf("Payload: %.*s\r\n", message.payloadlen, (char*)message.payload);
arsenalist 0:f4e449fa34d7 1906 //DBG.printf("Payload %s\r\n",message.payload);
arsenalist 0:f4e449fa34d7 1907
arsenalist 0:f4e449fa34d7 1908
arsenalist 0:f4e449fa34d7 1909 //check whether cmd is json
arsenalist 0:f4e449fa34d7 1910 //char r[255];
arsenalist 0:f4e449fa34d7 1911 char *s = (char*)message.payload;
arsenalist 0:f4e449fa34d7 1912 string sp(s);
arsenalist 0:f4e449fa34d7 1913 //sprintf(s,"%.*s",message.payloadlen, (char*)message.payload);
arsenalist 0:f4e449fa34d7 1914 //sprintf(globCmd,"%s",s);
arsenalist 0:f4e449fa34d7 1915 //DBG.printf("Payload: %s\r\n", r);
arsenalist 0:f4e449fa34d7 1916 //string cmd = r;
arsenalist 0:f4e449fa34d7 1917 //globalCommand = cmd;
arsenalist 10:1dc69e0ce7fd 1918
arsenalist 10:1dc69e0ce7fd 1919 //globalCommand = sp;
arsenalist 10:1dc69e0ce7fd 1920
arsenalist 0:f4e449fa34d7 1921 //globCmd = (char*)message.payload;
arsenalist 0:f4e449fa34d7 1922 //string globCmd((char*)message.payload);
arsenalist 0:f4e449fa34d7 1923 //std::string *sp = static_cast<std::char*>(message.payload);
arsenalist 0:f4e449fa34d7 1924 //string sp((char*)message.payload);
arsenalist 10:1dc69e0ce7fd 1925
arsenalist 10:1dc69e0ce7fd 1926 //DBG.printf("String: %s\r\n",sp.c_str());
arsenalist 10:1dc69e0ce7fd 1927
arsenalist 0:f4e449fa34d7 1928 //globCmd = sp;
arsenalist 0:f4e449fa34d7 1929
arsenalist 10:1dc69e0ce7fd 1930 //newCommand = true;
arsenalist 10:1dc69e0ce7fd 1931 if(sp.find("[") != std::string::npos && sp.find("]") != std::string::npos) {
arsenalist 10:1dc69e0ce7fd 1932 sp.erase(sp.begin(),sp.begin()+sp.find("[")+1);
arsenalist 10:1dc69e0ce7fd 1933 sp.erase(sp.begin()+sp.find("]"),sp.end());
arsenalist 10:1dc69e0ce7fd 1934 globalCommand = sp;
arsenalist 0:f4e449fa34d7 1935 newCommand = true;
arsenalist 0:f4e449fa34d7 1936 }
arsenalist 10:1dc69e0ce7fd 1937 sp.clear();
arsenalist 0:f4e449fa34d7 1938 }
arsenalist 0:f4e449fa34d7 1939
arsenalist 0:f4e449fa34d7 1940 int ethMQTTConnect(MQTT::Client<MQTTEthernet, Countdown, MQTT_MAX_PACKET_SIZE>* client, MQTTEthernet* ipstack) {
arsenalist 0:f4e449fa34d7 1941 //char hostname[] = "q.thingfabric.com";
arsenalist 0:f4e449fa34d7 1942 //char hostname[] = "192.168.131.200";
arsenalist 0:f4e449fa34d7 1943 //int rc = ipstack->connect(hostname, MQTT_PORT);
arsenalist 0:f4e449fa34d7 1944 int rc = ipstack->connect(MQTT_HOST, MQTT_PORT);
arsenalist 0:f4e449fa34d7 1945
arsenalist 0:f4e449fa34d7 1946 if(rc!=0)
arsenalist 0:f4e449fa34d7 1947 return rc;
arsenalist 0:f4e449fa34d7 1948
arsenalist 0:f4e449fa34d7 1949 //MQTT Connect
arsenalist 0:f4e449fa34d7 1950 //char clientId[] = "emma/0674ff575349896767072538";
arsenalist 0:f4e449fa34d7 1951 char clientId [32];
arsenalist 0:f4e449fa34d7 1952 sprintf(clientId,"emma/%s",emmaUID.c_str());
arsenalist 0:f4e449fa34d7 1953 //DBG.printf("clientId:%s\r\n",clientId);
arsenalist 0:f4e449fa34d7 1954 MQTTPacket_connectData data = MQTTPacket_connectData_initializer;
arsenalist 0:f4e449fa34d7 1955 data.MQTTVersion = 3;
arsenalist 0:f4e449fa34d7 1956 data.clientID.cstring = clientId;
arsenalist 0:f4e449fa34d7 1957 data.username.cstring = "761b233e-a49a-4830-a8ae-87cec3dc1086";
arsenalist 0:f4e449fa34d7 1958 data.password.cstring = "ef25cf4567fbc07113252f8d72b7faf2";
arsenalist 0:f4e449fa34d7 1959
arsenalist 0:f4e449fa34d7 1960 if((rc = client->connect(&data)) == 0) {
arsenalist 0:f4e449fa34d7 1961 DBG.printf("connected\r\n");
arsenalist 0:f4e449fa34d7 1962 }
arsenalist 0:f4e449fa34d7 1963
arsenalist 0:f4e449fa34d7 1964 //MQTT Subscribe
arsenalist 0:f4e449fa34d7 1965 //char* topic = "gaisbwqreqrfxjc/0674ff575349896767072538/command";
arsenalist 0:f4e449fa34d7 1966 char s[64];
arsenalist 0:f4e449fa34d7 1967 sprintf(s,"%s/%s/command",platformDOMAIN.c_str(),emmaUID.c_str());
arsenalist 0:f4e449fa34d7 1968 string topic = s;
arsenalist 0:f4e449fa34d7 1969 //DBG.printf("topic:%s\r\n",topic.c_str());
arsenalist 0:f4e449fa34d7 1970 if((rc=client->subscribe(topic.c_str(),MQTT::QOS0,ethMQTTMessageArrived)) == 0) {
arsenalist 0:f4e449fa34d7 1971 DBG.printf("subscribe success!\r\n");
arsenalist 0:f4e449fa34d7 1972 }
arsenalist 0:f4e449fa34d7 1973 return rc;
arsenalist 0:f4e449fa34d7 1974 }
arsenalist 0:f4e449fa34d7 1975 void ethMQTTAttemptConnect(MQTT::Client<MQTTEthernet, Countdown, MQTT_MAX_PACKET_SIZE>* client, MQTTEthernet* ipstack) {
arsenalist 0:f4e449fa34d7 1976 int retryAttempt = 0;
arsenalist 0:f4e449fa34d7 1977
arsenalist 0:f4e449fa34d7 1978 while(!ipstack->getEth().linkstatus()) {
arsenalist 0:f4e449fa34d7 1979 DBG.printf("Ethernet link not present. Check cable connection\r\n");
arsenalist 0:f4e449fa34d7 1980 wait(1);
arsenalist 0:f4e449fa34d7 1981 }
arsenalist 0:f4e449fa34d7 1982
arsenalist 0:f4e449fa34d7 1983 while(ethMQTTConnect(client,ipstack) != 0) {
arsenalist 0:f4e449fa34d7 1984 int timeout = 3;
arsenalist 0:f4e449fa34d7 1985 DBG.printf("Retry attempt number %d waiting %d\r\n", retryAttempt, timeout);
arsenalist 0:f4e449fa34d7 1986 wait(timeout);
arsenalist 0:f4e449fa34d7 1987 retryAttempt++;
arsenalist 0:f4e449fa34d7 1988 }
arsenalist 0:f4e449fa34d7 1989 }
arsenalist 0:f4e449fa34d7 1990 /*end eth mqtt*/
arsenalist 0:f4e449fa34d7 1991
arsenalist 0:f4e449fa34d7 1992 /*start emma settings*/
arsenalist 0:f4e449fa34d7 1993 string getUID(void) {
arsenalist 0:f4e449fa34d7 1994 char s[32];
arsenalist 0:f4e449fa34d7 1995 unsigned long *unique = (unsigned long *)BASE_ADDR;
arsenalist 0:f4e449fa34d7 1996 sprintf(s,"%08x%08x%08x",unique[0], unique[1], unique[2]);
arsenalist 0:f4e449fa34d7 1997 return s;
arsenalist 0:f4e449fa34d7 1998 }
arsenalist 0:f4e449fa34d7 1999
arsenalist 0:f4e449fa34d7 2000 string readSetting(string parameter) {
arsenalist 0:f4e449fa34d7 2001 FILE *fp;
arsenalist 0:f4e449fa34d7 2002 signed char c;
arsenalist 0:f4e449fa34d7 2003 int i=0;
arsenalist 0:f4e449fa34d7 2004 char s[64];
arsenalist 0:f4e449fa34d7 2005 string strS;
arsenalist 0:f4e449fa34d7 2006
arsenalist 0:f4e449fa34d7 2007 sprintf(s,"/sd/settings/%s.txt",parameter.c_str());
arsenalist 0:f4e449fa34d7 2008
arsenalist 0:f4e449fa34d7 2009 fp = fopen(s,"r");
arsenalist 0:f4e449fa34d7 2010 memset(s,0,sizeof(s));
arsenalist 0:f4e449fa34d7 2011 if(fp != NULL) {
arsenalist 0:f4e449fa34d7 2012 while(1) {
arsenalist 0:f4e449fa34d7 2013 c = fgetc(fp);
arsenalist 0:f4e449fa34d7 2014 if(c == EOF){
arsenalist 0:f4e449fa34d7 2015 break;
arsenalist 0:f4e449fa34d7 2016 }
arsenalist 0:f4e449fa34d7 2017 s[i] = c;
arsenalist 0:f4e449fa34d7 2018 i++;
arsenalist 0:f4e449fa34d7 2019 }
arsenalist 0:f4e449fa34d7 2020 strS = s;
arsenalist 0:f4e449fa34d7 2021 if(strS.find("(") != std::string::npos && strS.find(")") != std::string::npos) {
arsenalist 0:f4e449fa34d7 2022 strS.erase(strS.begin(),strS.begin()+strS.find("(")+1);
arsenalist 0:f4e449fa34d7 2023 strS.erase(strS.begin()+strS.find(")"),strS.end());
arsenalist 0:f4e449fa34d7 2024 } else {
arsenalist 0:f4e449fa34d7 2025 strS = "";
arsenalist 0:f4e449fa34d7 2026 }
arsenalist 0:f4e449fa34d7 2027 }
arsenalist 0:f4e449fa34d7 2028 fclose(fp);
arsenalist 0:f4e449fa34d7 2029 return strS;
arsenalist 0:f4e449fa34d7 2030 }
arsenalist 0:f4e449fa34d7 2031
arsenalist 0:f4e449fa34d7 2032 bool writeSetting(string parameter, string value) {
arsenalist 0:f4e449fa34d7 2033 FILE *fp;
arsenalist 0:f4e449fa34d7 2034 char s[255];
arsenalist 0:f4e449fa34d7 2035
arsenalist 0:f4e449fa34d7 2036 sprintf(s,"/sd/settings/%s.txt",parameter.c_str());
arsenalist 0:f4e449fa34d7 2037 fp = fopen(s,"w");
arsenalist 0:f4e449fa34d7 2038 if(fp != NULL) {
arsenalist 0:f4e449fa34d7 2039 fprintf(fp,value.c_str());
arsenalist 0:f4e449fa34d7 2040 fclose(fp);
arsenalist 0:f4e449fa34d7 2041 return true;
arsenalist 0:f4e449fa34d7 2042 }
arsenalist 0:f4e449fa34d7 2043 return false;
arsenalist 0:f4e449fa34d7 2044 }
arsenalist 0:f4e449fa34d7 2045 /*end emma settings*/
arsenalist 0:f4e449fa34d7 2046
arsenalist 0:f4e449fa34d7 2047 /*start emma node*/
arsenalist 0:f4e449fa34d7 2048 string readNodeIP(string macAddr) {
arsenalist 0:f4e449fa34d7 2049 FILE *fp;
arsenalist 0:f4e449fa34d7 2050 signed char c;
arsenalist 0:f4e449fa34d7 2051 int i=0;
arsenalist 0:f4e449fa34d7 2052 char s[64];
arsenalist 0:f4e449fa34d7 2053 string strS;
arsenalist 0:f4e449fa34d7 2054
arsenalist 0:f4e449fa34d7 2055 sprintf(s,"/sd/nodeList/%s/nodeIP.txt",macAddr.c_str());
arsenalist 0:f4e449fa34d7 2056
arsenalist 0:f4e449fa34d7 2057 fp = fopen(s,"r");
arsenalist 0:f4e449fa34d7 2058 memset(s,0,sizeof(s));
arsenalist 0:f4e449fa34d7 2059 if(fp != NULL) {
arsenalist 0:f4e449fa34d7 2060 while(1) {
arsenalist 0:f4e449fa34d7 2061 c = fgetc(fp);
arsenalist 0:f4e449fa34d7 2062 if(c == EOF){
arsenalist 0:f4e449fa34d7 2063 break;
arsenalist 0:f4e449fa34d7 2064 }
arsenalist 0:f4e449fa34d7 2065 s[i] = c;
arsenalist 0:f4e449fa34d7 2066 i++;
arsenalist 0:f4e449fa34d7 2067 }
arsenalist 0:f4e449fa34d7 2068 strS = s;
arsenalist 0:f4e449fa34d7 2069 if(strS.find("(") != std::string::npos && strS.find(")") != std::string::npos) {
arsenalist 0:f4e449fa34d7 2070 strS.erase(strS.begin(),strS.begin()+strS.find("(")+1);
arsenalist 0:f4e449fa34d7 2071 strS.erase(strS.begin()+strS.find(")"),strS.end());
arsenalist 0:f4e449fa34d7 2072 } else {
arsenalist 0:f4e449fa34d7 2073 strS = "";
arsenalist 0:f4e449fa34d7 2074 }
arsenalist 0:f4e449fa34d7 2075 }
arsenalist 0:f4e449fa34d7 2076 fclose(fp);
arsenalist 0:f4e449fa34d7 2077 return strS;
arsenalist 0:f4e449fa34d7 2078 }
arsenalist 0:f4e449fa34d7 2079
arsenalist 0:f4e449fa34d7 2080 string readNodeCmd(string dType, string cmd) {
arsenalist 0:f4e449fa34d7 2081 FILE *fp;
arsenalist 0:f4e449fa34d7 2082 signed char c;
arsenalist 0:f4e449fa34d7 2083 int i=0;
arsenalist 0:f4e449fa34d7 2084 char s[128];
arsenalist 0:f4e449fa34d7 2085 string strS;
arsenalist 0:f4e449fa34d7 2086
arsenalist 0:f4e449fa34d7 2087 sprintf(s,"/sd/nodeCode/%s/%s.txt",dType.c_str(),cmd.c_str());
arsenalist 0:f4e449fa34d7 2088
arsenalist 0:f4e449fa34d7 2089 fp = fopen(s,"r");
arsenalist 0:f4e449fa34d7 2090 memset(s,0,sizeof(s));
arsenalist 0:f4e449fa34d7 2091 if(fp != NULL) {
arsenalist 0:f4e449fa34d7 2092 while(1) {
arsenalist 0:f4e449fa34d7 2093 c = fgetc(fp);
arsenalist 0:f4e449fa34d7 2094 if(c == EOF){
arsenalist 0:f4e449fa34d7 2095 break;
arsenalist 0:f4e449fa34d7 2096 }
arsenalist 0:f4e449fa34d7 2097 s[i] = c;
arsenalist 0:f4e449fa34d7 2098 i++;
arsenalist 0:f4e449fa34d7 2099 }
arsenalist 0:f4e449fa34d7 2100 strS = s;
arsenalist 0:f4e449fa34d7 2101 if(strS.find("(") != std::string::npos && strS.find(")") != std::string::npos) {
arsenalist 0:f4e449fa34d7 2102 strS.erase(strS.begin(),strS.begin()+strS.find("(")+1);
arsenalist 0:f4e449fa34d7 2103 strS.erase(strS.begin()+strS.find(")"),strS.end());
arsenalist 0:f4e449fa34d7 2104 } else {
arsenalist 0:f4e449fa34d7 2105 strS = "";
arsenalist 0:f4e449fa34d7 2106 }
arsenalist 0:f4e449fa34d7 2107 }
arsenalist 0:f4e449fa34d7 2108 fclose(fp);
arsenalist 0:f4e449fa34d7 2109 return strS;
arsenalist 0:f4e449fa34d7 2110 }
arsenalist 0:f4e449fa34d7 2111
arsenalist 0:f4e449fa34d7 2112 string *readNodeList(void) {
arsenalist 0:f4e449fa34d7 2113 static string nd[10]; //max node
arsenalist 0:f4e449fa34d7 2114 DIR *d;
arsenalist 0:f4e449fa34d7 2115 struct dirent *p;
arsenalist 0:f4e449fa34d7 2116 string q;
arsenalist 0:f4e449fa34d7 2117 int i=0;
arsenalist 0:f4e449fa34d7 2118
arsenalist 0:f4e449fa34d7 2119 d = opendir("/sd/nodeList");
arsenalist 0:f4e449fa34d7 2120 if(d != NULL) {
arsenalist 0:f4e449fa34d7 2121 while((p = readdir(d)) != NULL) {
arsenalist 0:f4e449fa34d7 2122 q = p->d_name;
arsenalist 0:f4e449fa34d7 2123 nd[i] = q;
arsenalist 0:f4e449fa34d7 2124 i++;
arsenalist 0:f4e449fa34d7 2125 }
arsenalist 0:f4e449fa34d7 2126 }
arsenalist 0:f4e449fa34d7 2127 closedir(d);
arsenalist 0:f4e449fa34d7 2128 return nd;
arsenalist 0:f4e449fa34d7 2129 }
arsenalist 0:f4e449fa34d7 2130
arsenalist 0:f4e449fa34d7 2131 string wifiGetNodeTemp(string macAddr) {
arsenalist 0:f4e449fa34d7 2132 int trial=0;
arsenalist 0:f4e449fa34d7 2133 string nodeIP = readNodeIP(macAddr);
arsenalist 0:f4e449fa34d7 2134 string str;
arsenalist 0:f4e449fa34d7 2135 string temp = "0";
arsenalist 0:f4e449fa34d7 2136
arsenalist 0:f4e449fa34d7 2137 if(rest.begin(nodeIP.c_str(),REMOTE_TCP_PORT,false)) {
arsenalist 0:f4e449fa34d7 2138 while(1) {
arsenalist 0:f4e449fa34d7 2139 char rcv[256] = {};
arsenalist 0:f4e449fa34d7 2140 rest.get("/","<?xml version=\"1.0\" encoding=\"utf-8\"?><app_cmd cmd=\"2\"/>\r\n");
arsenalist 0:f4e449fa34d7 2141 rest.getResponse(rcv,sizeof(rcv));
arsenalist 0:f4e449fa34d7 2142 str = rcv;
arsenalist 0:f4e449fa34d7 2143 if(str.find("temp=") != std::string::npos) {
arsenalist 0:f4e449fa34d7 2144 str.erase(str.begin(),str.begin()+str.find("temp=")+6);
arsenalist 0:f4e449fa34d7 2145 str.erase(str.begin()+str.find("\""),str.end());
arsenalist 0:f4e449fa34d7 2146 temp = str;
arsenalist 0:f4e449fa34d7 2147 break;
arsenalist 0:f4e449fa34d7 2148 }
arsenalist 0:f4e449fa34d7 2149 if(trial>1) { //three times trial
arsenalist 0:f4e449fa34d7 2150 break;
arsenalist 0:f4e449fa34d7 2151 }
arsenalist 0:f4e449fa34d7 2152 trial++;
arsenalist 0:f4e449fa34d7 2153 wait(2);
arsenalist 0:f4e449fa34d7 2154 }
arsenalist 0:f4e449fa34d7 2155 }
arsenalist 0:f4e449fa34d7 2156 return temp;
arsenalist 0:f4e449fa34d7 2157 }
arsenalist 0:f4e449fa34d7 2158 /*end emma node*/
arsenalist 0:f4e449fa34d7 2159
arsenalist 0:f4e449fa34d7 2160 /*start emma connection function*/
arsenalist 0:f4e449fa34d7 2161 string ethGET(string host, int port, string url) {
arsenalist 0:f4e449fa34d7 2162 char buf[1024];
arsenalist 0:f4e449fa34d7 2163 char s[256];
arsenalist 0:f4e449fa34d7 2164 int ret;
arsenalist 0:f4e449fa34d7 2165 TCPSocketConnection sock;
arsenalist 0:f4e449fa34d7 2166 Timer t;
arsenalist 0:f4e449fa34d7 2167
arsenalist 0:f4e449fa34d7 2168 sprintf(s,"%s",url.c_str());
arsenalist 0:f4e449fa34d7 2169 sock.connect(host.c_str(),port);
arsenalist 0:f4e449fa34d7 2170 sock.send_all(s,sizeof(s)-1);
arsenalist 0:f4e449fa34d7 2171 wait(2);
arsenalist 0:f4e449fa34d7 2172
arsenalist 0:f4e449fa34d7 2173 //receive return
arsenalist 0:f4e449fa34d7 2174 t.start();
arsenalist 0:f4e449fa34d7 2175 while(1) {
arsenalist 0:f4e449fa34d7 2176 ret = sock.receive(buf, sizeof(buf));
arsenalist 0:f4e449fa34d7 2177 if(ret<=0 || t.read_ms() > 10000) {
arsenalist 0:f4e449fa34d7 2178 t.stop();
arsenalist 0:f4e449fa34d7 2179 break;
arsenalist 0:f4e449fa34d7 2180 }
arsenalist 0:f4e449fa34d7 2181 }
arsenalist 0:f4e449fa34d7 2182 sock.close();
arsenalist 0:f4e449fa34d7 2183 return buf;
arsenalist 0:f4e449fa34d7 2184 }
arsenalist 0:f4e449fa34d7 2185 /*end emma connection function*/
arsenalist 0:f4e449fa34d7 2186
arsenalist 0:f4e449fa34d7 2187 /*start emma private function*/
arsenalist 8:51a0ca9079ca 2188 /*
arsenalist 8:51a0ca9079ca 2189 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 2190 char s[512];
arsenalist 0:f4e449fa34d7 2191 int connPort;
arsenalist 0:f4e449fa34d7 2192 string connHost;
arsenalist 0:f4e449fa34d7 2193 string str;
arsenalist 0:f4e449fa34d7 2194 Timer t;
arsenalist 0:f4e449fa34d7 2195
arsenalist 0:f4e449fa34d7 2196 //wifi interface
arsenalist 0:f4e449fa34d7 2197 if(wifiAvailable) {
arsenalist 0:f4e449fa34d7 2198 _ESP.printf("MODE=B");
arsenalist 0:f4e449fa34d7 2199 if(useProxy) {
arsenalist 0:f4e449fa34d7 2200 connHost = proxySERVER;
arsenalist 0:f4e449fa34d7 2201 sscanf(proxyPORT.c_str(),"%d",&connPort);
arsenalist 0:f4e449fa34d7 2202 for(int i=0; i<sizeof(s); i++) {
arsenalist 0:f4e449fa34d7 2203 s[i]=0; }
arsenalist 4:76ab12e2f8a3 2204 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 2205 } else {
arsenalist 0:f4e449fa34d7 2206 connHost = EMMA_SERVER_HOST;
arsenalist 0:f4e449fa34d7 2207 connPort = EMMA_SERVER_PORT;
arsenalist 0:f4e449fa34d7 2208 for(int i=0; i<sizeof(s); i++) {
arsenalist 0:f4e449fa34d7 2209 s[i]=0; }
arsenalist 4:76ab12e2f8a3 2210 sprintf(s,"/emma/api/controller/test");
arsenalist 0:f4e449fa34d7 2211 }
arsenalist 0:f4e449fa34d7 2212 wait(1);
arsenalist 0:f4e449fa34d7 2213 t.start();
arsenalist 0:f4e449fa34d7 2214 while(!esp.ready() && t.read_ms() < 5000);
arsenalist 0:f4e449fa34d7 2215 t.stop();
arsenalist 0:f4e449fa34d7 2216 if(rest.begin(connHost.c_str(),connPort,false)) {
arsenalist 0:f4e449fa34d7 2217 //DBG.printf("rest begin\r\n");
arsenalist 0:f4e449fa34d7 2218 esp.process();
arsenalist 0:f4e449fa34d7 2219 rest.get(s);
arsenalist 0:f4e449fa34d7 2220 for(int i=0; i<sizeof(s); i++) {
arsenalist 0:f4e449fa34d7 2221 s[i]=0; }
arsenalist 0:f4e449fa34d7 2222 rest.getResponse(s,sizeof(s));
arsenalist 0:f4e449fa34d7 2223 str = s;
arsenalist 0:f4e449fa34d7 2224 //DBG.printf("response:%s\r\n",s);
arsenalist 0:f4e449fa34d7 2225 if(str.find("OK") != std::string::npos) {
arsenalist 0:f4e449fa34d7 2226 wifiConnected = true;
arsenalist 0:f4e449fa34d7 2227 }
arsenalist 0:f4e449fa34d7 2228 } else {
arsenalist 0:f4e449fa34d7 2229 wifiConnected = false;
arsenalist 0:f4e449fa34d7 2230 }
arsenalist 0:f4e449fa34d7 2231 } else {
arsenalist 0:f4e449fa34d7 2232 wifiConnected = false;
arsenalist 0:f4e449fa34d7 2233 }
arsenalist 0:f4e449fa34d7 2234
arsenalist 0:f4e449fa34d7 2235 //eth interface
arsenalist 0:f4e449fa34d7 2236 if(ethAvailable) {
arsenalist 0:f4e449fa34d7 2237 if(useProxy) {
arsenalist 0:f4e449fa34d7 2238 connHost = proxySERVER;
arsenalist 0:f4e449fa34d7 2239 sscanf(proxyPORT.c_str(),"%d",&connPort);
arsenalist 0:f4e449fa34d7 2240 for(int i=0; i<sizeof(s); i++) {
arsenalist 0:f4e449fa34d7 2241 s[i]=0; }
arsenalist 0:f4e449fa34d7 2242 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 2243 } else {
arsenalist 0:f4e449fa34d7 2244 connHost = EMMA_SERVER_HOST;
arsenalist 0:f4e449fa34d7 2245 connPort = EMMA_SERVER_PORT;
arsenalist 0:f4e449fa34d7 2246 for(int i=0; i<sizeof(s); i++) {
arsenalist 0:f4e449fa34d7 2247 s[i]=0; }
arsenalist 0:f4e449fa34d7 2248 strcpy(s,"GET /emma/api/web/test HTTP/1.0\nHost: %s\r\n\r\n");
arsenalist 0:f4e449fa34d7 2249 }
arsenalist 0:f4e449fa34d7 2250
arsenalist 0:f4e449fa34d7 2251 t.start();
arsenalist 0:f4e449fa34d7 2252 while(1) {
arsenalist 0:f4e449fa34d7 2253 str = ethGET(connHost,connPort,s);
arsenalist 0:f4e449fa34d7 2254 if(str.find("OK") != std::string::npos) {
arsenalist 0:f4e449fa34d7 2255 t.stop();
arsenalist 0:f4e449fa34d7 2256 ethConnected = true;
arsenalist 0:f4e449fa34d7 2257 break;
arsenalist 0:f4e449fa34d7 2258 }
arsenalist 0:f4e449fa34d7 2259 if(t.read_ms() > 5000) {
arsenalist 0:f4e449fa34d7 2260 t.stop();
arsenalist 0:f4e449fa34d7 2261 ethConnected = false;
arsenalist 0:f4e449fa34d7 2262 break;
arsenalist 0:f4e449fa34d7 2263 }
arsenalist 0:f4e449fa34d7 2264 }
arsenalist 0:f4e449fa34d7 2265 } else {
arsenalist 0:f4e449fa34d7 2266 ethConnected = false;
arsenalist 0:f4e449fa34d7 2267 }
arsenalist 0:f4e449fa34d7 2268
arsenalist 0:f4e449fa34d7 2269 //gprs interface
arsenalist 0:f4e449fa34d7 2270 }
arsenalist 8:51a0ca9079ca 2271 */
arsenalist 8:51a0ca9079ca 2272 void isEthAvailable(void) {
arsenalist 8:51a0ca9079ca 2273 if(ipstack.getEth().linkstatus()) {
arsenalist 8:51a0ca9079ca 2274 ethAvailable = true;
arsenalist 8:51a0ca9079ca 2275 } else {
arsenalist 8:51a0ca9079ca 2276 ethAvailable = false;
arsenalist 8:51a0ca9079ca 2277 }
arsenalist 8:51a0ca9079ca 2278 }
arsenalist 8:51a0ca9079ca 2279
arsenalist 8:51a0ca9079ca 2280 void isEthConnected(void) {
arsenalist 8:51a0ca9079ca 2281 char s[512];
arsenalist 8:51a0ca9079ca 2282 int connPort;
arsenalist 8:51a0ca9079ca 2283 string connHost;
arsenalist 8:51a0ca9079ca 2284 string str;
arsenalist 8:51a0ca9079ca 2285 Timer t;
arsenalist 8:51a0ca9079ca 2286
arsenalist 8:51a0ca9079ca 2287 if(ethAvailable) {
arsenalist 8:51a0ca9079ca 2288 if(useProxy) {
arsenalist 8:51a0ca9079ca 2289 connHost = proxySERVER;
arsenalist 8:51a0ca9079ca 2290 sscanf(proxyPORT.c_str(),"%d",&connPort);
arsenalist 8:51a0ca9079ca 2291 for(int i=0; i<sizeof(s); i++) {
arsenalist 8:51a0ca9079ca 2292 s[i]=0; }
arsenalist 8:51a0ca9079ca 2293 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 2294 } else {
arsenalist 8:51a0ca9079ca 2295 connHost = EMMA_SERVER_HOST;
arsenalist 8:51a0ca9079ca 2296 connPort = EMMA_SERVER_PORT;
arsenalist 8:51a0ca9079ca 2297 for(int i=0; i<sizeof(s); i++) {
arsenalist 8:51a0ca9079ca 2298 s[i]=0; }
arsenalist 8:51a0ca9079ca 2299 strcpy(s,"GET /emma/api/controller/test HTTP/1.0\nHost: %s\r\n\r\n");
arsenalist 8:51a0ca9079ca 2300 }
arsenalist 8:51a0ca9079ca 2301
arsenalist 8:51a0ca9079ca 2302 t.start();
arsenalist 8:51a0ca9079ca 2303 while(1) {
arsenalist 8:51a0ca9079ca 2304 str = ethGET(connHost,connPort,s);
arsenalist 8:51a0ca9079ca 2305 if(str.find("OK") != std::string::npos) {
arsenalist 8:51a0ca9079ca 2306 t.stop();
arsenalist 8:51a0ca9079ca 2307 ethConnected = true;
arsenalist 8:51a0ca9079ca 2308 break;
arsenalist 8:51a0ca9079ca 2309 }
arsenalist 8:51a0ca9079ca 2310 if(t.read_ms() > 5000) {
arsenalist 8:51a0ca9079ca 2311 t.stop();
arsenalist 8:51a0ca9079ca 2312 ethConnected = false;
arsenalist 8:51a0ca9079ca 2313 break;
arsenalist 8:51a0ca9079ca 2314 }
arsenalist 8:51a0ca9079ca 2315 }
arsenalist 8:51a0ca9079ca 2316 } else {
arsenalist 8:51a0ca9079ca 2317 ethConnected = false;
arsenalist 8:51a0ca9079ca 2318 }
arsenalist 8:51a0ca9079ca 2319 }
arsenalist 8:51a0ca9079ca 2320
arsenalist 8:51a0ca9079ca 2321 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 2322 char s[512];
arsenalist 8:51a0ca9079ca 2323 int connPort;
arsenalist 8:51a0ca9079ca 2324 string connHost;
arsenalist 8:51a0ca9079ca 2325 string str;
arsenalist 8:51a0ca9079ca 2326 Timer t;
arsenalist 8:51a0ca9079ca 2327
arsenalist 8:51a0ca9079ca 2328 if(wifiAvailable) {
arsenalist 8:51a0ca9079ca 2329 _ESP.printf("MODE=B");
arsenalist 8:51a0ca9079ca 2330 if(useProxy) {
arsenalist 8:51a0ca9079ca 2331 connHost = proxySERVER;
arsenalist 8:51a0ca9079ca 2332 sscanf(proxyPORT.c_str(),"%d",&connPort);
arsenalist 8:51a0ca9079ca 2333 for(int i=0; i<sizeof(s); i++) {
arsenalist 8:51a0ca9079ca 2334 s[i]=0; }
arsenalist 8:51a0ca9079ca 2335 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 2336 } else {
arsenalist 8:51a0ca9079ca 2337 connHost = EMMA_SERVER_HOST;
arsenalist 8:51a0ca9079ca 2338 connPort = EMMA_SERVER_PORT;
arsenalist 8:51a0ca9079ca 2339 for(int i=0; i<sizeof(s); i++) {
arsenalist 8:51a0ca9079ca 2340 s[i]=0; }
arsenalist 8:51a0ca9079ca 2341 sprintf(s,"/emma/api/controller/test");
arsenalist 8:51a0ca9079ca 2342 }
arsenalist 8:51a0ca9079ca 2343 wait(1);
arsenalist 8:51a0ca9079ca 2344 t.start();
arsenalist 8:51a0ca9079ca 2345 while(!esp.ready() && t.read_ms() < 5000);
arsenalist 8:51a0ca9079ca 2346 t.stop();
arsenalist 8:51a0ca9079ca 2347 if(rest.begin(connHost.c_str(),connPort,false)) {
arsenalist 8:51a0ca9079ca 2348 //DBG.printf("rest begin\r\n");
arsenalist 8:51a0ca9079ca 2349 esp.process();
arsenalist 8:51a0ca9079ca 2350 rest.get(s);
arsenalist 8:51a0ca9079ca 2351 for(int i=0; i<sizeof(s); i++) {
arsenalist 8:51a0ca9079ca 2352 s[i]=0; }
arsenalist 8:51a0ca9079ca 2353 rest.getResponse(s,sizeof(s));
arsenalist 8:51a0ca9079ca 2354 str = s;
arsenalist 8:51a0ca9079ca 2355 //DBG.printf("response:%s\r\n",s);
arsenalist 8:51a0ca9079ca 2356 if(str.find("OK") != std::string::npos) {
arsenalist 8:51a0ca9079ca 2357 wifiConnected = true;
arsenalist 8:51a0ca9079ca 2358 }
arsenalist 8:51a0ca9079ca 2359 } else {
arsenalist 8:51a0ca9079ca 2360 wifiConnected = false;
arsenalist 8:51a0ca9079ca 2361 }
arsenalist 8:51a0ca9079ca 2362 } else {
arsenalist 8:51a0ca9079ca 2363 wifiConnected = false;
arsenalist 8:51a0ca9079ca 2364 }
arsenalist 8:51a0ca9079ca 2365 }
arsenalist 8:51a0ca9079ca 2366
arsenalist 8:51a0ca9079ca 2367 void isGprsConnected(void) {
arsenalist 8:51a0ca9079ca 2368
arsenalist 8:51a0ca9079ca 2369 }
arsenalist 0:f4e449fa34d7 2370
arsenalist 0:f4e449fa34d7 2371 void addChar(char *s, char c) {
arsenalist 0:f4e449fa34d7 2372 uint16_t k; //customized for EMS
arsenalist 0:f4e449fa34d7 2373 k = strlen(s);
arsenalist 0:f4e449fa34d7 2374 s[k] = c;
arsenalist 0:f4e449fa34d7 2375 s[k + 1] = 0;
arsenalist 0:f4e449fa34d7 2376 }
arsenalist 0:f4e449fa34d7 2377
arsenalist 0:f4e449fa34d7 2378 void rcvReply(char *r, int to) {
arsenalist 0:f4e449fa34d7 2379 Timer t;
arsenalist 0:f4e449fa34d7 2380 bool ended = false;
arsenalist 0:f4e449fa34d7 2381 char c;
arsenalist 0:f4e449fa34d7 2382
arsenalist 0:f4e449fa34d7 2383 strcpy(r,"");
arsenalist 0:f4e449fa34d7 2384 t.start();
arsenalist 0:f4e449fa34d7 2385 while(!ended) {
arsenalist 0:f4e449fa34d7 2386 if(_ESP.readable()) {
arsenalist 0:f4e449fa34d7 2387 c = _ESP.getc();
arsenalist 0:f4e449fa34d7 2388 addChar(r,c);
arsenalist 0:f4e449fa34d7 2389 t.start();
arsenalist 0:f4e449fa34d7 2390 }
arsenalist 0:f4e449fa34d7 2391 if(t.read_ms() > to) {
arsenalist 0:f4e449fa34d7 2392 ended = true;
arsenalist 0:f4e449fa34d7 2393 }
arsenalist 0:f4e449fa34d7 2394 }
arsenalist 0:f4e449fa34d7 2395 addChar(r, 0x00);
arsenalist 0:f4e449fa34d7 2396 }
arsenalist 0:f4e449fa34d7 2397
arsenalist 0:f4e449fa34d7 2398 string calculateMD5(string text) {
arsenalist 0:f4e449fa34d7 2399 char s[64];
arsenalist 0:f4e449fa34d7 2400 memset(s,0,sizeof(s)); //for unknown reason, after reading UID, the 's' will contaion UID data
arsenalist 0:f4e449fa34d7 2401 uint8_t hash[16];
arsenalist 0:f4e449fa34d7 2402 MD5::computeHash(hash, (uint8_t*)text.c_str(), strlen(text.c_str()));
arsenalist 0:f4e449fa34d7 2403 for(int i=0; i<16; ++i) {
arsenalist 0:f4e449fa34d7 2404 sprintf(s,"%s%02x",s,hash[i]);
arsenalist 0:f4e449fa34d7 2405 }
arsenalist 0:f4e449fa34d7 2406 return s;
arsenalist 0:f4e449fa34d7 2407 }
arsenalist 0:f4e449fa34d7 2408
arsenalist 0:f4e449fa34d7 2409 bool writeFirmwareHexToChar(string value) {
arsenalist 0:f4e449fa34d7 2410 FILE *fp;
arsenalist 0:f4e449fa34d7 2411 char s[32];
arsenalist 0:f4e449fa34d7 2412 int number;
arsenalist 0:f4e449fa34d7 2413 string chunk;
arsenalist 0:f4e449fa34d7 2414
arsenalist 0:f4e449fa34d7 2415 sprintf(s,"/sd/newFirmware/firmware.bin");
arsenalist 0:f4e449fa34d7 2416 fp = fopen(s,"a");
arsenalist 0:f4e449fa34d7 2417 if(fp != NULL) {
arsenalist 0:f4e449fa34d7 2418 for(int ch=0; ch<value.size(); ch+=2) {
arsenalist 0:f4e449fa34d7 2419 chunk = value.substr(ch,2);
arsenalist 0:f4e449fa34d7 2420 sscanf(chunk.c_str(),"%x",&number);
arsenalist 0:f4e449fa34d7 2421 fprintf(fp,"%c",number);
arsenalist 0:f4e449fa34d7 2422 }
arsenalist 0:f4e449fa34d7 2423 fclose(fp);
arsenalist 0:f4e449fa34d7 2424 return true;
arsenalist 0:f4e449fa34d7 2425 }
arsenalist 0:f4e449fa34d7 2426 return false;
arsenalist 0:f4e449fa34d7 2427 }
arsenalist 0:f4e449fa34d7 2428
arsenalist 0:f4e449fa34d7 2429 bool clearFirmware(void) {
arsenalist 0:f4e449fa34d7 2430 FILE *fp;
arsenalist 0:f4e449fa34d7 2431 char s[32];
arsenalist 0:f4e449fa34d7 2432
arsenalist 0:f4e449fa34d7 2433 sprintf(s,"/sd/newFirmware/firmware.bin");
arsenalist 0:f4e449fa34d7 2434 fp = fopen(s,"w");
arsenalist 0:f4e449fa34d7 2435 if(fp != NULL) {
arsenalist 0:f4e449fa34d7 2436 fprintf(fp,"");
arsenalist 0:f4e449fa34d7 2437 fclose(fp);
arsenalist 0:f4e449fa34d7 2438 return true;
arsenalist 0:f4e449fa34d7 2439 }
arsenalist 0:f4e449fa34d7 2440 return false;
arsenalist 0:f4e449fa34d7 2441 }
arsenalist 0:f4e449fa34d7 2442 /*end emma private function*/