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