MQTT for Eth, Wifi, GPRS

Dependencies:   FP MQTTPacket

Dependents:   PB_Emma_Ethernet

Fork of MQTT by W5500-Ethernet-Interface Makers

Files at this revision

API Documentation at this revision

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&registrationKey=%s&hmac=%s HTTP/1.0\nHost: %s\r\n\r\n",EMMA_SERVER_HOST,EMMA_SERVER_PORT,emmaUID.c_str(),regKey.c_str(),hmac.c_str(),EMMA_SERVER_HOST);
+            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&registrationKey=%s&hmac=%s HTTP/1.0\nHost: %s\r\n\r\n",emmaUID.c_str(),regKey.c_str(),hmac.c_str(),EMMA_SERVER_HOST);
+            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&registrationKey=%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&registrationKey=%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