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@36:ed696fd1b44e, 2015-08-14 (annotated)

Committer:
arsenalist
Date:
Fri Aug 14 15:44:01 2015 +0000
Revision:
36:ed696fd1b44e
Parent:
35:b8ba2b73201b
Child:
37:93f196daf5cf
Working simple Ethernet with MQTT. Not tested for long time.

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