[Improve][Modularization][Module_ProduceUtils]

2020.09.01 / Folus Wen

Actions:
1. EVSE/Modularization/Module_ProduceUtils.c implement multi client logic.

Files:
1. As follow commit history

Image version: D0.00.XX.XXXX.XX
Image checksum: XXXXXXXX

Hardware PWB P/N : XXXXXXX
Hardware Version : XXXXXXX

EVSE/Modularization/Module_ProduceUtils.c

@@ -26,6 +26,7 @@
 #include 	<string.h>
 #include	<time.h>
 #include	<ctype.h>
+#include	<signal.h>
 #include	"define.h"
 #include	"Module_ProduceUtils.h"
 
@@ -38,7 +39,7 @@
 #define MtdBlockSize			0x600000
 
 #define LISTEN_PORT				8234
-#define	CONNECTION_LIMIT		1
+#define	CONNECTION_LIMIT		3
 
 #define PROTOCOL_ADDR			0xff
 
@@ -61,7 +62,7 @@ int StoreLogMsg(const char *fmt, ...)
 	memset(Buf,0,sizeof(Buf));
 	CurrentTime = time(NULL);
 	tm=localtime(&CurrentTime);
-	sprintf(Buf,"echo -n \"[%04d.%02d.%02d %02d:%02d:%02d] - %s\" >> /Storage/SystemLog/[%04d.%02d]ProduceUtils_SystemLog",
+	sprintf(Buf,"echo \"[%04d.%02d.%02d %02d:%02d:%02d] - %s\" >> /Storage/SystemLog/[%04d.%02d]ProduceUtils_SystemLog",
 			tm->tm_year+1900,tm->tm_mon+1,tm->tm_mday,tm->tm_hour,tm->tm_min,tm->tm_sec,
 			buffer,
 			tm->tm_year+1900,tm->tm_mon+1);
@@ -271,7 +272,7 @@ int main(void)
 	struct timeb csuTime;
 	struct tm *tmCSU;
 
-
+	signal(SIGCHLD,SIG_IGN);
 	if(InitShareMemory() == FAIL)
 	{
 		DEBUG_ERROR("InitShareMemory NG\n");
@@ -296,8 +297,20 @@ int main(void)
 	serverInfo.sin_family = PF_INET;
 	serverInfo.sin_addr.s_addr = htonl(INADDR_ANY);
 	serverInfo.sin_port = htons(LISTEN_PORT);
-	bind(sockFd, (struct sockaddr *)&serverInfo, sizeof(serverInfo));
-	listen(sockFd, CONNECTION_LIMIT);
+
+	if(bind(sockFd, (struct sockaddr *)&serverInfo, sizeof(serverInfo))<0)
+	{
+		DEBUG_ERROR("Socket bind error.\n");
+		sleep(5);
+		return 0;
+	}
+
+	if(listen(sockFd, CONNECTION_LIMIT)<0)
+	{
+		DEBUG_ERROR("Socket listen error.\n");
+		sleep(5);
+		return 0;
+	}
 
 	// Main loop
 	for(;;)
@@ -305,422 +318,433 @@ int main(void)
 		clientSockFd = accept(sockFd, (struct sockaddr*) &clientInfo, &addrlen);
 		DEBUG_INFO("Client connect in.\r\n");
 
-		while((read_size = recv(clientSockFd, inputBuffer, sizeof(inputBuffer), 0)) > 0)
+		if(fork()==0)
 		{
-			if(isValidCheckSum(inputBuffer))
+			// Child process
+			while((read_size = recv(clientSockFd, inputBuffer, sizeof(inputBuffer), 0)) > 0)
 			{
-				chksum = 0;
-				memset(outBuffer, 0x00, sizeof(outBuffer));
+				if(isValidCheckSum(inputBuffer))
+				{
+					chksum = 0;
+					memset(outBuffer, 0x00, sizeof(outBuffer));
 
-				switch(inputBuffer[3])
+					switch(inputBuffer[3])
+					{
+						case CMD_QUERY_FW_VER:
+							DEBUG_INFO("Query firmware version: %s.\r\n", (char*)ShmSysConfigAndInfo->SysInfo.CsuRootFsFwRev);
+							tx_size= 7 + (strlen((char*)ShmSysConfigAndInfo->SysInfo.CsuRootFsFwRev));
+							outBuffer[0] = 0xaa;
+							outBuffer[1] = PROTOCOL_ADDR;
+							outBuffer[2] = inputBuffer[1];
+							outBuffer[3] = CMD_QUERY_FW_VER;
+							outBuffer[4] = strlen((char*)ShmSysConfigAndInfo->SysInfo.CsuRootFsFwRev)&0xff;
+							outBuffer[5] = (strlen((char*)ShmSysConfigAndInfo->SysInfo.CsuRootFsFwRev)>>0x08) & 0xff;
+							for(uint8_t idx=0;idx<strlen((char*)ShmSysConfigAndInfo->SysInfo.CsuRootFsFwRev);idx++)
+							{
+								outBuffer[6+idx] = ShmSysConfigAndInfo->SysInfo.CsuRootFsFwRev[idx];
+							}
+
+							for(uint16_t idx=0;idx<(outBuffer[4] | (outBuffer[5]<<8));idx++)
+							{
+							  chksum ^= outBuffer[6 + idx];
+							}
+							outBuffer[6+(outBuffer[4] | (outBuffer[5]<<8))] = chksum;
+
+							break;
+						case CMD_QUERY_HW_VER:
+							DEBUG_INFO("Query hardware version: %s.\r\n", (char*)ShmSysConfigAndInfo->SysInfo.CsuHwRev);
+							tx_size = 7 + strlen((char*)ShmSysConfigAndInfo->SysInfo.CsuHwRev);
+							outBuffer[0] = 0xaa;
+							outBuffer[1] = PROTOCOL_ADDR;
+							outBuffer[2] = inputBuffer[1];
+							outBuffer[3] = CMD_QUERY_HW_VER;
+							outBuffer[4] = strlen((char*)ShmSysConfigAndInfo->SysInfo.CsuHwRev) & 0xff;
+							outBuffer[5] = (strlen((char*)ShmSysConfigAndInfo->SysInfo.CsuHwRev)>>0x08) & 0xff;
+							for(uint8_t idx=0;idx<strlen((char*)ShmSysConfigAndInfo->SysInfo.CsuHwRev);idx++)
+							{
+								outBuffer[6+idx] = (char)ShmSysConfigAndInfo->SysInfo.CsuHwRev[idx];
+							}
+
+							for(uint16_t idx=0;idx<(outBuffer[4] | (outBuffer[5]<<8));idx++)
+							{
+							  chksum ^= outBuffer[6 + idx];
+							}
+							outBuffer[6+(outBuffer[4] | (outBuffer[5]<<8))] = chksum;
+							break;
+						case CMD_QUERY_PRESENT_INPUTVOLTAGE:
+							DEBUG_INFO("Query present input voltage.\r\n");
+							DEBUG_INFO("  -Input R: %.2f.\r\n", ShmSysConfigAndInfo->SysInfo.InputVoltageR);
+							DEBUG_INFO("  -Input S: %.2f.\r\n", ShmSysConfigAndInfo->SysInfo.InputVoltageS);
+							DEBUG_INFO("  -Input T: %.2f.\r\n", ShmSysConfigAndInfo->SysInfo.InputVoltageT);
+							tx_size = 14;
+							outBuffer[0] = 0xaa;
+							outBuffer[1] = PROTOCOL_ADDR;
+							outBuffer[2] = inputBuffer[1];
+							outBuffer[3] = CMD_QUERY_PRESENT_INPUTVOLTAGE;
+							outBuffer[4] = 0x07;
+							outBuffer[5] = 0x00;
+							outBuffer[6] = 0x00;
+							outBuffer[7] = (((int)(ShmSysConfigAndInfo->SysInfo.InputVoltageR*10)>>0) & 0xff);
+							outBuffer[8] = (((int)(ShmSysConfigAndInfo->SysInfo.InputVoltageR*10)>>8) & 0xff);
+							outBuffer[9] = (((int)(ShmSysConfigAndInfo->SysInfo.InputVoltageS*10)>>0) & 0xff);
+							outBuffer[10] = (((int)(ShmSysConfigAndInfo->SysInfo.InputVoltageS*10)>>8) & 0xff);
+							outBuffer[11] = (((int)(ShmSysConfigAndInfo->SysInfo.InputVoltageT*10)>>0) & 0xff);
+							outBuffer[12] = (((int)(ShmSysConfigAndInfo->SysInfo.InputVoltageT*10)>>8) & 0xff);
+
+							for(uint16_t idx=0;idx<(outBuffer[4] | (outBuffer[5]<<8));idx++)
+							{
+							  chksum ^= outBuffer[6 + idx];
+							}
+							outBuffer[13] = chksum;
+							break;
+						case CMD_QUERY_PRESENT_OUTPUTVOLTAGE:
+							break;
+						case CMD_QUERY_FAN_SPEED:
+							break;
+						case CMD_QUERY_TEMPERATURE:
+							DEBUG_INFO("Query temperature.\r\n");
+							DEBUG_INFO("  -SystemAmbientTemp: %d\r\n", ShmSysConfigAndInfo->SysInfo.SystemAmbientTemp);
+							DEBUG_INFO("  -CcsConnectorTemp: %d\r\n", ShmSysConfigAndInfo->SysInfo.CcsConnectorTemp);
+							tx_size = 15;
+							outBuffer[0] = 0xaa;
+							outBuffer[1] = PROTOCOL_ADDR;
+							outBuffer[2] = inputBuffer[1];
+							outBuffer[3] = CMD_QUERY_TEMPERATURE;
+							outBuffer[4] = 0x08;
+							outBuffer[5] = 0x00;
+							outBuffer[6] = (((ShmSysConfigAndInfo->SysInfo.SystemAmbientTemp+60)>>0) & 0xff);
+							outBuffer[7] = (((ShmSysConfigAndInfo->SysInfo.CcsConnectorTemp+60)>>0) & 0xff);
+							outBuffer[8] = 0x00;
+							outBuffer[9] = 0x00;
+							outBuffer[10] = 0x00;
+							outBuffer[11] = 0x00;
+							outBuffer[12] = 0x00;
+							outBuffer[13] = 0x00;
+
+							for(uint16_t idx=0;idx<(outBuffer[4] | (outBuffer[5]<<8));idx++)
+							{
+							  chksum ^= outBuffer[6 + idx];
+							}
+							outBuffer[14] = chksum;
+							break;
+						case CMD_QUERY_AUX_POWERVOLTAGE:
+							break;
+						case CMD_QUERY_RELAY_OUTPUT:
+
+							break;
+						case CMD_QUERY_GFD_ADC:
+							break;
+						case CMD_QUERY_GPIO_INPUT:
+							break;
+						case CMD_QUERY_ALARM_LOG:
+							break;
+						case CMD_QUERY_SN:
+							ftime(&csuTime);
+							tmCSU = localtime(&csuTime.time);
+							DEBUG_INFO("Query serial number: %s\r\n", (char*)ShmSysConfigAndInfo->SysConfig.SerialNumber);
+							tx_size = 15 + strlen((char*)ShmSysConfigAndInfo->SysConfig.SerialNumber);
+							outBuffer[0] = 0xaa;
+							outBuffer[1] = PROTOCOL_ADDR;
+							outBuffer[2] = inputBuffer[1];
+							outBuffer[3] = CMD_QUERY_SN;
+							outBuffer[4] = (strlen((char*)ShmSysConfigAndInfo->SysConfig.SerialNumber)+8)&0xff;
+							outBuffer[5] = ((strlen((char*)ShmSysConfigAndInfo->SysConfig.SerialNumber)+8)>>0x08) & 0xff;
+							outBuffer[6] = ((tmCSU->tm_year+1900)/1000)+'0';
+							outBuffer[7] = (((tmCSU->tm_year+1900)%1000)/100)+'0';
+							outBuffer[8] = (((tmCSU->tm_year+1900)%100)/10)+'0';
+							outBuffer[9] = ((tmCSU->tm_year+1900)%10) +'0';
+							outBuffer[10] = ((tmCSU->tm_mon+1)/10) +'0';
+							outBuffer[11] = ((tmCSU->tm_mon+1)%10) +'0';
+							outBuffer[12] = (tmCSU->tm_mday/10) +'0';
+							outBuffer[13] = (tmCSU->tm_mday%10) +'0';
+
+							for(uint8_t idx=0;idx<strlen((char*)ShmSysConfigAndInfo->SysConfig.SerialNumber);idx++)
+							{
+								outBuffer[14+idx] = (char)ShmSysConfigAndInfo->SysConfig.SerialNumber[idx];
+							}
+
+							for(uint16_t idx=0;idx<(outBuffer[4] | (outBuffer[5]<<8));idx++)
+							{
+							  chksum ^= outBuffer[6 + idx];
+							}
+							outBuffer[6+(outBuffer[4] | (outBuffer[5]<<8))] = chksum;
+							break;
+						case CMD_QUERY_MODEL_NAME:
+							DEBUG_INFO("Query model name: %s\r\n", (char*)ShmSysConfigAndInfo->SysConfig.ModelName);
+							tx_size = 7 + strlen((char*)ShmSysConfigAndInfo->SysConfig.ModelName);
+							outBuffer[0] = 0xaa;
+							outBuffer[1] = PROTOCOL_ADDR;
+							outBuffer[2] = inputBuffer[1];
+							outBuffer[3] = CMD_QUERY_MODEL_NAME;
+							outBuffer[4] = strlen((char*)ShmSysConfigAndInfo->SysConfig.ModelName)&0xff;
+							outBuffer[5] = (strlen((char*)ShmSysConfigAndInfo->SysConfig.ModelName)>>0x08) & 0xff;
+							for(uint8_t idx=0;idx<strlen((char*)ShmSysConfigAndInfo->SysConfig.ModelName);idx++)
+							{
+								outBuffer[6+idx] = (char)ShmSysConfigAndInfo->SysConfig.ModelName[idx];
+							}
+
+							for(uint16_t idx=0;idx<(outBuffer[4] | (outBuffer[5]<<8));idx++)
+							{
+							  chksum ^= outBuffer[6 + idx];
+							}
+							outBuffer[6+(outBuffer[4] | (outBuffer[5]<<8))] = chksum;
+							break;
+						case CMD_QUERY_PARAMETER:
+							break;
+						case CMD_QUERY_RTC:
+							DEBUG_INFO("Query system time.\r\n");
+							ftime(&csuTime);
+							tmCSU = localtime(&csuTime.time);
+
+							tx_size = 21;
+							outBuffer[0] = 0xaa;
+							outBuffer[1] = PROTOCOL_ADDR;
+							outBuffer[2] = inputBuffer[1];
+							outBuffer[3] = CMD_QUERY_RTC;
+							outBuffer[4] = 0x0e;
+							outBuffer[5] = 0x00;
+							outBuffer[6] = ((tmCSU->tm_year+1900)/1000)+'0';
+							outBuffer[7] = (((tmCSU->tm_year+1900)%1000)/100)+'0';
+							outBuffer[8] = (((tmCSU->tm_year+1900)%100)/10)+'0';
+							outBuffer[9] = ((tmCSU->tm_year+1900)%10) +'0';
+							outBuffer[10] = ((tmCSU->tm_mon+1)/10) +'0';
+							outBuffer[11] = ((tmCSU->tm_mon+1)%10) +'0';
+							outBuffer[12] = (tmCSU->tm_mday/10) +'0';
+							outBuffer[13] = (tmCSU->tm_mday%10) +'0';
+							outBuffer[14] = (tmCSU->tm_hour/10) +'0';
+							outBuffer[15] = (tmCSU->tm_hour%10) +'0';
+							outBuffer[16] = (tmCSU->tm_min/10) +'0';
+							outBuffer[17] = (tmCSU->tm_min%10) +'0';
+							outBuffer[18] = (tmCSU->tm_sec/10) +'0';
+							outBuffer[19] = (tmCSU->tm_sec%10) +'0';
+
+							for(uint16_t idx=0;idx<(outBuffer[4] | (outBuffer[5]<<8));idx++)
+							{
+							  chksum ^= outBuffer[6 + idx];
+							}
+							outBuffer[20] = chksum;
+							break;
+						case CMD_QUERY_4G_REVISION:
+							DEBUG_INFO("Query 4G module revision: %s\r\n", (char*)ShmSysConfigAndInfo->SysConfig.TelecomInterface.TelcomSoftwareVer);
+							tx_size = 7 + strlen((char*)ShmSysConfigAndInfo->SysConfig.TelecomInterface.TelcomSoftwareVer);
+							outBuffer[0] = 0xaa;
+							outBuffer[1] = PROTOCOL_ADDR;
+							outBuffer[2] = inputBuffer[1];
+							outBuffer[3] = CMD_QUERY_4G_REVISION;
+							outBuffer[4] = strlen((char*)ShmSysConfigAndInfo->SysConfig.TelecomInterface.TelcomSoftwareVer)&0xff;
+							outBuffer[5] = (strlen((char*)ShmSysConfigAndInfo->SysConfig.TelecomInterface.TelcomSoftwareVer)>>0x08) & 0xff;
+							for(uint8_t idx=0;idx<strlen((char*)ShmSysConfigAndInfo->SysConfig.TelecomInterface.TelcomSoftwareVer);idx++)
+							{
+								outBuffer[6+idx] = (char)ShmSysConfigAndInfo->SysConfig.TelecomInterface.TelcomSoftwareVer[idx];
+							}
+
+							for(uint16_t idx=0;idx<(outBuffer[4] | (outBuffer[5]<<8));idx++)
+							{
+							  chksum ^= outBuffer[6 + idx];
+							}
+							outBuffer[6+(outBuffer[4] | (outBuffer[5]<<8))] = chksum;
+							break;
+						case CMD_QUERY_4G_SIM_INFO:
+							DEBUG_INFO("Query 4G SIM install status: %d\n", ShmSysConfigAndInfo->SysConfig.TelecomInterface.TelcomSimStatus);
+							DEBUG_INFO("Query 4G SIM ICCID: %s\n", ShmSysConfigAndInfo->SysConfig.TelecomInterface.TelcomSimIccid);
+							DEBUG_INFO("Query 4G SIM IMSI: %s\n", ShmSysConfigAndInfo->SysConfig.TelecomInterface.TelcomSimImsi);
+
+							tx_size = 46;
+							outBuffer[0] = 0xaa;
+							outBuffer[1] = PROTOCOL_ADDR;
+							outBuffer[2] = inputBuffer[1];
+							outBuffer[3] = CMD_QUERY_4G_SIM_INFO;
+							outBuffer[4] = 0x27&0xff;
+							outBuffer[5] = (0x27>>0x08) & 0xff;
+							outBuffer[6] = ShmSysConfigAndInfo->SysConfig.TelecomInterface.TelcomSimStatus;
+
+							for(uint8_t idx=0;idx<ARRAY_SIZE(ShmSysConfigAndInfo->SysConfig.TelecomInterface.TelcomSimIccid);idx++)
+							{
+								outBuffer[7+idx] = (char)ShmSysConfigAndInfo->SysConfig.TelecomInterface.TelcomSimIccid[idx];
+							}
+
+							for(uint8_t idx=0;idx<ARRAY_SIZE(ShmSysConfigAndInfo->SysConfig.TelecomInterface.TelcomSimImsi);idx++)
+							{
+								outBuffer[(7+ARRAY_SIZE(ShmSysConfigAndInfo->SysConfig.TelecomInterface.TelcomSimIccid))+idx] = (char)ShmSysConfigAndInfo->SysConfig.TelecomInterface.TelcomSimImsi[idx];
+							}
+
+							outBuffer[6+(outBuffer[4] | (outBuffer[5]<<8))] = chksum;
+
+							break;
+						case CMD_QUERY_AC_STATUS:
+							break;
+						case CMD_QUERY_AC_ALARM:
+							break;
+						case CMD_QUERY_BLE_CONFIG_DATA:
+							break;
+						case CMD_QUERY_POWER_CONSUMPTION:
+							break;
+						case CMD_QUERY_GUN_PLUGIN_TIMES:
+							break;
+						case CMD_CONFIG_FAN_SPEED:
+							break;
+						case CMD_CONFIG_SERIAL_NUMBER:
+							memset(ShmSysConfigAndInfo->SysConfig.SerialNumber, 0x00, ARRAY_SIZE(ShmSysConfigAndInfo->SysConfig.SerialNumber));
+							memset(ShmSysConfigAndInfo->SysConfig.SystemId, 0x00, ARRAY_SIZE(ShmSysConfigAndInfo->SysConfig.SystemId));
+
+							for(uint16_t idx=0;idx<((inputBuffer[4] | (inputBuffer[5]<<8))-8);idx++)
+							{
+								ShmSysConfigAndInfo->SysConfig.SerialNumber[idx] = inputBuffer[14+idx];
+							}
+							ShmSysConfigAndInfo->SysConfig.SerialNumber[(inputBuffer[4] | (inputBuffer[5]<<8))-8] = '\0';
+							memcpy(ShmSysConfigAndInfo->SysConfig.SystemId, ShmSysConfigAndInfo->SysConfig.ModelName, strlen((char*)ShmSysConfigAndInfo->SysConfig.ModelName));
+							memcpy(&ShmSysConfigAndInfo->SysConfig.SystemId[strlen((char*)ShmSysConfigAndInfo->SysConfig.ModelName)], ShmSysConfigAndInfo->SysConfig.SerialNumber, (inputBuffer[4] | (inputBuffer[5]<<8)));
+
+							tx_size = 8;
+							outBuffer[0] = 0xaa;
+							outBuffer[1] = PROTOCOL_ADDR;
+							outBuffer[2] =  inputBuffer[1];
+							outBuffer[3] = CMD_CONFIG_SERIAL_NUMBER;
+							outBuffer[4] = 0x01;
+							outBuffer[5] = 0x00;
+							outBuffer[6] = 0x01;
+							outBuffer[7] = outBuffer[6];
+
+							DEBUG_INFO("Config serial number: %s\r\n", (char*)ShmSysConfigAndInfo->SysConfig.SerialNumber);
+
+							break;
+						case CMD_CONFIG_MODEL_NAME:
+							memset(ShmSysConfigAndInfo->SysConfig.SerialNumber, 0x00, ARRAY_SIZE(ShmSysConfigAndInfo->SysConfig.SerialNumber));
+							memset(ShmSysConfigAndInfo->SysConfig.SystemId, 0x00, ARRAY_SIZE(ShmSysConfigAndInfo->SysConfig.SystemId));
+
+							for(uint16_t idx=0;idx<(inputBuffer[4] | (inputBuffer[5]<<8));idx++)
+							{
+								ShmSysConfigAndInfo->SysConfig.ModelName[idx] = inputBuffer[6+idx];
+							}
+							ShmSysConfigAndInfo->SysConfig.ModelName[(inputBuffer[4] | (inputBuffer[5]<<8))] = '\0';
+							memcpy(ShmSysConfigAndInfo->SysConfig.SystemId, ShmSysConfigAndInfo->SysConfig.ModelName, strlen((char*)ShmSysConfigAndInfo->SysConfig.ModelName));
+							memcpy(&ShmSysConfigAndInfo->SysConfig.SystemId[strlen((char*)ShmSysConfigAndInfo->SysConfig.ModelName)], ShmSysConfigAndInfo->SysConfig.SerialNumber, (inputBuffer[4] | (inputBuffer[5]<<8)));
+
+							tx_size = 8;
+							outBuffer[0] = 0xaa;
+							outBuffer[1] = PROTOCOL_ADDR;
+							outBuffer[2] =  inputBuffer[1];
+							outBuffer[3] = CMD_CONFIG_MODEL_NAME;
+							outBuffer[4] = 0x01;
+							outBuffer[5] = 0x00;
+							outBuffer[6] = 0x01;
+							outBuffer[7] = outBuffer[6];
+							DEBUG_INFO("Config model name: %s\r\n", (char*)ShmSysConfigAndInfo->SysConfig.ModelName);
+							break;
+						case CMD_CONFIG_RELAY_OUTPUT:
+							break;
+						case CMD_CONFIG_GPIO_OUTPUT:
+							break;
+						case CMD_CONFIG_RTC:
+							DEBUG_INFO("Config system time.\r\n");
+							tx_size = 8;
+							outBuffer[0] = 0xaa;
+							outBuffer[1] = PROTOCOL_ADDR;
+							outBuffer[2] =  inputBuffer[1];
+							outBuffer[3] = CMD_CONFIG_RTC;
+							outBuffer[4] = 0x01;
+							outBuffer[5] = 0x00;
+							outBuffer[6] = 0x01;
+							outBuffer[7] = 0x01;
+
+							sprintf((char*)cmdBuf, "date -u -s \"%04d-%02d-%02d %02d:%02d:%02d\"", (inputBuffer[6]-'0')*1000 + (inputBuffer[7]-'0')*100 + (inputBuffer[8]-'0')*10 + (inputBuffer[9]-'0'),
+																							(inputBuffer[10]-'0')*10+ (inputBuffer[11]-'0'),
+																							(inputBuffer[12]-'0')*10 + (inputBuffer[13]-'0'),
+																							(inputBuffer[14]-'0')*10 + (inputBuffer[15]-'0'),
+																							(inputBuffer[16]-'0')*10 + (inputBuffer[17]-'0'),
+																							(inputBuffer[18]-'0')*10 + (inputBuffer[19]-'0'));
+							system((char*)cmdBuf);
+							system("hwclock -w -u");
+							system("hwclock -s");
+
+							break;
+						case CMD_CONFIG_AC_LED:
+							break;
+						case CMD_CONFIG_CURRENT_LINIT:
+							break;
+						case CMD_CONFIG_MCU_MODE:
+							break;
+						case CMD_CONFIG_MCU_RESET_REQUEST:
+							break;
+						case CMD_CONFIG_BREATHE_LED_TIMING:
+							break;
+						case CMD_CONFIG_SAVE_CONFIGURATION:
+							tx_size = 8;
+							outBuffer[0] = 0xaa;
+							outBuffer[1] = PROTOCOL_ADDR;
+							outBuffer[2] =  inputBuffer[1];
+							outBuffer[3] = CMD_CONFIG_SAVE_CONFIGURATION;
+							outBuffer[4] = 0x01;
+							outBuffer[5] = 0x00;
+							outBuffer[6] = (StoreUsrConfigData(&ShmSysConfigAndInfo->SysConfig)!=0x01?0x00:0x01);
+							outBuffer[7] = outBuffer[6];
+							DEBUG_INFO("Save configuration\r\n");
+
+							if((outBuffer[6] == PASS))
+							{
+								sprintf((char*)ShmOCPP16Data->Reset.Type, "Soft");
+								ShmOCPP16Data->MsMsg.bits.ResetReq = ON;
+							}
+
+							break;
+						case CMD_UPDATE_START:
+							DEBUG_INFO("Upgrade firmware request.\n");
+							tx_size = 8;
+							outBuffer[0] = 0xaa;
+							outBuffer[1] = PROTOCOL_ADDR;
+							outBuffer[2] =  inputBuffer[1];
+							outBuffer[3] = CMD_UPDATE_START;
+							outBuffer[4] = 0x01;
+							outBuffer[5] = 0x00;
+							outBuffer[6] = 0x01;
+							outBuffer[7] = outBuffer[6];
+							ShmSysConfigAndInfo->SysInfo.FirmwareUpdate = ON;
+
+							break;
+						case CMD_UPDATE_ABOARD:
+							break;
+						case CMD_UPDATE_TRANSFER:
+							break;
+						case CMD_UPDATE_END:
+							break;
+						default:
+							break;
+					}
+				}
+				else
 				{
-					case CMD_QUERY_FW_VER:
-						DEBUG_INFO("Query firmware version: %s.\r\n", (char*)ShmSysConfigAndInfo->SysInfo.CsuRootFsFwRev);
-						tx_size= 7 + (strlen((char*)ShmSysConfigAndInfo->SysInfo.CsuRootFsFwRev));
-						outBuffer[0] = 0xaa;
-						outBuffer[1] = PROTOCOL_ADDR;
-						outBuffer[2] = inputBuffer[1];
-						outBuffer[3] = CMD_QUERY_FW_VER;
-						outBuffer[4] = strlen((char*)ShmSysConfigAndInfo->SysInfo.CsuRootFsFwRev)&0xff;
-						outBuffer[5] = (strlen((char*)ShmSysConfigAndInfo->SysInfo.CsuRootFsFwRev)>>0x08) & 0xff;
-						for(uint8_t idx=0;idx<strlen((char*)ShmSysConfigAndInfo->SysInfo.CsuRootFsFwRev);idx++)
-						{
-							outBuffer[6+idx] = ShmSysConfigAndInfo->SysInfo.CsuRootFsFwRev[idx];
-						}
-
-						for(uint16_t idx=0;idx<(outBuffer[4] | (outBuffer[5]<<8));idx++)
-						{
-						  chksum ^= outBuffer[6 + idx];
-						}
-						outBuffer[6+(outBuffer[4] | (outBuffer[5]<<8))] = chksum;
-
-						break;
-					case CMD_QUERY_HW_VER:
-						DEBUG_INFO("Query hardware version: %s.\r\n", (char*)ShmSysConfigAndInfo->SysInfo.CsuHwRev);
-						tx_size = 7 + strlen((char*)ShmSysConfigAndInfo->SysInfo.CsuHwRev);
-						outBuffer[0] = 0xaa;
-						outBuffer[1] = PROTOCOL_ADDR;
-						outBuffer[2] = inputBuffer[1];
-						outBuffer[3] = CMD_QUERY_HW_VER;
-						outBuffer[4] = strlen((char*)ShmSysConfigAndInfo->SysInfo.CsuHwRev) & 0xff;
-						outBuffer[5] = (strlen((char*)ShmSysConfigAndInfo->SysInfo.CsuHwRev)>>0x08) & 0xff;
-						for(uint8_t idx=0;idx<strlen((char*)ShmSysConfigAndInfo->SysInfo.CsuHwRev);idx++)
-						{
-							outBuffer[6+idx] = (char)ShmSysConfigAndInfo->SysInfo.CsuHwRev[idx];
-						}
-
-						for(uint16_t idx=0;idx<(outBuffer[4] | (outBuffer[5]<<8));idx++)
-						{
-						  chksum ^= outBuffer[6 + idx];
-						}
-						outBuffer[6+(outBuffer[4] | (outBuffer[5]<<8))] = chksum;
-						break;
-					case CMD_QUERY_PRESENT_INPUTVOLTAGE:
-						DEBUG_INFO("Query present input voltage.\r\n");
-						DEBUG_INFO("  -Input R: %.2f.\r\n", ShmSysConfigAndInfo->SysInfo.InputVoltageR);
-						DEBUG_INFO("  -Input S: %.2f.\r\n", ShmSysConfigAndInfo->SysInfo.InputVoltageS);
-						DEBUG_INFO("  -Input T: %.2f.\r\n", ShmSysConfigAndInfo->SysInfo.InputVoltageT);
-						tx_size = 14;
-						outBuffer[0] = 0xaa;
-						outBuffer[1] = PROTOCOL_ADDR;
-						outBuffer[2] = inputBuffer[1];
-						outBuffer[3] = CMD_QUERY_PRESENT_INPUTVOLTAGE;
-						outBuffer[4] = 0x07;
-						outBuffer[5] = 0x00;
-						outBuffer[6] = 0x00;
-						outBuffer[7] = (((int)(ShmSysConfigAndInfo->SysInfo.InputVoltageR*10)>>0) & 0xff);
-						outBuffer[8] = (((int)(ShmSysConfigAndInfo->SysInfo.InputVoltageR*10)>>8) & 0xff);
-						outBuffer[9] = (((int)(ShmSysConfigAndInfo->SysInfo.InputVoltageS*10)>>0) & 0xff);
-						outBuffer[10] = (((int)(ShmSysConfigAndInfo->SysInfo.InputVoltageS*10)>>8) & 0xff);
-						outBuffer[11] = (((int)(ShmSysConfigAndInfo->SysInfo.InputVoltageT*10)>>0) & 0xff);
-						outBuffer[12] = (((int)(ShmSysConfigAndInfo->SysInfo.InputVoltageT*10)>>8) & 0xff);
-
-						for(uint16_t idx=0;idx<(outBuffer[4] | (outBuffer[5]<<8));idx++)
-						{
-						  chksum ^= outBuffer[6 + idx];
-						}
-						outBuffer[13] = chksum;
-						break;
-					case CMD_QUERY_PRESENT_OUTPUTVOLTAGE:
-						break;
-					case CMD_QUERY_FAN_SPEED:
-						break;
-					case CMD_QUERY_TEMPERATURE:
-						DEBUG_INFO("Query temperature.\r\n");
-						DEBUG_INFO("  -SystemAmbientTemp: %d\r\n", ShmSysConfigAndInfo->SysInfo.SystemAmbientTemp);
-						DEBUG_INFO("  -CcsConnectorTemp: %d\r\n", ShmSysConfigAndInfo->SysInfo.CcsConnectorTemp);
-						tx_size = 15;
-						outBuffer[0] = 0xaa;
-						outBuffer[1] = PROTOCOL_ADDR;
-						outBuffer[2] = inputBuffer[1];
-						outBuffer[3] = CMD_QUERY_TEMPERATURE;
-						outBuffer[4] = 0x08;
-						outBuffer[5] = 0x00;
-						outBuffer[6] = (((ShmSysConfigAndInfo->SysInfo.SystemAmbientTemp+60)>>0) & 0xff);
-						outBuffer[7] = (((ShmSysConfigAndInfo->SysInfo.CcsConnectorTemp+60)>>0) & 0xff);
-						outBuffer[8] = 0x00;
-						outBuffer[9] = 0x00;
-						outBuffer[10] = 0x00;
-						outBuffer[11] = 0x00;
-						outBuffer[12] = 0x00;
-						outBuffer[13] = 0x00;
-
-						for(uint16_t idx=0;idx<(outBuffer[4] | (outBuffer[5]<<8));idx++)
-						{
-						  chksum ^= outBuffer[6 + idx];
-						}
-						outBuffer[14] = chksum;
-						break;
-					case CMD_QUERY_AUX_POWERVOLTAGE:
-						break;
-					case CMD_QUERY_RELAY_OUTPUT:
-
-						break;
-					case CMD_QUERY_GFD_ADC:
-						break;
-					case CMD_QUERY_GPIO_INPUT:
-						break;
-					case CMD_QUERY_ALARM_LOG:
-						break;
-					case CMD_QUERY_SN:
-						ftime(&csuTime);
-						tmCSU = localtime(&csuTime.time);
-						DEBUG_INFO("Query serial number: %s\r\n", (char*)ShmSysConfigAndInfo->SysConfig.SerialNumber);
-						tx_size = 15 + strlen((char*)ShmSysConfigAndInfo->SysConfig.SerialNumber);
-						outBuffer[0] = 0xaa;
-						outBuffer[1] = PROTOCOL_ADDR;
-						outBuffer[2] = inputBuffer[1];
-						outBuffer[3] = CMD_QUERY_SN;
-						outBuffer[4] = (strlen((char*)ShmSysConfigAndInfo->SysConfig.SerialNumber)+8)&0xff;
-						outBuffer[5] = ((strlen((char*)ShmSysConfigAndInfo->SysConfig.SerialNumber)+8)>>0x08) & 0xff;
-						outBuffer[6] = ((tmCSU->tm_year+1900)/1000)+'0';
-						outBuffer[7] = (((tmCSU->tm_year+1900)%1000)/100)+'0';
-						outBuffer[8] = (((tmCSU->tm_year+1900)%100)/10)+'0';
-						outBuffer[9] = ((tmCSU->tm_year+1900)%10) +'0';
-						outBuffer[10] = ((tmCSU->tm_mon+1)/10) +'0';
-						outBuffer[11] = ((tmCSU->tm_mon+1)%10) +'0';
-						outBuffer[12] = (tmCSU->tm_mday/10) +'0';
-						outBuffer[13] = (tmCSU->tm_mday%10) +'0';
-
-						for(uint8_t idx=0;idx<strlen((char*)ShmSysConfigAndInfo->SysConfig.SerialNumber);idx++)
-						{
-							outBuffer[14+idx] = (char)ShmSysConfigAndInfo->SysConfig.SerialNumber[idx];
-						}
-
-						for(uint16_t idx=0;idx<(outBuffer[4] | (outBuffer[5]<<8));idx++)
-						{
-						  chksum ^= outBuffer[6 + idx];
-						}
-						outBuffer[6+(outBuffer[4] | (outBuffer[5]<<8))] = chksum;
-						break;
-					case CMD_QUERY_MODEL_NAME:
-						DEBUG_INFO("Query model name: %s\r\n", (char*)ShmSysConfigAndInfo->SysConfig.ModelName);
-						tx_size = 7 + strlen((char*)ShmSysConfigAndInfo->SysConfig.ModelName);
-						outBuffer[0] = 0xaa;
-						outBuffer[1] = PROTOCOL_ADDR;
-						outBuffer[2] = inputBuffer[1];
-						outBuffer[3] = CMD_QUERY_MODEL_NAME;
-						outBuffer[4] = strlen((char*)ShmSysConfigAndInfo->SysConfig.ModelName)&0xff;
-						outBuffer[5] = (strlen((char*)ShmSysConfigAndInfo->SysConfig.ModelName)>>0x08) & 0xff;
-						for(uint8_t idx=0;idx<strlen((char*)ShmSysConfigAndInfo->SysConfig.ModelName);idx++)
-						{
-							outBuffer[6+idx] = (char)ShmSysConfigAndInfo->SysConfig.ModelName[idx];
-						}
-
-						for(uint16_t idx=0;idx<(outBuffer[4] | (outBuffer[5]<<8));idx++)
-						{
-						  chksum ^= outBuffer[6 + idx];
-						}
-						outBuffer[6+(outBuffer[4] | (outBuffer[5]<<8))] = chksum;
-						break;
-					case CMD_QUERY_PARAMETER:
-						break;
-					case CMD_QUERY_RTC:
-						DEBUG_INFO("Query system time.\r\n");
-						ftime(&csuTime);
-						tmCSU = localtime(&csuTime.time);
-
-						tx_size = 21;
-						outBuffer[0] = 0xaa;
-						outBuffer[1] = PROTOCOL_ADDR;
-						outBuffer[2] = inputBuffer[1];
-						outBuffer[3] = CMD_QUERY_RTC;
-						outBuffer[4] = 0x0e;
-						outBuffer[5] = 0x00;
-						outBuffer[6] = ((tmCSU->tm_year+1900)/1000)+'0';
-						outBuffer[7] = (((tmCSU->tm_year+1900)%1000)/100)+'0';
-						outBuffer[8] = (((tmCSU->tm_year+1900)%100)/10)+'0';
-						outBuffer[9] = ((tmCSU->tm_year+1900)%10) +'0';
-						outBuffer[10] = ((tmCSU->tm_mon+1)/10) +'0';
-						outBuffer[11] = ((tmCSU->tm_mon+1)%10) +'0';
-						outBuffer[12] = (tmCSU->tm_mday/10) +'0';
-						outBuffer[13] = (tmCSU->tm_mday%10) +'0';
-						outBuffer[14] = (tmCSU->tm_hour/10) +'0';
-						outBuffer[15] = (tmCSU->tm_hour%10) +'0';
-						outBuffer[16] = (tmCSU->tm_min/10) +'0';
-						outBuffer[17] = (tmCSU->tm_min%10) +'0';
-						outBuffer[18] = (tmCSU->tm_sec/10) +'0';
-						outBuffer[19] = (tmCSU->tm_sec%10) +'0';
-
-						for(uint16_t idx=0;idx<(outBuffer[4] | (outBuffer[5]<<8));idx++)
-						{
-						  chksum ^= outBuffer[6 + idx];
-						}
-						outBuffer[20] = chksum;
-						break;
-					case CMD_QUERY_4G_REVISION:
-						DEBUG_INFO("Query 4G module revision: %s\r\n", (char*)ShmSysConfigAndInfo->SysConfig.TelecomInterface.TelcomSoftwareVer);
-						tx_size = 7 + strlen((char*)ShmSysConfigAndInfo->SysConfig.TelecomInterface.TelcomSoftwareVer);
-						outBuffer[0] = 0xaa;
-						outBuffer[1] = PROTOCOL_ADDR;
-						outBuffer[2] = inputBuffer[1];
-						outBuffer[3] = CMD_QUERY_4G_REVISION;
-						outBuffer[4] = strlen((char*)ShmSysConfigAndInfo->SysConfig.TelecomInterface.TelcomSoftwareVer)&0xff;
-						outBuffer[5] = (strlen((char*)ShmSysConfigAndInfo->SysConfig.TelecomInterface.TelcomSoftwareVer)>>0x08) & 0xff;
-						for(uint8_t idx=0;idx<strlen((char*)ShmSysConfigAndInfo->SysConfig.TelecomInterface.TelcomSoftwareVer);idx++)
-						{
-							outBuffer[6+idx] = (char)ShmSysConfigAndInfo->SysConfig.TelecomInterface.TelcomSoftwareVer[idx];
-						}
-
-						for(uint16_t idx=0;idx<(outBuffer[4] | (outBuffer[5]<<8));idx++)
-						{
-						  chksum ^= outBuffer[6 + idx];
-						}
-						outBuffer[6+(outBuffer[4] | (outBuffer[5]<<8))] = chksum;
-						break;
-					case CMD_QUERY_4G_SIM_INFO:
-						DEBUG_INFO("Query 4G SIM install status: %d\n", ShmSysConfigAndInfo->SysConfig.TelecomInterface.TelcomSimStatus);
-						DEBUG_INFO("Query 4G SIM ICCID: %s\n", ShmSysConfigAndInfo->SysConfig.TelecomInterface.TelcomSimIccid);
-						DEBUG_INFO("Query 4G SIM IMSI: %s\n", ShmSysConfigAndInfo->SysConfig.TelecomInterface.TelcomSimImsi);
-
-						tx_size = 46;
-						outBuffer[0] = 0xaa;
-						outBuffer[1] = PROTOCOL_ADDR;
-						outBuffer[2] = inputBuffer[1];
-						outBuffer[3] = CMD_QUERY_4G_SIM_INFO;
-						outBuffer[4] = 0x27&0xff;
-						outBuffer[5] = (0x27>>0x08) & 0xff;
-						outBuffer[6] = ShmSysConfigAndInfo->SysConfig.TelecomInterface.TelcomSimStatus;
-
-						for(uint8_t idx=0;idx<ARRAY_SIZE(ShmSysConfigAndInfo->SysConfig.TelecomInterface.TelcomSimIccid);idx++)
-						{
-							outBuffer[7+idx] = (char)ShmSysConfigAndInfo->SysConfig.TelecomInterface.TelcomSimIccid[idx];
-						}
-
-						for(uint8_t idx=0;idx<ARRAY_SIZE(ShmSysConfigAndInfo->SysConfig.TelecomInterface.TelcomSimImsi);idx++)
-						{
-							outBuffer[(7+ARRAY_SIZE(ShmSysConfigAndInfo->SysConfig.TelecomInterface.TelcomSimIccid))+idx] = (char)ShmSysConfigAndInfo->SysConfig.TelecomInterface.TelcomSimImsi[idx];
-						}
-
-						outBuffer[6+(outBuffer[4] | (outBuffer[5]<<8))] = chksum;
-
-						break;
-					case CMD_QUERY_AC_STATUS:
-						break;
-					case CMD_QUERY_AC_ALARM:
-						break;
-					case CMD_QUERY_BLE_CONFIG_DATA:
-						break;
-					case CMD_QUERY_POWER_CONSUMPTION:
-						break;
-					case CMD_QUERY_GUN_PLUGIN_TIMES:
-						break;
-					case CMD_CONFIG_FAN_SPEED:
-						break;
-					case CMD_CONFIG_SERIAL_NUMBER:
-						memset(ShmSysConfigAndInfo->SysConfig.SerialNumber, 0x00, ARRAY_SIZE(ShmSysConfigAndInfo->SysConfig.SerialNumber));
-						memset(ShmSysConfigAndInfo->SysConfig.SystemId, 0x00, ARRAY_SIZE(ShmSysConfigAndInfo->SysConfig.SystemId));
-
-						for(uint16_t idx=0;idx<((inputBuffer[4] | (inputBuffer[5]<<8))-8);idx++)
-						{
-							ShmSysConfigAndInfo->SysConfig.SerialNumber[idx] = inputBuffer[14+idx];
-						}
-						ShmSysConfigAndInfo->SysConfig.SerialNumber[(inputBuffer[4] | (inputBuffer[5]<<8))-8] = '\0';
-						memcpy(ShmSysConfigAndInfo->SysConfig.SystemId, ShmSysConfigAndInfo->SysConfig.ModelName, strlen((char*)ShmSysConfigAndInfo->SysConfig.ModelName));
-						memcpy(&ShmSysConfigAndInfo->SysConfig.SystemId[strlen((char*)ShmSysConfigAndInfo->SysConfig.ModelName)], ShmSysConfigAndInfo->SysConfig.SerialNumber, (inputBuffer[4] | (inputBuffer[5]<<8)));
-
-						tx_size = 8;
-						outBuffer[0] = 0xaa;
-						outBuffer[1] = PROTOCOL_ADDR;
-						outBuffer[2] =  inputBuffer[1];
-						outBuffer[3] = CMD_CONFIG_SERIAL_NUMBER;
-						outBuffer[4] = 0x01;
-						outBuffer[5] = 0x00;
-						outBuffer[6] = 0x01;
-						outBuffer[7] = outBuffer[6];
-
-						DEBUG_INFO("Config serial number: %s\r\n", (char*)ShmSysConfigAndInfo->SysConfig.SerialNumber);
-
-						break;
-					case CMD_CONFIG_MODEL_NAME:
-						memset(ShmSysConfigAndInfo->SysConfig.SerialNumber, 0x00, ARRAY_SIZE(ShmSysConfigAndInfo->SysConfig.SerialNumber));
-						memset(ShmSysConfigAndInfo->SysConfig.SystemId, 0x00, ARRAY_SIZE(ShmSysConfigAndInfo->SysConfig.SystemId));
-
-						for(uint16_t idx=0;idx<(inputBuffer[4] | (inputBuffer[5]<<8));idx++)
-						{
-							ShmSysConfigAndInfo->SysConfig.ModelName[idx] = inputBuffer[6+idx];
-						}
-						ShmSysConfigAndInfo->SysConfig.ModelName[(inputBuffer[4] | (inputBuffer[5]<<8))] = '\0';
-						memcpy(ShmSysConfigAndInfo->SysConfig.SystemId, ShmSysConfigAndInfo->SysConfig.ModelName, strlen((char*)ShmSysConfigAndInfo->SysConfig.ModelName));
-						memcpy(&ShmSysConfigAndInfo->SysConfig.SystemId[strlen((char*)ShmSysConfigAndInfo->SysConfig.ModelName)], ShmSysConfigAndInfo->SysConfig.SerialNumber, (inputBuffer[4] | (inputBuffer[5]<<8)));
-
-						tx_size = 8;
-						outBuffer[0] = 0xaa;
-						outBuffer[1] = PROTOCOL_ADDR;
-						outBuffer[2] =  inputBuffer[1];
-						outBuffer[3] = CMD_CONFIG_MODEL_NAME;
-						outBuffer[4] = 0x01;
-						outBuffer[5] = 0x00;
-						outBuffer[6] = 0x01;
-						outBuffer[7] = outBuffer[6];
-						DEBUG_INFO("Config model name: %s\r\n", (char*)ShmSysConfigAndInfo->SysConfig.ModelName);
-						break;
-					case CMD_CONFIG_RELAY_OUTPUT:
-						break;
-					case CMD_CONFIG_GPIO_OUTPUT:
-						break;
-					case CMD_CONFIG_RTC:
-						DEBUG_INFO("Config system time.\r\n");
-						tx_size = 8;
-						outBuffer[0] = 0xaa;
-						outBuffer[1] = PROTOCOL_ADDR;
-						outBuffer[2] =  inputBuffer[1];
-						outBuffer[3] = CMD_CONFIG_RTC;
-						outBuffer[4] = 0x01;
-						outBuffer[5] = 0x00;
-						outBuffer[6] = 0x01;
-						outBuffer[7] = 0x01;
-
-						sprintf((char*)cmdBuf, "date -u -s \"%04d-%02d-%02d %02d:%02d:%02d\"", (inputBuffer[6]-'0')*1000 + (inputBuffer[7]-'0')*100 + (inputBuffer[8]-'0')*10 + (inputBuffer[9]-'0'),
-																						(inputBuffer[10]-'0')*10+ (inputBuffer[11]-'0'),
-																						(inputBuffer[12]-'0')*10 + (inputBuffer[13]-'0'),
-																						(inputBuffer[14]-'0')*10 + (inputBuffer[15]-'0'),
-																						(inputBuffer[16]-'0')*10 + (inputBuffer[17]-'0'),
-																						(inputBuffer[18]-'0')*10 + (inputBuffer[19]-'0'));
-						system((char*)cmdBuf);
-						system("hwclock -w -u");
-						system("hwclock -s");
-
-						break;
-					case CMD_CONFIG_AC_LED:
-						break;
-					case CMD_CONFIG_CURRENT_LINIT:
-						break;
-					case CMD_CONFIG_MCU_MODE:
-						break;
-					case CMD_CONFIG_MCU_RESET_REQUEST:
-						break;
-					case CMD_CONFIG_BREATHE_LED_TIMING:
-						break;
-					case CMD_CONFIG_SAVE_CONFIGURATION:
-						tx_size = 8;
-						outBuffer[0] = 0xaa;
-						outBuffer[1] = PROTOCOL_ADDR;
-						outBuffer[2] =  inputBuffer[1];
-						outBuffer[3] = CMD_CONFIG_SAVE_CONFIGURATION;
-						outBuffer[4] = 0x01;
-						outBuffer[5] = 0x00;
-						outBuffer[6] = (StoreUsrConfigData(&ShmSysConfigAndInfo->SysConfig)!=0x01?0x00:0x01);
-						outBuffer[7] = outBuffer[6];
-						DEBUG_INFO("Save configuration\r\n");
-
-						if((outBuffer[6] == PASS))
-						{
-							sprintf((char*)ShmOCPP16Data->Reset.Type, "Soft");
-							ShmOCPP16Data->MsMsg.bits.ResetReq = ON;
-						}
-
-						break;
-					case CMD_UPDATE_START:
-						DEBUG_INFO("Upgrade firmware request.\n");
-						tx_size = 8;
-						outBuffer[0] = 0xaa;
-						outBuffer[1] = PROTOCOL_ADDR;
-						outBuffer[2] =  inputBuffer[1];
-						outBuffer[3] = CMD_UPDATE_START;
-						outBuffer[4] = 0x01;
-						outBuffer[5] = 0x00;
-						outBuffer[6] = 0x01;
-						outBuffer[7] = outBuffer[6];
-						ShmSysConfigAndInfo->SysInfo.FirmwareUpdate = ON;
-
-						break;
-					case CMD_UPDATE_ABOARD:
-						break;
-					case CMD_UPDATE_TRANSFER:
-						break;
-					case CMD_UPDATE_END:
-						break;
-					default:
-						break;
+					tx_size = 9;
+					outBuffer[0] = 0xaa;
+					outBuffer[1] = PROTOCOL_ADDR;
+					outBuffer[2] = inputBuffer[1];
+					outBuffer[3] = inputBuffer[3];
+					outBuffer[4] = 0x01;
+					outBuffer[5] = 0x00;
+					outBuffer[6] = 0x00;
+					outBuffer[7] = 0x00;
 				}
+
+				send(clientSockFd, outBuffer, tx_size, 0);
 			}
-			else
+
+			if(read_size == 0)
 			{
-				tx_size = 9;
-				outBuffer[0] = 0xaa;
-				outBuffer[1] = PROTOCOL_ADDR;
-				outBuffer[2] = inputBuffer[1];
-				outBuffer[3] = inputBuffer[3];
-				outBuffer[4] = 0x01;
-				outBuffer[5] = 0x00;
-				outBuffer[6] = 0x00;
-				outBuffer[7] = 0x00;
+				close(clientSockFd);
+				DEBUG_INFO("Client disconnected.\r\n");
+				fflush(stdout);
+			}
+			else if(read_size == -1)
+			{
+				close(clientSockFd);
+				DEBUG_ERROR("Socket recv failed.\r\n");
 			}
 
-			send(clientSockFd, outBuffer, tx_size, 0);
-		}
-
-		if(read_size == 0)
-		{
-			close(clientSockFd);
-			DEBUG_INFO("Client disconnected.\r\n");
-			fflush(stdout);
+			exit(0);
 		}
-		else if(read_size == -1)
+		else
 		{
+			// Parent process
 			close(clientSockFd);
-			DEBUG_ERROR("Socket recv failed.\r\n");
 		}
 
 		sleep(1);