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@6:45f50f1177db, 2015-07-09 (annotated)

Committer:
arsenalist
Date:
Thu Jul 09 03:11:22 2015 +0000
Revision:
6:45f50f1177db
Parent:
5:d00233dd36f5
Child:
7:7e8c6ad3fd64
Add node temp reading, and working.

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