Emma / PB_emma_controller_mbed_src

emma controller code in production board v1

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

Fork of emma_controller_energy by Emma

emmaCode.cpp@4:76ab12e2f8a3, 2015-07-08 (annotated)

Committer:
arsenalist
Date:
Wed Jul 08 13:33:14 2015 +0000
Revision:
4:76ab12e2f8a3
Parent:
3:e7fcbe6deb19
Child:
5:d00233dd36f5
Working code for reading and sending WattHR, VRMS, and Watt data with thread.

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 0:f4e449fa34d7 759 //nodeTemp
arsenalist 0:f4e449fa34d7 760 /*
arsenalist 0:f4e449fa34d7 761 if(tNodeTemp.read_ms() > 30000) {
arsenalist 0:f4e449fa34d7 762 DBG.printf("getNodeTemperature\r\n");
arsenalist 0:f4e449fa34d7 763
arsenalist 0:f4e449fa34d7 764 //get list of nodes
arsenalist 0:f4e449fa34d7 765 string *node;
arsenalist 0:f4e449fa34d7 766 node = readNodeList();
arsenalist 0:f4e449fa34d7 767
arsenalist 0:f4e449fa34d7 768 int idx=0;
arsenalist 0:f4e449fa34d7 769 while(!(node[idx].empty())) {
arsenalist 0:f4e449fa34d7 770 //get node's temperature
arsenalist 0:f4e449fa34d7 771 string nodeTemp = wifiGetNodeTemp(node[idx]);
arsenalist 0:f4e449fa34d7 772 DBG.printf("nodeTemp[%d]:%s\r\n",idx,nodeTemp.c_str());
arsenalist 0:f4e449fa34d7 773
arsenalist 0:f4e449fa34d7 774 //send node's temperature
arsenalist 0:f4e449fa34d7 775 if(rest.begin("192.168.131.200",8080,false)) {
arsenalist 0:f4e449fa34d7 776 for(int j=0; j<sizeof(s); j++) {
arsenalist 0:f4e449fa34d7 777 s[j]=0; }
arsenalist 0:f4e449fa34d7 778 sprintf(s,"{\"uid\":\"%s\",\"hmac\":\"%s\",\"time\":\"2015-06-09 12:32:12\",\"mac\":\"%s\",\"value\":%s}",
arsenalist 0:f4e449fa34d7 779 emmaUID.c_str(),hmac.c_str(),node[idx].c_str(),nodeTemp.c_str());
arsenalist 0:f4e449fa34d7 780 rest.post("/emma/api/controller/nodetemp",s);
arsenalist 0:f4e449fa34d7 781 for(int j=0; j<sizeof(s); j++) {
arsenalist 0:f4e449fa34d7 782 s[j]=0; }
arsenalist 0:f4e449fa34d7 783 rest.getResponse(s,sizeof(s));
arsenalist 0:f4e449fa34d7 784 DBG.printf("Response: %s\r\n",s);
arsenalist 0:f4e449fa34d7 785 }
arsenalist 0:f4e449fa34d7 786 idx++;
arsenalist 0:f4e449fa34d7 787 }
arsenalist 0:f4e449fa34d7 788 tNodeTemp.reset();
arsenalist 0:f4e449fa34d7 789 }
arsenalist 0:f4e449fa34d7 790 */
arsenalist 0:f4e449fa34d7 791 //publish data
arsenalist 0:f4e449fa34d7 792 //if(t.read_ms() > 30000) {
arsenalist 0:f4e449fa34d7 793 // sprintf(mqttTopic,"%s/%s/panelTemp",platformDOMAIN.c_str(),emmaUID.c_str());
arsenalist 0:f4e449fa34d7 794 // sprintf(mqttPayload,"{\"time\":\"20150615-12:32:12\",\"value\":%d}",loop);
arsenalist 0:f4e449fa34d7 795 // DBG.printf(mqttPayload);
arsenalist 0:f4e449fa34d7 796 // DBG.printf("\r\n");
arsenalist 0:f4e449fa34d7 797 // mqtt.publish(mqttTopic,mqttPayload);
arsenalist 0:f4e449fa34d7 798 //mqtt.publish("gaisbwqreqrfxjc/066eff575349896767073038/panelTemp",mqttPayload);
arsenalist 0:f4e449fa34d7 799 //mqtt.publish("gaisbwqreqrfxjc/066eff575349896767073038/panelHum",mqttPayload);
arsenalist 0:f4e449fa34d7 800 //mqtt.publish("gaisbwqreqrfxjc/066eff575349896767073038/panelGas",mqttPayload);
arsenalist 0:f4e449fa34d7 801 //mqtt.publish("gaisbwqreqrfxjc/066eff575349896767073038/panelCh1",mqttPayload);
arsenalist 0:f4e449fa34d7 802 //mqtt.publish("gaisbwqreqrfxjc/066eff575349896767073038/panelCh2",mqttPayload);
arsenalist 0:f4e449fa34d7 803 //mqtt.publish("gaisbwqreqrfxjc/066eff575349896767073038/panelCh3",mqttPayload);
arsenalist 0:f4e449fa34d7 804 //mqtt.publish("gaisbwqreqrfxjc/066eff575349896767073038/nodeTemp",mqttPayload);
arsenalist 0:f4e449fa34d7 805 //mqtt.publish("gaisbwqreqrfxjc/066eff575349896767073038/cmdExecution","success");
arsenalist 0:f4e449fa34d7 806 // loop++;
arsenalist 0:f4e449fa34d7 807 // t.reset();
arsenalist 0:f4e449fa34d7 808 //}
arsenalist 0:f4e449fa34d7 809
arsenalist 0:f4e449fa34d7 810 //check for new command
arsenalist 4:76ab12e2f8a3 811 /*
arsenalist 0:f4e449fa34d7 812 if(newCommand) {
arsenalist 0:f4e449fa34d7 813 DBG.printf("newCommand\r\n");
arsenalist 0:f4e449fa34d7 814 MbedJSONValue jsonValue;
arsenalist 0:f4e449fa34d7 815 parse(jsonValue,globalCommand.c_str());
arsenalist 0:f4e449fa34d7 816 char *parameter[5] = {"id","nType","nAddr","dType","cmd"};
arsenalist 0:f4e449fa34d7 817
arsenalist 0:f4e449fa34d7 818 //check if command is valid
arsenalist 0:f4e449fa34d7 819 bool validCommand = true;
arsenalist 0:f4e449fa34d7 820 for(int i=0; i<5; i++) {
arsenalist 0:f4e449fa34d7 821 validCommand = validCommand && jsonValue.hasMember(parameter[i]);
arsenalist 0:f4e449fa34d7 822 }
arsenalist 0:f4e449fa34d7 823 DBG.printf("command validity:%d\r\n",validCommand);
arsenalist 0:f4e449fa34d7 824
arsenalist 0:f4e449fa34d7 825 if(validCommand) {
arsenalist 0:f4e449fa34d7 826 string commandId = jsonValue[parameter[0]].get<std::string>();
arsenalist 0:f4e449fa34d7 827 string commandNType = jsonValue[parameter[1]].get<std::string>();
arsenalist 0:f4e449fa34d7 828 string commandNAddr = jsonValue[parameter[2]].get<std::string>();
arsenalist 0:f4e449fa34d7 829 string commandDType = jsonValue[parameter[3]].get<std::string>();
arsenalist 0:f4e449fa34d7 830 string commandCmd = jsonValue[parameter[4]].get<std::string>();
arsenalist 0:f4e449fa34d7 831
arsenalist 0:f4e449fa34d7 832 if(commandNType == "0") { //switch on panel controller
arsenalist 0:f4e449fa34d7 833 DBG.printf("command for switch\r\n");
arsenalist 0:f4e449fa34d7 834 }
arsenalist 0:f4e449fa34d7 835 else if(commandNType == "1") { //node with mac address
arsenalist 0:f4e449fa34d7 836 DBG.printf("command for node\r\n");
arsenalist 0:f4e449fa34d7 837 //get node ip address based on node mac address
arsenalist 1:d314a43ae6f7 838 string nodeIP;
arsenalist 1:d314a43ae6f7 839 //nodeIp = readNodeIP(commandNAddr);
arsenalist 1:d314a43ae6f7 840 nodeIP = "192.168.2.15";
arsenalist 0:f4e449fa34d7 841 //DBG.printf("nodeIP: %s\r\n",nodeIP.c_str());
arsenalist 0:f4e449fa34d7 842
arsenalist 0:f4e449fa34d7 843 //get cmd string based on device type and command number
arsenalist 1:d314a43ae6f7 844 string nodeCmd;
arsenalist 1:d314a43ae6f7 845 //nodeCmd = readNodeCmd(commandDType,commandCmd);
arsenalist 1:d314a43ae6f7 846 nodeCmd = "020129A0163B161315131613153C151316131514143C153C16141414141415151315141414141514141415141414143D1514143D141415141414143D14000D";
arsenalist 0:f4e449fa34d7 847 //DBG.printf("nodeCmd: %s\r\n",nodeCmd.c_str());
arsenalist 0:f4e449fa34d7 848
arsenalist 0:f4e449fa34d7 849 //execute command
arsenalist 0:f4e449fa34d7 850 if(rest.begin(nodeIP.c_str(),REMOTE_TCP_PORT,false)) {
arsenalist 0:f4e449fa34d7 851 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 852
arsenalist 0:f4e449fa34d7 853 int trial=0;
arsenalist 0:f4e449fa34d7 854 string execStatus = "failed";
arsenalist 0:f4e449fa34d7 855 while(1) {
arsenalist 0:f4e449fa34d7 856 char rcv[1024] = {};
arsenalist 0:f4e449fa34d7 857 rest.get("/",s);
arsenalist 0:f4e449fa34d7 858 rcvReply(rcv,2000);
arsenalist 0:f4e449fa34d7 859 str = rcv;
arsenalist 0:f4e449fa34d7 860 if(str.find("REST: Sent") != std::string::npos) {
arsenalist 0:f4e449fa34d7 861 DBG.printf("cmd executed\r\n");
arsenalist 0:f4e449fa34d7 862 execStatus = "success";
arsenalist 0:f4e449fa34d7 863 break;
arsenalist 0:f4e449fa34d7 864 }
arsenalist 0:f4e449fa34d7 865 if(trial>0) { //two times trial
arsenalist 0:f4e449fa34d7 866 DBG.printf("cmd is not executed\r\n");
arsenalist 0:f4e449fa34d7 867 break;
arsenalist 0:f4e449fa34d7 868 }
arsenalist 0:f4e449fa34d7 869 trial++;
arsenalist 0:f4e449fa34d7 870 wait(3);
arsenalist 0:f4e449fa34d7 871 }
arsenalist 0:f4e449fa34d7 872
arsenalist 0:f4e449fa34d7 873 //send execution status - mqtt
arsenalist 0:f4e449fa34d7 874 //sprintf(mqttTopic,"%s/%s/executionResult",platformDOMAIN.c_str(),emmaUID.c_str());
arsenalist 0:f4e449fa34d7 875 //sprintf(mqttPayload,"{\"id\":\"%s\",\"nType\":\"%s\",\"nAddr\":\"%s\",\"dType\":\"%s\",\"cmd\":\"%s\",\"result\":\"%s\"}",
arsenalist 0:f4e449fa34d7 876 //commandId.c_str(),commandNType.c_str(),commandNAddr.c_str(),commandDType.c_str(),commandCmd.c_str(),execStatus.c_str());
arsenalist 0:f4e449fa34d7 877 //DBG.printf(mqttPayload);
arsenalist 0:f4e449fa34d7 878 //DBG.printf("\r\n");
arsenalist 0:f4e449fa34d7 879 //mqtt.publish(mqttTopic,mqttPayload);
arsenalist 0:f4e449fa34d7 880
arsenalist 0:f4e449fa34d7 881 //send execution status - rest
arsenalist 0:f4e449fa34d7 882 wait(5);
arsenalist 0:f4e449fa34d7 883 if(rest.begin("192.168.131.200",8080,false)) {
arsenalist 0:f4e449fa34d7 884 sprintf(mqttPayload,"{\"id\":\"%s\",\"nType\":\"%s\",\"nAddr\":\"%s\",\"dType\":\"%s\",\"cmd\":\"%s\",\"result\":\"%s\"}",
arsenalist 0:f4e449fa34d7 885 commandId.c_str(),commandNType.c_str(),commandNAddr.c_str(),commandDType.c_str(),commandCmd.c_str(),execStatus.c_str());
arsenalist 0:f4e449fa34d7 886 //rest.post("/emma/api/controller/test","{\"test\": \"post\"}");
arsenalist 0:f4e449fa34d7 887 rest.post("/emma/api/controller/test",mqttPayload);
arsenalist 0:f4e449fa34d7 888 rest.getResponse(s,sizeof(s));
arsenalist 0:f4e449fa34d7 889 DBG.printf("Response: %s\r\n",s);
arsenalist 0:f4e449fa34d7 890 for(int j=0; j<sizeof(s); j++) {
arsenalist 0:f4e449fa34d7 891 s[j]=0; }
arsenalist 0:f4e449fa34d7 892 }
arsenalist 0:f4e449fa34d7 893 }
arsenalist 0:f4e449fa34d7 894 }
arsenalist 0:f4e449fa34d7 895 }
arsenalist 0:f4e449fa34d7 896 newCommand = false;
arsenalist 2:fdfdeb5fd6fd 897 }
arsenalist 4:76ab12e2f8a3 898 */
arsenalist 4:76ab12e2f8a3 899 osDelay(5000);
arsenalist 0:f4e449fa34d7 900 }
arsenalist 0:f4e449fa34d7 901 }
arsenalist 0:f4e449fa34d7 902 //operation eth
arsenalist 0:f4e449fa34d7 903 /*
arsenalist 0:f4e449fa34d7 904 DBG.printf("IP Address:%s\r\n",ipstack.getEth().getIPAddress());
arsenalist 0:f4e449fa34d7 905 DBG.printf("MAC Address:%s\r\n",ipstack.getEth().getMACAddress());
arsenalist 0:f4e449fa34d7 906 ethMQTTAttemptConnect(&client, &ipstack);
arsenalist 0:f4e449fa34d7 907 t.start();
arsenalist 0:f4e449fa34d7 908 DBG.printf("start\r\n");
arsenalist 0:f4e449fa34d7 909 while(true) {
arsenalist 0:f4e449fa34d7 910 if(!ipstack.getEth().linkstatus()) {
arsenalist 0:f4e449fa34d7 911 NVIC_SystemReset();
arsenalist 0:f4e449fa34d7 912 }
arsenalist 0:f4e449fa34d7 913 //if(t.read_ms() > 5000) {
arsenalist 0:f4e449fa34d7 914 // if(publish(&client,&ipstack) != 0)
arsenalist 0:f4e449fa34d7 915 // ethMQTTAttemptConnect(&client, &ipstack);
arsenalist 0:f4e449fa34d7 916 // t.reset();
arsenalist 0:f4e449fa34d7 917 //}
arsenalist 0:f4e449fa34d7 918
arsenalist 0:f4e449fa34d7 919 //check for new command
arsenalist 0:f4e449fa34d7 920 if(newCommand) {
arsenalist 0:f4e449fa34d7 921 DBG.printf("newCommand\r\n");
arsenalist 0:f4e449fa34d7 922 DBG.printf("globalCommand: %s\r\n",globalCommand.c_str());
arsenalist 0:f4e449fa34d7 923 //string qw(globCmd);
arsenalist 0:f4e449fa34d7 924
arsenalist 0:f4e449fa34d7 925 //if(cmd.find("[") != std::string::npos && cmd.find("]") != std::string::npos) {
arsenalist 0:f4e449fa34d7 926 // cmd.erase(cmd.begin(),cmd.begin()+cmd.find("[")+1);
arsenalist 0:f4e449fa34d7 927 // cmd.erase(cmd.begin()+cmd.find("]"),cmd.end());
arsenalist 0:f4e449fa34d7 928 //globalCommand = cmd;
arsenalist 0:f4e449fa34d7 929 //newCommand = true;
arsenalist 0:f4e449fa34d7 930 //}
arsenalist 0:f4e449fa34d7 931
arsenalist 0:f4e449fa34d7 932 MbedJSONValue jsonValue;
arsenalist 0:f4e449fa34d7 933 parse(jsonValue,globalCommand.c_str());
arsenalist 0:f4e449fa34d7 934 char *parameter[5] = {"id","nType","nAddr","dType","cmd"};
arsenalist 0:f4e449fa34d7 935
arsenalist 0:f4e449fa34d7 936 //check if command is valid
arsenalist 0:f4e449fa34d7 937 bool validCommand = true;
arsenalist 0:f4e449fa34d7 938 for(int i=0; i<5; i++) {
arsenalist 0:f4e449fa34d7 939 validCommand = validCommand && jsonValue.hasMember(parameter[i]);
arsenalist 0:f4e449fa34d7 940 }
arsenalist 0:f4e449fa34d7 941 DBG.printf("is command valid:%d\r\n",validCommand);
arsenalist 0:f4e449fa34d7 942
arsenalist 0:f4e449fa34d7 943 if(validCommand) {
arsenalist 0:f4e449fa34d7 944 string commandId = jsonValue[parameter[0]].get<std::string>();
arsenalist 0:f4e449fa34d7 945 string commandNType = jsonValue[parameter[1]].get<std::string>();
arsenalist 0:f4e449fa34d7 946 string commandNAddr = jsonValue[parameter[2]].get<std::string>();
arsenalist 0:f4e449fa34d7 947 string commandDType = jsonValue[parameter[3]].get<std::string>();
arsenalist 0:f4e449fa34d7 948 string commandCmd = jsonValue[parameter[4]].get<std::string>();
arsenalist 0:f4e449fa34d7 949
arsenalist 0:f4e449fa34d7 950 if(commandNType == "0") { //switch on panel controller
arsenalist 0:f4e449fa34d7 951 DBG.printf("command for switch\r\n");
arsenalist 0:f4e449fa34d7 952 }
arsenalist 0:f4e449fa34d7 953 else if(commandNType == "1") { //node with mac address
arsenalist 0:f4e449fa34d7 954 DBG.printf("command for node\r\n");
arsenalist 0:f4e449fa34d7 955 //get node ip address based on node mac address
arsenalist 0:f4e449fa34d7 956 string nodeIP = readNodeIP(commandNAddr);
arsenalist 0:f4e449fa34d7 957 DBG.printf("nodeIP: %s\r\n",nodeIP.c_str());
arsenalist 0:f4e449fa34d7 958
arsenalist 0:f4e449fa34d7 959 //get cmd string based on device type and command number
arsenalist 0:f4e449fa34d7 960 string nodeCmd = readNodeCmd(commandDType,commandCmd);
arsenalist 0:f4e449fa34d7 961 DBG.printf("nodeCmd: %s\r\n",nodeCmd.c_str());
arsenalist 0:f4e449fa34d7 962
arsenalist 0:f4e449fa34d7 963 //execute command
arsenalist 0:f4e449fa34d7 964 int trial=0;
arsenalist 0:f4e449fa34d7 965 string execStatus="failed";
arsenalist 0:f4e449fa34d7 966
arsenalist 0:f4e449fa34d7 967 while(1) {
arsenalist 0:f4e449fa34d7 968 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 969 str = s;
arsenalist 0:f4e449fa34d7 970 string rcv = ethGET(nodeIP,REMOTE_TCP_PORT,str);
arsenalist 0:f4e449fa34d7 971 DBG.printf("response:%s\r\n",rcv.c_str());
arsenalist 0:f4e449fa34d7 972 str = rcv;
arsenalist 0:f4e449fa34d7 973 if(str.find("OK") != std::string::npos) {
arsenalist 0:f4e449fa34d7 974 DBG.printf("cmd executed\r\n");
arsenalist 0:f4e449fa34d7 975 execStatus = "success";
arsenalist 0:f4e449fa34d7 976 break;
arsenalist 0:f4e449fa34d7 977 }
arsenalist 0:f4e449fa34d7 978 if(trial>0) { //two times trial
arsenalist 0:f4e449fa34d7 979 DBG.printf("cmd is not executed\r\n");
arsenalist 0:f4e449fa34d7 980 break;
arsenalist 0:f4e449fa34d7 981 }
arsenalist 0:f4e449fa34d7 982 trial++;
arsenalist 0:f4e449fa34d7 983 wait(3);
arsenalist 0:f4e449fa34d7 984 }
arsenalist 0:f4e449fa34d7 985
arsenalist 0:f4e449fa34d7 986 //send execution status
arsenalist 0:f4e449fa34d7 987 }
arsenalist 0:f4e449fa34d7 988 }
arsenalist 0:f4e449fa34d7 989
arsenalist 0:f4e449fa34d7 990 newCommand = false;
arsenalist 0:f4e449fa34d7 991 }
arsenalist 0:f4e449fa34d7 992 client.yield(100); //allow MQTT client to receive message
arsenalist 0:f4e449fa34d7 993 }
arsenalist 0:f4e449fa34d7 994 */
arsenalist 0:f4e449fa34d7 995
arsenalist 0:f4e449fa34d7 996 //----------------------------------------------------------------------------------
arsenalist 0:f4e449fa34d7 997 }
arsenalist 0:f4e449fa34d7 998 void emmaModeFirmwareDownload(void) {
arsenalist 0:f4e449fa34d7 999 bool emmaGetFirmwareParam = false;
arsenalist 0:f4e449fa34d7 1000
arsenalist 0:f4e449fa34d7 1001 DBG.printf("emmaModeFirmwareDownload\r\n");
arsenalist 0:f4e449fa34d7 1002
arsenalist 0:f4e449fa34d7 1003 char s[384];
arsenalist 0:f4e449fa34d7 1004 string str;
arsenalist 0:f4e449fa34d7 1005 string connData;
arsenalist 0:f4e449fa34d7 1006 string chunk;
arsenalist 0:f4e449fa34d7 1007
arsenalist 0:f4e449fa34d7 1008 //firmware parameter
arsenalist 0:f4e449fa34d7 1009 string firmwareVer;
arsenalist 0:f4e449fa34d7 1010 string firmwareName;
arsenalist 0:f4e449fa34d7 1011 int numPart;
arsenalist 0:f4e449fa34d7 1012
arsenalist 0:f4e449fa34d7 1013 //downloading
arsenalist 0:f4e449fa34d7 1014 string firmwarePart;
arsenalist 0:f4e449fa34d7 1015 string calcMD5;
arsenalist 0:f4e449fa34d7 1016 string srvrMD5;
arsenalist 0:f4e449fa34d7 1017 bool nextPart;
arsenalist 0:f4e449fa34d7 1018
arsenalist 0:f4e449fa34d7 1019 //set wifi to mode bridge
arsenalist 0:f4e449fa34d7 1020 _ESP.printf("MODE=B");
arsenalist 0:f4e449fa34d7 1021 DBG.printf("set mode bridge\r\n");
arsenalist 0:f4e449fa34d7 1022 while(1) {
arsenalist 0:f4e449fa34d7 1023 char rcv[128] = {};
arsenalist 0:f4e449fa34d7 1024 rcvReply(rcv,3000);
arsenalist 0:f4e449fa34d7 1025 str = rcv;
arsenalist 0:f4e449fa34d7 1026 if(str.find("MODE=B_OK") != std::string::npos)
arsenalist 0:f4e449fa34d7 1027 break;
arsenalist 0:f4e449fa34d7 1028 }
arsenalist 0:f4e449fa34d7 1029 DBG.printf("MODE=B\r\n");
arsenalist 0:f4e449fa34d7 1030
arsenalist 0:f4e449fa34d7 1031 esp.enable();
arsenalist 0:f4e449fa34d7 1032 wait(1);
arsenalist 0:f4e449fa34d7 1033 while(!esp.ready());
arsenalist 0:f4e449fa34d7 1034
arsenalist 0:f4e449fa34d7 1035 if(!rest.begin("candra.tritronik.com",3128,false)) {
arsenalist 0:f4e449fa34d7 1036 DBG.printf("EMMA: fail to setup rest");
arsenalist 0:f4e449fa34d7 1037 while(1);
arsenalist 0:f4e449fa34d7 1038 }
arsenalist 0:f4e449fa34d7 1039
arsenalist 0:f4e449fa34d7 1040 //wifiConnected = true; //with custom firmware, panel should connect wifi automatically
arsenalist 0:f4e449fa34d7 1041 useProxy = true;
arsenalist 0:f4e449fa34d7 1042
arsenalist 0:f4e449fa34d7 1043 esp.process();
arsenalist 0:f4e449fa34d7 1044 //set connData
arsenalist 0:f4e449fa34d7 1045 if(useProxy) {
arsenalist 0:f4e449fa34d7 1046 for(int i=0; i<sizeof(s); i++) {
arsenalist 0:f4e449fa34d7 1047 s[i]=0; }
arsenalist 0:f4e449fa34d7 1048 //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 1049 sprintf(s,"http://192.168.128.69/emmaController/firmware/firmwareParameter");
arsenalist 0:f4e449fa34d7 1050 connData = s;
arsenalist 0:f4e449fa34d7 1051 } else {
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,"/emma/api/controller/register?uid=%s&hmac=%s",emmaUID.c_str(),hmac.c_str());
arsenalist 0:f4e449fa34d7 1055 sprintf(s,"/emmaController/firmware/firmwareParameter");
arsenalist 0:f4e449fa34d7 1056 connData = s;
arsenalist 0:f4e449fa34d7 1057 }
arsenalist 0:f4e449fa34d7 1058
arsenalist 0:f4e449fa34d7 1059 //get parameter of firmware to be downloaded
arsenalist 0:f4e449fa34d7 1060 while(!emmaGetFirmwareParam) {
arsenalist 0:f4e449fa34d7 1061 rest.get(connData.c_str());
arsenalist 0:f4e449fa34d7 1062 for(int i=0; i<sizeof(s); i++) {
arsenalist 0:f4e449fa34d7 1063 s[i]=0; }
arsenalist 0:f4e449fa34d7 1064 rest.getResponse(s,sizeof(s));
arsenalist 0:f4e449fa34d7 1065 //DBG.printf("rsp param:%s\r\n",s);
arsenalist 0:f4e449fa34d7 1066
arsenalist 0:f4e449fa34d7 1067 str = s;
arsenalist 0:f4e449fa34d7 1068 if(str.find("[") != std::string::npos && str.find("]") != std::string::npos) {
arsenalist 0:f4e449fa34d7 1069 str.erase(str.begin(),str.begin()+str.find("[")+1);
arsenalist 0:f4e449fa34d7 1070 str.erase(str.begin()+str.find("]"),str.end());
arsenalist 0:f4e449fa34d7 1071
arsenalist 0:f4e449fa34d7 1072 MbedJSONValue jsonValue;
arsenalist 0:f4e449fa34d7 1073 parse(jsonValue,str.c_str());
arsenalist 0:f4e449fa34d7 1074
arsenalist 0:f4e449fa34d7 1075 char *parameter[2] = {"firmwareVer","numPart"};
arsenalist 0:f4e449fa34d7 1076
arsenalist 0:f4e449fa34d7 1077 for(int i=0; i<2; i++) {
arsenalist 0:f4e449fa34d7 1078 if(jsonValue.hasMember(parameter[i])) {
arsenalist 0:f4e449fa34d7 1079 string val = jsonValue[parameter[i]].get<std::string>();
arsenalist 0:f4e449fa34d7 1080 if(i==0) {
arsenalist 0:f4e449fa34d7 1081 firmwareVer = val;
arsenalist 0:f4e449fa34d7 1082 } else if(i==1) {
arsenalist 0:f4e449fa34d7 1083 sscanf(val.c_str(),"%d",&numPart);
arsenalist 0:f4e449fa34d7 1084 }
arsenalist 0:f4e449fa34d7 1085 }
arsenalist 0:f4e449fa34d7 1086 }
arsenalist 0:f4e449fa34d7 1087
arsenalist 0:f4e449fa34d7 1088 if(!firmwareVer.empty() && numPart!=0) {
arsenalist 0:f4e449fa34d7 1089 emmaGetFirmwareParam = true;
arsenalist 0:f4e449fa34d7 1090 }
arsenalist 0:f4e449fa34d7 1091 }
arsenalist 0:f4e449fa34d7 1092 }
arsenalist 0:f4e449fa34d7 1093 DBG.printf("firmwareVer:%s\r\n",firmwareVer.c_str());
arsenalist 0:f4e449fa34d7 1094 DBG.printf("numPart:%d\r\n",numPart);
arsenalist 0:f4e449fa34d7 1095
arsenalist 0:f4e449fa34d7 1096 //clear firmware file
arsenalist 0:f4e449fa34d7 1097 while(1) {
arsenalist 0:f4e449fa34d7 1098 if(clearFirmware()){
arsenalist 0:f4e449fa34d7 1099 DBG.printf("clear firmware on sd card\r\n\r\n");
arsenalist 0:f4e449fa34d7 1100 break;
arsenalist 0:f4e449fa34d7 1101 }
arsenalist 0:f4e449fa34d7 1102 wait(1);
arsenalist 0:f4e449fa34d7 1103 }
arsenalist 0:f4e449fa34d7 1104
arsenalist 0:f4e449fa34d7 1105 //set connData
arsenalist 0:f4e449fa34d7 1106 if(useProxy) {
arsenalist 0:f4e449fa34d7 1107 for(int i=0; i<sizeof(s); i++) {
arsenalist 0:f4e449fa34d7 1108 s[i]=0; }
arsenalist 0:f4e449fa34d7 1109 sprintf(s,"http://192.168.128.69/emmaController/firmware/%s",firmwareVer.c_str());
arsenalist 0:f4e449fa34d7 1110 connData = s;
arsenalist 0:f4e449fa34d7 1111 } else {
arsenalist 0:f4e449fa34d7 1112 for(int i=0; i<sizeof(s); i++) {
arsenalist 0:f4e449fa34d7 1113 s[i]=0; }
arsenalist 0:f4e449fa34d7 1114 sprintf(s,"/emmaController/firmware/%s",firmwareVer.c_str());
arsenalist 0:f4e449fa34d7 1115 connData = s;
arsenalist 0:f4e449fa34d7 1116 }
arsenalist 0:f4e449fa34d7 1117
arsenalist 0:f4e449fa34d7 1118 //download firmware
arsenalist 0:f4e449fa34d7 1119 for(int n=0; n<numPart; n++) {
arsenalist 0:f4e449fa34d7 1120 nextPart = false;
arsenalist 0:f4e449fa34d7 1121 while(!nextPart) {
arsenalist 0:f4e449fa34d7 1122 for(int i=0; i<sizeof(s); i++) {
arsenalist 0:f4e449fa34d7 1123 s[i]=0; }
arsenalist 0:f4e449fa34d7 1124 sprintf(s,"%s/firmware_Hex_%s_%d",connData.c_str(),firmwareVer.c_str(),n);
arsenalist 0:f4e449fa34d7 1125 rest.get(s);
arsenalist 0:f4e449fa34d7 1126 for(int i=0; i<sizeof(s); i++) {
arsenalist 0:f4e449fa34d7 1127 s[i]=0; }
arsenalist 0:f4e449fa34d7 1128 rest.getResponse(s,sizeof(s));
arsenalist 0:f4e449fa34d7 1129 //DBG.printf("rsp[%d]:%s\r\n",n,s);
arsenalist 0:f4e449fa34d7 1130
arsenalist 0:f4e449fa34d7 1131 str = s;
arsenalist 0:f4e449fa34d7 1132 if(str.find("{") != std::string::npos && str.find("}") != std::string::npos) {
arsenalist 0:f4e449fa34d7 1133 str.erase(str.begin(),str.begin()+str.find("{")+1);
arsenalist 0:f4e449fa34d7 1134 str.erase(str.begin()+str.find("}"),str.end());
arsenalist 0:f4e449fa34d7 1135 //DBG.printf("firmwarePart[%d]:%s\r\n",n,str.c_str());
arsenalist 0:f4e449fa34d7 1136 firmwarePart = str;
arsenalist 0:f4e449fa34d7 1137
arsenalist 0:f4e449fa34d7 1138 //calculated MD5
arsenalist 0:f4e449fa34d7 1139 calcMD5 = calculateMD5(firmwarePart);
arsenalist 0:f4e449fa34d7 1140 //DBG.printf("calcMD5[%d]:%s\r\n",n,calcMD5.c_str());
arsenalist 0:f4e449fa34d7 1141
arsenalist 0:f4e449fa34d7 1142 //MD5 from server
arsenalist 0:f4e449fa34d7 1143 for(int i=0; i<sizeof(s); i++) {
arsenalist 0:f4e449fa34d7 1144 s[i]=0; }
arsenalist 0:f4e449fa34d7 1145 sprintf(s,"%s/MD5/firmware_MD5_%s_%d",connData.c_str(),firmwareVer.c_str(),n);
arsenalist 0:f4e449fa34d7 1146 rest.get(s);
arsenalist 0:f4e449fa34d7 1147 for(int i=0; i<sizeof(s); i++) {
arsenalist 0:f4e449fa34d7 1148 s[i]=0; }
arsenalist 0:f4e449fa34d7 1149 rest.getResponse(s,sizeof(s));
arsenalist 0:f4e449fa34d7 1150
arsenalist 0:f4e449fa34d7 1151 str = s;
arsenalist 0:f4e449fa34d7 1152 if(str.find("{") != std::string::npos && str.find("}") != std::string::npos) {
arsenalist 0:f4e449fa34d7 1153 str.erase(str.begin(),str.begin()+str.find("{")+1);
arsenalist 0:f4e449fa34d7 1154 str.erase(str.begin()+str.find("}"),str.end());
arsenalist 0:f4e449fa34d7 1155 srvrMD5 = str;
arsenalist 0:f4e449fa34d7 1156 //DBG.printf("srvrMD5[%d]:%s\r\n",n,srvrMD5.c_str());
arsenalist 0:f4e449fa34d7 1157
arsenalist 0:f4e449fa34d7 1158 //compare original MD5 vs MD5 from server
arsenalist 0:f4e449fa34d7 1159 if(strcmp(calcMD5.c_str(),srvrMD5.c_str()) == 0) {
arsenalist 0:f4e449fa34d7 1160 //DBG.printf("MD5 correct\r\n");
arsenalist 0:f4e449fa34d7 1161
arsenalist 0:f4e449fa34d7 1162 //save to sd card
arsenalist 0:f4e449fa34d7 1163 int st = writeFirmwareHexToChar(firmwarePart);
arsenalist 0:f4e449fa34d7 1164 if(st) {
arsenalist 0:f4e449fa34d7 1165 DBG.printf("firmwarePart[%d/%d] written\r\n",n,numPart-1);
arsenalist 0:f4e449fa34d7 1166 nextPart = true;
arsenalist 0:f4e449fa34d7 1167 }
arsenalist 0:f4e449fa34d7 1168
arsenalist 0:f4e449fa34d7 1169 } else {
arsenalist 0:f4e449fa34d7 1170 DBG.printf("MD5 incorrect\r\n");
arsenalist 0:f4e449fa34d7 1171 }
arsenalist 0:f4e449fa34d7 1172 }
arsenalist 0:f4e449fa34d7 1173 } else {
arsenalist 0:f4e449fa34d7 1174 DBG.printf("retry to fetch firmwarePart[%d]\r\n",n);
arsenalist 0:f4e449fa34d7 1175 }
arsenalist 0:f4e449fa34d7 1176 wait(0.5);
arsenalist 0:f4e449fa34d7 1177 }
arsenalist 0:f4e449fa34d7 1178 }
arsenalist 0:f4e449fa34d7 1179 DBG.printf("download finished\r\n");
arsenalist 0:f4e449fa34d7 1180 }
arsenalist 0:f4e449fa34d7 1181
arsenalist 4:76ab12e2f8a3 1182 /*start energy related*/
arsenalist 0:f4e449fa34d7 1183 void energyThread(void const*) {
arsenalist 0:f4e449fa34d7 1184 while(1) {
arsenalist 0:f4e449fa34d7 1185 //DBG.printf("insideEnergyThread\r\n");
arsenalist 0:f4e449fa34d7 1186 //osDelay(5000);
arsenalist 0:f4e449fa34d7 1187
arsenalist 0:f4e449fa34d7 1188 //calculate energy
arsenalist 4:76ab12e2f8a3 1189 DBG.printf("energyThread-start\r\n");
arsenalist 0:f4e449fa34d7 1190 float period = 0;
arsenalist 0:f4e449fa34d7 1191 AWattHrSum = 0;
arsenalist 0:f4e449fa34d7 1192 BWattHrSum = 0;
arsenalist 0:f4e449fa34d7 1193 CWattHrSum = 0;
arsenalist 0:f4e449fa34d7 1194 while(period < 1*60.0) {
arsenalist 0:f4e449fa34d7 1195 period += ADE.getAccumulationTime(PHASE_A);
arsenalist 0:f4e449fa34d7 1196 ADE.getAccumulatedEnergy(PHASE_A, &AWattHrValue, &BWattHrValue, &CWattHrValue, &AVAHrValue, &BVAHrValue, &CVAHrValue);
arsenalist 0:f4e449fa34d7 1197 AWattHrSum += AWattHrValue;
arsenalist 0:f4e449fa34d7 1198 BWattHrSum += BWattHrValue;
arsenalist 0:f4e449fa34d7 1199 CWattHrSum += CWattHrValue;
arsenalist 0:f4e449fa34d7 1200 }
arsenalist 0:f4e449fa34d7 1201 AWattHr = AWattHrSum * ADE.AWhLSB;
arsenalist 0:f4e449fa34d7 1202 BWattHr = BWattHrSum * ADE.BWhLSB;
arsenalist 0:f4e449fa34d7 1203 CWattHr = CWattHrSum * ADE.CWhLSB;
arsenalist 0:f4e449fa34d7 1204
arsenalist 4:76ab12e2f8a3 1205 DBG.printf("energyThread-finish\r\n");
arsenalist 0:f4e449fa34d7 1206 }
arsenalist 0:f4e449fa34d7 1207 }
arsenalist 4:76ab12e2f8a3 1208 void checkVoltagePower() {
arsenalist 4:76ab12e2f8a3 1209 //check if voltage or power violates threshold
arsenalist 4:76ab12e2f8a3 1210 char s[256];
arsenalist 4:76ab12e2f8a3 1211 string str;
arsenalist 4:76ab12e2f8a3 1212
arsenalist 4:76ab12e2f8a3 1213 //DBG.printf("checkVoltagePower-start\r\n");
arsenalist 4:76ab12e2f8a3 1214
arsenalist 4:76ab12e2f8a3 1215 AVrms = ADE.VRMS(PHASE_A) * 2*0.000158; //constants are from calculateVRMS function
arsenalist 4:76ab12e2f8a3 1216 BVrms = ADE.VRMS(PHASE_B) * 2*0.000157;
arsenalist 4:76ab12e2f8a3 1217 CVrms = ADE.VRMS(PHASE_C) * 2*0.000156;
arsenalist 4:76ab12e2f8a3 1218
arsenalist 4:76ab12e2f8a3 1219 AIrms = ADE.IRMS(PHASE_A) * 0.0000125; //constants are from calculateIRMS function
arsenalist 4:76ab12e2f8a3 1220 BIrms = ADE.IRMS(PHASE_B) * 0.0000123;
arsenalist 4:76ab12e2f8a3 1221 CIrms = ADE.IRMS(PHASE_C) * 0.0000124;
arsenalist 4:76ab12e2f8a3 1222
arsenalist 4:76ab12e2f8a3 1223 AWatt = AVrms * AIrms;
arsenalist 4:76ab12e2f8a3 1224 BWatt = BVrms * BIrms;
arsenalist 4:76ab12e2f8a3 1225 CWatt = CVrms * CIrms;
arsenalist 4:76ab12e2f8a3 1226
arsenalist 4:76ab12e2f8a3 1227 if(AVrms > VRMSTHRESHOLD || AWatt > WATTTHRESHOLD) {
arsenalist 4:76ab12e2f8a3 1228 DBG.printf("alert on ch1\r\n");
arsenalist 4:76ab12e2f8a3 1229 sprintf(s,"{\"uid\":\"%s\",\"hmac\":\"%s\",\"time\":\"2015-06-09 12:32:12\",\"voltage\":%.2f,\"power\":%.2f}",
arsenalist 4:76ab12e2f8a3 1230 emmaUID.c_str(),hmac.c_str(),AVrms,AWatt);
arsenalist 4:76ab12e2f8a3 1231 rest.post("/emma/api/controller/alert/1",s);
arsenalist 4:76ab12e2f8a3 1232 wait(2);
arsenalist 4:76ab12e2f8a3 1233 str = rxBuf;
arsenalist 4:76ab12e2f8a3 1234 if(str.rfind("/alert/1") != std::string::npos) {
arsenalist 4:76ab12e2f8a3 1235 str.erase(str.begin(),str.begin()+str.rfind("/alert/1"));
arsenalist 4:76ab12e2f8a3 1236 if(str.find("\"status\":\"success\"") != std::string::npos) {
arsenalist 4:76ab12e2f8a3 1237 DBG.printf("send alert ch1 success\r\n");
arsenalist 4:76ab12e2f8a3 1238 } else {
arsenalist 4:76ab12e2f8a3 1239 DBG.printf("send alert ch1 failed\r\n");
arsenalist 4:76ab12e2f8a3 1240 }
arsenalist 4:76ab12e2f8a3 1241 }
arsenalist 4:76ab12e2f8a3 1242 }
arsenalist 4:76ab12e2f8a3 1243
arsenalist 4:76ab12e2f8a3 1244 if(BVrms > VRMSTHRESHOLD || BWatt > WATTTHRESHOLD) {
arsenalist 4:76ab12e2f8a3 1245 DBG.printf("alert on ch2\r\n");
arsenalist 4:76ab12e2f8a3 1246 sprintf(s,"{\"uid\":\"%s\",\"hmac\":\"%s\",\"time\":\"2015-06-09 12:32:12\",\"voltage\":%.2f,\"power\":%.2f}",
arsenalist 4:76ab12e2f8a3 1247 emmaUID.c_str(),hmac.c_str(),BVrms,BWatt);
arsenalist 4:76ab12e2f8a3 1248 rest.post("/emma/api/controller/alert/2",s);
arsenalist 4:76ab12e2f8a3 1249 wait(2);
arsenalist 4:76ab12e2f8a3 1250 str = rxBuf;
arsenalist 4:76ab12e2f8a3 1251 if(str.rfind("/alert/2") != std::string::npos) {
arsenalist 4:76ab12e2f8a3 1252 str.erase(str.begin(),str.begin()+str.rfind("/alert/2"));
arsenalist 4:76ab12e2f8a3 1253 if(str.find("\"status\":\"success\"") != std::string::npos) {
arsenalist 4:76ab12e2f8a3 1254 DBG.printf("send alert ch2 success\r\n");
arsenalist 4:76ab12e2f8a3 1255 } else {
arsenalist 4:76ab12e2f8a3 1256 DBG.printf("send alert ch2 failed\r\n");
arsenalist 4:76ab12e2f8a3 1257 }
arsenalist 4:76ab12e2f8a3 1258 }
arsenalist 4:76ab12e2f8a3 1259 }
arsenalist 4:76ab12e2f8a3 1260
arsenalist 4:76ab12e2f8a3 1261 if(CVrms > VRMSTHRESHOLD || CWatt > WATTTHRESHOLD) {
arsenalist 4:76ab12e2f8a3 1262 DBG.printf("alert on channel C\r\n");
arsenalist 4:76ab12e2f8a3 1263 DBG.printf("alert on ch3\r\n");
arsenalist 4:76ab12e2f8a3 1264 sprintf(s,"{\"uid\":\"%s\",\"hmac\":\"%s\",\"time\":\"2015-06-09 12:32:12\",\"voltage\":%.2f,\"power\":%.2f}",
arsenalist 4:76ab12e2f8a3 1265 emmaUID.c_str(),hmac.c_str(),CVrms,CWatt);
arsenalist 4:76ab12e2f8a3 1266 rest.post("/emma/api/controller/alert/3",s);
arsenalist 4:76ab12e2f8a3 1267 wait(2);
arsenalist 4:76ab12e2f8a3 1268 str = rxBuf;
arsenalist 4:76ab12e2f8a3 1269 if(str.rfind("/alert/3") != std::string::npos) {
arsenalist 4:76ab12e2f8a3 1270 str.erase(str.begin(),str.begin()+str.rfind("/alert/3"));
arsenalist 4:76ab12e2f8a3 1271 if(str.find("\"status\":\"success\"") != std::string::npos) {
arsenalist 4:76ab12e2f8a3 1272 DBG.printf("send alert ch3 success\r\n");
arsenalist 4:76ab12e2f8a3 1273 } else {
arsenalist 4:76ab12e2f8a3 1274 DBG.printf("send alert ch3 failed\r\n");
arsenalist 4:76ab12e2f8a3 1275 }
arsenalist 4:76ab12e2f8a3 1276 }
arsenalist 4:76ab12e2f8a3 1277 }
arsenalist 4:76ab12e2f8a3 1278 //DBG.printf("checkVoltagePower-finish\r\n");
arsenalist 4:76ab12e2f8a3 1279 }
arsenalist 4:76ab12e2f8a3 1280 /*end energy related*/
arsenalist 0:f4e449fa34d7 1281
arsenalist 0:f4e449fa34d7 1282 /*start wifi mqtt*/
arsenalist 0:f4e449fa34d7 1283 void wifiCb(void* response) {
arsenalist 0:f4e449fa34d7 1284 uint32_t status;
arsenalist 0:f4e449fa34d7 1285 RESPONSE res(response);
arsenalist 0:f4e449fa34d7 1286
arsenalist 0:f4e449fa34d7 1287 if(res.getArgc() == 1) {
arsenalist 0:f4e449fa34d7 1288 res.popArgs((uint8_t*)&status,4);
arsenalist 0:f4e449fa34d7 1289 if(status == STATION_GOT_IP) {
arsenalist 0:f4e449fa34d7 1290 DBG.printf("WIFI Connected\r\n");
arsenalist 0:f4e449fa34d7 1291 mqtt.connect(MQTT_HOST,MQTT_PORT,false);
arsenalist 0:f4e449fa34d7 1292 wifiConnected = true;
arsenalist 0:f4e449fa34d7 1293 }
arsenalist 0:f4e449fa34d7 1294 else {
arsenalist 0:f4e449fa34d7 1295 wifiConnected = false;
arsenalist 0:f4e449fa34d7 1296 mqtt.disconnect();
arsenalist 0:f4e449fa34d7 1297 }
arsenalist 0:f4e449fa34d7 1298 }
arsenalist 0:f4e449fa34d7 1299 }
arsenalist 0:f4e449fa34d7 1300 void mqttConnected(void* response) {
arsenalist 1:d314a43ae6f7 1301 DBG.printf("MQTT Connected\r\n");
arsenalist 0:f4e449fa34d7 1302 char mqttTopic[64];
arsenalist 0:f4e449fa34d7 1303 sprintf(mqttTopic,"%s/%s/command",platformDOMAIN.c_str(),emmaUID.c_str());
arsenalist 0:f4e449fa34d7 1304 mqtt.subscribe(mqttTopic);
arsenalist 0:f4e449fa34d7 1305 }
arsenalist 0:f4e449fa34d7 1306 void mqttDisconnected(void* response) {
arsenalist 1:d314a43ae6f7 1307 DBG.printf("MQTT Disconnected\r\n");
arsenalist 0:f4e449fa34d7 1308 }
arsenalist 0:f4e449fa34d7 1309 void mqttData(void* response) {
arsenalist 0:f4e449fa34d7 1310 RESPONSE res(response);
arsenalist 0:f4e449fa34d7 1311
arsenalist 0:f4e449fa34d7 1312 //DBG.printf("Received:\r\n");
arsenalist 0:f4e449fa34d7 1313 //DBG.printf("topic=");
arsenalist 0:f4e449fa34d7 1314 string topic = res.popString();
arsenalist 0:f4e449fa34d7 1315 DBG.printf(topic.c_str());
arsenalist 0:f4e449fa34d7 1316 DBG.printf("\r\n");
arsenalist 0:f4e449fa34d7 1317
arsenalist 0:f4e449fa34d7 1318 //DBG.printf("command=");
arsenalist 0:f4e449fa34d7 1319 string cmd = res.popString();
arsenalist 0:f4e449fa34d7 1320 DBG.printf(cmd.c_str());
arsenalist 0:f4e449fa34d7 1321 DBG.printf("\r\n");
arsenalist 0:f4e449fa34d7 1322
arsenalist 0:f4e449fa34d7 1323 //check whether cmd is json
arsenalist 0:f4e449fa34d7 1324 if(cmd.find("[") != std::string::npos && cmd.find("]") != std::string::npos) {
arsenalist 0:f4e449fa34d7 1325 cmd.erase(cmd.begin(),cmd.begin()+cmd.find("[")+1);
arsenalist 0:f4e449fa34d7 1326 cmd.erase(cmd.begin()+cmd.find("]"),cmd.end());
arsenalist 0:f4e449fa34d7 1327 globalCommand = cmd;
arsenalist 0:f4e449fa34d7 1328 newCommand = true;
arsenalist 0:f4e449fa34d7 1329 }
arsenalist 0:f4e449fa34d7 1330 }
arsenalist 0:f4e449fa34d7 1331 void mqttPublished(void* response) {
arsenalist 0:f4e449fa34d7 1332 }
arsenalist 0:f4e449fa34d7 1333 /*end wifi mqtt*/
arsenalist 0:f4e449fa34d7 1334
arsenalist 0:f4e449fa34d7 1335 /*start wifi rest*/
arsenalist 0:f4e449fa34d7 1336 void restWifiCb(void* response) {
arsenalist 0:f4e449fa34d7 1337 uint32_t status;
arsenalist 0:f4e449fa34d7 1338 RESPONSE res(response);
arsenalist 0:f4e449fa34d7 1339
arsenalist 0:f4e449fa34d7 1340 if(res.getArgc() == 1) {
arsenalist 0:f4e449fa34d7 1341 res.popArgs((uint8_t*)&status,4);
arsenalist 0:f4e449fa34d7 1342 if(status == STATION_GOT_IP) {
arsenalist 0:f4e449fa34d7 1343 DBG.printf("WIFI Connected\r\n");
arsenalist 0:f4e449fa34d7 1344 wifiConnected = true;
arsenalist 0:f4e449fa34d7 1345 }
arsenalist 0:f4e449fa34d7 1346 else {
arsenalist 0:f4e449fa34d7 1347 wifiConnected = false;
arsenalist 0:f4e449fa34d7 1348 }
arsenalist 0:f4e449fa34d7 1349 }
arsenalist 0:f4e449fa34d7 1350 }
arsenalist 4:76ab12e2f8a3 1351 void rxInterrupt(void) {
arsenalist 4:76ab12e2f8a3 1352 char c;
arsenalist 4:76ab12e2f8a3 1353
arsenalist 4:76ab12e2f8a3 1354 while(_ESP.readable()) {
arsenalist 4:76ab12e2f8a3 1355 c = _ESP.getc();
arsenalist 4:76ab12e2f8a3 1356 if(c != 0) { //char is not null
arsenalist 4:76ab12e2f8a3 1357 rxBuf += c;
arsenalist 4:76ab12e2f8a3 1358 }
arsenalist 4:76ab12e2f8a3 1359 }
arsenalist 4:76ab12e2f8a3 1360 }
arsenalist 4:76ab12e2f8a3 1361 void checkRxBuffer(void) {
arsenalist 4:76ab12e2f8a3 1362 //check new command
arsenalist 4:76ab12e2f8a3 1363 if(rxBuf.rfind("/command") != std::string::npos) {
arsenalist 4:76ab12e2f8a3 1364 rxBuf.erase(rxBuf.begin(),rxBuf.begin()+rxBuf.rfind("/command"));
arsenalist 4:76ab12e2f8a3 1365 if(rxBuf.find("[{") != std::string::npos && rxBuf.find("}]") != std::string::npos) {
arsenalist 4:76ab12e2f8a3 1366 rxBuf.erase(rxBuf.begin(),rxBuf.begin()+rxBuf.find("[{")+1);
arsenalist 4:76ab12e2f8a3 1367 rxBuf.erase(rxBuf.begin()+rxBuf.find("]"),rxBuf.end());
arsenalist 4:76ab12e2f8a3 1368 globalCommand = rxBuf;
arsenalist 4:76ab12e2f8a3 1369 //DBG.printf("gC:%s\r\n",globalCommand.c_str());
arsenalist 4:76ab12e2f8a3 1370 newCommand = true;
arsenalist 4:76ab12e2f8a3 1371 }
arsenalist 4:76ab12e2f8a3 1372 }
arsenalist 4:76ab12e2f8a3 1373
arsenalist 4:76ab12e2f8a3 1374 //clear rxBuf
arsenalist 4:76ab12e2f8a3 1375 rxBuf.clear();
arsenalist 4:76ab12e2f8a3 1376 }
arsenalist 0:f4e449fa34d7 1377 /*end wifi rest*/
arsenalist 0:f4e449fa34d7 1378
arsenalist 0:f4e449fa34d7 1379 /*start eth mqtt*/
arsenalist 0:f4e449fa34d7 1380 void ethMQTTMessageArrived(MQTT::MessageData& md) {
arsenalist 0:f4e449fa34d7 1381 MQTT::Message &message = md.message;
arsenalist 0:f4e449fa34d7 1382 DBG.printf("Message arrived: qos %d, retained %d, dup %d, packetid %d\r\n",
arsenalist 0:f4e449fa34d7 1383 message.qos, message.retained, message.dup, message.id);
arsenalist 0:f4e449fa34d7 1384 DBG.printf("Payload: %.*s\r\n", message.payloadlen, (char*)message.payload);
arsenalist 0:f4e449fa34d7 1385 //DBG.printf("Payload %s\r\n",message.payload);
arsenalist 0:f4e449fa34d7 1386
arsenalist 0:f4e449fa34d7 1387
arsenalist 0:f4e449fa34d7 1388 //check whether cmd is json
arsenalist 0:f4e449fa34d7 1389 //char r[255];
arsenalist 0:f4e449fa34d7 1390 char *s = (char*)message.payload;
arsenalist 0:f4e449fa34d7 1391 string sp(s);
arsenalist 0:f4e449fa34d7 1392 //sprintf(s,"%.*s",message.payloadlen, (char*)message.payload);
arsenalist 0:f4e449fa34d7 1393 //sprintf(globCmd,"%s",s);
arsenalist 0:f4e449fa34d7 1394 //DBG.printf("Payload: %s\r\n", r);
arsenalist 0:f4e449fa34d7 1395 //string cmd = r;
arsenalist 0:f4e449fa34d7 1396 //globalCommand = cmd;
arsenalist 0:f4e449fa34d7 1397 globalCommand = sp;
arsenalist 0:f4e449fa34d7 1398 //globCmd = (char*)message.payload;
arsenalist 0:f4e449fa34d7 1399 //string globCmd((char*)message.payload);
arsenalist 0:f4e449fa34d7 1400 //std::string *sp = static_cast<std::char*>(message.payload);
arsenalist 0:f4e449fa34d7 1401 //string sp((char*)message.payload);
arsenalist 0:f4e449fa34d7 1402 DBG.printf("String: %s\r\n",sp.c_str());
arsenalist 0:f4e449fa34d7 1403 //globCmd = sp;
arsenalist 0:f4e449fa34d7 1404
arsenalist 0:f4e449fa34d7 1405 newCommand = true;
arsenalist 0:f4e449fa34d7 1406 /*
arsenalist 0:f4e449fa34d7 1407 if(cmd.find("[") != std::string::npos && cmd.find("]") != std::string::npos) {
arsenalist 0:f4e449fa34d7 1408 cmd.erase(cmd.begin(),cmd.begin()+cmd.find("[")+1);
arsenalist 0:f4e449fa34d7 1409 cmd.erase(cmd.begin()+cmd.find("]"),cmd.end());
arsenalist 0:f4e449fa34d7 1410 globalCommand = cmd;
arsenalist 0:f4e449fa34d7 1411 newCommand = true;
arsenalist 0:f4e449fa34d7 1412 }
arsenalist 0:f4e449fa34d7 1413 */
arsenalist 0:f4e449fa34d7 1414 }
arsenalist 0:f4e449fa34d7 1415
arsenalist 0:f4e449fa34d7 1416 int ethMQTTConnect(MQTT::Client<MQTTEthernet, Countdown, MQTT_MAX_PACKET_SIZE>* client, MQTTEthernet* ipstack) {
arsenalist 0:f4e449fa34d7 1417 //char hostname[] = "q.thingfabric.com";
arsenalist 0:f4e449fa34d7 1418 //char hostname[] = "192.168.131.200";
arsenalist 0:f4e449fa34d7 1419 //int rc = ipstack->connect(hostname, MQTT_PORT);
arsenalist 0:f4e449fa34d7 1420 int rc = ipstack->connect(MQTT_HOST, MQTT_PORT);
arsenalist 0:f4e449fa34d7 1421
arsenalist 0:f4e449fa34d7 1422 if(rc!=0)
arsenalist 0:f4e449fa34d7 1423 return rc;
arsenalist 0:f4e449fa34d7 1424
arsenalist 0:f4e449fa34d7 1425 //MQTT Connect
arsenalist 0:f4e449fa34d7 1426 //char clientId[] = "emma/0674ff575349896767072538";
arsenalist 0:f4e449fa34d7 1427 char clientId [32];
arsenalist 0:f4e449fa34d7 1428 sprintf(clientId,"emma/%s",emmaUID.c_str());
arsenalist 0:f4e449fa34d7 1429 //DBG.printf("clientId:%s\r\n",clientId);
arsenalist 0:f4e449fa34d7 1430 MQTTPacket_connectData data = MQTTPacket_connectData_initializer;
arsenalist 0:f4e449fa34d7 1431 data.MQTTVersion = 3;
arsenalist 0:f4e449fa34d7 1432 data.clientID.cstring = clientId;
arsenalist 0:f4e449fa34d7 1433 data.username.cstring = "761b233e-a49a-4830-a8ae-87cec3dc1086";
arsenalist 0:f4e449fa34d7 1434 data.password.cstring = "ef25cf4567fbc07113252f8d72b7faf2";
arsenalist 0:f4e449fa34d7 1435
arsenalist 0:f4e449fa34d7 1436 if((rc = client->connect(&data)) == 0) {
arsenalist 0:f4e449fa34d7 1437 DBG.printf("connected\r\n");
arsenalist 0:f4e449fa34d7 1438 }
arsenalist 0:f4e449fa34d7 1439
arsenalist 0:f4e449fa34d7 1440 //MQTT Subscribe
arsenalist 0:f4e449fa34d7 1441 //char* topic = "gaisbwqreqrfxjc/0674ff575349896767072538/command";
arsenalist 0:f4e449fa34d7 1442 char s[64];
arsenalist 0:f4e449fa34d7 1443 sprintf(s,"%s/%s/command",platformDOMAIN.c_str(),emmaUID.c_str());
arsenalist 0:f4e449fa34d7 1444 string topic = s;
arsenalist 0:f4e449fa34d7 1445 //DBG.printf("topic:%s\r\n",topic.c_str());
arsenalist 0:f4e449fa34d7 1446 if((rc=client->subscribe(topic.c_str(),MQTT::QOS0,ethMQTTMessageArrived)) == 0) {
arsenalist 0:f4e449fa34d7 1447 DBG.printf("subscribe success!\r\n");
arsenalist 0:f4e449fa34d7 1448 }
arsenalist 0:f4e449fa34d7 1449 return rc;
arsenalist 0:f4e449fa34d7 1450 }
arsenalist 0:f4e449fa34d7 1451 void ethMQTTAttemptConnect(MQTT::Client<MQTTEthernet, Countdown, MQTT_MAX_PACKET_SIZE>* client, MQTTEthernet* ipstack) {
arsenalist 0:f4e449fa34d7 1452 int retryAttempt = 0;
arsenalist 0:f4e449fa34d7 1453
arsenalist 0:f4e449fa34d7 1454 while(!ipstack->getEth().linkstatus()) {
arsenalist 0:f4e449fa34d7 1455 DBG.printf("Ethernet link not present. Check cable connection\r\n");
arsenalist 0:f4e449fa34d7 1456 wait(1);
arsenalist 0:f4e449fa34d7 1457 }
arsenalist 0:f4e449fa34d7 1458
arsenalist 0:f4e449fa34d7 1459 while(ethMQTTConnect(client,ipstack) != 0) {
arsenalist 0:f4e449fa34d7 1460 int timeout = 3;
arsenalist 0:f4e449fa34d7 1461 DBG.printf("Retry attempt number %d waiting %d\r\n", retryAttempt, timeout);
arsenalist 0:f4e449fa34d7 1462 wait(timeout);
arsenalist 0:f4e449fa34d7 1463 retryAttempt++;
arsenalist 0:f4e449fa34d7 1464 }
arsenalist 0:f4e449fa34d7 1465 }
arsenalist 0:f4e449fa34d7 1466 /*end eth mqtt*/
arsenalist 0:f4e449fa34d7 1467
arsenalist 0:f4e449fa34d7 1468 /*start emma settings*/
arsenalist 0:f4e449fa34d7 1469 string getUID(void) {
arsenalist 0:f4e449fa34d7 1470 char s[32];
arsenalist 0:f4e449fa34d7 1471 unsigned long *unique = (unsigned long *)BASE_ADDR;
arsenalist 0:f4e449fa34d7 1472 sprintf(s,"%08x%08x%08x",unique[0], unique[1], unique[2]);
arsenalist 0:f4e449fa34d7 1473 return s;
arsenalist 0:f4e449fa34d7 1474 }
arsenalist 0:f4e449fa34d7 1475
arsenalist 0:f4e449fa34d7 1476 string readSetting(string parameter) {
arsenalist 0:f4e449fa34d7 1477 FILE *fp;
arsenalist 0:f4e449fa34d7 1478 signed char c;
arsenalist 0:f4e449fa34d7 1479 int i=0;
arsenalist 0:f4e449fa34d7 1480 char s[64];
arsenalist 0:f4e449fa34d7 1481 string strS;
arsenalist 0:f4e449fa34d7 1482
arsenalist 0:f4e449fa34d7 1483 sprintf(s,"/sd/settings/%s.txt",parameter.c_str());
arsenalist 0:f4e449fa34d7 1484
arsenalist 0:f4e449fa34d7 1485 fp = fopen(s,"r");
arsenalist 0:f4e449fa34d7 1486 memset(s,0,sizeof(s));
arsenalist 0:f4e449fa34d7 1487 if(fp != NULL) {
arsenalist 0:f4e449fa34d7 1488 while(1) {
arsenalist 0:f4e449fa34d7 1489 c = fgetc(fp);
arsenalist 0:f4e449fa34d7 1490 if(c == EOF){
arsenalist 0:f4e449fa34d7 1491 break;
arsenalist 0:f4e449fa34d7 1492 }
arsenalist 0:f4e449fa34d7 1493 s[i] = c;
arsenalist 0:f4e449fa34d7 1494 i++;
arsenalist 0:f4e449fa34d7 1495 }
arsenalist 0:f4e449fa34d7 1496 strS = s;
arsenalist 0:f4e449fa34d7 1497 if(strS.find("(") != std::string::npos && strS.find(")") != std::string::npos) {
arsenalist 0:f4e449fa34d7 1498 strS.erase(strS.begin(),strS.begin()+strS.find("(")+1);
arsenalist 0:f4e449fa34d7 1499 strS.erase(strS.begin()+strS.find(")"),strS.end());
arsenalist 0:f4e449fa34d7 1500 } else {
arsenalist 0:f4e449fa34d7 1501 strS = "";
arsenalist 0:f4e449fa34d7 1502 }
arsenalist 0:f4e449fa34d7 1503 }
arsenalist 0:f4e449fa34d7 1504 fclose(fp);
arsenalist 0:f4e449fa34d7 1505 return strS;
arsenalist 0:f4e449fa34d7 1506 }
arsenalist 0:f4e449fa34d7 1507
arsenalist 0:f4e449fa34d7 1508 bool writeSetting(string parameter, string value) {
arsenalist 0:f4e449fa34d7 1509 FILE *fp;
arsenalist 0:f4e449fa34d7 1510 char s[255];
arsenalist 0:f4e449fa34d7 1511
arsenalist 0:f4e449fa34d7 1512 sprintf(s,"/sd/settings/%s.txt",parameter.c_str());
arsenalist 0:f4e449fa34d7 1513 fp = fopen(s,"w");
arsenalist 0:f4e449fa34d7 1514 if(fp != NULL) {
arsenalist 0:f4e449fa34d7 1515 fprintf(fp,value.c_str());
arsenalist 0:f4e449fa34d7 1516 fclose(fp);
arsenalist 0:f4e449fa34d7 1517 return true;
arsenalist 0:f4e449fa34d7 1518 }
arsenalist 0:f4e449fa34d7 1519 return false;
arsenalist 0:f4e449fa34d7 1520 }
arsenalist 0:f4e449fa34d7 1521 /*end emma settings*/
arsenalist 0:f4e449fa34d7 1522
arsenalist 0:f4e449fa34d7 1523 /*start emma node*/
arsenalist 0:f4e449fa34d7 1524 string readNodeIP(string macAddr) {
arsenalist 0:f4e449fa34d7 1525 FILE *fp;
arsenalist 0:f4e449fa34d7 1526 signed char c;
arsenalist 0:f4e449fa34d7 1527 int i=0;
arsenalist 0:f4e449fa34d7 1528 char s[64];
arsenalist 0:f4e449fa34d7 1529 string strS;
arsenalist 0:f4e449fa34d7 1530
arsenalist 0:f4e449fa34d7 1531 sprintf(s,"/sd/nodeList/%s/nodeIP.txt",macAddr.c_str());
arsenalist 0:f4e449fa34d7 1532
arsenalist 0:f4e449fa34d7 1533 fp = fopen(s,"r");
arsenalist 0:f4e449fa34d7 1534 memset(s,0,sizeof(s));
arsenalist 0:f4e449fa34d7 1535 if(fp != NULL) {
arsenalist 0:f4e449fa34d7 1536 while(1) {
arsenalist 0:f4e449fa34d7 1537 c = fgetc(fp);
arsenalist 0:f4e449fa34d7 1538 if(c == EOF){
arsenalist 0:f4e449fa34d7 1539 break;
arsenalist 0:f4e449fa34d7 1540 }
arsenalist 0:f4e449fa34d7 1541 s[i] = c;
arsenalist 0:f4e449fa34d7 1542 i++;
arsenalist 0:f4e449fa34d7 1543 }
arsenalist 0:f4e449fa34d7 1544 strS = s;
arsenalist 0:f4e449fa34d7 1545 if(strS.find("(") != std::string::npos && strS.find(")") != std::string::npos) {
arsenalist 0:f4e449fa34d7 1546 strS.erase(strS.begin(),strS.begin()+strS.find("(")+1);
arsenalist 0:f4e449fa34d7 1547 strS.erase(strS.begin()+strS.find(")"),strS.end());
arsenalist 0:f4e449fa34d7 1548 } else {
arsenalist 0:f4e449fa34d7 1549 strS = "";
arsenalist 0:f4e449fa34d7 1550 }
arsenalist 0:f4e449fa34d7 1551 }
arsenalist 0:f4e449fa34d7 1552 fclose(fp);
arsenalist 0:f4e449fa34d7 1553 return strS;
arsenalist 0:f4e449fa34d7 1554 }
arsenalist 0:f4e449fa34d7 1555
arsenalist 0:f4e449fa34d7 1556 string readNodeCmd(string dType, string cmd) {
arsenalist 0:f4e449fa34d7 1557 FILE *fp;
arsenalist 0:f4e449fa34d7 1558 signed char c;
arsenalist 0:f4e449fa34d7 1559 int i=0;
arsenalist 0:f4e449fa34d7 1560 char s[128];
arsenalist 0:f4e449fa34d7 1561 string strS;
arsenalist 0:f4e449fa34d7 1562
arsenalist 0:f4e449fa34d7 1563 sprintf(s,"/sd/nodeCode/%s/%s.txt",dType.c_str(),cmd.c_str());
arsenalist 0:f4e449fa34d7 1564
arsenalist 0:f4e449fa34d7 1565 fp = fopen(s,"r");
arsenalist 0:f4e449fa34d7 1566 memset(s,0,sizeof(s));
arsenalist 0:f4e449fa34d7 1567 if(fp != NULL) {
arsenalist 0:f4e449fa34d7 1568 while(1) {
arsenalist 0:f4e449fa34d7 1569 c = fgetc(fp);
arsenalist 0:f4e449fa34d7 1570 if(c == EOF){
arsenalist 0:f4e449fa34d7 1571 break;
arsenalist 0:f4e449fa34d7 1572 }
arsenalist 0:f4e449fa34d7 1573 s[i] = c;
arsenalist 0:f4e449fa34d7 1574 i++;
arsenalist 0:f4e449fa34d7 1575 }
arsenalist 0:f4e449fa34d7 1576 strS = s;
arsenalist 0:f4e449fa34d7 1577 if(strS.find("(") != std::string::npos && strS.find(")") != std::string::npos) {
arsenalist 0:f4e449fa34d7 1578 strS.erase(strS.begin(),strS.begin()+strS.find("(")+1);
arsenalist 0:f4e449fa34d7 1579 strS.erase(strS.begin()+strS.find(")"),strS.end());
arsenalist 0:f4e449fa34d7 1580 } else {
arsenalist 0:f4e449fa34d7 1581 strS = "";
arsenalist 0:f4e449fa34d7 1582 }
arsenalist 0:f4e449fa34d7 1583 }
arsenalist 0:f4e449fa34d7 1584 fclose(fp);
arsenalist 0:f4e449fa34d7 1585 return strS;
arsenalist 0:f4e449fa34d7 1586 }
arsenalist 0:f4e449fa34d7 1587
arsenalist 0:f4e449fa34d7 1588 string *readNodeList(void) {
arsenalist 0:f4e449fa34d7 1589 static string nd[10]; //max node
arsenalist 0:f4e449fa34d7 1590 DIR *d;
arsenalist 0:f4e449fa34d7 1591 struct dirent *p;
arsenalist 0:f4e449fa34d7 1592 string q;
arsenalist 0:f4e449fa34d7 1593 int i=0;
arsenalist 0:f4e449fa34d7 1594
arsenalist 0:f4e449fa34d7 1595 d = opendir("/sd/nodeList");
arsenalist 0:f4e449fa34d7 1596 if(d != NULL) {
arsenalist 0:f4e449fa34d7 1597 while((p = readdir(d)) != NULL) {
arsenalist 0:f4e449fa34d7 1598 q = p->d_name;
arsenalist 0:f4e449fa34d7 1599 nd[i] = q;
arsenalist 0:f4e449fa34d7 1600 i++;
arsenalist 0:f4e449fa34d7 1601 }
arsenalist 0:f4e449fa34d7 1602 }
arsenalist 0:f4e449fa34d7 1603 closedir(d);
arsenalist 0:f4e449fa34d7 1604 return nd;
arsenalist 0:f4e449fa34d7 1605 }
arsenalist 0:f4e449fa34d7 1606
arsenalist 0:f4e449fa34d7 1607 string wifiGetNodeTemp(string macAddr) {
arsenalist 0:f4e449fa34d7 1608 int trial=0;
arsenalist 0:f4e449fa34d7 1609 string nodeIP = readNodeIP(macAddr);
arsenalist 0:f4e449fa34d7 1610 string str;
arsenalist 0:f4e449fa34d7 1611 string temp = "0";
arsenalist 0:f4e449fa34d7 1612
arsenalist 0:f4e449fa34d7 1613 if(rest.begin(nodeIP.c_str(),REMOTE_TCP_PORT,false)) {
arsenalist 0:f4e449fa34d7 1614 while(1) {
arsenalist 0:f4e449fa34d7 1615 char rcv[256] = {};
arsenalist 0:f4e449fa34d7 1616 rest.get("/","<?xml version=\"1.0\" encoding=\"utf-8\"?><app_cmd cmd=\"2\"/>\r\n");
arsenalist 0:f4e449fa34d7 1617 rest.getResponse(rcv,sizeof(rcv));
arsenalist 0:f4e449fa34d7 1618 str = rcv;
arsenalist 0:f4e449fa34d7 1619 if(str.find("temp=") != std::string::npos) {
arsenalist 0:f4e449fa34d7 1620 str.erase(str.begin(),str.begin()+str.find("temp=")+6);
arsenalist 0:f4e449fa34d7 1621 str.erase(str.begin()+str.find("\""),str.end());
arsenalist 0:f4e449fa34d7 1622 temp = str;
arsenalist 0:f4e449fa34d7 1623 break;
arsenalist 0:f4e449fa34d7 1624 }
arsenalist 0:f4e449fa34d7 1625 if(trial>1) { //three times trial
arsenalist 0:f4e449fa34d7 1626 break;
arsenalist 0:f4e449fa34d7 1627 }
arsenalist 0:f4e449fa34d7 1628 trial++;
arsenalist 0:f4e449fa34d7 1629 wait(2);
arsenalist 0:f4e449fa34d7 1630 }
arsenalist 0:f4e449fa34d7 1631 }
arsenalist 0:f4e449fa34d7 1632 return temp;
arsenalist 0:f4e449fa34d7 1633 }
arsenalist 0:f4e449fa34d7 1634 /*end emma node*/
arsenalist 0:f4e449fa34d7 1635
arsenalist 0:f4e449fa34d7 1636 /*start emma connection function*/
arsenalist 0:f4e449fa34d7 1637 string ethGET(string host, int port, string url) {
arsenalist 0:f4e449fa34d7 1638 char buf[1024];
arsenalist 0:f4e449fa34d7 1639 char s[256];
arsenalist 0:f4e449fa34d7 1640 int ret;
arsenalist 0:f4e449fa34d7 1641 TCPSocketConnection sock;
arsenalist 0:f4e449fa34d7 1642 Timer t;
arsenalist 0:f4e449fa34d7 1643
arsenalist 0:f4e449fa34d7 1644 sprintf(s,"%s",url.c_str());
arsenalist 0:f4e449fa34d7 1645 sock.connect(host.c_str(),port);
arsenalist 0:f4e449fa34d7 1646 sock.send_all(s,sizeof(s)-1);
arsenalist 0:f4e449fa34d7 1647 wait(2);
arsenalist 0:f4e449fa34d7 1648
arsenalist 0:f4e449fa34d7 1649 //receive return
arsenalist 0:f4e449fa34d7 1650 t.start();
arsenalist 0:f4e449fa34d7 1651 while(1) {
arsenalist 0:f4e449fa34d7 1652 ret = sock.receive(buf, sizeof(buf));
arsenalist 0:f4e449fa34d7 1653 if(ret<=0 || t.read_ms() > 10000) {
arsenalist 0:f4e449fa34d7 1654 t.stop();
arsenalist 0:f4e449fa34d7 1655 break;
arsenalist 0:f4e449fa34d7 1656 }
arsenalist 0:f4e449fa34d7 1657 }
arsenalist 0:f4e449fa34d7 1658 sock.close();
arsenalist 0:f4e449fa34d7 1659 return buf;
arsenalist 0:f4e449fa34d7 1660 }
arsenalist 0:f4e449fa34d7 1661 /*end emma connection function*/
arsenalist 0:f4e449fa34d7 1662
arsenalist 0:f4e449fa34d7 1663 /*start emma private function*/
arsenalist 0:f4e449fa34d7 1664 void connectedIface(void) { //WARNING: should be run in emmaModeRegister and emmaModeOperation
arsenalist 0:f4e449fa34d7 1665 char s[512];
arsenalist 0:f4e449fa34d7 1666 int connPort;
arsenalist 0:f4e449fa34d7 1667 string connHost;
arsenalist 0:f4e449fa34d7 1668 string str;
arsenalist 0:f4e449fa34d7 1669 Timer t;
arsenalist 0:f4e449fa34d7 1670
arsenalist 0:f4e449fa34d7 1671 //wifi interface
arsenalist 0:f4e449fa34d7 1672 if(wifiAvailable) {
arsenalist 0:f4e449fa34d7 1673 _ESP.printf("MODE=B");
arsenalist 0:f4e449fa34d7 1674 if(useProxy) {
arsenalist 0:f4e449fa34d7 1675 connHost = proxySERVER;
arsenalist 0:f4e449fa34d7 1676 sscanf(proxyPORT.c_str(),"%d",&connPort);
arsenalist 0:f4e449fa34d7 1677 for(int i=0; i<sizeof(s); i++) {
arsenalist 0:f4e449fa34d7 1678 s[i]=0; }
arsenalist 4:76ab12e2f8a3 1679 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 1680 } else {
arsenalist 0:f4e449fa34d7 1681 connHost = EMMA_SERVER_HOST;
arsenalist 0:f4e449fa34d7 1682 connPort = EMMA_SERVER_PORT;
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,"/emma/api/controller/test");
arsenalist 0:f4e449fa34d7 1686 }
arsenalist 0:f4e449fa34d7 1687 wait(1);
arsenalist 0:f4e449fa34d7 1688 t.start();
arsenalist 0:f4e449fa34d7 1689 while(!esp.ready() && t.read_ms() < 5000);
arsenalist 0:f4e449fa34d7 1690 t.stop();
arsenalist 0:f4e449fa34d7 1691 if(rest.begin(connHost.c_str(),connPort,false)) {
arsenalist 0:f4e449fa34d7 1692 //DBG.printf("rest begin\r\n");
arsenalist 0:f4e449fa34d7 1693 esp.process();
arsenalist 0:f4e449fa34d7 1694 rest.get(s);
arsenalist 0:f4e449fa34d7 1695 for(int i=0; i<sizeof(s); i++) {
arsenalist 0:f4e449fa34d7 1696 s[i]=0; }
arsenalist 0:f4e449fa34d7 1697 rest.getResponse(s,sizeof(s));
arsenalist 0:f4e449fa34d7 1698 str = s;
arsenalist 0:f4e449fa34d7 1699 //DBG.printf("response:%s\r\n",s);
arsenalist 0:f4e449fa34d7 1700 if(str.find("OK") != std::string::npos) {
arsenalist 0:f4e449fa34d7 1701 wifiConnected = true;
arsenalist 0:f4e449fa34d7 1702 }
arsenalist 0:f4e449fa34d7 1703 } else {
arsenalist 0:f4e449fa34d7 1704 wifiConnected = false;
arsenalist 0:f4e449fa34d7 1705 }
arsenalist 0:f4e449fa34d7 1706 } else {
arsenalist 0:f4e449fa34d7 1707 wifiConnected = false;
arsenalist 0:f4e449fa34d7 1708 }
arsenalist 0:f4e449fa34d7 1709
arsenalist 0:f4e449fa34d7 1710 //eth interface
arsenalist 0:f4e449fa34d7 1711 if(ethAvailable) {
arsenalist 0:f4e449fa34d7 1712 if(useProxy) {
arsenalist 0:f4e449fa34d7 1713 connHost = proxySERVER;
arsenalist 0:f4e449fa34d7 1714 sscanf(proxyPORT.c_str(),"%d",&connPort);
arsenalist 0:f4e449fa34d7 1715 for(int i=0; i<sizeof(s); i++) {
arsenalist 0:f4e449fa34d7 1716 s[i]=0; }
arsenalist 0:f4e449fa34d7 1717 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 1718 } else {
arsenalist 0:f4e449fa34d7 1719 connHost = EMMA_SERVER_HOST;
arsenalist 0:f4e449fa34d7 1720 connPort = EMMA_SERVER_PORT;
arsenalist 0:f4e449fa34d7 1721 for(int i=0; i<sizeof(s); i++) {
arsenalist 0:f4e449fa34d7 1722 s[i]=0; }
arsenalist 0:f4e449fa34d7 1723 strcpy(s,"GET /emma/api/web/test HTTP/1.0\nHost: %s\r\n\r\n");
arsenalist 0:f4e449fa34d7 1724 }
arsenalist 0:f4e449fa34d7 1725
arsenalist 0:f4e449fa34d7 1726 t.start();
arsenalist 0:f4e449fa34d7 1727 while(1) {
arsenalist 0:f4e449fa34d7 1728 str = ethGET(connHost,connPort,s);
arsenalist 0:f4e449fa34d7 1729 if(str.find("OK") != std::string::npos) {
arsenalist 0:f4e449fa34d7 1730 t.stop();
arsenalist 0:f4e449fa34d7 1731 ethConnected = true;
arsenalist 0:f4e449fa34d7 1732 break;
arsenalist 0:f4e449fa34d7 1733 }
arsenalist 0:f4e449fa34d7 1734 if(t.read_ms() > 5000) {
arsenalist 0:f4e449fa34d7 1735 t.stop();
arsenalist 0:f4e449fa34d7 1736 ethConnected = false;
arsenalist 0:f4e449fa34d7 1737 break;
arsenalist 0:f4e449fa34d7 1738 }
arsenalist 0:f4e449fa34d7 1739 }
arsenalist 0:f4e449fa34d7 1740 } else {
arsenalist 0:f4e449fa34d7 1741 ethConnected = false;
arsenalist 0:f4e449fa34d7 1742 }
arsenalist 0:f4e449fa34d7 1743
arsenalist 0:f4e449fa34d7 1744 //gprs interface
arsenalist 0:f4e449fa34d7 1745 }
arsenalist 0:f4e449fa34d7 1746
arsenalist 0:f4e449fa34d7 1747 void addChar(char *s, char c) {
arsenalist 0:f4e449fa34d7 1748 uint16_t k; //customized for EMS
arsenalist 0:f4e449fa34d7 1749 k = strlen(s);
arsenalist 0:f4e449fa34d7 1750 s[k] = c;
arsenalist 0:f4e449fa34d7 1751 s[k + 1] = 0;
arsenalist 0:f4e449fa34d7 1752 }
arsenalist 0:f4e449fa34d7 1753
arsenalist 0:f4e449fa34d7 1754 void rcvReply(char *r, int to) {
arsenalist 0:f4e449fa34d7 1755 Timer t;
arsenalist 0:f4e449fa34d7 1756 bool ended = false;
arsenalist 0:f4e449fa34d7 1757 char c;
arsenalist 0:f4e449fa34d7 1758
arsenalist 0:f4e449fa34d7 1759 strcpy(r,"");
arsenalist 0:f4e449fa34d7 1760 t.start();
arsenalist 0:f4e449fa34d7 1761 while(!ended) {
arsenalist 0:f4e449fa34d7 1762 if(_ESP.readable()) {
arsenalist 0:f4e449fa34d7 1763 c = _ESP.getc();
arsenalist 0:f4e449fa34d7 1764 addChar(r,c);
arsenalist 0:f4e449fa34d7 1765 t.start();
arsenalist 0:f4e449fa34d7 1766 }
arsenalist 0:f4e449fa34d7 1767 if(t.read_ms() > to) {
arsenalist 0:f4e449fa34d7 1768 ended = true;
arsenalist 0:f4e449fa34d7 1769 }
arsenalist 0:f4e449fa34d7 1770 }
arsenalist 0:f4e449fa34d7 1771 addChar(r, 0x00);
arsenalist 0:f4e449fa34d7 1772 }
arsenalist 0:f4e449fa34d7 1773
arsenalist 0:f4e449fa34d7 1774 string calculateMD5(string text) {
arsenalist 0:f4e449fa34d7 1775 char s[64];
arsenalist 0:f4e449fa34d7 1776 memset(s,0,sizeof(s)); //for unknown reason, after reading UID, the 's' will contaion UID data
arsenalist 0:f4e449fa34d7 1777 uint8_t hash[16];
arsenalist 0:f4e449fa34d7 1778 MD5::computeHash(hash, (uint8_t*)text.c_str(), strlen(text.c_str()));
arsenalist 0:f4e449fa34d7 1779 for(int i=0; i<16; ++i) {
arsenalist 0:f4e449fa34d7 1780 sprintf(s,"%s%02x",s,hash[i]);
arsenalist 0:f4e449fa34d7 1781 }
arsenalist 0:f4e449fa34d7 1782 return s;
arsenalist 0:f4e449fa34d7 1783 }
arsenalist 0:f4e449fa34d7 1784
arsenalist 0:f4e449fa34d7 1785 bool writeFirmwareHexToChar(string value) {
arsenalist 0:f4e449fa34d7 1786 FILE *fp;
arsenalist 0:f4e449fa34d7 1787 char s[32];
arsenalist 0:f4e449fa34d7 1788 int number;
arsenalist 0:f4e449fa34d7 1789 string chunk;
arsenalist 0:f4e449fa34d7 1790
arsenalist 0:f4e449fa34d7 1791 sprintf(s,"/sd/newFirmware/firmware.bin");
arsenalist 0:f4e449fa34d7 1792 fp = fopen(s,"a");
arsenalist 0:f4e449fa34d7 1793 if(fp != NULL) {
arsenalist 0:f4e449fa34d7 1794 for(int ch=0; ch<value.size(); ch+=2) {
arsenalist 0:f4e449fa34d7 1795 chunk = value.substr(ch,2);
arsenalist 0:f4e449fa34d7 1796 sscanf(chunk.c_str(),"%x",&number);
arsenalist 0:f4e449fa34d7 1797 fprintf(fp,"%c",number);
arsenalist 0:f4e449fa34d7 1798 }
arsenalist 0:f4e449fa34d7 1799 fclose(fp);
arsenalist 0:f4e449fa34d7 1800 return true;
arsenalist 0:f4e449fa34d7 1801 }
arsenalist 0:f4e449fa34d7 1802 return false;
arsenalist 0:f4e449fa34d7 1803 }
arsenalist 0:f4e449fa34d7 1804
arsenalist 0:f4e449fa34d7 1805 bool clearFirmware(void) {
arsenalist 0:f4e449fa34d7 1806 FILE *fp;
arsenalist 0:f4e449fa34d7 1807 char s[32];
arsenalist 0:f4e449fa34d7 1808
arsenalist 0:f4e449fa34d7 1809 sprintf(s,"/sd/newFirmware/firmware.bin");
arsenalist 0:f4e449fa34d7 1810 fp = fopen(s,"w");
arsenalist 0:f4e449fa34d7 1811 if(fp != NULL) {
arsenalist 0:f4e449fa34d7 1812 fprintf(fp,"");
arsenalist 0:f4e449fa34d7 1813 fclose(fp);
arsenalist 0:f4e449fa34d7 1814 return true;
arsenalist 0:f4e449fa34d7 1815 }
arsenalist 0:f4e449fa34d7 1816 return false;
arsenalist 0:f4e449fa34d7 1817 }
arsenalist 0:f4e449fa34d7 1818 /*end emma private function*/