MQTT for Eth, Wifi, GPRS
Dependencies: FP MQTTPacket
Fork of MQTT by
Revision 45:ba32a33d6867, committed 2015-08-07
- Comitter:
- bonchenko
- Date:
- Fri Aug 07 02:50:57 2015 +0000
- Parent:
- 44:f53a95f9c1d8
- Commit message:
- Ethernet able to subscribe to MQTT commands for > 12 hours
Changed in this revision
MQTTAsync.h | Show annotated file Show diff for this revision Revisions of this file |
diff -r f53a95f9c1d8 -r ba32a33d6867 MQTTAsync.h --- a/MQTTAsync.h Mon Sep 29 04:56:42 2014 +0000 +++ b/MQTTAsync.h Fri Aug 07 02:50:57 2015 +0000 @@ -1,607 +1,2519 @@ -/******************************************************************************* - * Copyright (c) 2014 IBM Corp. - * - * All rights reserved. This program and the accompanying materials - * are made available under the terms of the Eclipse Public License v1.0 - * and Eclipse Distribution License v1.0 which accompany this distribution. - * - * The Eclipse Public License is available at - * http://www.eclipse.org/legal/epl-v10.html - * and the Eclipse Distribution License is available at - * http://www.eclipse.org/org/documents/edl-v10.php. - * - * Contributors: - * Ian Craggs - initial API and implementation and/or initial documentation - *******************************************************************************/ +#include "emmaCode.h" + +//init debug port +Serial DBG(PA_9, PA_10); //tx, rx + +//init wifi port +Serial _ESP(PA_2, PA_3); //tx, rx +//init espduino - without ch_pd pin +ESP esp(&_ESP, &DBG, ESP_BAUD); +//init wifi mqtt +ESPMQTT mqtt(&esp); +//init wifi rest +REST rest(&esp); -#if !defined(MQTTASYNC_H) -#define MQTTASYNC_H +//init eth port +SPI spi(PB_15, PB_14, PB_13); //mosi, miso, sck +MQTTEthernet ipstack(&spi, PB_12, PC_6); //spi, cs, reset +MQTT::Client<MQTTEthernet, Countdown, MQTT_MAX_PACKET_SIZE> client(ipstack); + +//init sd card +SDFileSystem sd(PA_7, PA_6, PA_5, PB_3, "sd"); //mosi, miso, sck, cs -#include "FP.h" -#include "MQTTPacket.h" -#include "stdio.h" +//init ade7758 - without cs pin +ADE7758 ADE(PB_6, PB_4, PB_5, PB_7); //mosi, miso, sck, irq -namespace MQTT -{ +//init tft lcd +SPI_TFT_ILI9341 TFT(PA_7, PA_6, PA_5, PA_4, PC_5, PC_4,"TFT"); //mosi, miso, sclk, cs, reset, dc +//init touch screen - without cs pin +TouchScreenADS7843 TP(PB_10, PB_0, PB_1, PB_2, &TFT); //mosi, miso, sclk, irq, tft +//InterruptIn tpIRQ(PB_2); + +//init dht sensor +DHT11 d(PD_2); -enum QoS { QOS0, QOS1, QOS2 }; - +//emma settings +string emmaUID; +string hmac; +string platformDOMAIN; +string platformKEY; +string platformSECRET; +string wifiSSID; +string wifiPASS; +string gprsAPN; +string proxySERVER; +string proxyPORT; +string proxyAUTH; -struct Message -{ - enum QoS qos; - bool retained; - bool dup; - unsigned short id; - void *payload; - size_t payloadlen; +//nodes settings +class NODES { +public: + REST *restConn; + NODES(REST *r); + string macAddr; + string ipAddr; }; - +NODES::NODES(REST *r) { + restConn = r; +} +REST restObj[NODES_MAX] = {REST(&esp),REST(&esp),REST(&esp),REST(&esp),REST(&esp)}; +NODES nodes[NODES_MAX] = {NODES(&restObj[0]),NODES(&restObj[1]),NODES(&restObj[2]),NODES(&restObj[3]),NODES(&restObj[4])}; -class PacketId -{ +//mode box class for main menu +class modeBox { public: - PacketId(); - - int getNext(); - -private: - static const int MAX_PACKET_ID = 65535; - int next; + int xTL; //TopLeft + int yTL; + int xBR; //BottomRight + int yBR; + string text; }; -typedef void (*messageHandler)(Message*); +//ade7758 variables +uint32_t AWattHrValue, BWattHrValue, CWattHrValue; +uint32_t AVAHrValue, BVAHrValue, CVAHrValue; +//long AWattHrSum = 0; +//long BWattHrSum = 0; +//long CWattHrSum = 0; +uint32_t AWattHrSum = 0; +uint32_t BWattHrSum = 0; +uint32_t CWattHrSum = 0; +float AWattHr, BWattHr, CWattHr; +float AVrms, BVrms, CVrms; +float AIrms, BIrms, CIrms; +float AWatt, BWatt, CWatt; +float XWattHr,XVrms,XWatt; + +//variables +bool ethAvailable = false; +bool wifiAvailable = false; +bool gprsAvailable = false; +bool ethConnected = false; +bool wifiConnected = false; +bool gprsConnected = false; +bool useProxy = false; +bool newCommand = false; +bool espFreeMemory = true; //for after bootup initialization +bool newEnergyData = false; +string globalCommand; +string rxBuf; + +/*start lcd and touch*/ +int emmaModeSelection(void) { + bool modeSelected = false; + int md=0; + int TPx; + int TPy; + + TFT.background(Black); + TFT.foreground(White); + + TFT.set_font((unsigned char*) Arial12x12); + TFT.set_orientation(1); + TFT.cls(); + TFT.locate(0,0); + TFT.printf("Hello, I'm Emma!"); + wait(2); + TFT.cls(); + + Matrix matrix; + Coordinate ScreenSample[3]; + + matrix.An = 580; + matrix.Bn = 75980; + matrix.Cn = -3410580; + matrix.Dn = 57855; + matrix.En = -2465; + matrix.Fn = -3483515; + matrix.Divider = 209144; + + ScreenSample[0].x = 230; + ScreenSample[0].y = 167; + ScreenSample[1].x = 754; + ScreenSample[1].y = 163; + ScreenSample[2].x = 771; + ScreenSample[2].y = 562; + + TP.SetCalibration(&matrix, &ScreenSample[0]); + + //TFT.locate(0,0); + //TFT.printf(" X:"); + //TFT.locate(70,0); + //TFT.printf(" Y:"); + + //draw border + TFT.line(15,15,310,15,Orange); + TFT.line(310,15,310,250,Orange); + TFT.line(310,250,15,250,Orange); + TFT.line(15,250,15,15,Orange); + + //init main menu + modeBox menu[6]; + + //wifi config mode + menu[MODE_WIFI_CONFIG].xTL = 25; + menu[MODE_WIFI_CONFIG].yTL = 25; + menu[MODE_WIFI_CONFIG].xBR = 110; + menu[MODE_WIFI_CONFIG].yBR = 90; + menu[MODE_WIFI_CONFIG].text = "wifi config"; + + //setting mode + menu[MODE_SETTINGS].xTL = 120; + menu[MODE_SETTINGS].yTL = 25; + menu[MODE_SETTINGS].xBR = 205; + menu[MODE_SETTINGS].yBR = 90; + menu[MODE_SETTINGS].text = "settings"; + + //register mode + menu[MODE_REGISTER].xTL = 25; + menu[MODE_REGISTER].yTL = 100; + menu[MODE_REGISTER].xBR = 110; + menu[MODE_REGISTER].yBR = 165; + menu[MODE_REGISTER].text = "register"; + + //operational mode + menu[MODE_OPERATION].xTL = 120; + menu[MODE_OPERATION].yTL = 100; + menu[MODE_OPERATION].xBR = 205; + menu[MODE_OPERATION].yBR = 165; + menu[MODE_OPERATION].text = "operation"; + + //firmware download mode + menu[MODE_FIRMWARE_DOWNLOAD].xTL = 215; + menu[MODE_FIRMWARE_DOWNLOAD].yTL = 25; + menu[MODE_FIRMWARE_DOWNLOAD].xBR = 300; + menu[MODE_FIRMWARE_DOWNLOAD].yBR = 90; + menu[MODE_FIRMWARE_DOWNLOAD].text = "fw dwld"; + + //reserved mode + menu[5].xTL = 215; + menu[5].yTL = 100; + menu[5].xBR = 300; + menu[5].yBR = 165; + menu[5].text = "reserved"; + + //draw main menu + for(int i=0; i<6; i++) { + TFT.fillrect(menu[i].xTL,menu[i].yTL,menu[i].xBR,menu[i].yBR,Orange); + } + + //add text to main menu + for(int i=0; i<6; i++) { + TFT.locate(menu[i].xTL,menu[i].yTL); + TFT.printf("%s",menu[i].text.c_str()); + } + + while(!modeSelected) { + if(!TP._tp_irq) { + if(TP.Read_Ads7843()) { + TP.getDisplayPoint(); + TPx = TP.display.x; + TPy = TP.display.y; + TP.TP_DrawPoint(TPx,TPy, Blue); + //TFT.locate(25,0); + //TFT.printf("%03d",TPx); + //TFT.locate(95,0); + //TFT.printf("%03d",TPy); + + for(int i=0; i<6; i++) { + if((menu[i].xTL < TPx && TPx < menu[i].xBR) && (menu[i].yTL < TPy && TPy < menu[i].yBR)) { + //TFT.locate(25,170); + //TFT.printf(" "); + //TFT.locate(25,170); + //TFT.printf("mode: %s is selected",menu[i].text.c_str()); + //wait(3); + md = i; + modeSelected = true; + } + } + } + } + } + + TFT.locate(25,170); + TFT.printf(" "); + TFT.locate(25,170); + TFT.printf("mode: %s is selected",menu[md].text.c_str()); + wait(2); + TFT.cls(); + + return md; +} +/*end lcd and touch*/ -typedef struct limits -{ - int MAX_MQTT_PACKET_SIZE; // - int MAX_MESSAGE_HANDLERS; // each subscription requires a message handler - int MAX_CONCURRENT_OPERATIONS; // each command which runs concurrently can have a result handler, when we are in multi-threaded mode - int command_timeout_ms; - - limits() - { - MAX_MQTT_PACKET_SIZE = 100; - MAX_MESSAGE_HANDLERS = 5; - MAX_CONCURRENT_OPERATIONS = 1; // 1 indicates single-threaded mode - set to >1 for multithreaded mode - command_timeout_ms = 30000; - } -} Limits; - - -/** - * @class Async - * @brief non-blocking, threaded MQTT client API - * @param Network a network class which supports send, receive - * @param Timer a timer class with the methods: - */ -template<class Network, class Timer, class Thread, class Mutex> class Async -{ +/*start emma mode*/ +void emmaInit(int mode) { + char s[64]; + DBG.baud(19200); + DBG.printf("\r\nemmaInit\r\n"); + DBG.printf("mode:%d\r\n",mode); + + //read settings + //readSetting("emmaUID"); //sd card need to be read once before working correctly + emmaUID = readSetting("emmaUID"); + //emmaUID = "066eff575349896767073038"; + DBG.printf("emmaUID:%s\r\n",emmaUID.c_str()); + //calculate hmac + for(int i=0; i<sizeof(s); i++) { + s[i]=0; } + sprintf(s,"emma-%s",emmaUID.c_str()); + hmac = calculateMD5(s); + DBG.printf("hmac:%s\r\n",hmac.c_str()); + platformDOMAIN = readSetting("platformDOMAIN"); + //platformDOMAIN = "testdulu"; + DBG.printf("platformDOMAIN:%s\r\n",platformDOMAIN.c_str()); + platformKEY = readSetting("platformKEY"); + //platformKEY = "5980e444-81dd-47ba-8222-6a40bc94fdce"; + DBG.printf("platformKEY:%s\r\n",platformKEY.c_str()); + platformSECRET = readSetting("platformSECRET"); + //platformSECRET = "3ca8ec0239fda2b6d12ba1580c91a052"; + DBG.printf("platformSECRET:%s\r\n",platformSECRET.c_str()); + proxySERVER = readSetting("proxySERVER"); + DBG.printf("proxySERVER:%s\r\n",proxySERVER.c_str()); + proxyPORT = readSetting("proxyPORT"); + DBG.printf("proxyPORT:%s\r\n",proxyPORT.c_str()); + proxyAUTH = readSetting("proxyAUTH"); + DBG.printf("proxyAUTH:%s\r\n",proxyAUTH.c_str()); + + //check proxy + if(!proxySERVER.empty() && !proxyPORT.empty() && !proxyAUTH.empty()) { + useProxy = true; + } else { + useProxy = false; + } + //testing purpose + useProxy = false; + DBG.printf("proxy:%d\r\n",useProxy); + + //check available interface + isEthAvailable(); //check whether cable is connected + wifiAvailable = true; //we assume wifi will always available + DBG.printf("eth:%d\r\n",ethAvailable); + DBG.printf("wifi:%d\r\n",wifiAvailable); + DBG.printf("gprs:%d\r\n",gprsAvailable); +} +void emmaModeWiFiConfig(void) { + string str; + TFT.locate(0,0); + TFT.printf(" please wait"); + MbedJSONValue jsonValue; + + if(wifiAvailable) { + DBG.printf("emmaModeWiFiConfig\r\n"); + + //set wifi module to configuration + _ESP.printf("MODE=C"); + while(1) { + char rcv[128] = {}; + rcvReply(rcv,3000); + str = rcv; + if(str.find("SC_STATUS_FIND_CHANNEL") != std::string::npos) + break; + } + + TFT.locate(0,0); + TFT.printf(" emmaModeWiFiConfig"); + TFT.locate(0,20); + TFT.printf(" connect with emma app now"); + + DBG.printf("entering wifi configuration mode\r\n"); + while(1) { + char rcv[128] = {}; + rcvReply(rcv,3000); + str = rcv; + if(str.find("MODE=C OK") != std::string::npos) { + //save wifiSSID and wifiPASS + if(str.find("[") != std::string::npos && str.find("]") != std::string::npos) { + str.erase(str.begin(),str.begin()+str.find("[")+1); + str.erase(str.begin()+str.find("]"),str.end()); + + parse(jsonValue,str.c_str()); + + char *parameter[2] = {"wifiSSID","wifiPASS"}; + + for(int i=0; i<2; i++) { + if(jsonValue.hasMember(parameter[i])) { + string val = jsonValue[parameter[i]].get<std::string>(); + int st = writeSetting(parameter[i],val.c_str()); + if(st) { + DBG.printf("%s is saved\r\n",parameter[i]); + TFT.locate(0,40); + TFT.printf(" %s is saved\r\n",parameter[i]); + wait(3); + TFT.locate(0,40); + TFT.printf(" "); + } else { + DBG.printf("%s is not saved\r\n",parameter[i]); + TFT.locate(0,40); + TFT.printf(" %s is not saved\r\n",parameter[i]); + wait(3); + TFT.locate(0,40); + TFT.printf(" "); + } + } + } + + //wificonfig finish + TFT.locate(0,20); + TFT.printf(" "); + TFT.locate(0,20); + TFT.printf(" wificonfig finish. please restart."); + + } + } else if(str.find("SC_STATUS_GETTING_SSID_PSWD") != std::string::npos){ + DBG.printf("app connected\r\n"); + TFT.locate(0,20); + TFT.printf(" "); + TFT.locate(0,20); + TFT.printf(" app connected"); + } + } + } else { + DBG.printf("no wifi found\r\n"); + TFT.locate(0,20); + TFT.printf(" no wifi found"); + } +} +void emmaModeSettings(void) { + bool clientIsConnected = false; + bool serverIsListened = false; + char s[32]; + string str; + MbedJSONValue jsonValue; + + TFT.locate(0,0); + TFT.printf(" please wait"); + + //create settings dir + mkdir("/sd/settings",0777); + + //get and write emmaUID + string uid = getUID(); + sprintf(s,"(%s)",uid.c_str()); + uid = s; + writeSetting("emmaUID",uid); + + if(ethAvailable) { + DBG.printf("emmaModeSettings - eth\r\n"); + + TCPSocketServer svr; + TCPSocketConnection clientSock; + + if(svr.bind(SERVER_PORT) < 0) { + DBG.printf("tcp server bind failed\r\n"); + } else { + DBG.printf("tcp server bind success\r\n"); + serverIsListened = true; + } + + DBG.printf("please connect to %s\r\n",ipstack.getEth().getIPAddress()); + + if(svr.listen(1) < 0) { + DBG.printf("tcp server listen failed\r\n"); + } else { + DBG.printf("tcp server is listening...\r\n"); + } + + clientSock.set_blocking(false,30000); //timeout after 30sec -public: + //listening + while (serverIsListened) { + if(svr.accept(clientSock) < 0) { + DBG.printf("failed to accept connection\r\n"); + } else { + DBG.printf("connection success!\r\nIP: %s\r\n",clientSock.get_address()); + clientIsConnected = true; + + while(clientIsConnected) { + char buffer[1024] = {}; + switch(clientSock.receive(buffer,1023)) { + case 0: + DBG.printf("received buffer is empty\r\n"); + clientIsConnected = false; + break; + case -1: + DBG.printf("failed to read data from client\r\n"); + clientIsConnected = false; + break; + default: + //DBG.printf("received data: %d\r\n%s\r\n",strlen(buffer),buffer); + DBG.printf("\r\n"); + + str = buffer; + if(str.find("[") != std::string::npos && str.find("]") != std::string::npos) { + str.erase(str.begin(),str.begin()+str.find("[")+1); + str.erase(str.begin()+str.find("]"),str.end()); + + parse(jsonValue,str.c_str()); + + char *parameter[5] = {"gprsAPN","proxySERVER","proxyPORT","proxyAUTH","epochTime"}; + + for(int i=0; i<4; i++) { + if(jsonValue.hasMember(parameter[i])) { + string val = jsonValue[parameter[i]].get<std::string>(); + int st = writeSetting(parameter[i],val.c_str()); + if(st) { + DBG.printf("%s: %s is saved\r\n",parameter[i],val.c_str()); + } else { + DBG.printf("%s is not saved\r\n",parameter[i]); + } + } + } + + //set time + if(jsonValue.hasMember(parameter[4])) { + string epTime = jsonValue[parameter[4]].get<std::string>(); + time_t seconds; + sscanf(epTime.c_str(),"%d",&seconds); + set_time(seconds); + DBG.printf("time is set\r\n"); + } + } + break; + } + } + DBG.printf("close connection\r\n"); + clientSock.close(); + } + } + } else if(wifiAvailable) { + DBG.printf("emmaModeSettings - wifi\r\n"); + + _ESP.printf("MODE=S"); + while(1) { + char rcv[128] = {}; + rcvReply(rcv,3000); + str = rcv; + if(str.find("MODE=S_OK") != std::string::npos) + break; + } + DBG.printf("entering settings mode\r\n"); + TFT.locate(0,0); + TFT.printf(" emmaModeSettings"); + TFT.locate(0,20); + TFT.printf(" connect with emma app now"); + + while(1) { + char rcv[512] = {}; + rcvReply(rcv,3000); + //DBG.printf("rcv:%s\r\n",rcv); + str = rcv; + if(str.find("MODE=S_Config") != std::string::npos) { + //save gprs and proxy setting + if(str.find("[") != std::string::npos && str.find("]") != std::string::npos) { + str.erase(str.begin(),str.begin()+str.find("[")+1); + str.erase(str.begin()+str.find("]"),str.end()); + + parse(jsonValue,str.c_str()); + + char *parameter[5] = {"gprsAPN","proxySERVER","proxyPORT","proxyAUTH","epochTime"}; + + for(int i=0; i<4; i++) { + if(jsonValue.hasMember(parameter[i])) { + string val = jsonValue[parameter[i]].get<std::string>(); + int st = writeSetting(parameter[i],val.c_str()); + if(st) { + DBG.printf("%s: %s is saved\r\n",parameter[i],val.c_str()); + TFT.locate(0,40); + TFT.printf(" %s: %s is saved",parameter[i],val.c_str()); + wait(3); + TFT.locate(0,40); + TFT.printf(" "); + } else { + DBG.printf("%s is not saved\r\n",parameter[i]); + TFT.locate(0,40); + TFT.printf(" %s is not saved",parameter[i]); + wait(3); + TFT.locate(0,40); + TFT.printf(" "); + } + } + } + + //set time + if(jsonValue.hasMember(parameter[4])) { + string epTime = jsonValue[parameter[4]].get<std::string>(); + time_t seconds; + sscanf(epTime.c_str(),"%d",&seconds); + set_time(seconds); + DBG.printf("time is set\r\n"); + TFT.locate(0,40); + TFT.printf(" time is set"); + wait(3); + TFT.locate(0,40); + TFT.printf(" "); + } + + //setting finish + TFT.locate(0,20); + TFT.printf(" "); + TFT.locate(0,20); + TFT.printf(" settings finish. please restart."); + } + } else if(str.find("connect") != std::string::npos) { + DBG.printf("connection success!\r\n"); + TFT.locate(0,20); + TFT.printf(" "); + TFT.locate(0,20); + TFT.printf(" connection success"); + } + } + } else { + DBG.printf("no eth or wifi is available\r\n"); + TFT.locate(0,0); + TFT.printf(" no iface avail, please restart!"); + } +} +void emmaModeRegister(void) { + bool emmaGetRegKey = false; + bool emmaRegistered = false; + char s[512]; + char r[256]; + int connPort; + int loop = 0; + string connData; + string connHost; + //string hmac; + string str; + string regKey; + Timer t; + MbedJSONValue jsonValue; + + TFT.locate(0,0); + TFT.printf(" please wait"); + useProxy = true; + //check connected interface + //connectedIface(); + isEthConnected(); + isWiFiConnected(); + isGprsConnected(); + DBG.printf("ethConnected:%d\r\n",ethConnected); + DBG.printf("wifiConnected:%d\r\n",wifiConnected); + + //calculate hmac + //for(int i=0; i<sizeof(s); i++) { + // s[i]=0; } + //sprintf(s,"emma-%s",emmaUID.c_str()); + //hmac = calculateMD5(s); + //DBG.printf("hmac:%s\r\n",hmac.c_str()); + + if(ethConnected) { + DBG.printf("emmaModeRegister - eth\r\n"); + + //set connHost, connPort, connData + if(useProxy) { + DBG.printf("use proxy\r\n"); + connHost = proxySERVER; + sscanf(proxyPORT.c_str(),"%d",&connPort); + for(int i=0; i<sizeof(s); i++) { + s[i]=0; } + 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); + connData = s; + } else { + DBG.printf("no proxy\r\n"); + connHost = EMMA_SERVER_HOST; + connPort = EMMA_SERVER_PORT; + for(int i=0; i<sizeof(s); i++) { + s[i]=0; } + 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); + connData = s; + } + + //register + while(!emmaGetRegKey) { + str = ""; + str = ethGET(connHost,connPort,connData); + DBG.printf("rsp reg:%s\r\n",str.c_str()); - struct Result - { - /* success or failure result data */ - Async<Network, Timer, Thread, Mutex>* client; - int rc; - }; - - typedef void (*resultHandler)(Result*); - - Async(Network* network, const Limits limits = Limits()); + //check and save platform setting + if(str.find("[") != std::string::npos && str.find("]") != std::string::npos) { + str.erase(str.begin(),str.begin()+str.find("[")+1); + str.erase(str.begin()+str.find("]"),str.end()); + + parse(jsonValue,str.c_str()); + + char *parameter[4] = {"platformDOMAIN","platformKEY","platformSECRET","registrationKey"}; + + //save platform parameter + writeSetting(parameter[0],"()"); //sd card need to be initialized + for(int i=0; i<3; i++) { + if(jsonValue.hasMember(parameter[i])) { + string val = jsonValue[parameter[i]].get<std::string>(); + int st = writeSetting(parameter[i],val.c_str()); + if(st) { + DBG.printf("%s: %s is saved\r\n",parameter[i],val.c_str()); + } else { + DBG.printf("%s is not saved\r\n",parameter[i]); + } + } + } + + //get registrationKey + if(jsonValue.hasMember(parameter[3])) { + string val = jsonValue[parameter[3]].get<std::string>(); + if(val.find("(") != std::string::npos && val.find(")") != std::string::npos) { + val.erase(val.begin(),val.begin()+val.find("(")+1); + val.erase(val.begin()+val.find(")"),val.end()); + regKey = val; + DBG.printf("%s: %s\r\n",parameter[3],regKey.c_str()); + emmaGetRegKey = true; + } + } + } + } + + //calculate hmac + for(int i=0; i<sizeof(r); i++) { + r[i]=0; } + sprintf(r,"emma-%s-%s",emmaUID.c_str(),regKey.c_str()); + hmac = calculateMD5(r); + DBG.printf("hmac:%s\r\n",hmac.c_str()); - typedef struct - { - Async* client; - Network* network; - } connectionLostInfo; + //set connData + if(useProxy) { + DBG.printf("use proxy\r\n"); + for(int i=0; i<sizeof(s); i++) { + s[i]=0; } + 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); + connData = s; + } else { + DBG.printf("no proxy\r\n"); + for(int i=0; i<sizeof(s); i++) { + s[i]=0; } + 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); + connData = s; + } + + //verify registration + while(!emmaRegistered && loop < 12){ + str.clear(); + str = ethGET(connHost,connPort,connData); + DBG.printf("rsp vrf:%s\r\n",str.c_str()); + + //check verification + if(str.find("[") != std::string::npos && str.find("]") != std::string::npos) { + str.erase(str.begin(),str.begin()+str.find("[")+1); + str.erase(str.begin()+str.find("]"),str.end()); + + parse(jsonValue,str.c_str()); + if(jsonValue.hasMember("user")) { + string val = jsonValue["user"].get<std::string>(); + DBG.printf("%s is registered\r\n",val.c_str()); + emmaRegistered = true; + } + } + wait(5); + loop++; + } + + //check whether registration success + if(emmaRegistered) { + DBG.printf("registration successful\r\n"); + } else { + DBG.printf("registration unsuccessful\r\n"); + } + while(1); + + } else if(wifiConnected) { + DBG.printf("emmaModeRegister - wifi\r\n"); + + _ESP.printf("MODE=B"); + wait(1); + while(!esp.ready()); + + //set connHost, connPort + if(useProxy) { + connHost = proxySERVER; + sscanf(proxyPORT.c_str(),"%d",&connPort); + } else { + connHost = EMMA_SERVER_HOST; + connPort = EMMA_SERVER_PORT; + } + TFT.locate(0,0); + TFT.printf(" emmaModeRegister"); + + //rest begin + if(!rest.begin(connHost.c_str(),connPort,false)) { + DBG.printf("EMMA: fail to setup rest"); + while(1); + } + //wifiConnected = true; //with custom firmware, wifi module should connect automatically + + esp.process(); + if(wifiConnected) { + //set connData + if(useProxy) { + for(int i=0; i<sizeof(s); i++) { + s[i]=0; } + 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()); + connData = s; + } else { + for(int i=0; i<sizeof(s); i++) { + s[i]=0; } + sprintf(s,"/emma/api/controller/register?uid=%s&hmac=%s",emmaUID.c_str(),hmac.c_str()); + connData = s; + } + + //register + while(!emmaGetRegKey) { + rest.get(connData.c_str()); + for(int i=0; i<sizeof(s); i++) { + s[i]=0; } + rest.getResponse(s,sizeof(s)); + DBG.printf("rsp reg:%s\r\n",s); + + //check and save platform setting + str = s; + if(str.find("[") != std::string::npos && str.find("]") != std::string::npos) { + str.erase(str.begin(),str.begin()+str.find("[")+1); + str.erase(str.begin()+str.find("]"),str.end()); + + parse(jsonValue,str.c_str()); + + char *parameter[4] = {"platformDOMAIN","platformKEY","platformSECRET","registrationKey"}; - typedef int (*connectionLostHandlers)(connectionLostInfo*); + //save platform parameter + writeSetting(parameter[0],"()"); //sd card need to be initialized + for(int i=0; i<3; i++) { + if(jsonValue.hasMember(parameter[i])) { + string val = jsonValue[parameter[i]].get<std::string>(); + int st = writeSetting(parameter[i],val.c_str()); + if(st) { + DBG.printf("%s: %s is saved\r\n",parameter[i],val.c_str()); + } else { + DBG.printf("%s is not saved\r\n",parameter[i]); + } + } + } + + //get registrationKey + if(jsonValue.hasMember(parameter[3])) { + string val = jsonValue[parameter[3]].get<std::string>(); + if(val.find("(") != std::string::npos && val.find(")") != std::string::npos) { + val.erase(val.begin(),val.begin()+val.find("(")+1); + val.erase(val.begin()+val.find(")"),val.end()); + regKey = val; + DBG.printf("%s: %s\r\n",parameter[3],regKey.c_str()); + + TFT.locate(0,20); + TFT.printf(" %s: %s\r\n",parameter[3],regKey.c_str()); + + emmaGetRegKey = true; + } + } + } + } + + //calculate hmac + for(int i=0; i<sizeof(r); i++) { + r[i]=0; } + sprintf(r,"emma-%s-%s",emmaUID.c_str(),regKey.c_str()); + hmac = calculateMD5(r); + DBG.printf("hmac:%s\r\n",hmac.c_str()); + + //set connData + if(useProxy) { + for(int i=0; i<sizeof(s); i++) { + s[i]=0; } + 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()); + connData = s; + } else { + for(int i=0; i<sizeof(s); i++) { + s[i]=0; } + sprintf(s,"/emma/api/controller/verify?uid=%s®istrationKey=%s&hmac=%s",emmaUID.c_str(),regKey.c_str(),hmac.c_str()); + connData = s; + } + + //verify registration + while(!emmaRegistered && loop < 12){ + rest.get(connData.c_str()); + for(int i=0; i<sizeof(s); i++) { + s[i]=0; } + rest.getResponse(s,sizeof(s)); + DBG.printf("rsp vrf:%s\r\n",s); + TFT.locate(0,40); + TFT.printf(" "); + TFT.locate(0,40); + TFT.printf(" wait:%d\r\n",loop); + + //check verification + str = s; + if(str.find("[") != std::string::npos && str.find("]") != std::string::npos) { + str.erase(str.begin(),str.begin()+str.find("[")+1); + str.erase(str.begin()+str.find("]"),str.end()); + + parse(jsonValue,str.c_str()); + if(jsonValue.hasMember("user")) { + string val = jsonValue["user"].get<std::string>(); + DBG.printf(" %s is registered\r\n",val.c_str()); + TFT.locate(0,40); + TFT.printf(" "); + TFT.locate(0,40); + TFT.printf(" %s is registered\r\n",val.c_str()); + emmaRegistered = true; + } + } + wait(5); + loop++; + } + + //check whether registration success + if(emmaRegistered) { + DBG.printf("registration successful\r\n"); + TFT.locate(0,60); + TFT.printf(" registration successful\r\n"); + } else { + DBG.printf("registration unsuccessful\r\n"); + TFT.locate(0,60); + TFT.printf(" egistration unsuccessful. please restart.\r\n"); + } + while(1); + } + + } else if(gprsConnected) { + DBG.printf("emmaModeRegister - gprs\r\n"); + + } else { + DBG.printf("no eth, wifi, or gprs is connected\r\n"); + TFT.locate(0,60); + TFT.printf(" no iface connected. please restart.\r\n"); + } +} + +void emmaModeOperation(void) { + char *parameter[5] = {"\"id\"","\"nType\"","\"nAddr\"","\"dType\"","\"cmd\""}; + char mqttClientId[32]; + char p[64]; + char q[32]; + char r[32]; + char s[512]; + int loop=0; + int trial=0; + //string hmac; + string hmacTime; + string hmacCmd; + string str; + time_t seconds; + Timer t; + Timer tPanelEnergy; + Timer tPanel; + Timer tNodes; + MbedJSONValue jsonValue; + + TFT.locate(0,0); + TFT.printf(" please wait"); - /** Set the connection lost callback - called whenever the connection is lost and we should be connected - * @param clh - pointer to the callback function - */ - void setConnectionLostHandler(connectionLostHandlers clh) - { - connectionLostHandler.attach(clh); + //check connected interface + //connectedIface(); + DBG.printf("EMMA OPERATION MODE\r\n"); + isEthConnected(); + isWiFiConnected(); + isGprsConnected(); + DBG.printf("ethConnected:%d\r\n",ethConnected); + DBG.printf("wifiConnected:%d\r\n",wifiConnected); + + TFT.locate(0,0); + TFT.printf(" emmaModeOperation"); + + TFT.locate(0,20); + if(ethConnected) { + TFT.printf("ETH:Avail"); + } else { + TFT.printf("ETH:N/A"); + } + + TFT.locate(80,20); + if(wifiConnected) { + TFT.printf("WiFi:Avail"); + } else { + TFT.printf("WiFi:N/A"); + } + + TFT.locate(160,20); + if(gprsConnected) { + TFT.printf("GPRS:Avail"); + } else { + TFT.printf("GPRS:N/A"); } - /** Set the default message handling callback - used for any message which does not match a subscription message handler - * @param mh - pointer to the callback function - */ - void setDefaultMessageHandler(messageHandler mh) - { - defaultMessageHandler.attach(mh); - } - - int connect(resultHandler fn, MQTTPacket_connectData* options = 0); + //calculate hmac + //for(int j=0; j<sizeof(s); j++) { + // s[j]=0; } + //sprintf(s,"emma-%s",emmaUID.c_str()); + //hmac = calculateMD5(s); + //DBG.printf("hmac:%s\r\n",hmac.c_str()); - template<class T> - int connect(void(T::*method)(Result *), MQTTPacket_connectData* options = 0, T *item = 0); // alternative to pass in pointer to member function - - int publish(resultHandler rh, const char* topic, Message* message); + if(ethConnected) { + DBG.printf("emmaModeOperation - eth\r\n"); + DBG.printf("IP Address:%s\r\n",ipstack.getEth().getIPAddress()); + DBG.printf("MAC Address:%s\r\n",ipstack.getEth().getMACAddress()); + ethMQTTAttemptConnect(&client, &ipstack); +// t.start(); +// DBG.printf("start\r\n"); + while(true) { +// if(!ipstack.getEth().linkstatus()) { +// NVIC_SystemReset(); +// } + + //check for new command + if(newCommand) { + string cmd(globalCommand); + string cmdBuffer; + int keyIndex, key2Index; + int valueLength, valueStart; + + DBG.printf("Parsing CMD...\r\n"); + + for (int i=0; i<4; i++) { + keyIndex = cmd.find(parameter[i]); + key2Index = cmd.find(parameter[i+1]); + valueStart = keyIndex + strlen(parameter[i]) + 2; + valueLength = key2Index - keyIndex - strlen(parameter[i]) - 4; + cmdBuffer.assign(cmd, valueStart, valueLength); + DBG.printf("the value: %s\r\n", cmdBuffer); + } + cmd.clear(); + cmdBuffer.clear(); + + DBG.printf("Checking command validity...\r\n"); + //check if command is valid + bool validCommand = true; + DBG.printf("Command validity:%d\r\n",validCommand); + +// if(validCommand) { +// string commandId = jsonValue[parameter[0]].get<std::string>(); +// string commandNType = jsonValue[parameter[1]].get<std::string>(); +// string commandNAddr = jsonValue[parameter[2]].get<std::string>(); +// string commandDType = jsonValue[parameter[3]].get<std::string>(); +// string commandCmd = jsonValue[parameter[4]].get<std::string>(); +// +// if(commandNType == "0") { //switch on panel controller +// DBG.printf("command for switch\r\n"); +// } +// else if(commandNType == "1") { //node with mac address +// DBG.printf("command for node\r\n"); +// //get node ip address based on node mac address +// string nodeIP = readNodeIP(commandNAddr); +// //DBG.printf("nodeIP: %s\r\n",nodeIP.c_str()); +// +// //get cmd string based on device type and command number +// string nodeCmd = readNodeCmd(commandDType,commandCmd); +// //DBG.printf("nodeCmd: %s\r\n",nodeCmd.c_str()); +// //execute command +// //int trial=0; +// trial = 0; +// bool execStatus=false; +// +// while( !execStatus ) { +// sprintf(s,"<?xml version=\"1.0\" encoding=\"utf-8\"?><app_cmd cmd=\"5\" /><app_data code=\"%s\"/>\r\n",nodeCmd.c_str()); +// str = s; +// DBG.printf("str value:%s\r\n",str.c_str()); +// string rcv = ethGET(nodeIP,REMOTE_TCP_PORT,str); // cause mqtt to stop +// DBG.printf("response:%s\r\n",rcv.c_str()); +// str = rcv; +// if(str.find("OK") != std::string::npos) { +// DBG.printf("CMD executed successfully\r\n"); +// execStatus = true; +// } +// if(trial>0) { //two times trial +// DBG.printf("cmd is not executed\r\n"); +// execStatus = false; +// } +// DBG.printf("Trial++\r\n"); +// trial++; +// wait(3); +// } +// DBG.printf("Send execution status\r\n"); +// //send execution status +// } +// } + newCommand = false; + DBG.printf("New command false\r\n"); + } + // DBG.printf("Yielding...\r\n"); + client.yield(1000); //allow MQTT client to receive message + // DBG.printf("Yield finished\r\n"); + } + } else if(wifiConnected) { + DBG.printf("emmaModeOperation - wifi\r\n"); - int subscribe(resultHandler rh, const char* topicFilter, enum QoS qos, messageHandler mh); - - int unsubscribe(resultHandler rh, const char* topicFilter); - - int disconnect(resultHandler rh); + //do not delete code below - indicator that esp need to MODE=B and esp.ready() to work + //_ESP.printf("MODE=B"); + //wait(1); + //while(!esp.ready()); + + /* + DBG.printf("emma: setup mqtt client\r\n"); + sprintf(mqttClientId,"emma/%s",emmaUID.c_str()); -private: - - void run(void const *argument); - int cycle(int timeout); - int waitfor(int packet_type, Timer& atimer); - int keepalive(); - int findFreeOperation(); + if(mqtt.begin(mqttClientId, platformKEY.c_str(), platformSECRET.c_str(), 120, 1)) { + mqtt.connectedCb.attach(&mqttConnected); + mqtt.disconnectedCb.attach(&mqttDisconnected); + mqtt.connect(MQTT_HOST,MQTT_PORT,false); + DBG.printf("emma: success to setup mqtt\r\n"); + TFT.locate(0,40); + TFT.printf("emma: success to setup mqtt"); + } + DBG.printf("emma: system started\r\n"); + */ + + //t.start(); + //while(t.read_ms() < 5000) { + // esp.process(); + //} + //t.stop(); + //t.reset(); + + //set ade7758 parameter + ADE.begin(); + //ADE.AVRMSCalib = 1526873.00; + //ADE.BVRMSCalib = 534202.00; + //ADE.CVRMSCalib = 456990.00; + //ADE.AIRMSCalib = 39248.00; + //ADE.BIRMSCalib = 654.00; + //ADE.CIRMSCalib = 111.00; + + ADE.writeRMSOffset(AIRMSOFFSET, BIRMSOFFSET, CIRMSOFFSET, AVRMSOFFSET, BVRMSOFFSET, CVRMSOFFSET); + + ADE.write16bits(AWG, 0); + ADE.write16bits(BWG, 0); + ADE.write16bits(CWG, 0); + ADE.write16bits(AVAG, 0); + ADE.write16bits(BVAG, 0); + ADE.write16bits(CVAG, 0); + + //ADE.AWhLSB = 0.000001192;//0.00006025556; + //ADE.AWhLSB = 0.00002109; + //ADE.BWhLSB = 0.25075167; + //ADE.CWhLSB = 0.25075167; + + //ADE.AVAhLSB = 0.00008370; + //ADE.BVAhLSB = 0; + //ADE.CVAhLSB = 0; + + //init rest to server + if(rest.begin(EMMA_SERVER_HOST,EMMA_SERVER_PORT,false)) { + DBG.printf("rest to server is created\r\n"); + TFT.locate(0,40); + TFT.printf(" "); + TFT.locate(0,40); + TFT.printf("rest to server is created"); + } else { + DBG.printf("rest to server is NOT created\r\n"); + TFT.locate(0,40); + TFT.printf(" "); + TFT.locate(0,40); + TFT.printf("rest to server is NOT created"); + } + + //check firmware update - int decodePacket(int* value, int timeout); - int readPacket(int timeout); - int sendPacket(int length, int timeout); - int deliverMessage(MQTTString* topic, Message* message); + //execute last state of switches on board - Thread* thread; - Network* ipstack; - - Limits limits; - - char* buf; - char* readbuf; + //get list of nodes from server + sprintf(s,"/emma/api/controller/remotes?uid=%s&hmac=%s",emmaUID.c_str(),hmac.c_str()); + rest.get(s); + for(int i=0; i<sizeof(s); i++) { + s[i]=0; } + rest.getResponse(s,sizeof(s)); + str = s; + if(str.rfind("[{\"mac\"") != std::string::npos) { + DBG.printf("get nodes from server\r\n"); + str.erase(str.begin(),str.begin()+str.rfind("[{\"mac\"")); + str.erase(str.begin()+str.rfind("}]")+2,str.end()); + + parse(jsonValue,str.c_str()); + char *parameter[2] = {"mac","ip"}; + + TFT.locate(0,40); + TFT.printf(" "); + TFT.locate(0,40); + TFT.printf("get %d nodes from server",jsonValue.size()); + wait(0.5); + TFT.locate(0,40); + TFT.printf(" "); + + //check whether nodes valid + bool validNodes = true; + for(int i=0; i<jsonValue.size(); i++) { + for(int j=0; j<2; j++) { + validNodes = validNodes && jsonValue[i].hasMember(parameter[j]); + } + } + DBG.printf("nodes validity:%d\r\n",validNodes); + + if(validNodes) { + for(int i=0; i<jsonValue.size(); i++) { + string macValue = jsonValue[i][parameter[0]].get<std::string>(); + string ipValue = jsonValue[i][parameter[1]].get<std::string>(); + nodes[i].macAddr = macValue; + nodes[i].ipAddr = ipValue; + DBG.printf("nodes[%d]mac:%s\r\n",i,nodes[i].macAddr.c_str()); + DBG.printf("nodes[%d]ip:%s\r\n",i,nodes[i].ipAddr.c_str()); + } + } + + } else { + DBG.printf("no nodes from server\r\n"); + } + + /* + //success + DBG.printf("emma: setup mqtt client\r\n"); + sprintf(mqttClientId,"emma/%s",emmaUID.c_str()); + if(mqtt.begin(mqttClientId, platformKEY.c_str(), platformSECRET.c_str(), 120, 1)) { + mqtt.connectedCb.attach(&mqttConnected); + mqtt.disconnectedCb.attach(&mqttDisconnected); + mqtt.connect(MQTT_HOST,MQTT_PORT,false); + DBG.printf("emma: success to setup mqtt\r\n"); + TFT.locate(0,40); + TFT.printf("emma: success to setup mqtt"); + } + DBG.printf("emma: system started\r\n"); + + t.start(); + while(t.read_ms() < 5000) { + esp.process(); + } + t.stop(); + t.reset(); + */ + + //preset nodes' macAddr and ipAddr + //nodes[0].macAddr = "002629034222"; + //nodes[0].ipAddr = "192.168.2.15"; + //nodes[1].macAddr = "00262903424e"; + //nodes[1].ipAddr = "192.168.2.32"; + + //init rest to remotes + for(int i=0; i<NODES_MAX; i++) { + if(!nodes[i].ipAddr.empty()) { + DBG.printf("restConn nodes[%d] is created\r\n",i); + nodes[i].restConn->begin(nodes[i].ipAddr.c_str(),16038,false); + wait(1); + } else { + DBG.printf("restConn nodes[%d] is NOT created\r\n",i); + wait(1); + } + } + + _ESP.attach(&rxInterrupt,Serial::RxIrq); + + //define thread + osThreadDef(energyThread, osPriorityBelowNormal, (8*DEFAULT_STACK_SIZE)); + //create thread + osThreadCreate(osThread(energyThread),NULL); + + tPanelEnergy.start(); + tPanel.start(); + tNodes.start(); + wait(1); + while(1) { + checkRxBuffer(); + checkVoltagePower(); + + //whether espFreeMemory occurs + if(espFreeMemory) { + //success if rxInterrupt is disabled + + //disable UART2 + NVIC_DisableIRQ(USART2_IRQn); + + DBG.printf("emma: setup mqtt client\r\n"); + sprintf(mqttClientId,"emma/%s",emmaUID.c_str()); + if(mqtt.begin(mqttClientId, platformKEY.c_str(), platformSECRET.c_str(), 120, 1)) { + mqtt.connectedCb.attach(&mqttConnected); + mqtt.disconnectedCb.attach(&mqttDisconnected); + mqtt.connect(MQTT_HOST,MQTT_PORT,false); + DBG.printf("emma: success to setup mqtt\r\n"); + TFT.locate(0,40); + TFT.printf("emma: success to setup mqtt"); + } + DBG.printf("emma: system started\r\n"); + + t.start(); + while(t.read_ms() < 5000) { + esp.process(); + } + t.stop(); + t.reset(); + + //enable UART2 + NVIC_EnableIRQ(USART2_IRQn); - Timer ping_timer, connect_timer; - unsigned int keepAliveInterval; - bool ping_outstanding; - - PacketId packetid; + espFreeMemory = false; + } + + //panelEnergy, panelVoltage, and panelPower + if(tPanelEnergy.read() > 30.0f) { + DBG.printf("[%d]WattHR for each phase: %.2f, %.2f, %.2f\r\n", loop, AWattHr, BWattHr, CWattHr); + TFT.locate(0,60); + TFT.printf(" "); + TFT.locate(0,60); + TFT.printf("[%d]WHR: %.1f, %.1f, %.1f", loop, AWattHr, BWattHr, CWattHr); + + DBG.printf("VRMS for each phase: %.2f, %.2f, %.2f\r\n", AVrms, BVrms, CVrms); + TFT.locate(0,80); + TFT.printf(" "); + TFT.locate(0,80); + TFT.printf("VRMS: %.1f, %.1f, %.1f", AVrms, BVrms, CVrms); + + DBG.printf("Watt for each phase: %.2f, %.2f, %.2f\r\n", AWatt, BWatt, CWatt); + TFT.locate(0,100); + TFT.printf(" "); + TFT.locate(0,100); + TFT.printf("Watt: %.1f, %.1f, %.1f", AWatt, BWatt, CWatt); + + if(newEnergyData) { + //for(int i=1; i<4; i++) { + for(int i=1; i<2; i++) { + DBG.printf("sending channel: %d\r\n",i); + if(i==1){ + XWattHr = AWattHr; + XVrms = AVrms; + XWatt = AWatt; + } else if(i==2) { + XWattHr = BWattHr; + XVrms = BVrms; + XWatt = BWatt; + } else { + XWattHr = CWattHr; + XVrms = CVrms; + XWatt = CWatt; + } + + if(XWattHr != 0.0f) { + + sprintf(r,"/emma/api/controller/energy/%d",i); + seconds = time(NULL); + //for(int j=0; j<sizeof(q); j++) { + // q[j]=0; } + strftime(q, 32, "%Y-%m-%d %H:%M:%S",localtime(&seconds)); + + //calculate hmacTime + for(int j=0; j<sizeof(p); j++) { + p[j]=0; } + sprintf(p,"emma-%s-%s",emmaUID.c_str(),q); + hmacTime = calculateMD5(p); + + sprintf(s,"{\"uid\":\"%s\",\"hmac\":\"%s\",\"time\":\"%s\",\"energy\":%.2f,\"voltage\":%.2f,\"power\":%.2f}", + emmaUID.c_str(),hmacTime.c_str(),q,XWattHr,XVrms,XWatt); + //DBG.printf("dataEnergy:\r\n%s\r\n",s); + rest.post(r,s); + wait(2); + if(rxBuf.find("\"status\":\"success\"") != std::string::npos) { + DBG.printf("send channel: %d success\r\n",i); + TFT.foreground(Green); + TFT.locate(0,120); + TFT.printf(" "); + TFT.locate(0,120); + TFT.printf("send ch%d success",i); + wait(1); + TFT.locate(0,120); + TFT.printf(" "); + TFT.foreground(White); + } else { + DBG.printf("send channel: %d failed\r\n",i); + TFT.foreground(Red); + TFT.locate(0,120); + TFT.printf(" "); + TFT.locate(0,120); + TFT.printf("send ch%d failed",i); + wait(1); + TFT.locate(0,120); + TFT.printf(" "); + TFT.foreground(White); + } + } + } + + newEnergyData = false; + } + + tPanelEnergy.reset(); + loop++; + } + + //panel environment + checkRxBuffer(); + if(tPanel.read() > 900.0f) { //900 is 15 minutes + int dTemp=0; + int dHum=0; + int dGas=0; + + DBG.printf("getPanelEnvironment\r\n"); + + //get environment sensor + trial=0; + while(1) { + if(trial>=2) { //two times trial + break; + } + if(d.readData() == DHT11::OK) { + dTemp = d.readTemperature(); + dHum = d.readHumidity(); + break; + } + trial++; + wait(3); + } + + //send environment sensor + if(dTemp!=0 && dHum!=0) { + seconds = time(NULL); + strftime(q, 32, "%Y-%m-%d %H:%M:%S",localtime(&seconds)); + + //calculate hmacTime + for(int j=0; j<sizeof(p); j++) { + p[j]=0; } + sprintf(p,"emma-%s-%s",emmaUID.c_str(),q); + hmacTime = calculateMD5(p); + + sprintf(s,"{\"uid\":\"%s\",\"hmac\":\"%s\",\"time\":\"%s\",\"temp\":%d,\"hum\":%d,\"gas\":%d}", + emmaUID.c_str(),hmacTime.c_str(),q,dTemp,dHum,dGas); + //DBG.printf("dataEnvironment:\r\n%s\r\n",s); + rest.post("/emma/api/controller/environment",s); + wait(2); + str = rxBuf; + if(str.rfind("/environment") != std::string::npos) { + str.erase(str.begin(),str.begin()+str.rfind("/environment")); + if(str.find("\"status\":\"success\"") != std::string::npos) { + DBG.printf("send panel environment success\r\n"); + } else { + DBG.printf("send panel environment failed\r\n"); + } + } + checkRxBuffer(); + } + tPanel.reset(); + } + + //nodeTemp + checkRxBuffer(); + if(tNodes.read() > 900.0f) { //900 is 15 minutes + DBG.printf("getNodesTemperature\r\n"); + + for(int i=0; i<NODES_MAX; i++) { + if(!nodes[i].ipAddr.empty()) { + //get node's temp + string temp; + nodes[i].restConn->get("/","<?xml version=\"1.0\" encoding=\"utf-8\"?><app_cmd cmd=\"2\"/>\r\n"); + wait(2); + temp = rxBuf; + if(temp.rfind(nodes[i].ipAddr) != std::string::npos) { + temp.erase(temp.begin(),temp.begin()+temp.rfind(nodes[i].ipAddr)); + if(temp.rfind("temp=") != std::string::npos) { + temp.erase(temp.begin(),temp.begin()+temp.rfind("temp=")+6); + temp.erase(temp.begin()+temp.find("\""),temp.end()); + } else { + temp = "0"; //connect to node, but receive none + } + } else { + temp = "0"; //not connected to node + } + + DBG.printf("nodeTemp[%d]:%s\r\n",i,temp.c_str()); + + //send node's temp + if(temp != "0") { + seconds = time(NULL); + strftime(q, 32, "%Y-%m-%d %H:%M:%S",localtime(&seconds)); + + //calculate hmacTime + for(int j=0; j<sizeof(p); j++) { + p[j]=0; } + sprintf(p,"emma-%s-%s",emmaUID.c_str(),q); + hmacTime = calculateMD5(p); + + sprintf(s,"{\"uid\":\"%s\",\"hmac\":\"%s\",\"time\":\"%s\",\"mac\":\"%s\",\"value\":%s}", + emmaUID.c_str(),hmacTime.c_str(),q,nodes[i].macAddr.c_str(),temp.c_str()); + //DBG.printf("dataNodeTemp:\r\n%s\r\n",s); + rest.post("/emma/api/controller/nodetemp",s); + wait(2); + str = rxBuf; + if(str.rfind("/nodetemp") != std::string::npos) { + str.erase(str.begin(),str.begin()+str.rfind("/nodetemp")); + if(str.find("\"status\":\"success\"") != std::string::npos) { + DBG.printf("send nodeTemp success\r\n"); + } else { + DBG.printf("send nodeTemp failed\r\n"); + } + } + checkRxBuffer(); + } + } + } + tNodes.reset(); + } + + //command + checkRxBuffer(); + if(newCommand) { + DBG.printf("newCommand:\r\n%s\r\n",globalCommand.c_str()); + TFT.locate(0,160); + TFT.printf(" "); + TFT.locate(0,160); + TFT.printf("newCommand"); + + parse(jsonValue,globalCommand.c_str()); + char *parameter[5] = {"name","nType","nAddr","dType","cmd"}; + + //check whether command is valid + bool validCommand = true; + for(int i=0; i<5; i++) { + validCommand = validCommand && jsonValue.hasMember(parameter[i]); + } + DBG.printf("command validity:%d\r\n",validCommand); + + if(validCommand) { + string commandName = jsonValue[parameter[0]].get<std::string>(); + string commandNType = jsonValue[parameter[1]].get<std::string>(); + string commandNAddr = jsonValue[parameter[2]].get<std::string>(); + string commandDType = jsonValue[parameter[3]].get<std::string>(); + string commandCmd = jsonValue[parameter[4]].get<std::string>(); + + if(commandNType == "0") { //switch on panel controller + DBG.printf("command for switch\r\n"); + } + else if(commandNType == "1") { //node with mac address + DBG.printf("command for node\r\n"); + //get node ip address based on node mac address + //string nodeIP; + //nodeIp = readNodeIP(commandNAddr); + //nodeIP = "192.168.2.15"; + //DBG.printf("nodeIP: %s\r\n",nodeIP.c_str()); + + //get index of node list based on mac address + int idx = NODES_INVALID; + for(int i=0; i<NODES_MAX; i++) { + if(!nodes[i].macAddr.compare(commandNAddr)) { + idx = i; + } + } + + //execution process + //int trial; + string execResult = "failed"; + if(idx != NODES_INVALID) { + DBG.printf("index found at %d\r\n",idx); + + //get cmd string based on device type and command number + string nodeCmd; + nodeCmd = readNodeCmd(commandDType,commandCmd); + //nodeCmd = "020129A0163B161315131613153C151316131514143C153C16141414141415151315141414141514141415141414143D1514143D141415141414143D14000D"; //turn off + //DBG.printf("nodeCmd: %s\r\n",nodeCmd.c_str()); + + //execute command + DBG.printf("executing command\r\n"); + sprintf(s,"<?xml version=\"1.0\" encoding=\"utf-8\"?><app_cmd cmd=\"5\" /><app_data code=\"%s\"/>\r\n",nodeCmd.c_str()); + + trial=0; + while(1) { + //cmdExecuted = false; + if(trial>=2) { //two times trial + DBG.printf("cmd is not executed\r\n"); + TFT.foreground(Red); + TFT.locate(0,180); + TFT.printf(" "); + TFT.locate(0,180); + TFT.printf("cmd is not executed"); + wait(1); + TFT.locate(0,180); + TFT.printf(" "); + TFT.foreground(White); + break; + } + nodes[idx].restConn->get("/",s); + wait(2); + if(rxBuf.find("REST: Sent") != std::string::npos) { + DBG.printf("cmd is executed\r\n"); + TFT.foreground(Green); + TFT.locate(0,180); + TFT.printf(" "); + TFT.locate(0,180); + TFT.printf("cmd is executed"); + wait(1); + TFT.locate(0,180); + TFT.printf(" "); + TFT.foreground(White); + execResult = "success"; + break; + } + trial++; + } + } else { + TFT.foreground(Red); + TFT.locate(0,180); + TFT.printf(" "); + TFT.locate(0,180); + TFT.printf("node is invalid"); + wait(1); + TFT.locate(0,180); + TFT.printf(" "); + TFT.foreground(White); + } + + wait(2); + //send execution result + //DBG.printf("send execution result\r\n"); + + //calculate hmacCmd + for(int j=0; j<sizeof(p); j++) { + p[j]=0; } + sprintf(p,"emma-%s-%s",emmaUID.c_str(),commandCmd.c_str()); + hmacCmd = calculateMD5(p); + + sprintf(s,"{\"uid\":\"%s\",\"nType\":\"%s\",\"nAddr\":\"%s\",\"dType\":\"%s\",\"cmd\":\"%s\",\"name\":\"%s\",\"result\":\"%s\",\"hmac\":\"%s\"}", + emmaUID.c_str(), commandNType.c_str(),commandNAddr.c_str(),commandDType.c_str(),commandCmd.c_str(),commandName.c_str(),execResult.c_str(),hmacCmd.c_str()); + + trial=0; + while(1) { + if(trial>=2) { //two times trial + DBG.printf("failed to send execution result\r\n"); + break; + } + rest.post("/emma/api/controller/result",s); + wait(2); + str = rxBuf; + if(str.rfind("/result") != std::string::npos) { + str.erase(str.begin(),str.begin()+str.rfind("/result")); + if(str.find("\"status\":\"success\"") != std::string::npos) { + DBG.printf("success to send execution result\r\n"); + break; + } + } + checkRxBuffer(); + trial++; + } + } + } + + //clear text on lcd + TFT.locate(0,160); + TFT.printf(" "); + + newCommand = false; + } + osDelay(5000); + } + } +} +void emmaModeFirmwareDownload(void) { + bool emmaGetFirmwareParam = false; + MbedJSONValue jsonValue; - typedef FP<void, Result*> resultHandlerFP; - resultHandlerFP connectHandler; + DBG.printf("emmaModeFirmwareDownload\r\n"); - typedef FP<void, Message*> messageHandlerFP; - struct MessageHandlers - { - const char* topic; - messageHandlerFP fp; - } *messageHandlers; // Message handlers are indexed by subscription topic + char s[384]; + string str; + string connData; + string chunk; + + //firmware parameter + string firmwareVer; + string firmwareName; + int numPart; - // how many concurrent operations should we allow? Each one will require a function pointer - struct Operations - { - unsigned short id; - resultHandlerFP fp; - const char* topic; // if this is a publish, store topic name in case republishing is required - Message* message; // for publish, - Timer timer; // to check if the command has timed out - } *operations; // result handlers are indexed by packet ids + //downloading + string firmwarePart; + string calcMD5; + string srvrMD5; + bool nextPart; + + //set wifi to mode bridge + _ESP.printf("MODE=B"); + DBG.printf("set mode bridge\r\n"); + while(1) { + char rcv[128] = {}; + rcvReply(rcv,3000); + str = rcv; + if(str.find("MODE=B_OK") != std::string::npos) + break; + } + DBG.printf("MODE=B\r\n"); + + esp.enable(); + wait(1); + while(!esp.ready()); + + if(!rest.begin("candra.tritronik.com",3128,false)) { + DBG.printf("EMMA: fail to setup rest"); + while(1); + } + + //wifiConnected = true; //with custom firmware, panel should connect wifi automatically + useProxy = true; + + esp.process(); + //set connData + if(useProxy) { + for(int i=0; i<sizeof(s); i++) { + s[i]=0; } + //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()); + sprintf(s,"http://192.168.128.69/emmaController/firmware/firmwareParameter"); + connData = s; + } else { + for(int i=0; i<sizeof(s); i++) { + s[i]=0; } + //sprintf(s,"/emma/api/controller/register?uid=%s&hmac=%s",emmaUID.c_str(),hmac.c_str()); + sprintf(s,"/emmaController/firmware/firmwareParameter"); + connData = s; + } + + //get parameter of firmware to be downloaded + while(!emmaGetFirmwareParam) { + rest.get(connData.c_str()); + for(int i=0; i<sizeof(s); i++) { + s[i]=0; } + rest.getResponse(s,sizeof(s)); + //DBG.printf("rsp param:%s\r\n",s); + + str = s; + if(str.find("[") != std::string::npos && str.find("]") != std::string::npos) { + str.erase(str.begin(),str.begin()+str.find("[")+1); + str.erase(str.begin()+str.find("]"),str.end()); + + parse(jsonValue,str.c_str()); + + char *parameter[2] = {"firmwareVer","numPart"}; + + for(int i=0; i<2; i++) { + if(jsonValue.hasMember(parameter[i])) { + string val = jsonValue[parameter[i]].get<std::string>(); + if(i==0) { + firmwareVer = val; + } else if(i==1) { + sscanf(val.c_str(),"%d",&numPart); + } + } + } + + if(!firmwareVer.empty() && numPart!=0) { + emmaGetFirmwareParam = true; + } + } + } + DBG.printf("firmwareVer:%s\r\n",firmwareVer.c_str()); + DBG.printf("numPart:%d\r\n",numPart); + + //clear firmware file + while(1) { + if(clearFirmware()){ + DBG.printf("clear firmware on sd card\r\n\r\n"); + break; + } + wait(1); + } + + //set connData + if(useProxy) { + for(int i=0; i<sizeof(s); i++) { + s[i]=0; } + sprintf(s,"http://192.168.128.69/emmaController/firmware/%s",firmwareVer.c_str()); + connData = s; + } else { + for(int i=0; i<sizeof(s); i++) { + s[i]=0; } + sprintf(s,"/emmaController/firmware/%s",firmwareVer.c_str()); + connData = s; + } + + //download firmware + for(int n=0; n<numPart; n++) { + nextPart = false; + while(!nextPart) { + for(int i=0; i<sizeof(s); i++) { + s[i]=0; } + sprintf(s,"%s/firmware_Hex_%s_%d",connData.c_str(),firmwareVer.c_str(),n); + rest.get(s); + for(int i=0; i<sizeof(s); i++) { + s[i]=0; } + rest.getResponse(s,sizeof(s)); + //DBG.printf("rsp[%d]:%s\r\n",n,s); + + str = s; + if(str.find("{") != std::string::npos && str.find("}") != std::string::npos) { + str.erase(str.begin(),str.begin()+str.find("{")+1); + str.erase(str.begin()+str.find("}"),str.end()); + //DBG.printf("firmwarePart[%d]:%s\r\n",n,str.c_str()); + firmwarePart = str; + + //calculated MD5 + calcMD5 = calculateMD5(firmwarePart); + //DBG.printf("calcMD5[%d]:%s\r\n",n,calcMD5.c_str()); + + //MD5 from server + for(int i=0; i<sizeof(s); i++) { + s[i]=0; } + sprintf(s,"%s/MD5/firmware_MD5_%s_%d",connData.c_str(),firmwareVer.c_str(),n); + rest.get(s); + for(int i=0; i<sizeof(s); i++) { + s[i]=0; } + rest.getResponse(s,sizeof(s)); + + str = s; + if(str.find("{") != std::string::npos && str.find("}") != std::string::npos) { + str.erase(str.begin(),str.begin()+str.find("{")+1); + str.erase(str.begin()+str.find("}"),str.end()); + srvrMD5 = str; + //DBG.printf("srvrMD5[%d]:%s\r\n",n,srvrMD5.c_str()); + + //compare original MD5 vs MD5 from server + if(strcmp(calcMD5.c_str(),srvrMD5.c_str()) == 0) { + //DBG.printf("MD5 correct\r\n"); + + //save to sd card + int st = writeFirmwareHexToChar(firmwarePart); + if(st) { + DBG.printf("firmwarePart[%d/%d] written\r\n",n,numPart-1); + nextPart = true; + } + + } else { + DBG.printf("MD5 incorrect\r\n"); + } + } + } else { + DBG.printf("retry to fetch firmwarePart[%d]\r\n",n); + } + wait(0.5); + } + } + DBG.printf("download finished\r\n"); +} +/*end emma mode*/ - static void threadfn(void* arg); - - messageHandlerFP defaultMessageHandler; +/*start energy related*/ +void energyThread(void const*) { + Timer tEnergy; + + while(1) { + tEnergy.start(); + DBG.printf("energyThread-start\r\n"); + + AWattHrSum = 0; + BWattHrSum = 0; + CWattHrSum = 0; + + while(tEnergy.read() < 1*60.0) { + AWattHrValue = ADE.getWattHR(PHASE_A); + BWattHrValue = ADE.getWattHR(PHASE_B); + CWattHrValue = ADE.getWattHR(PHASE_C); + + AWattHrSum += AWattHrValue; + BWattHrSum += BWattHrValue; + CWattHrSum += CWattHrValue; + + + //start check voltage and power + AVrms = ADE.VRMS(PHASE_A) * 0.000124f; //0.000158; //constants are from calculateVRMS function + BVrms = ADE.VRMS(PHASE_B) * 0.000123f; + CVrms = ADE.VRMS(PHASE_C) * 0.000122f; + + AIrms = ADE.IRMS(PHASE_A) * 0.00001006f; //0.0000125f; //constants are from calculateIRMS function + BIrms = ADE.IRMS(PHASE_B) * 0.00001005f; + CIrms = ADE.IRMS(PHASE_C) * 0.00001004f; - typedef FP<int, connectionLostInfo*> connectionLostFP; + AWatt = AVrms * AIrms; + BWatt = BVrms * BIrms; + CWatt = CVrms * CIrms; + //end check voltage and power + + } + + AWattHr = AWattHrSum * 0.000044169f; //0.0000198f; + BWattHr = BWattHrSum * 0.000044168f; //0.0000197f; + CWattHr = CWattHrSum * 0.000044167f; //0.0000196f; + + newEnergyData = true; + + tEnergy.stop(); + tEnergy.reset(); + DBG.printf("energyThread-finish\r\n"); + } +} +void checkVoltagePower(void) { + //check if voltage or power violates threshold + char p[64]; + char q[32]; + char s[256]; + string hmacTime; + string str; + time_t seconds; + + //DBG.printf("checkVoltagePower-start\r\n"); - connectionLostFP connectionLostHandler; + //vrms and irms might be placed inside energy calculation routine + /* + AVrms = ADE.VRMS(PHASE_A) * 0.000128f; //0.000158; //constants are from calculateVRMS function + BVrms = ADE.VRMS(PHASE_B) * 0.000127f; //0.000157; + CVrms = ADE.VRMS(PHASE_C) * 0.000126f; //0.000156; + + AIrms = ADE.IRMS(PHASE_A) * 0.0000125f; //constants are from calculateIRMS function + BIrms = ADE.IRMS(PHASE_B) * 0.0000123f; + CIrms = ADE.IRMS(PHASE_C) * 0.0000124f; + + AWatt = AVrms * AIrms; + BWatt = BVrms * BIrms; + CWatt = CVrms * CIrms; + */ + + //DBG.printf("Vrms of each phase:%.2f - %.2f - %.2f\r\n", AVrms, BVrms, CVrms); + //DBG.printf("Watt of each phase:%.2f - %.2f - %.2f\r\n", AWatt, BWatt, CWatt); + //wait(1); + + //get time + seconds = time(NULL); + strftime(q, 32, "%Y-%m-%d %H:%M:%S",localtime(&seconds)); + + //calculate hmacTime + for(int j=0; j<sizeof(p); j++) { + p[j]=0; } + sprintf(p,"emma-%s-%s",emmaUID.c_str(),q); + hmacTime = calculateMD5(p); -}; - + if(AVrms > VRMSTHRESHOLD || AWatt > WATTTHRESHOLD) { + DBG.printf("alert on ch1\r\n"); + sprintf(s,"{\"uid\":\"%s\",\"hmac\":\"%s\",\"time\":\"%s\",\"voltage\":%.2f,\"power\":%.2f}", + emmaUID.c_str(),hmacTime.c_str(),q,AVrms,AWatt); + rest.post("/emma/api/controller/alert/1",s); + wait(2); + str = rxBuf; + if(str.rfind("/alert/1") != std::string::npos) { + str.erase(str.begin(),str.begin()+str.rfind("/alert/1")); + if(str.find("\"status\":\"success\"") != std::string::npos) { + DBG.printf("send alert ch1 success\r\n"); + } else { + DBG.printf("send alert ch1 failed\r\n"); + } + } + } + + if(BVrms > VRMSTHRESHOLD || BWatt > WATTTHRESHOLD) { + DBG.printf("alert on ch2\r\n"); + sprintf(s,"{\"uid\":\"%s\",\"hmac\":\"%s\",\"time\":\"%s\",\"voltage\":%.2f,\"power\":%.2f}", + emmaUID.c_str(),hmacTime.c_str(),q,BVrms,BWatt); + rest.post("/emma/api/controller/alert/2",s); + wait(2); + str = rxBuf; + if(str.rfind("/alert/2") != std::string::npos) { + str.erase(str.begin(),str.begin()+str.rfind("/alert/2")); + if(str.find("\"status\":\"success\"") != std::string::npos) { + DBG.printf("send alert ch2 success\r\n"); + } else { + DBG.printf("send alert ch2 failed\r\n"); + } + } + } + + if(CVrms > VRMSTHRESHOLD || CWatt > WATTTHRESHOLD) { + DBG.printf("alert on ch3\r\n"); + DBG.printf("alert on ch3\r\n"); + sprintf(s,"{\"uid\":\"%s\",\"hmac\":\"%s\",\"time\":\"%s\",\"voltage\":%.2f,\"power\":%.2f}", + emmaUID.c_str(),hmacTime.c_str(),q,CVrms,CWatt); + rest.post("/emma/api/controller/alert/3",s); + wait(2); + str = rxBuf; + if(str.rfind("/alert/3") != std::string::npos) { + str.erase(str.begin(),str.begin()+str.rfind("/alert/3")); + if(str.find("\"status\":\"success\"") != std::string::npos) { + DBG.printf("send alert ch3 success\r\n"); + } else { + DBG.printf("send alert ch3 failed\r\n"); + } + } + } + //DBG.printf("checkVoltagePower-finish\r\n"); } +/*end energy related*/ +/*start wifi mqtt*/ +void mqttConnected(void* response) { + DBG.printf("MQTT Connected\r\n"); + char mqttTopic[64]; + sprintf(mqttTopic,"%s/%s/command",platformDOMAIN.c_str(),emmaUID.c_str()); + mqtt.subscribe(mqttTopic); +} +void mqttDisconnected(void* response) { + DBG.printf("MQTT Disconnected\r\n"); +} +/*end wifi mqtt*/ -template<class Network, class Timer, class Thread, class Mutex> void MQTT::Async<Network, Timer, Thread, Mutex>::threadfn(void* arg) -{ - ((Async<Network, Timer, Thread, Mutex>*) arg)->run(NULL); +/*start wifi rest*/ +void rxInterrupt(void) { + char c; + + while(_ESP.readable()) { + c = _ESP.getc(); + if(c != 0) { //char is not null + rxBuf += c; + } + } +} +void checkRxBuffer(void) { + //check new command + if(rxBuf.rfind("/command") != std::string::npos) { + rxBuf.erase(rxBuf.begin(),rxBuf.begin()+rxBuf.rfind("/command")); + if(rxBuf.find("[{") != std::string::npos && rxBuf.find("}]") != std::string::npos) { + rxBuf.erase(rxBuf.begin(),rxBuf.begin()+rxBuf.find("[{")+1); + rxBuf.erase(rxBuf.begin()+rxBuf.find("]"),rxBuf.end()); + rxBuf.assign(globalCommand); + //DBG.printf("gC:%s\r\n",globalCommand.c_str()); + newCommand = true; + } + } + + //check free memory -> reinitialize mqtt connection + if(rxBuf.rfind("Free memory") != std::string::npos || rxBuf.rfind("dhcp client start") != std::string::npos) { + espFreeMemory = true; + } + + //clear rxBuf + rxBuf.clear(); +} +/*end wifi rest*/ + +/*start eth mqtt*/ +void ethMQTTMessageArrived(MQTT::MessageData& md) { + MQTT::Message &message = md.message; + DBG.printf("Payload %.*s\r\n", message.payloadlen, (char*)message.payload); + + string sp = string((char*)(message.payload)); + + if(sp.find("[") != std::string::npos && sp.find("]") != std::string::npos) { + sp.erase(sp.begin(),sp.begin()+sp.find("[")+1); + sp.erase(sp.begin()+sp.find("]"), sp.end()); + globalCommand.assign(sp); + newCommand = true; + } } - -template<class Network, class Timer, class Thread, class Mutex> MQTT::Async<Network, Timer, Thread, Mutex>::Async(Network* network, Limits limits) : limits(limits), packetid() -{ - this->thread = 0; - this->ipstack = network; - this->ping_timer = Timer(); - this->ping_outstanding = 0; - - // How to make these memory allocations portable? I was hoping to avoid the heap - buf = new char[limits.MAX_MQTT_PACKET_SIZE]; - readbuf = new char[limits.MAX_MQTT_PACKET_SIZE]; - this->operations = new struct Operations[limits.MAX_CONCURRENT_OPERATIONS]; - for (int i = 0; i < limits.MAX_CONCURRENT_OPERATIONS; ++i) - operations[i].id = 0; - this->messageHandlers = new struct MessageHandlers[limits.MAX_MESSAGE_HANDLERS]; - for (int i = 0; i < limits.MAX_MESSAGE_HANDLERS; ++i) - messageHandlers[i].topic = 0; -} - - -template<class Network, class Timer, class Thread, class Mutex> int MQTT::Async<Network, Timer, Thread, Mutex>::sendPacket(int length, int timeout) -{ - int sent = 0; +int ethMQTTConnect(MQTT::Client<MQTTEthernet, Countdown, MQTT_MAX_PACKET_SIZE>* client, MQTTEthernet* ipstack) { + //char hostname[] = "q.thingfabric.com"; + //char hostname[] = "192.168.131.200"; + //int rc = ipstack->connect(hostname, MQTT_PORT); + int rc = ipstack->connect(MQTT_HOST, MQTT_PORT); - while (sent < length) - sent += ipstack->write(&buf[sent], length, timeout); - if (sent == length) - ping_timer.countdown(this->keepAliveInterval); // record the fact that we have successfully sent the packet - return sent; -} - - -template<class Network, class Timer, class Thread, class Mutex> int MQTT::Async<Network, Timer, Thread, Mutex>::decodePacket(int* value, int timeout) -{ - char c; - int multiplier = 1; - int len = 0; - const int MAX_NO_OF_REMAINING_LENGTH_BYTES = 4; - - *value = 0; - do - { - int rc = MQTTPACKET_READ_ERROR; - - if (++len > MAX_NO_OF_REMAINING_LENGTH_BYTES) - { - rc = MQTTPACKET_READ_ERROR; /* bad data */ - goto exit; - } - rc = ipstack->read(&c, 1, timeout); - if (rc != 1) - goto exit; - *value += (c & 127) * multiplier; - multiplier *= 128; - } while ((c & 128) != 0); -exit: - return len; -} - - -/** - * If any read fails in this method, then we should disconnect from the network, as on reconnect - * the packets can be retried. - * @param timeout the max time to wait for the packet read to complete, in milliseconds - * @return the MQTT packet type, or -1 if none - */ -template<class Network, class Timer, class Thread, class Mutex> int MQTT::Async<Network, Timer, Thread, Mutex>::readPacket(int timeout) -{ - int rc = -1; - MQTTHeader header = {0}; - int len = 0; - int rem_len = 0; - - /* 1. read the header byte. This has the packet type in it */ - if (ipstack->read(readbuf, 1, timeout) != 1) - goto exit; - - len = 1; - /* 2. read the remaining length. This is variable in itself */ - decodePacket(&rem_len, timeout); - len += MQTTPacket_encode(readbuf + 1, rem_len); /* put the original remaining length back into the buffer */ - - /* 3. read the rest of the buffer using a callback to supply the rest of the data */ - if (ipstack->read(readbuf + len, rem_len, timeout) != rem_len) - goto exit; - - header.byte = readbuf[0]; - rc = header.bits.type; -exit: + if(rc!=0) + return rc; + + //MQTT Connect + //char clientId[] = "emma/0674ff575349896767072538"; + char clientId [32]; + sprintf(clientId,"emma/%s",emmaUID.c_str()); + //DBG.printf("clientId:%s\r\n",clientId); + MQTTPacket_connectData data = MQTTPacket_connectData_initializer; + data.MQTTVersion = 3; + data.clientID.cstring = clientId; + data.username.cstring = "761b233e-a49a-4830-a8ae-87cec3dc1086"; + data.password.cstring = "ef25cf4567fbc07113252f8d72b7faf2"; + + if((rc = client->connect(&data)) == 0) { + DBG.printf("connected\r\n"); + } + + //MQTT Subscribe + //char* topic = "gaisbwqreqrfxjc/0674ff575349896767072538/command"; + char s[64]; + sprintf(s,"%s/%s/command",platformDOMAIN.c_str(),emmaUID.c_str()); + string topic = s; + DBG.printf("topic:%s\r\n",topic.c_str()); + if((rc=client->subscribe(topic.c_str(),MQTT::QOS2,ethMQTTMessageArrived)) == 0) { + DBG.printf("subscribe success!\r\n"); + } return rc; } +void ethMQTTAttemptConnect(MQTT::Client<MQTTEthernet, Countdown, MQTT_MAX_PACKET_SIZE>* client, MQTTEthernet* ipstack) { + int retryAttempt = 0; + + while(!ipstack->getEth().linkstatus()) { + DBG.printf("Ethernet link not present. Check cable connection\r\n"); + wait(1); + } + + while(ethMQTTConnect(client,ipstack) != 0) { + int timeout = 3; + DBG.printf("Retry attempt number %d waiting %d\r\n", retryAttempt, timeout); + wait(timeout); + retryAttempt++; + } +} -template<class Network, class Timer, class Thread, class Mutex> int MQTT::Async<Network, Timer, Thread, Mutex>::deliverMessage(MQTTString* topic, Message* message) -{ - int rc = -1; +/*end eth mqtt*/ + +/*start emma settings*/ +string getUID(void) { + char s[32]; + unsigned long *unique = (unsigned long *)BASE_ADDR; + sprintf(s,"%08x%08x%08x",unique[0], unique[1], unique[2]); + return s; +} - // we have to find the right message handler - indexed by topic - for (int i = 0; i < limits.MAX_MESSAGE_HANDLERS; ++i) - { - if (messageHandlers[i].topic != 0 && MQTTPacket_equals(topic, (char*)messageHandlers[i].topic)) - { - messageHandlers[i].fp(message); - rc = 0; - break; - } - } - - return rc; +string readSetting(string parameter) { + FILE *fp; + signed char c; + int i=0; + char s[64]; + string strS; + + sprintf(s,"/sd/settings/%s.txt",parameter.c_str()); + + fp = fopen(s,"r"); + memset(s,0,sizeof(s)); + if(fp != NULL) { + while(1) { + c = fgetc(fp); + if(c == EOF){ + break; + } + s[i] = c; + i++; + } + strS = s; + if(strS.find("(") != std::string::npos && strS.find(")") != std::string::npos) { + strS.erase(strS.begin(),strS.begin()+strS.find("(")+1); + strS.erase(strS.begin()+strS.find(")"),strS.end()); + } else { + strS = ""; + } + } + fclose(fp); + return strS; } - +bool writeSetting(string parameter, string value) { + FILE *fp; + char s[255]; + + sprintf(s,"/sd/settings/%s.txt",parameter.c_str()); + fp = fopen(s,"w"); + if(fp != NULL) { + fprintf(fp,value.c_str()); + fclose(fp); + return true; + } + return false; +} +/*end emma settings*/ -template<class Network, class Timer, class Thread, class Mutex> int MQTT::Async<Network, Timer, Thread, Mutex>::cycle(int timeout) -{ - /* get one piece of work off the wire and one pass through */ - - // read the socket, see what work is due - int packet_type = readPacket(timeout); +/*start emma node*/ +string readNodeIP(string macAddr) { + FILE *fp; + signed char c; + int i=0; + char s[64]; + string strS; - int len, rc; - switch (packet_type) - { - case CONNACK: - if (this->thread) - { - Result res = {this, 0}; - if (MQTTDeserialize_connack(&res.rc, readbuf, limits.MAX_MQTT_PACKET_SIZE) == 1) - ; - connectHandler(&res); - connectHandler.detach(); // only invoke the callback once - } - break; - case PUBACK: - if (this->thread) - ; //call resultHandler - case SUBACK: - break; - case PUBLISH: - MQTTString topicName; - Message msg; - rc = MQTTDeserialize_publish((int*)&msg.dup, (int*)&msg.qos, (int*)&msg.retained, (int*)&msg.id, &topicName, - (char**)&msg.payload, (int*)&msg.payloadlen, readbuf, limits.MAX_MQTT_PACKET_SIZE);; - if (msg.qos == QOS0) - deliverMessage(&topicName, &msg); - break; - case PUBREC: - int type, dup, mypacketid; - if (MQTTDeserialize_ack(&type, &dup, &mypacketid, readbuf, limits.MAX_MQTT_PACKET_SIZE) == 1) - ; - // must lock this access against the application thread, if we are multi-threaded - len = MQTTSerialize_ack(buf, limits.MAX_MQTT_PACKET_SIZE, PUBREL, 0, mypacketid); - rc = sendPacket(len, timeout); // send the PUBREL packet - if (rc != len) - goto exit; // there was a problem - - break; - case PUBCOMP: - break; - case PINGRESP: - ping_outstanding = false; - break; + sprintf(s,"/sd/nodeList/%s/nodeIP.txt",macAddr.c_str()); + + fp = fopen(s,"r"); + memset(s,0,sizeof(s)); + if(fp != NULL) { + while(1) { + c = fgetc(fp); + if(c == EOF){ + break; + } + s[i] = c; + i++; + } + strS = s; + if(strS.find("(") != std::string::npos && strS.find(")") != std::string::npos) { + strS.erase(strS.begin(),strS.begin()+strS.find("(")+1); + strS.erase(strS.begin()+strS.find(")"),strS.end()); + } else { + strS = ""; + } } - keepalive(); -exit: - return packet_type; + fclose(fp); + return strS; } - -template<class Network, class Timer, class Thread, class Mutex> int MQTT::Async<Network, Timer, Thread, Mutex>::keepalive() -{ - int rc = 0; - - if (keepAliveInterval == 0) - goto exit; - - if (ping_timer.expired()) - { - if (ping_outstanding) - rc = -1; - else - { - int len = MQTTSerialize_pingreq(buf, limits.MAX_MQTT_PACKET_SIZE); - rc = sendPacket(len, 1000); // send the ping packet - if (rc != len) - rc = -1; // indicate there's a problem - else - ping_outstanding = true; - } - } - -exit: - return rc; +string readNodeCmd(string dType, string cmd) { + FILE *fp; + signed char c; + int i=0; + char s[128]; + string strS; + + sprintf(s,"/sd/nodeCode/%s/%s.txt",dType.c_str(),cmd.c_str()); + + fp = fopen(s,"r"); + memset(s,0,sizeof(s)); + if(fp != NULL) { + while(1) { + c = fgetc(fp); + if(c == EOF){ + break; + } + s[i] = c; + i++; + } + strS = s; + if(strS.find("(") != std::string::npos && strS.find(")") != std::string::npos) { + strS.erase(strS.begin(),strS.begin()+strS.find("(")+1); + strS.erase(strS.begin()+strS.find(")"),strS.end()); + } else { + strS = ""; + } + } + fclose(fp); + return strS; } - -template<class Network, class Timer, class Thread, class Mutex> void MQTT::Async<Network, Timer, Thread, Mutex>::run(void const *argument) -{ - while (true) - cycle(ping_timer.left_ms()); -} - - -// only used in single-threaded mode where one command at a time is in process -template<class Network, class Timer, class Thread, class Mutex> int MQTT::Async<Network, Timer, Thread, Mutex>::waitfor(int packet_type, Timer& atimer) -{ - int rc = -1; - - do - { - if (atimer.expired()) - break; // we timed out - } - while ((rc = cycle(atimer.left_ms())) != packet_type); - - return rc; +string *readNodeList(void) { + static string nd[10]; //max node + DIR *d; + struct dirent *p; + string q; + int i=0; + + d = opendir("/sd/nodeList"); + if(d != NULL) { + while((p = readdir(d)) != NULL) { + q = p->d_name; + nd[i] = q; + i++; + } + } + closedir(d); + return nd; } - -template<class Network, class Timer, class Thread, class Mutex> int MQTT::Async<Network, Timer, Thread, Mutex>::connect(resultHandler resultHandler, MQTTPacket_connectData* options) -{ - connect_timer.countdown(limits.command_timeout_ms); - - MQTTPacket_connectData default_options = MQTTPacket_connectData_initializer; - if (options == 0) - options = &default_options; // set default options if none were supplied - - this->keepAliveInterval = options->keepAliveInterval; - ping_timer.countdown(this->keepAliveInterval); - int len = MQTTSerialize_connect(buf, limits.MAX_MQTT_PACKET_SIZE, options); - int rc = sendPacket(len, connect_timer.left_ms()); // send the connect packet - if (rc != len) - goto exit; // there was a problem - - if (resultHandler == 0) // wait until the connack is received - { - // this will be a blocking call, wait for the connack - if (waitfor(CONNACK, connect_timer) == CONNACK) - { - int connack_rc = -1; - if (MQTTDeserialize_connack(&connack_rc, readbuf, limits.MAX_MQTT_PACKET_SIZE) == 1) - rc = connack_rc; - } - } - else - { - // set connect response callback function - connectHandler.attach(resultHandler); - - // start background thread - this->thread = new Thread((void (*)(void const *argument))&MQTT::Async<Network, Timer, Thread, Mutex>::threadfn, (void*)this); - } +string wifiGetNodeTemp(string macAddr) { + int trial=0; + string nodeIP = readNodeIP(macAddr); + string str; + string temp = "0"; -exit: - return rc; -} - - -template<class Network, class Timer, class Thread, class Mutex> int MQTT::Async<Network, Timer, Thread, Mutex>::findFreeOperation() -{ - int found = -1; - for (int i = 0; i < limits.MAX_CONCURRENT_OPERATIONS; ++i) - { - if (operations[i].id == 0) - { - found = i; - break; - } - } - return found; -} - - -template<class Network, class Timer, class Thread, class Mutex> int MQTT::Async<Network, Timer, Thread, Mutex>::subscribe(resultHandler resultHandler, const char* topicFilter, enum QoS qos, messageHandler messageHandler) -{ - int index = 0; - if (this->thread) - index = findFreeOperation(); - Timer& atimer = operations[index].timer; - - atimer.countdown(limits.command_timeout_ms); - MQTTString topic = {(char*)topicFilter, 0, 0}; - - int len = MQTTSerialize_subscribe(buf, limits.MAX_MQTT_PACKET_SIZE, 0, packetid.getNext(), 1, &topic, (int*)&qos); - int rc = sendPacket(len, atimer.left_ms()); // send the subscribe packet - if (rc != len) - goto exit; // there was a problem - - /* wait for suback */ - if (resultHandler == 0) - { - // this will block - if (waitfor(SUBACK, atimer) == SUBACK) - { - int count = 0, grantedQoS = -1, mypacketid; - if (MQTTDeserialize_suback(&mypacketid, 1, &count, &grantedQoS, readbuf, limits.MAX_MQTT_PACKET_SIZE) == 1) - rc = grantedQoS; // 0, 1, 2 or 0x80 - if (rc != 0x80) - { - for (int i = 0; i < limits.MAX_MESSAGE_HANDLERS; ++i) - { - if (messageHandlers[i].topic == 0) - { - messageHandlers[i].topic = topicFilter; - messageHandlers[i].fp.attach(messageHandler); - rc = 0; - break; - } - } + if(rest.begin(nodeIP.c_str(),REMOTE_TCP_PORT,false)) { + while(1) { + char rcv[256] = {}; + rest.get("/","<?xml version=\"1.0\" encoding=\"utf-8\"?><app_cmd cmd=\"2\"/>\r\n"); + rest.getResponse(rcv,sizeof(rcv)); + str = rcv; + if(str.find("temp=") != std::string::npos) { + str.erase(str.begin(),str.begin()+str.find("temp=")+6); + str.erase(str.begin()+str.find("\""),str.end()); + temp = str; + break; } + if(trial>1) { //three times trial + break; + } + trial++; + wait(2); } } - else - { - // set subscribe response callback function - + return temp; +} +/*end emma node*/ + +/*start emma connection function*/ +string ethGET(string host, int port, string url) { +// DBG.printf("Entering ethGET with url: %s\r\n", url); +// DBG.printf("Host: %s\r\n", host); +// DBG.printf("Port: %d\r\n", port); + char buf[1024]; + char s[256]; + int ret; + TCPSocketConnection sock; + Timer t; + + DBG.printf("Sock connecting\r\n"); + if (sock.connect(host.c_str(), port) == 0){ + DBG.printf("Sock connected successfully\r\n"); + } + else { + DBG.printf("Sock failed to connect\r\n"); + sock.close(); + return buf; + } + DBG.printf("Sock sending all\r\n"); + sprintf(s,"%s",url.c_str()); + int size = sock.send_all(s,sizeof(s)-1); + if (size >= 0) { + DBG.printf("Sock sent %d\r\n", size); + } + else { + DBG.printf("Sock failed to send\r\n"); + sock.close(); + return buf; + } + DBG.printf("Wait...\r\n"); + wait(2); + + //receive return + t.start(); + while(1) { + ret = sock.receive(buf, sizeof(buf)); + if(ret<=0 || t.read_ms() > 10000) { + t.stop(); + break; + } + } + sock.close(); + return buf; +} +/*end emma connection function*/ + +/*start emma private function*/ +/* +void connectedIface(void) { //WARNING: should be run in emmaModeRegister and emmaModeOperation only - problem with esp, after MODE=B, cannot go back to MODE=S + char s[512]; + int connPort; + string connHost; + string str; + Timer t; + + //wifi interface + if(wifiAvailable) { + _ESP.printf("MODE=B"); + if(useProxy) { + connHost = proxySERVER; + sscanf(proxyPORT.c_str(),"%d",&connPort); + for(int i=0; i<sizeof(s); i++) { + s[i]=0; } + 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); + } else { + connHost = EMMA_SERVER_HOST; + connPort = EMMA_SERVER_PORT; + for(int i=0; i<sizeof(s); i++) { + s[i]=0; } + sprintf(s,"/emma/api/controller/test"); + } + wait(1); + t.start(); + while(!esp.ready() && t.read_ms() < 5000); + t.stop(); + if(rest.begin(connHost.c_str(),connPort,false)) { + //DBG.printf("rest begin\r\n"); + esp.process(); + rest.get(s); + for(int i=0; i<sizeof(s); i++) { + s[i]=0; } + rest.getResponse(s,sizeof(s)); + str = s; + //DBG.printf("response:%s\r\n",s); + if(str.find("OK") != std::string::npos) { + wifiConnected = true; + } + } else { + wifiConnected = false; + } + } else { + wifiConnected = false; } -exit: - return rc; + //eth interface + if(ethAvailable) { + if(useProxy) { + connHost = proxySERVER; + sscanf(proxyPORT.c_str(),"%d",&connPort); + for(int i=0; i<sizeof(s); i++) { + s[i]=0; } + 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); + } else { + connHost = EMMA_SERVER_HOST; + connPort = EMMA_SERVER_PORT; + for(int i=0; i<sizeof(s); i++) { + s[i]=0; } + strcpy(s,"GET /emma/api/web/test HTTP/1.0\nHost: %s\r\n\r\n"); + } + + t.start(); + while(1) { + str = ethGET(connHost,connPort,s); + if(str.find("OK") != std::string::npos) { + t.stop(); + ethConnected = true; + break; + } + if(t.read_ms() > 5000) { + t.stop(); + ethConnected = false; + break; + } + } + } else { + ethConnected = false; + } + + //gprs interface } - - -template<class Network, class Timer, class Thread, class Mutex> int MQTT::Async<Network, Timer, Thread, Mutex>::unsubscribe(resultHandler resultHandler, const char* topicFilter) -{ - int index = 0; - if (this->thread) - index = findFreeOperation(); - Timer& atimer = operations[index].timer; - - atimer.countdown(limits.command_timeout_ms); - MQTTString topic = {(char*)topicFilter, 0, 0}; - - int len = MQTTSerialize_unsubscribe(buf, limits.MAX_MQTT_PACKET_SIZE, 0, packetid.getNext(), 1, &topic); - int rc = sendPacket(len, atimer.left_ms()); // send the subscribe packet - if (rc != len) - goto exit; // there was a problem - - // set unsubscribe response callback function - - -exit: - return rc; +*/ +void isEthAvailable(void) { + if(ipstack.getEth().linkstatus()) { + ethAvailable = true; + DBG.printf("IP address: %s\r\n", ipstack.getEth().getIPAddress()); + } else { + ethAvailable = false; + } } - - -template<class Network, class Timer, class Thread, class Mutex> int MQTT::Async<Network, Timer, Thread, Mutex>::publish(resultHandler resultHandler, const char* topicName, Message* message) -{ - int index = 0; - if (this->thread) - index = findFreeOperation(); - Timer& atimer = operations[index].timer; - - atimer.countdown(limits.command_timeout_ms); - MQTTString topic = {(char*)topicName, 0, 0}; - - if (message->qos == QOS1 || message->qos == QOS2) - message->id = packetid.getNext(); - - int len = MQTTSerialize_publish(buf, limits.MAX_MQTT_PACKET_SIZE, 0, message->qos, message->retained, message->id, topic, (char*)message->payload, message->payloadlen); - int rc = sendPacket(len, atimer.left_ms()); // send the subscribe packet - if (rc != len) - goto exit; // there was a problem +void isEthConnected(void) { + char s[512]; + int connPort; + string connHost; + string str; + Timer t; - /* wait for acks */ - if (resultHandler == 0) - { - if (message->qos == QOS1) - { - if (waitfor(PUBACK, atimer) == PUBACK) - { - int type, dup, mypacketid; - if (MQTTDeserialize_ack(&type, &dup, &mypacketid, readbuf, limits.MAX_MQTT_PACKET_SIZE) == 1) - rc = 0; - } - } - else if (message->qos == QOS2) - { - if (waitfor(PUBCOMP, atimer) == PUBCOMP) - { - int type, dup, mypacketid; - if (MQTTDeserialize_ack(&type, &dup, &mypacketid, readbuf, limits.MAX_MQTT_PACKET_SIZE) == 1) - rc = 0; - } - - } + if(ethAvailable) { + if(useProxy) { + connHost = proxySERVER; + sscanf(proxyPORT.c_str(),"%d",&connPort); + for(int i=0; i<sizeof(s); i++) { + s[i]=0; } + sprintf(s,"GET http://%s:%d/emma/api/controller/test HTTP/1.0\nHost: %s\r\n\r\n",EMMA_SERVER_HOST,EMMA_SERVER_PORT,EMMA_SERVER_HOST); + } else { + connHost = EMMA_SERVER_HOST; + connPort = EMMA_SERVER_PORT; + for(int i=0; i<sizeof(s); i++) { + s[i]=0; } + sprintf(s,"GET /emma/api/controller/test HTTP/1.0\nHost: %s\r\n\r\n",EMMA_SERVER_HOST); + } + + t.start(); + while(1) { + str = ethGET(connHost,connPort,s); + DBG.printf("str value: %s", str); + if(str.find("OK") != std::string::npos) { + t.stop(); + ethConnected = true; + break; + } + if(t.read_ms() > 5000) { + t.stop(); + ethConnected = false; + break; + } + } + } else { + ethConnected = false; } - else - { - // set publish response callback function - - } - -exit: - return rc; } +void isWiFiConnected(void) { //WARNING: should be run in emmaModeRegister and emmaModeOperation only - limitation with esp, after MODE=B, cannot go to MODE=S + char s[512]; + int connPort; + string connHost; + string str; + Timer t; + + if(wifiAvailable) { + _ESP.printf("MODE=B"); + if(useProxy) { + connHost = proxySERVER; + sscanf(proxyPORT.c_str(),"%d",&connPort); + for(int i=0; i<sizeof(s); i++) { + s[i]=0; } + 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); + } else { + connHost = EMMA_SERVER_HOST; + connPort = EMMA_SERVER_PORT; + for(int i=0; i<sizeof(s); i++) { + s[i]=0; } + sprintf(s,"/emma/api/controller/test"); + } + wait(1); + t.start(); + while(!esp.ready() && t.read_ms() < 5000); + t.stop(); + if(rest.begin(connHost.c_str(),connPort,false)) { + //DBG.printf("rest begin\r\n"); + esp.process(); + rest.get(s); + for(int i=0; i<sizeof(s); i++) { + s[i]=0; } + rest.getResponse(s,sizeof(s)); + str = s; + //DBG.printf("response:%s\r\n",s); + if(str.find("OK") != std::string::npos) { + wifiConnected = true; + } + } else { + wifiConnected = false; + } + } else { + wifiConnected = false; + } +} -template<class Network, class Timer, class Thread, class Mutex> int MQTT::Async<Network, Timer, Thread, Mutex>::disconnect(resultHandler resultHandler) -{ - Timer timer = Timer(limits.command_timeout_ms); // we might wait for incomplete incoming publishes to complete - int len = MQTTSerialize_disconnect(buf, limits.MAX_MQTT_PACKET_SIZE); - int rc = sendPacket(len, timer.left_ms()); // send the disconnect packet - - return (rc == len) ? 0 : -1; +void isGprsConnected(void) { + +} + +void addChar(char *s, char c) { + uint16_t k; //customized for EMS + k = strlen(s); + s[k] = c; + s[k + 1] = 0; } +void rcvReply(char *r, int to) { + Timer t; + bool ended = false; + char c; + + strcpy(r,""); + t.start(); + while(!ended) { + if(_ESP.readable()) { + c = _ESP.getc(); + addChar(r,c); + t.start(); + } + if(t.read_ms() > to) { + ended = true; + } + } + addChar(r, 0x00); +} +string calculateMD5(string text) { + char s[64]; + memset(s,0,sizeof(s)); //for unknown reason, after reading UID, the 's' will contaion UID data + uint8_t hash[16]; + MD5::computeHash(hash, (uint8_t*)text.c_str(), strlen(text.c_str())); + for(int i=0; i<16; ++i) { + sprintf(s,"%s%02x",s,hash[i]); + } + return s; +} -#endif \ No newline at end of file +bool writeFirmwareHexToChar(string value) { + FILE *fp; + char s[32]; + int number; + string chunk; + + sprintf(s,"/sd/newFirmware/firmware.bin"); + fp = fopen(s,"a"); + if(fp != NULL) { + for(int ch=0; ch<value.size(); ch+=2) { + chunk = value.substr(ch,2); + sscanf(chunk.c_str(),"%x",&number); + fprintf(fp,"%c",number); + } + fclose(fp); + return true; + } + return false; +} + +bool clearFirmware(void) { + FILE *fp; + char s[32]; + + sprintf(s,"/sd/newFirmware/firmware.bin"); + fp = fopen(s,"w"); + if(fp != NULL) { + fprintf(fp,""); + fclose(fp); + return true; + } + return false; +} +/*end emma private function*/ \ No newline at end of file