bontor humala / PB_Emma_Ethernet

able to subscribe for >10hrs and still running

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

Fork of PB_emma_controller_mbed_src by Emma

emmaCode.cpp@1:d314a43ae6f7, 2015-07-03 (annotated)

Committer:
arsenalist
Date:
Fri Jul 03 07:15:29 2015 +0000
Revision:
1:d314a43ae6f7
Parent:
0:f4e449fa34d7
Child:
2:fdfdeb5fd6fd
Update previous commit.

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