bontor humala / PB_Emma_Ethernet

able to subscribe for >10hrs and still running

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

Fork of PB_emma_controller_mbed_src by Emma

emmaCode.cpp@13:e8adfe305dbc, 2015-07-14 (annotated)

Committer:
arsenalist
Date:
Tue Jul 14 04:43:01 2015 +0000
Revision:
13:e8adfe305dbc
Parent:
12:96f637ed37f9
Child:
14:8287f0f5d987
Add simple lcd display in mode operation.

Who changed what in which revision?

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