PB_Emma_Ethernet - able to subscribe for >10hrs and still running

Users » bonchenko » Code » PB_Emma_Ethernet

able to subscribe for >10hrs and still running

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

Fork of PB_emma_controller_mbed_src by Emma

emmaCode.cpp@7:7e8c6ad3fd64, 2015-07-10 (annotated)

Committer:: arsenalist
Date:: Fri Jul 10 05:26:04 2015 +0000
Revision:: 7:7e8c6ad3fd64
Parent:: 6:45f50f1177db
Child:: 8:51a0ca9079ca

add get list of nodes from server.

Who changed what in which revision?

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

Repository toolbox

Export to desktop IDE

Build repository

Repository details

Type:	Program
Created:	07 Aug 2015
Imports:	2
Forks:	0
Commits:	30
Dependents:	0
Dependencies:	15
Followers:	1

emmaCode.cpp@7:7e8c6ad3fd64, 2015-07-10 (annotated)

Who changed what in which revision?

Repository toolbox

Repository details

Important Information for this Arm website

Access Warning