Merge branch 'DD360Audi'

EVSE/Modularization/Module_RatingCurrent.c

@@ -1,516 +0,0 @@
-/*
- *  Module_RatingCurrent.c
- *
- *  Created on: 2021-03-15
- *  Update:
- *  Author: Jerry Wang
- *  Version: V0.01
- *
- * History
- * 1. Create Parsing Rated Current Parameter, reference model name 7, 8, 9 field gun type,
- *    GunRateCurInfo arrays 0 and 1 represent DC guns of 7 and 9 fields, and array 2 represents AC guns of 8 fields.
- */
-#include <stdio.h>
-#include <stdlib.h>
-#include <stdint.h>
-#include <string.h>
-#include <stdarg.h>
-#include <time.h>
-
-#include <sys/timeb.h>
-
-#include "Module_RatingCurrent.h"
-
-//------------------------------------------------------------------------------
-#define PASS                                    (1)
-#define FAIL                                    (-1)
-
-#define log_info(format, args...)               StoreLogMsg("[%s:%d][%s][Info] "format, __FILE__, __LINE__, __FUNCTION__, ##args)
-#define log_warn(format, args...)               StoreLogMsg("[%s:%d][%s][Warn] "format, __FILE__, __LINE__, __FUNCTION__, ##args)
-#define log_error(format, args...)              StoreLogMsg("[%s:%d][%s][Error] "format, __FILE__, __LINE__, __FUNCTION__, ##args)
-
-//------------------------------------------------------------------------------
-static SymStruct modelTable[] = {
-    { "AC", MODEL_AC },
-    { "AW", MODEL_AW },
-    { "AP", MODEL_AP },
-    { "DW", MODEL_DW },
-    { "DS", MODEL_DS },
-    { "DM", MODEL_DM },
-    { "DR", MODEL_DR },
-    //{ "DM", MODEL_DM },
-    { "DD", MODEL_DD },
-    { "DO", MODEL_DO },
-};
-
-static SymStruct regulationTable[] = {
-    {"E", REG_CE},
-    {"U", REG_UL},
-    {"G", REG_GB},
-    {"C", REG_CNS},
-    {"J", REG_JARI},
-    {"T", REG_TR25},
-    {"K", REG_KC},
-    {"B", REG_B},
-    {"Z", REG_Z},
-    {"M", REG_M},
-    {"P", REG_P},
-    {"I", REG_I},
-    {"F", REG_F},
-    {"L", REG_L},
-};
-
-static SymStruct powerTable[] = {
-    {"30", POWER_30W},
-    {"60", POWER_60W},
-    {"90", POWER_90W},
-    {"12", POWER_120W},
-    {"15", POWER_150W},
-    {"18", POWER_180W},
-    {"24", POWER_240W},
-    {"36", POWER_360W},
-    {"48", POWER_480W},
-    {"72", POWER_720W},
-};
-
-static SymStruct gunTypeTable[] = {
-    {"0", GUN_TYPE_0},
-    {"1", GUN_TYPE_1},
-    {"2", GUN_TYPE_2},
-    {"3", GUN_TYPE_3},
-    {"4", GUN_TYPE_4},
-    {"5", GUN_TYPE_5},
-    {"6", GUN_TYPE_6},
-    {"7", GUN_TYPE_7},
-    {"8", GUN_TYPE_8},
-    {"J", GUN_TYPE_J},
-    {"U", GUN_TYPE_U},
-    {"V", GUN_TYPE_V},
-    {"E", GUN_TYPE_E},
-    {"F", GUN_TYPE_F},
-    {"G", GUN_TYPE_G},
-};
-
-//------------------------------------------------------------------------------
-static int StoreLogMsg(const char *fmt, ...)
-{
-    char Buf[4096 + 256] = {0};
-    char buffer[4096] = {0};
-    int rc = 0;
-    va_list args;
-    struct timeb  SeqEndTime;
-    struct tm *tm;
-
-    va_start(args, fmt);
-    rc = vsnprintf(buffer, sizeof(buffer), fmt, args);
-    va_end(args);
-
-    ftime(&SeqEndTime);
-    SeqEndTime.time = time(NULL);
-    tm = localtime(&SeqEndTime.time);
-
-    //if (ShmSysConfigAndInfo->SysConfig.SwitchDebugFlag == YES) {
-    //    sprintf(Buf, "%02d:%02d:%02d:%03d - %s",
-    //            tm->tm_hour, tm->tm_min, tm->tm_sec, SeqEndTime.millitm, buffer);
-    //    printf("%s \n", Buf);
-    //} else {
-    sprintf(Buf, "echo \"%04d-%02d-%02d %02d:%02d:%02d:%03d - %s\" >> /Storage/SystemLog/[%04d.%02d]SystemLog",
-            tm->tm_year + 1900,
-            tm->tm_mon + 1,
-            tm->tm_mday,
-            tm->tm_hour,
-            tm->tm_min,
-            tm->tm_sec,
-            SeqEndTime.millitm,
-            buffer,
-            tm->tm_year + 1900,
-            tm->tm_mon + 1);
-    system(Buf);
-    //}
-
-    return rc;
-}
-
-static int keyfromstring(char *key, SymStruct *table, int tableCount)
-{
-    int i = 0;
-    //int loop = sizeof(table) / sizeof(SymStruct);
-    SymStruct *sym = NULL;
-
-    for (i = 0; i < tableCount; i++) {
-        sym = (SymStruct *)&table[i];
-        if (strcmp(sym->key, key) == 0) {
-            //printf("val = %x\r\n", sym->val);
-            return sym->val;
-        }
-    }
-
-    return BADKEY;
-}
-
-//------------------------------------------------------------------------------
-static uint16_t exchangeRatingCur(uint32_t key)
-{
-    switch (key) {
-    //60A J
-    case DW_CE_30_J:
-    case DM_CE_30_J:
-
-    case DW_CE_30_E:
-    case DM_CE_30_E:
-        return RC_60A; //rating current 60A
-
-    //65A U
-    case DW_UL_30_U:
-    case DM_UL_30_U:
-
-    case DW_CNS_30_U:
-    case DM_CNS_30_U:
-        return RC_65A;
-
-    //80A J
-    case DW_UL_30_J:
-    case DM_UL_30_J:
-    case DW_CNS_30_J:
-    case DM_CNS_30_J:
-
-    //80A G
-    case DM_CNS_30_G:
-    case DS_UL_30_G:
-
-    //80A M
-    case DW_CE_30_M:
-    case DM_CE_30_M:
-
-    //80A N
-    case DW_UL_30_N:
-    case DM_UL_30_N:
-    case DW_CNS_30_N:
-    case DM_CNS_30_N:
-        return RC_80A; //rating current 80A
-
-    //125A J
-    case DS_CE_60_J:
-    case DS_CE_90_J:
-    case DS_CE_120_J:
-    case DS_CE_150_J:
-    case DS_CE_180_J:
-
-    case DS_UL_60_J:
-    case DS_UL_90_J:
-    case DS_UL_120_J:
-    case DS_UL_150_J:
-    case DS_UL_180_J:
-
-    case DS_CNS_60_J:
-    case DS_CNS_90_J:
-    case DS_CNS_120_J:
-    case DS_CNS_150_J:
-    case DS_CNS_180_J:
-
-    //125A U
-    case DS_UL_60_U:
-
-    case DS_CNS_60_U:
-
-    //125A E
-    case DS_CE_60_E:
-        return RC_125A; //rating current 125A
-
-    //200A U
-    case DS_UL_90_U:
-    case DS_UL_120_U:
-    case DS_UL_150_U:
-    case DS_UL_180_U:
-    case DD_UL_360_U:
-
-    case DS_CNS_90_U:
-    case DS_CNS_120_U:
-    case DS_CNS_150_U:
-    case DS_CNS_180_U:
-    case DD_CNS_360_U:
-
-    //200A E
-    case DS_CE_90_E:
-    case DS_CE_120_E:
-    case DS_CE_150_E:
-    case DS_CE_180_E:
-
-    //200A K
-    case DS_CE_90_K:
-    case DS_CE_120_K:
-    case DS_CE_150_K:
-    case DS_CE_180_K:
-
-    case DD_CE_360_K:
-
-    case DS_UL_90_K:
-    case DS_UL_120_K:
-    case DS_UL_150_K:
-    case DS_UL_180_K:
-
-    case DD_UL_360_K:
-        return RC_200A; //rating current 200A
-
-    //250A G
-    case DS_CNS_120_G:
-        return RC_250A;
-
-    //300A T
-    case DS_CE_90_T:
-    case DS_CE_120_T:
-    case DS_CE_150_T:
-    case DS_CE_180_T:
-
-    case DD_CE_360_T:
-
-    case DS_UL_90_T:
-    case DS_UL_120_T:
-    case DS_UL_150_T:
-    case DS_UL_180_T:
-
-    case DD_UL_360_T:
-
-    case DS_CNS_90_T:
-    case DS_CNS_120_T:
-    case DS_CNS_150_T:
-    case DS_CNS_180_T:
-
-    case DD_CNS_360_T:
-
-    //300A D
-    case DS_CE_90_D:
-    case DS_CE_120_D:
-    case DS_CE_150_D:
-    case DS_CE_180_D:
-    case DD_CE_360_D:
-
-    case DS_UL_90_D:
-    case DS_UL_120_D:
-    case DS_UL_150_D:
-    case DS_UL_180_D:
-
-    case DD_UL_360_D:
-
-    case DS_CNS_90_D:
-    case DS_CNS_120_D:
-    case DS_CNS_150_D:
-    case DS_CNS_180_D:
-
-    case DD_CNS_360_D:
-        return RC_300A;
-
-    //500A V
-    case DD_UL_360_V:
-
-    case DD_CNS_360_V:
-
-    case DO_UL_360_V:
-    case DO_CNS_360_V:
-
-    //500A F
-    case DD_CE_360_F:
-    case DO_CE_360_F:
-
-    //P
-    case DD_CE_360_P:
-
-    case DD_UL_360_R:
-    case DD_CNS_360_R:
-        return RC_500A; //rating current 500A
-
-    default:
-        return RC_0A; //rating current 200A
-    }
-}
-
-static void exchangeGunTypeAndVolValue(uint8_t key, GunTypeAndVolInfo *gunAndVol)
-{
-    GunTypeAndVolInfo *pGunAndVol = (GunTypeAndVolInfo *)gunAndVol;
-
-    switch (key) {
-    case GUN_TYPE_0:// : none
-    case GUN_TYPE_1:// : IEC 62196-2 Type 1/SAE J1772 Plug
-    case GUN_TYPE_2:// : IEC 62196-2 Type 1/SAE J1772 Socket
-    case GUN_TYPE_3:// : IEC 62196-2 Type 2 Plug
-    case GUN_TYPE_4:// : IEC 62196-2 Type 2 Socket
-    case GUN_TYPE_5:// : GB/T AC Plug
-    case GUN_TYPE_6:// : GB/T AC Socket
-    case GUN_TYPE_7:// ：CCS2 AC Plug
-        pGunAndVol->GunType = Gun_Type_AC;
-        pGunAndVol->GunVoltage = VOL_CHADEMO;
-        break;
-
-    case GUN_TYPE_8:// ：Type E socket
-        break;
-
-    case GUN_TYPE_J:// : CHAdeMO
-        pGunAndVol->GunType = Gun_Type_Chademo;
-        pGunAndVol->GunVoltage = VOL_CHADEMO;
-        break;
-
-    case GUN_TYPE_U:// : Natural cooling CCS1 combo
-    case GUN_TYPE_V:// : Liquid cooling CCS1 combo
-    case GUN_TYPE_E:// : Natural cooling CCS2 combo
-    case GUN_TYPE_F:// : Liquid cooling CCS2 combo
-        pGunAndVol->GunType = Gun_Type_CCS_2;
-        pGunAndVol->GunVoltage = VOL_CCS;
-        break;
-
-    case GUN_TYPE_G:// : GBT DC
-        pGunAndVol->GunType = Gun_Type_GB;
-        pGunAndVol->GunVoltage = VOL_GBT;
-        break;
-    }
-}
-
-static int exchangePowerValue(uint8_t key)
-{
-    switch (key) {
-    case POWER_30W:
-        return 300;
-
-    case POWER_60W:
-        return 600;
-
-    case POWER_90W:
-        return 900;
-
-    case POWER_120W:
-        return 1200;
-
-    case POWER_150W:
-        return 1500;
-
-    case POWER_180W:
-        return 1800;
-
-    case POWER_240W:
-        return 2400;
-
-    case POWER_360W:
-        return 3600;
-
-    case POWER_480W:
-        return 4800;
-
-    case POWER_720W:
-        return 7200;
-
-    default:
-        return 600;
-        break;
-    }
-}
-
-/**
- * [ModuleRatedCurrentParsing : Parsing Rating Current]
- * @param  pModuleName  [description]
- * @param  pDestStruct  [save parameter structure array]
- * @param  parsingCount [parameter structure array count, array 0, 1 for DC Gun, 2 for AC Gun]
- * @return              [return -1 is module name format non match.]
- */
-int ModuleRatedCurrentParsing(char *pModuleName, void *pDestStruct, uint8_t parsingCount)
-{
-    uint8_t gunTypeIndex = 0;
-
-    uint8_t modelKey = 0;
-    uint8_t reguKey = 0;
-    uint8_t powerKey = 0;
-    uint8_t gunTypeKey = 0;
-
-    uint16_t powerVal = 0;
-    uint16_t ratingCurVal = 0;
-    int i = 0;
-    uint32_t ret = 0;
-    char model[2] = {'\0'};
-    char regulation[1] = {'\0'};
-    char power[2] = {'\0'};
-    char gunType[1] = {'\0'};
-    GunRateCurInfo *pGunRateCurInfo = NULL;
-    GunTypeAndVolInfo fGunAndVol = {0};
-
-    if (pModuleName == NULL || pDestStruct == NULL || parsingCount <= 0) {
-        log_error("Failed to parse source data\r\n");
-        return FAIL;
-    }
-
-    if (parsingCount > 3) {
-        parsingCount = 3;
-    }
-
-    strncpy(model, &pModuleName[0], 2);
-    model[2] = '\0';
-    strncpy(regulation, &pModuleName[3], 1);
-    regulation[1] = '\0';
-    strncpy(power, &pModuleName[4], 2);
-    power[2] = '\0';
-
-    for (i = 0; i < parsingCount; i++) {
-        pGunRateCurInfo = (GunRateCurInfo *)pDestStruct + i;
-
-        if (i == 0) {
-            gunTypeIndex = DC_ONE;
-        } else if (i == 1) {
-            gunTypeIndex = DC_SEC;
-        } else if (i == 2) {
-            gunTypeIndex = AC_ONE;
-        }
-
-        strncpy(gunType, &pModuleName[gunTypeIndex], 1);
-        gunType[1] = '\0';
-
-        modelKey = keyfromstring(&model[0], &modelTable[0], sizeof(modelTable) / sizeof(SymStruct));
-        reguKey = keyfromstring(&regulation[0], &regulationTable[0], sizeof(regulationTable) / sizeof(SymStruct));
-        powerKey = keyfromstring(&power[0], &powerTable[0], sizeof(powerTable) / sizeof(SymStruct));
-        if ((gunTypeKey = keyfromstring(&gunType[0], &gunTypeTable[0], sizeof(gunTypeTable) / sizeof(SymStruct))) == GUN_TYPE_0) {
-            log_error("The type of gun is none\r\n");
-            continue;
-        }
-
-        ret = 0;
-        ret = ((modelKey << 24) | (reguKey << 16) | (powerKey << 8) | gunTypeKey);
-        ratingCurVal = exchangeRatingCur(ret);
-        if (ratingCurVal == RC_0A) {
-            log_error("Model name format none match\r\n");
-            return FAIL;
-        }
-
-        memset((uint8_t *)&fGunAndVol, 0, sizeof(GunTypeAndVolInfo));
-        exchangeGunTypeAndVolValue(gunTypeKey, &fGunAndVol);
-        powerVal = exchangePowerValue(powerKey);
-
-        pGunRateCurInfo->GunType = fGunAndVol.GunType;
-        pGunRateCurInfo->RatingCurrent = ratingCurVal;
-        pGunRateCurInfo->Voltage = fGunAndVol.GunVoltage;
-        pGunRateCurInfo->Power = powerVal;
-
-        log_info("%d GunType = %d, Rating current = %d, Vol = %d, Power = %d\r\n",
-                 i,
-                 pGunRateCurInfo->GunType,
-                 pGunRateCurInfo->RatingCurrent,
-                 pGunRateCurInfo->Voltage,
-                 pGunRateCurInfo->Power);
-
-    }
-
-    return PASS;
-}
-
-//------------------------------------------------------------------------------
-//Test function
-//------------------------------------------------------------------------------
-void TestRatedCurrentParsing(void)
-{
-    GunRateCurInfo fGunRateCurInfo[3] = {0};
-
-    ModuleRatedCurrentParsing("DDYC362V0UE2AD", &fGunRateCurInfo[0], sizeof(fGunRateCurInfo) / sizeof(GunRateCurInfo));
-    //log_info("%d GunType = %d, Rating current = %d, Vol = %d, Power = %d\r\n",
-    //         0,
-    //         fGunRateCurInfo[0].GunType,
-    //         fGunRateCurInfo[0].RatingCurrent,
-    //         fGunRateCurInfo[0].Voltage,
-    //         fGunRateCurInfo[0].Power);
-
-    ModuleRatedCurrentParsing("DSYE301E00D2PH", &fGunRateCurInfo[0], sizeof(fGunRateCurInfo) / sizeof(GunRateCurInfo));
-}

EVSE/Modularization/Module_RatingCurrent.h

@@ -1,298 +0,0 @@
-#ifndef _MODULE_NAME_PARSING_H_
-#define _MODULE_NAME_PARSING_H_
-
-#define BADKEY                                  (-1)
-
-//------------------------------------------------------------------------------
-// model type key
-//------------------------------------------------------------------------------
-#define MODEL_AC                                (0x01) //Ac EVse Cordset
-#define MODEL_AW                                (0x02) //Ac EVse Wallmount
-#define MODEL_AP                                (0x03) //Ac EVse Pedestal
-#define MODEL_DW                                (0x04) //Dc EVse Wallmount
-#define MODEL_DS                                (0x05) //Dc EVse Standalone
-#define MODEL_DM                                (0x06) //Dc EVse Moveable (Battery equipped)
-#define MODEL_DR                                (0x07) //Dc EVse Power Rack (without cabinet)
-//#define MODEL_DM                                (0x08) //Dc EVse Moveable (移動)
-#define MODEL_DD                                (0x09) //Dc EVse Dispenser
-#define MODEL_DO                                (0x0A) //Dc EVse Output power cabinet
-
-//------------------------------------------------------------------------------
-// regulation key
-//------------------------------------------------------------------------------
-#define REG_CE                                  (0x01) // CE / European Market
-#define REG_UL                                  (0x02) // UL / North America Market
-#define REG_GB                                  (0x03) // GB / China Market
-#define REG_CNS                                 (0x04) // CNS / Taiwan Market
-#define REG_JARI                                (0x05) // JARI / Japan Market
-#define REG_TR25                                (0x06) // TR25 / Singapor Market
-#define REG_KC                                  (0x07) // KC / Korea Market
-#define REG_B                                   (0x08) // British / UK Market
-#define REG_Z                                   (0x09) // EV ready / French Market
-#define REG_M                                   (0x0A) // E + MID Meter
-#define REG_P                                   (0x0B) // E + PTB certification
-#define REG_I                                   (0x0C) // Z + TIC Meter pcb
-#define REG_F                                   (0x0D) // Z + MID Meter
-#define REG_L                                   (0x0E) // U + UL meter
-
-//------------------------------------------------------------------------------
-// rate power key
-//------------------------------------------------------------------------------
-#define POWER_30W                               (0x01)
-#define POWER_60W                               (0x02)
-#define POWER_90W                               (0x03)
-#define POWER_120W                              (0x04)
-#define POWER_150W                              (0x05)
-#define POWER_180W                              (0x06)
-#define POWER_240W                              (0x07)
-#define POWER_360W                              (0x08)
-#define POWER_480W                              (0x09)
-#define POWER_720W                              (0x0A)
-
-//------------------------------------------------------------------------------
-// gun type key
-//------------------------------------------------------------------------------
-#define GUN_TYPE_0                              (0x00) //none
-#define GUN_TYPE_1                              (0x01) //IEC 62196-2 Type 1/SAE J1772 Plug
-#define GUN_TYPE_2                              (0x02) //IEC 62196-2 Type 1/SAE J1772 Socket
-#define GUN_TYPE_3                              (0x03) //IEC 62196-2 Type 2 Plug
-#define GUN_TYPE_4                              (0x04) //IEC 62196-2 Type 2 Socket
-#define GUN_TYPE_5                              (0x05) //GB/T AC Plug
-#define GUN_TYPE_6                              (0x06) //GB/T AC Socket
-#define GUN_TYPE_7                              (0x07) //CS2 AC Plug
-#define GUN_TYPE_8                              (0x08) //Type E socket
-#define GUN_TYPE_J                              (0x09) //CHAdeMO
-#define GUN_TYPE_U                              (0x0A) //Natural cooling CCS1 combo
-#define GUN_TYPE_V                              (0x0B) //Liquid cooling CCS1 combo
-#define GUN_TYPE_E                              (0x0C) //Natural cooling CCS2 combo
-#define GUN_TYPE_F                              (0x0D) //Liquid cooling CCS2 combo
-#define GUN_TYPE_G                              (0x0E) //GBT DC
-#define GUN_TYPE_T                              (0x0F) //Rema CCS1
-#define GUN_TYPE_D                              (0x10) //Rema CCS2
-#define GUN_TYPE_K                              (0x11) //CHAdeMO 200A/500V
-#define GUN_TYPE_M                              (0x12) //CCS2 80A
-#define GUN_TYPE_N                              (0x13) //CCS1 80A
-#define GUN_TYPE_P                              (0x14) //Phoenix CCS2 500A 水冷
-#define GUN_TYPE_R                              (0x15) //Phoenix CCS1 500A 水冷
-
-//------------------------------------------------------------------------------
-// rating current parameters
-//------------------------------------------------------------------------------
-#define RC_0A                                   (0)
-#define RC_60A                                  (600)
-#define RC_65A                                  (650)
-#define RC_80A                                  (800)
-#define RC_125A                                 (1250)
-#define RC_200A                                 (2000)
-#define RC_250A                                 (2500)
-#define RC_300A                                 (3000)
-#define RC_500A                                 (5000)
-
-//------------------------------------------------------------------------------
-// maximum voltage parameters
-//------------------------------------------------------------------------------
-#define VOL_CHADEMO                             (5000)
-#define VOL_CCS                                 (9500)
-#define VOL_GBT                                 (7500)
-
-#define DC_ONE                                  (7)
-#define DC_SEC                                  (9)
-#define AC_ONE                                  (8)
-
-//------------------------------------------------------------------------------
-// power parameters
-//------------------------------------------------------------------------------
-
-//------------------------------------------------------------------------------
-// rating current case
-//------------------------------------------------------------------------------
-//J
-#define DW_CE_30_J                              ((uint32_t)((MODEL_DW << 24) | (REG_CE << 16) | (POWER_30W << 8) | GUN_TYPE_J))
-#define DM_CE_30_J                              ((uint32_t)((MODEL_DM << 24) | (REG_CE << 16) | (POWER_30W << 8) | GUN_TYPE_J))
-
-#define DW_UL_30_J                              ((uint32_t)((MODEL_DW << 24) | (REG_UL << 16) | (POWER_30W << 8) | GUN_TYPE_J))
-#define DM_UL_30_J                              ((uint32_t)((MODEL_DM << 24) | (REG_UL << 16) | (POWER_30W << 8) | GUN_TYPE_J))
-
-#define DW_CNS_30_J                             ((uint32_t)((MODEL_DW << 24) | (REG_CNS << 16) | (POWER_30W << 8) | GUN_TYPE_J))
-#define DM_CNS_30_J                             ((uint32_t)((MODEL_DM << 24) | (REG_CNS << 16) | (POWER_30W << 8) | GUN_TYPE_J))
-
-#define DS_CE_60_J                              ((uint32_t)((MODEL_DS << 24) | (REG_CE << 16) | (POWER_60W << 8) | GUN_TYPE_J))
-#define DS_CE_90_J                              ((uint32_t)((MODEL_DS << 24) | (REG_CE << 16) | (POWER_90W << 8) | GUN_TYPE_J))
-#define DS_CE_120_J                             ((uint32_t)((MODEL_DS << 24) | (REG_CE << 16) | (POWER_120W << 8) | GUN_TYPE_J))
-#define DS_CE_150_J                             ((uint32_t)((MODEL_DS << 24) | (REG_CE << 16) | (POWER_150W << 8) | GUN_TYPE_J))
-#define DS_CE_180_J                             ((uint32_t)((MODEL_DS << 24) | (REG_CE << 16) | (POWER_180W << 8) | GUN_TYPE_J))
-
-#define DS_UL_60_J                              ((uint32_t)((MODEL_DS << 24) | (REG_UL << 16) | (POWER_60W << 8) | GUN_TYPE_J))
-#define DS_UL_90_J                              ((uint32_t)((MODEL_DS << 24) | (REG_UL << 16) | (POWER_90W << 8) | GUN_TYPE_J))
-#define DS_UL_120_J                             ((uint32_t)((MODEL_DS << 24) | (REG_UL << 16) | (POWER_120W << 8) | GUN_TYPE_J))
-#define DS_UL_150_J                             ((uint32_t)((MODEL_DS << 24) | (REG_UL << 16) | (POWER_150W << 8) | GUN_TYPE_J))
-#define DS_UL_180_J                             ((uint32_t)((MODEL_DS << 24) | (REG_UL << 16) | (POWER_180W << 8) | GUN_TYPE_J))
-
-#define DS_CNS_60_J                             ((uint32_t)((MODEL_DS << 24) | (REG_CNS << 16) | (POWER_60W << 8) | GUN_TYPE_J))
-#define DS_CNS_90_J                             ((uint32_t)((MODEL_DS << 24) | (REG_CNS << 16) | (POWER_90W << 8) | GUN_TYPE_J))
-#define DS_CNS_120_J                            ((uint32_t)((MODEL_DS << 24) | (REG_CNS << 16) | (POWER_120W << 8) | GUN_TYPE_J))
-#define DS_CNS_150_J                            ((uint32_t)((MODEL_DS << 24) | (REG_CNS << 16) | (POWER_150W << 8) | GUN_TYPE_J))
-#define DS_CNS_180_J                            ((uint32_t)((MODEL_DS << 24) | (REG_CNS << 16) | (POWER_180W << 8) | GUN_TYPE_J))
-
-//U
-#define DW_UL_30_U                              ((uint32_t)((MODEL_DW << 24) | (REG_UL << 16) | (POWER_30W << 8) | GUN_TYPE_U))
-#define DM_UL_30_U                              ((uint32_t)((MODEL_DM << 24) | (REG_UL << 16) | (POWER_30W << 8) | GUN_TYPE_U))
-
-#define DW_CNS_30_U                             ((uint32_t)((MODEL_DW << 24) | (REG_CNS << 16) | (POWER_30W << 8) | GUN_TYPE_U))
-#define DM_CNS_30_U                             ((uint32_t)((MODEL_DM << 24) | (REG_CNS << 16) | (POWER_30W << 8) | GUN_TYPE_U))
-
-#define DS_UL_60_U                              ((uint32_t)((MODEL_DS << 24) | (REG_UL << 16) | (POWER_60W << 8) | GUN_TYPE_U))
-#define DS_UL_90_U                              ((uint32_t)((MODEL_DS << 24) | (REG_UL << 16) | (POWER_90W << 8) | GUN_TYPE_U))
-#define DS_UL_120_U                             ((uint32_t)((MODEL_DS << 24) | (REG_UL << 16) | (POWER_120W << 8) | GUN_TYPE_U))
-#define DS_UL_150_U                             ((uint32_t)((MODEL_DS << 24) | (REG_UL << 16) | (POWER_150W << 8) | GUN_TYPE_U))
-#define DS_UL_180_U                             ((uint32_t)((MODEL_DS << 24) | (REG_UL << 16) | (POWER_180W << 8) | GUN_TYPE_U))
-
-#define DD_UL_360_U                             ((uint32_t)((MODEL_DD << 24) | (REG_UL << 16) | (POWER_360W << 8) | GUN_TYPE_U))
-
-#define DS_CNS_60_U                             ((uint32_t)((MODEL_DS << 24) | (REG_CNS << 16) | (POWER_60W << 8) | GUN_TYPE_U))
-#define DS_CNS_90_U                             ((uint32_t)((MODEL_DS << 24) | (REG_CNS << 16) | (POWER_90W << 8) | GUN_TYPE_U))
-#define DS_CNS_120_U                            ((uint32_t)((MODEL_DS << 24) | (REG_CNS << 16) | (POWER_120W << 8) | GUN_TYPE_U))
-#define DS_CNS_150_U                            ((uint32_t)((MODEL_DS << 24) | (REG_CNS << 16) | (POWER_150W << 8) | GUN_TYPE_U))
-#define DS_CNS_180_U                            ((uint32_t)((MODEL_DS << 24) | (REG_CNS << 16) | (POWER_180W << 8) | GUN_TYPE_U))
-
-#define DD_CNS_360_U                             ((uint32_t)((MODEL_DD << 24) | (REG_CNS << 16) | (POWER_360W << 8) | GUN_TYPE_U))
-
-//V
-#define DD_UL_360_V                             ((uint32_t)((MODEL_DD << 24) | (REG_UL << 16) | (POWER_360W << 8) | GUN_TYPE_V))
-
-#define DD_CNS_360_V                            ((uint32_t)((MODEL_DD << 24) | (REG_CNS << 16) | (POWER_360W << 8) | GUN_TYPE_V))
-
-#define DO_UL_360_V                             ((uint32_t)((MODEL_DO << 24) | (REG_UL << 16) | (POWER_360W << 8) | GUN_TYPE_V))
-
-#define DO_CNS_360_V                            ((uint32_t)((MODEL_DO << 24) | (REG_CNS << 16) | (POWER_360W << 8) | GUN_TYPE_V))
-
-//E
-#define DW_CE_30_E                              ((uint32_t)((MODEL_DW << 24) | (REG_CE << 16) | (POWER_30W << 8) | GUN_TYPE_E))
-#define DM_CE_30_E                              ((uint32_t)((MODEL_DM << 24) | (REG_CE << 16) | (POWER_30W << 8) | GUN_TYPE_E))
-
-#define DS_CE_60_E                              ((uint32_t)((MODEL_DS << 24) | (REG_CE << 16) | (POWER_60W << 8) | GUN_TYPE_E))
-#define DS_CE_90_E                              ((uint32_t)((MODEL_DS << 24) | (REG_CE << 16) | (POWER_90W << 8) | GUN_TYPE_E))
-#define DS_CE_120_E                             ((uint32_t)((MODEL_DS << 24) | (REG_CE << 16) | (POWER_120W << 8) | GUN_TYPE_E))
-#define DS_CE_150_E                             ((uint32_t)((MODEL_DS << 24) | (REG_CE << 16) | (POWER_150W << 8) | GUN_TYPE_E))
-#define DS_CE_180_E                             ((uint32_t)((MODEL_DS << 24) | (REG_CE << 16) | (POWER_180W << 8) | GUN_TYPE_E))
-
-//F
-#define DD_CE_360_F                             ((uint32_t)((MODEL_DD << 24) | (REG_CE << 16) | (POWER_360W << 8) | GUN_TYPE_F))
-
-#define DO_CE_360_F                             ((uint32_t)((MODEL_DO << 24) | (REG_CE << 16) | (POWER_360W << 8) | GUN_TYPE_F))
-
-//G
-#define DM_CNS_30_G                             ((uint32_t)((MODEL_DM << 24) | (REG_CNS << 16) | (POWER_30W << 8) | GUN_TYPE_G))
-
-#define DS_UL_30_G                              ((uint32_t)((MODEL_DS << 24) | (REG_UL << 16) | (POWER_30W << 8) | GUN_TYPE_G))
-#define DS_CNS_120_G                            ((uint32_t)((MODEL_DS << 24) | (REG_CNS << 16) | (POWER_120W << 8) | GUN_TYPE_G))
-
-//T
-#define DS_CE_90_T                              ((uint32_t)((MODEL_DS << 24) | (REG_CE << 16) | (POWER_90W << 8) | GUN_TYPE_T))
-#define DS_CE_120_T                             ((uint32_t)((MODEL_DS << 24) | (REG_CE << 16) | (POWER_120W << 8) | GUN_TYPE_T))
-#define DS_CE_150_T                             ((uint32_t)((MODEL_DS << 24) | (REG_CE << 16) | (POWER_150W << 8) | GUN_TYPE_T))
-#define DS_CE_180_T                             ((uint32_t)((MODEL_DS << 24) | (REG_CE << 16) | (POWER_180W << 8) | GUN_TYPE_T))
-
-#define DD_CE_360_T                             ((uint32_t)((MODEL_DD << 24) | (REG_CE << 16) | (POWER_360W << 8) | GUN_TYPE_T))
-
-#define DS_UL_90_T                              ((uint32_t)((MODEL_DS << 24) | (REG_UL << 16) | (POWER_90W << 8) | GUN_TYPE_T))
-#define DS_UL_120_T                             ((uint32_t)((MODEL_DS << 24) | (REG_UL << 16) | (POWER_120W << 8) | GUN_TYPE_T))
-#define DS_UL_150_T                             ((uint32_t)((MODEL_DS << 24) | (REG_UL << 16) | (POWER_150W << 8) | GUN_TYPE_T))
-#define DS_UL_180_T                             ((uint32_t)((MODEL_DS << 24) | (REG_UL << 16) | (POWER_180W << 8) | GUN_TYPE_T))
-
-#define DD_UL_360_T                             ((uint32_t)((MODEL_DD << 24) | (REG_UL << 16) | (POWER_360W << 8) | GUN_TYPE_T))
-
-#define DS_CNS_90_T                             ((uint32_t)((MODEL_DS << 24) | (REG_CNS << 16) | (POWER_90W << 8) | GUN_TYPE_T))
-#define DS_CNS_120_T                            ((uint32_t)((MODEL_DS << 24) | (REG_CNS << 16) | (POWER_120W << 8) | GUN_TYPE_T))
-#define DS_CNS_150_T                            ((uint32_t)((MODEL_DS << 24) | (REG_CNS << 16) | (POWER_150W << 8) | GUN_TYPE_T))
-#define DS_CNS_180_T                            ((uint32_t)((MODEL_DS << 24) | (REG_CNS << 16) | (POWER_180W << 8) | GUN_TYPE_T))
-
-#define DD_CNS_360_T                            ((uint32_t)((MODEL_DD << 24) | (REG_CNS << 16) | (POWER_360W << 8) | GUN_TYPE_T))
-
-//D
-#define DS_CE_90_D                              ((uint32_t)((MODEL_DS << 24) | (REG_CE << 16) | (POWER_90W << 8) | GUN_TYPE_D))
-#define DS_CE_120_D                             ((uint32_t)((MODEL_DS << 24) | (REG_CE << 16) | (POWER_120W << 8) | GUN_TYPE_D))
-#define DS_CE_150_D                             ((uint32_t)((MODEL_DS << 24) | (REG_CE << 16) | (POWER_150W << 8) | GUN_TYPE_D))
-#define DS_CE_180_D                             ((uint32_t)((MODEL_DS << 24) | (REG_CE << 16) | (POWER_180W << 8) | GUN_TYPE_D))
-
-#define DD_CE_360_D                             ((uint32_t)((MODEL_DD << 24) | (REG_CE << 16) | (POWER_360W << 8) | GUN_TYPE_D))
-
-#define DS_UL_90_D                              ((uint32_t)((MODEL_DS << 24) | (REG_UL << 16) | (POWER_90W << 8) | GUN_TYPE_D))
-#define DS_UL_120_D                             ((uint32_t)((MODEL_DS << 24) | (REG_UL << 16) | (POWER_120W << 8) | GUN_TYPE_D))
-#define DS_UL_150_D                             ((uint32_t)((MODEL_DS << 24) | (REG_UL << 16) | (POWER_150W << 8) | GUN_TYPE_D))
-#define DS_UL_180_D                             ((uint32_t)((MODEL_DS << 24) | (REG_UL << 16) | (POWER_180W << 8) | GUN_TYPE_D))
-
-#define DD_UL_360_D                             ((uint32_t)((MODEL_DD << 24) | (REG_UL << 16) | (POWER_360W << 8) | GUN_TYPE_D))
-
-#define DS_CNS_90_D                             ((uint32_t)((MODEL_DS << 24) | (REG_CNS << 16) | (POWER_90W << 8) | GUN_TYPE_D))
-#define DS_CNS_120_D                            ((uint32_t)((MODEL_DS << 24) | (REG_CNS << 16) | (POWER_120W << 8) | GUN_TYPE_D))
-#define DS_CNS_150_D                            ((uint32_t)((MODEL_DS << 24) | (REG_CNS << 16) | (POWER_150W << 8) | GUN_TYPE_D))
-#define DS_CNS_180_D                            ((uint32_t)((MODEL_DS << 24) | (REG_CNS << 16) | (POWER_180W << 8) | GUN_TYPE_D))
-
-#define DD_CNS_360_D                            ((uint32_t)((MODEL_DD << 24) | (REG_CNS << 16) | (POWER_360W << 8) | GUN_TYPE_D))
-
-//K
-#define DS_CE_90_K                              ((uint32_t)((MODEL_DS << 24) | (REG_CE << 16) | (POWER_90W << 8) | GUN_TYPE_K))
-#define DS_CE_120_K                             ((uint32_t)((MODEL_DS << 24) | (REG_CE << 16) | (POWER_120W << 8) | GUN_TYPE_K))
-#define DS_CE_150_K                             ((uint32_t)((MODEL_DS << 24) | (REG_CE << 16) | (POWER_150W << 8) | GUN_TYPE_K))
-#define DS_CE_180_K                             ((uint32_t)((MODEL_DS << 24) | (REG_CE << 16) | (POWER_180W << 8) | GUN_TYPE_K))
-
-#define DD_CE_360_K                             ((uint32_t)((MODEL_DD << 24) | (REG_CE << 16) | (POWER_360W << 8) | GUN_TYPE_K))
-
-#define DS_UL_90_K                              ((uint32_t)((MODEL_DS << 24) | (REG_UL << 16) | (POWER_90W << 8) | GUN_TYPE_K))
-#define DS_UL_120_K                             ((uint32_t)((MODEL_DS << 24) | (REG_UL << 16) | (POWER_120W << 8) | GUN_TYPE_K))
-#define DS_UL_150_K                             ((uint32_t)((MODEL_DS << 24) | (REG_UL << 16) | (POWER_150W << 8) | GUN_TYPE_K))
-#define DS_UL_180_K                             ((uint32_t)((MODEL_DS << 24) | (REG_UL << 16) | (POWER_180W << 8) | GUN_TYPE_K))
-
-#define DD_UL_360_K                             ((uint32_t)((MODEL_DD << 24) | (REG_UL << 16) | (POWER_360W << 8) | GUN_TYPE_K))
-
-//M
-#define DW_CE_30_M                              ((uint32_t)((MODEL_DW << 24) | (REG_CE << 16) | (POWER_30W << 8) | GUN_TYPE_M))
-#define DM_CE_30_M                              ((uint32_t)((MODEL_DM << 24) | (REG_CE << 16) | (POWER_30W << 8) | GUN_TYPE_M))
-
-//N
-#define DW_UL_30_N                              ((uint32_t)((MODEL_DW << 24) | (REG_UL << 16) | (POWER_30W << 8) | GUN_TYPE_N))
-#define DM_UL_30_N                              ((uint32_t)((MODEL_DM << 24) | (REG_UL << 16) | (POWER_30W << 8) | GUN_TYPE_N))
-
-#define DW_CNS_30_N                             ((uint32_t)((MODEL_DW << 24) | (REG_CNS << 16) | (POWER_30W << 8) | GUN_TYPE_N))
-#define DM_CNS_30_N                             ((uint32_t)((MODEL_DM << 24) | (REG_CNS << 16) | (POWER_30W << 8) | GUN_TYPE_N))
-
-//P
-#define DD_CE_360_P                             ((uint32_t)((MODEL_DD << 24) | (REG_CE << 16) | (POWER_360W << 8) | GUN_TYPE_P))
-
-//R
-#define DD_UL_360_R                             ((uint32_t)((MODEL_DD << 24) | (REG_UL << 16) | (POWER_360W << 8) | GUN_TYPE_R))
-
-#define DD_CNS_360_R                            ((uint32_t)((MODEL_DD << 24) | (REG_CNS << 16) | (POWER_360W << 8) | GUN_TYPE_R))
-
-//------------------------------------------------------------------------------
-typedef enum EnGunType {
-    Gun_Type_Chademo = 0,
-    Gun_Type_CCS_2,
-    Gun_Type_GB,
-    Gun_Type_AC,
-} GunType;
-
-typedef struct StSymStruct {
-    char *key;
-    int val;
-} SymStruct;
-
-typedef struct StGunTypeAndVolInfo {
-    uint8_t GunType;
-    uint16_t GunVoltage;
-} GunTypeAndVolInfo;
-
-typedef struct StGunRateCurInfo {
-    uint8_t GunType;
-    uint16_t RatingCurrent; //* 0.1A
-    uint16_t Voltage;       //* 0.1V
-    uint16_t Power;
-    uint8_t Reserved;
-} GunRateCurInfo;
-
-//------------------------------------------------------------------------------
-int ModuleRatedCurrentParsing(char *pModuleName, void *pDestStruct, uint8_t parsingCount);
-void TestRatedCurrentParsing(void);
-
-#endif /* _MODULE_NAME_PARSING_H_ */

EVSE/Projects/DD360/Apps/FactoryConfig.c

@@ -104,7 +104,7 @@ int main(int argc, char *argv[])
     */
     //********** System **********// udhcpc -i eth1 -s ./dhcp_script/eth1.script
     //
-    strcpy((char *)SysConfig.ModelName, "DDYC182V0UE2AD");
+    strcpy((char *)SysConfig.ModelName, "DXYE18200EE1E4");
     strcpy((char *)SysConfig.SerialNumber, "SERIALFORRD");
 
     memset(SysConfig.SystemId, 0x00, sizeof(SysConfig.SystemId));

EVSE/Projects/DD360/Apps/Module_InternalComm.c

@@ -2321,7 +2321,7 @@ int main(void)
 //              printRelayStatus = true;
 //          }
         }
-#ifndef NO_FAN_BOARD
+#if !defined NO_FAN_BOARD && !defined DD360ComBox
         if (ShmFanModuleData->SelfTest_Comp == YES) {
             if (GetTimeoutValue(_priority_time) / 1000 >= 1000) {
                 //GetPsuTempForFanSpeed();

EVSE/Projects/DD360/Apps/Module_LcmControl.c

@@ -336,7 +336,7 @@ void ChangeWarningFunc()
     // 最多一次五筆
     //PRINTF_FUNC("LCM PageIndex = %d \n", ShmSysConfigAndInfo->SysWarningInfo.PageIndex);
     //PRINTF_FUNC("WarningCount = %d \n", ShmSysConfigAndInfo->SysWarningInfo.WarningCount);
-#if !defined DD360 && !defined DD360Audi
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
     for (i = 0; (i + ShmSysConfigAndInfo->SysWarningInfo.PageIndex * 5) < ShmSysConfigAndInfo->SysWarningInfo.WarningCount; i++) {
         memset(cmd, 0x00, sizeof(cmd));
         if ((i) >= 5) {
@@ -918,7 +918,7 @@ void RefreshPageAnimation(byte value)
 void RefreshConnStatus()
 {
     // Wifi priority is higher than Ethernet
-#if defined DD360 || defined DD360Audi
+#if defined DD360 ||defined DD360Audi || defined DD360ComBox
     uint8_t i = 0;
     unsigned char flag[4] = {0};
 

EVSE/Projects/DD360/Apps/Module_PrimaryComm.c

@@ -257,7 +257,7 @@ void GetInputGpioStatus()
 {
     //PRINTF_FUNC("GetInputGpioStatus \n");
     if (Query_Gpio_Input(Uart1Fd, Addr.IoExtend, &gpio_in) == PASS) {
-#if !defined DD360 && !defined DD360Audi
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
         ShmSysConfigAndInfo->SysInfo.AcContactorStatus = ShmPrimaryMcuData->InputDet.bits.AcContactorDetec = gpio_in.AC_Connector;
         ShmPrimaryMcuData->InputDet.bits.AcMainBreakerDetec = gpio_in.AC_MainBreaker;
 #else
@@ -284,7 +284,7 @@ void GetInputGpioStatus()
         //PRINTF_FUNC("left = %d \n", ShmPrimaryMcuData->InputDet.bits.Button1);
         //PRINTF_FUNC("right = %d \n", ShmPrimaryMcuData->InputDet.bits.Button2);
         //PRINTF_FUNC("ShmSysConfigAndInfo->SysInfo.AcContactorStatus = %d \n", ShmSysConfigAndInfo->SysInfo.AcContactorStatus);
-#if !defined DD360 && !defined DD360Audi
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
         if (ShmPrimaryMcuData->InputDet.bits.AcMainBreakerDetec == YES) {
             DEBUG_ERROR("AC Mainbreaker occur. \n");
         }
@@ -303,7 +303,7 @@ void SetOutputGpio(byte flash)
     gpio.System_LED[2] = 0x00;
     gpio.System_LED[3] = 0x00;
 
-#if defined DD360 || defined DD360Audi
+#if defined DD360 ||defined DD360Audi || defined DD360ComBox
     if ((ChargingData[0]->PresentChargingCurrent) >= 150) {
         ChillerSwitch = 1;
         ChillerOnTime = time((time_t *)NULL);

EVSE/Projects/DD360/Apps/ReMain.c

@@ -33,7 +33,7 @@
 #include <dirent.h>
 #include "timeout.h"
 
-#if defined DD360 || defined DD360Audi
+#if defined DD360 ||defined DD360Audi || defined DD360ComBox
 #include "AudiCust.h"
 #endif //defined DD360Audi
 
@@ -53,7 +53,7 @@
 #define MtdBlockSize                            0x600000
 #define SYSFS_GPIO_DIR                          "/sys/class/gpio"
 #define UPGRADE_FAN                             0x02
-#if defined DD360 || defined DD360Audi
+#if defined DD360 ||defined DD360Audi || defined DD360ComBox
 #define UPGRADE_RB                              0x09 //0x09 for DD360 dispenser
 #else
 #define UPGRADE_RB                              0x03 //other module use
@@ -84,6 +84,18 @@
 #define GUN_COMP_WAIT_TIMEOUT                   10
 #define GUN_PRECHARGING_TIMEOUT                 60
 
+typedef struct StLedConfig {
+    //OutputDrvValue[0]
+    uint8_t LeftButtonLed: 1;                   //bit 0,    H: ON,      L:OFF
+    uint8_t RightButtonLed: 1;                  //bit 1,    H: ON,      L:OFF
+    uint8_t GreenLED: 1;                        //bit 2,    H: ON,      L:OFF
+    uint8_t YellowLED: 1;                       //bit 3,    H: ON,      L:OFF
+    uint8_t RedLED: 1;                          //bit 4,    H: ON,      L:OFF
+    uint8_t SystemLed4: 1;                      //bit 5,    H: ON,      L:OFF
+    uint8_t AcContactor: 1;                     //bit 6,    H: ON,      L:OFF
+    uint8_t Reserved: 1;                        //bit 7 reserved
+} LedConfig;
+
 char *valid_Internet[2] = {"8.8.8.8", "180.76.76.76"};
 unsigned char mask_table[] = { 0x01, 0x02, 0x04, 0x08, 0x10, 0x20, 0x40, 0x80 };
 int whileLoopTime = 10000; // 10 ms
@@ -153,7 +165,7 @@ struct MeterInformation         *ShmCsuMeterData;
 struct DcCommonInformation      *ShmDcCommonData;
 #endif //defined METER_ENABLE
 
-#if defined DD360 || defined DD360Audi
+#if defined DD360 ||defined DD360Audi || defined DD360ComBox
 static AudiCustInfo             *gAudiCustInfo = NULL; //Jerry add
 #endif //defined DD360Audi
 
@@ -317,6 +329,100 @@ static void confirmSelGun(uint8_t selGun)
 }
 #endif // defined DD360Audi
 
+static void startPrimaryLedIndicatorCtrlFork(void)
+{
+    pid_t pid = fork();
+    if (pid == 0) {
+        uint8_t totalGun = ShmSysConfigAndInfo->SysConfig.TotalConnectorCount;
+        uint8_t gunIndex = 0;
+        int isContinue = 1;
+        LedConfig *pLedConfig = (LedConfig *)&ShmPrimaryMcuData->OutputDrv.OutputDrvValue[0];
+
+        while (isContinue) {
+            for (gunIndex = 0; gunIndex < totalGun; gunIndex++) {
+                //printf("led indicator status = %d\r\n", chargingInfo[gunIndex]->SystemStatus);
+                //printf("level = %d\r\n", ShmSysConfigAndInfo->SysWarningInfo.Level);
+                switch (chargingInfo[gunIndex]->SystemStatus) {
+                case S_BOOTING:
+                    pLedConfig->RedLED = YES;
+                    pLedConfig->YellowLED = YES;
+                    pLedConfig->GreenLED = YES;
+                    break;
+
+                case S_IDLE:
+                case S_RESERVATION:
+                case S_AUTHORIZING:
+                case S_REASSIGN_CHECK:
+                case S_REASSIGN:
+                case S_PREPARNING:
+                case S_PREPARING_FOR_EV:
+                case S_PREPARING_FOR_EVSE:
+                case S_CCS_PRECHARGE_ST0:
+                case S_CCS_PRECHARGE_ST1:
+                    pLedConfig->RedLED = NO;
+                    pLedConfig->YellowLED = NO;
+
+                    if (pLedConfig->GreenLED == YES) {
+                        pLedConfig->GreenLED = NO;
+                    } else {
+                        pLedConfig->GreenLED = YES;
+                    }
+                    break;
+
+                case S_CHARGING:
+                    pLedConfig->RedLED = NO;
+                    if (pLedConfig->YellowLED == YES) {
+                        pLedConfig->YellowLED = NO;
+                    } else {
+                        pLedConfig->YellowLED = YES;
+                    }
+                    pLedConfig->GreenLED = NO;
+                    break;
+
+                case S_ALARM:
+                case S_TERMINATING:
+                case S_COMPLETE:
+                    if (ShmSysConfigAndInfo->SysWarningInfo.Level == 2) {
+                        pLedConfig->YellowLED = NO;
+                        pLedConfig->GreenLED = NO;
+                        if (pLedConfig->RedLED == YES) {
+                            pLedConfig->RedLED = NO;
+                        } else {
+                            pLedConfig->RedLED = YES;
+                        }
+                    } else {
+                        pLedConfig->RedLED = NO;
+                        pLedConfig->YellowLED = NO;
+                        pLedConfig->GreenLED = YES;
+                    }
+                    break;
+
+                case S_MAINTAIN:
+                case S_FAULT:
+                    pLedConfig->YellowLED = NO;
+                    pLedConfig->GreenLED = NO;
+                    if (ShmSysConfigAndInfo->SysWarningInfo.Level == 2) {
+                        if (pLedConfig->RedLED == YES) {
+                            pLedConfig->RedLED = NO;
+                        } else {
+                            pLedConfig->RedLED = YES;
+                        }
+                    }
+                    break;
+
+                case S_BOOKING:
+                case S_DEBUG:
+                case S_UPDATE:
+                case S_NONE:
+                    break;
+                }
+
+                usleep(500000);
+            }//switch
+        }//for
+    }//while
+}
+
 //================================================
 // initial can-bus
 //================================================
@@ -702,7 +808,7 @@ int CreateShareMemory()
     memset(ShmDcCommonData, 0, sizeof(struct DcCommonInformation));
 #endif //defined METER_ENABLE
 
-#if defined DD360 || defined DD360Audi
+#if defined DD360 ||defined DD360Audi || defined DD360ComBox
     //creat Audi customization info
     if ((MeterSMId = shmget(ShmAudiCustInfoKey, sizeof(AudiCustInfo), IPC_CREAT | 0777)) < 0) {
         return FAIL;
@@ -820,7 +926,7 @@ void InitGPIO()
     system("echo \"out\" > /sys/class/gpio/gpio116/direction");
     system("echo 0 > /sys/class/gpio/gpio116/value");
 
-#if !defined DD360 && !defined DD360Audi
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
     /* (C14) EMU0.gpio3[7] */  /*CP open/short feature enable/disable, pull low for default enable*/
     system("echo 103 > /sys/class/gpio/export");
     system("echo \"out\" > /sys/class/gpio/gpio103/direction");
@@ -1027,7 +1133,7 @@ int isReachableInternet()
     }
     pclose(fp);
 
-#if defined DD360 || defined DD360Audi
+#if defined DD360 ||defined DD360Audi || defined DD360ComBox
     if (ShmStatusCodeData->AlarmCode.AlarmEvents.bits.DisconnectedFromDo == NORMAL) {
         result = FAIL;
     } else {
@@ -1063,7 +1169,7 @@ int isReachableInternet()
 void InitEthernet()
 {
     char tmpbuf[256];
-#if !defined DD360 && !defined DD360Audi
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
     bool ethResult = false;
     uint8_t cnt_pingDNS_Fail = 0;
 #endif //!defined DD360 && !defined DD360Audi
@@ -1117,7 +1223,7 @@ void InitEthernet()
     if (pid == 0) {
         log_info("InitEthernet = %d\r\n", pid);
         for (;;) {
-#if !defined DD360 && !defined DD360Audi
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
             if (isRouteFail()) {
                 //PRINTF_FUNC("eth0 not in route, restart eht0. \n");
                 system("/sbin/ifconfig eth0 down;/sbin/ifconfig eth0 up");
@@ -1597,7 +1703,7 @@ bool DisplaySelfTestFailReason()
     }
 
     if (ShmSysConfigAndInfo->SysInfo.AcContactorStatus == NO) {
-#if !defined DD360 && !defined DD360Audi
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
         // AC Contact 未搭上
         ShmStatusCodeData->AlarmCode.AlarmEvents.bits.AcContactStestFail = true;
         result = true;
@@ -1650,7 +1756,7 @@ void SelfTestRun()
                     log_info("Relay Board FW Rev = %s", ShmSysConfigAndInfo->SysInfo.RelayModuleFwRev);
                     ShmRelayModuleData->SelfTest_Comp = YES;
                 }
-#ifndef NO_FAN_BOARD
+#if !defined NO_FAN_BOARD && !defined DD360ComBox
                 if ((strlen((char *)ShmSysConfigAndInfo->SysInfo.FanModuleFwRev) != 0 ||
                         ShmSysConfigAndInfo->SysInfo.FanModuleFwRev[0] != '\0')
                         && (ShmFanModuleData->SelfTest_Comp != YES)
@@ -1756,7 +1862,7 @@ void SelfTestRun()
             case _STEST_AC_CONTACTOR: {
                 //ShmPsuData->Work_Step = _TEST_COMPLETE;
                 // 因為 30KW 以下沒有 Relay feedback 功能，所以暫時先直接跳過
-#if !defined DD360 && !defined DD360Audi
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
                 if (ShmSysConfigAndInfo->SysInfo.AcContactorStatus == YES) {
                     ShmSysConfigAndInfo->SysInfo.SelfTestSeq = _STEST_PSU_DETECT;
                     log_info("AC contactor self test OK");
@@ -1768,7 +1874,7 @@ void SelfTestRun()
             }
             break;
             case _STEST_PSU_DETECT: {
-#if !defined DD360 && !defined DD360Audi
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
                 if (ShmPsuData->Work_Step >= GET_SYS_CAP) {
                     ShmSysConfigAndInfo->SysInfo.SelfTestSeq = _STEST_PSU_CAP;
                 }
@@ -1778,7 +1884,7 @@ void SelfTestRun()
             }
             break;
             case _STEST_PSU_CAP: {
-#if !defined DD360 && !defined DD360Audi
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
                 // 此測試是要確認當前總輸出能力
                 // 如果沒有 PSU 模組請 bypass
                 if (ShmPsuData->Work_Step == BOOTING_COMPLETE) {
@@ -1813,7 +1919,7 @@ int SpawnTask()
     system("/root/Module_InternalComm &");
     system("/root/Module_ProduceUtils &");
 
-#if defined DD360 || defined DD360Audi
+#if defined DD360 ||defined DD360Audi || defined DD360ComBox
     system("/root/DoComm &");
 #else
     system("/root/Module_PsuComm &");
@@ -2398,7 +2504,7 @@ void EmcOccureByString(char *code)
     // 嚴重的急停有以下幾種 : EMC 按鈕、Mainbreak、Dooropen
     // 其錯誤等級為 2
 
-#if defined DD360 || defined DD360Audi
+#if defined DD360 ||defined DD360Audi || defined DD360ComBox
     //DS60-120 remove
     if (strncmp(code, "012251", 6) == EQUAL ||
             strncmp(code, "012252", 6) == EQUAL ||
@@ -2423,7 +2529,7 @@ void EmcOccureByString(char *code)
                 ChargingAlarmProcess(gun);
             }
         }
-#if defined DD360 || defined DD360Audi
+#if defined DD360 ||defined DD360Audi || defined DD360ComBox
         StopChargingProcessByString(level);
         InformOcppErrOccur(4);
 #endif //defined DD360 || defined DD360Audi
@@ -2935,19 +3041,19 @@ void CheckGunTypeFromHw()
     for (i = 0; i < 2; i++) {
         switch (tmp[i]) {
         case 0x01:
-            log_info("BD%d(%s) = %s ", i + 1, i == 1 ? "Left" : "Right", "CHAdeMO");
+            log_info("BD%d(%s) = %s ", i + 1, i == 0 ? "Left" : "Right", "CHAdeMO");
             break;
 
         case 0x10:
-            log_info("BD%d(%s) = %s ", i + 1, i == 1 ? "Left" : "Right", "CCS");
+            log_info("BD%d(%s) = %s ", i + 1, i == 0 ? "Left" : "Right", "CCS");
             break;
 
         case 0x11:
-            log_info("BD%d(%s) = %s ", i + 1, i == 1 ? "Left" : "Right", "GBT");
+            log_info("BD%d(%s) = %s ", i + 1, i == 0 ? "Left" : "Right", "GBT");
             break;
 
         case 0x00:
-            log_info("BD%d(%s) = %s ", i + 1, i == 1 ? "Left" : "Right", "None");
+            log_info("BD%d(%s) = %s ", i + 1, i == 0 ? "Left" : "Right", "None");
             break;
         }
     }
@@ -3122,7 +3228,7 @@ void UserScanFunction()
                     } else {
                         _authorizeIndex = ShmSysConfigAndInfo->SysInfo.CurGunSelected;
                     }
-#if !defined DD360 && !defined DD360Audi
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
                     StartSystemTimeoutDet(Timeout_AuthorizingForStop);
                     AuthorizingStart();
 #else
@@ -3155,14 +3261,14 @@ void UserScanFunction()
     } else {
         // 透過後臺停止充電的判斷
         if (isAuthorizedComplete()
-#if !defined DD360 && !defined DD360Audi
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
                 || (ShmSysConfigAndInfo->SysInfo.OcppConnStatus == NO &&
                     ShmSysConfigAndInfo->SysConfig.OfflinePolicy == _OFFLINE_POLICY_FREE_CHARGING)
 #endif //!defined DD360 && !defined DD360Audi
            ) {
             // 判斷後台回覆狀態
             if (canStartCharging()
-#if !defined DD360 && !defined DD360Audi
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
                     || (ShmSysConfigAndInfo->SysInfo.OcppConnStatus == NO &&
                         ShmSysConfigAndInfo->SysConfig.OfflinePolicy == _OFFLINE_POLICY_FREE_CHARGING)
 #endif //!defined DD360 && !defined DD360Audi
@@ -3229,14 +3335,14 @@ void ScannerCardProcess()
 
         // 確認驗證卡號完成沒
         if (isAuthorizedComplete()
-#if !defined DD360 && !defined DD360Audi
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
                 || ShmSysConfigAndInfo->SysConfig.OfflinePolicy == _OFFLINE_POLICY_FREE_CHARGING
 #endif //!defined DD360 && !defined DD360Audi
            ) {
             StopSystemTimeoutDet();
             // 判斷後台回覆狀態
             if (canStartCharging()
-#if !defined DD360 && !defined DD360Audi
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
                     || ShmSysConfigAndInfo->SysConfig.OfflinePolicy == _OFFLINE_POLICY_FREE_CHARGING
 #endif //!defined DD360 && !defined DD360Audi
                ) {
@@ -3540,7 +3646,7 @@ void KillTask()
     system("killall Module_LcmControl");
     system("killall Module_InternalComm");
     //system("killall DoComm");
-#if !defined DD360 && !defined DD360Audi
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
     system("killall Module_PsuComm");
     system("killall OcppBackend &");
     system("killall Module_4g &");
@@ -3553,7 +3659,7 @@ void KillTaskExceptPrimary()
     ChangeLcmByIndex(_LCM_FIX);
     system("killall Module_EvComm");
     system("killall Module_InternalComm");
-#if !defined DD360 && !defined DD360Audi
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
     system("killall Module_PsuComm");
     system("killall Module_4g &");
     system("killall Module_Wifi &");
@@ -3568,7 +3674,7 @@ void KillAllTask()
     system("killall Module_EvComm");
     system("killall Module_LcmControl");
     system("killall Module_InternalComm");
-#if !defined DD360 && !defined DD360Audi
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
     system("killall Module_PsuComm");
     system("killall OcppBackend &");
     system("killall Module_4g &");
@@ -5421,6 +5527,20 @@ static void powerCabinetPsuAlarmStatus(void)
     }
 }
 
+static void autoStartChargingForComBox(uint8_t gunIndex)
+{
+#if defined DD360ComBox
+    if ((chargingInfo[gunIndex]->ConnectorPlugIn == YES) &&
+            (chargingInfo[gunIndex]->SystemStatus == S_IDLE)
+       ) {
+        ShmSysConfigAndInfo->SysInfo.CurGunSelected = gunIndex;
+        strcpy((char *)&ShmSysConfigAndInfo->SysConfig.UserId, "AutoStartCharging");
+    }
+#else
+    return;
+#endif //DD360ComBox
+}
+
 int main(void)
 {
     uint8_t evBoardStopState = 0;
@@ -5465,6 +5585,7 @@ int main(void)
     }
     CreateTimeoutFork();
     log_info("Start self test... \n");
+    startPrimaryLedIndicatorCtrlFork();
     SelfTestRun();
     StopSystemTimeoutDet();
     log_info("Self test finished : SelfTestSeq = %d, Work_Step = %d ",
@@ -5537,6 +5658,7 @@ int main(void)
     CheckFwSlotStatusLog();
     AdjustChargerCurrent();
     gettimeofday(&_cmdMainPriority_time, NULL);
+
     for (;;) {
         CheckOcppStatus();
         ChkPrimaryStatus();
@@ -5555,7 +5677,7 @@ int main(void)
         ClearAlarmCodeWhenAcOff();
         // 確認是否要回到充電中的槍畫面邏輯判斷
         CheckReturnToChargingConn();
-#if defined DD360 || defined DD360Audi
+#if defined DD360 ||defined DD360Audi || defined DD360ComBox
         //確認Power cabinet PSU Status
         powerCabinetPsuAlarmStatus();
 #endif // defined DD360 || defined DD360Audi
@@ -5612,6 +5734,8 @@ int main(void)
 #endif //defined METER_ENABLE
 
         for (byte gun_index = 0; gun_index < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; gun_index++) {
+            autoStartChargingForComBox(gun_index); //for DD360ComBox
+
             CheckGpioInStatus();
             CheckErrorOccurStatus(gun_index);
             ChkOcppStatus(gun_index);
@@ -5683,7 +5807,7 @@ int main(void)
                     }
 
                     ClearDetectPluginFlag();
-//#if !defined DD360 && !defined DD360Audi
+//#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
                     UpdateErrorCodeToOcpp(gun_index);
 //#endif //!defined DD360 && !defined DD360Audi
                     setChargerMode(gun_index, MODE_FAULT);
@@ -5707,7 +5831,7 @@ int main(void)
 #endif //0
 
                     if (ShmSysConfigAndInfo->SysInfo.MainChargingMode == _MAIN_CHARGING_MODE_AVER) {
-#if !defined DD360 && !defined DD360Audi
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
                         if (ShmSysConfigAndInfo->SysInfo.AcContactorStatus == YES)
 #else
                         if (1)
@@ -5845,7 +5969,7 @@ int main(void)
                     }
                     StopSystemTimeoutDet();
                 }
-#if !defined DD360 && !defined DD360Audi
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
                 bool isRessign = false;
                 if (ShmSysConfigAndInfo->SysConfig.TotalConnectorCount > 1 && ShmSysConfigAndInfo->SysInfo.IsAlternatvieConf == NO) {
                     if (ShmSysConfigAndInfo->SysInfo.MainChargingMode == _MAIN_CHARGING_MODE_MAX) {
@@ -5884,7 +6008,7 @@ int main(void)
 #endif // !defined DD360 && !defined DD360Audi
 
                 if (0) { // if (isRessign)
-#if defined DD360 || defined DD360Audi
+#if defined DD360 ||defined DD360Audi || defined DD360ComBox
                     setChargerMode(gun_index, MODE_PRECHARGE);
 #else
                     setChargerMode(gun_index, MODE_REASSIGN);
@@ -6136,7 +6260,7 @@ int main(void)
                     ftime(&startChargingTime[gun_index]);
                     strcpy((char *)ShmOCPP16Data->StartTransaction[gun_index].ResponseIdTagInfo.Status, ""); //DS60-120 add
                     ChangeStartOrStopDateTime(YES, gun_index);
-#if !defined DD360 && !defined DD360Audi
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
                     OcppStartTransation(gun_index);
 #endif //!defined DD360 && !defined DD360Audi
                 }

EVSE/Projects/DD360/Apps/ReModule_EvComm.c

@@ -2578,14 +2578,14 @@ void SetPresentChargingOutputCap(struct ChargingInfoData *chargingData_1, struct
     float pow1 = 0, cur1 = 0;
     float pow2 = 0, cur2 = 0;
 
-#if !defined DD360 && !defined DD360Audi
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
     float vol = 0;
 #endif //!defined DD360 && !defined DD360Audi
 
     pow1 = chargingData_1->AvailableChargingPower;
     cur1 = chargingData_1->AvailableChargingCurrent;
 
-#if !defined DD360 && !defined DD360Audi
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
     vol = chargingData_1->MaximumChargingVoltage;
     GetMaxVolAndCurMethod(chargingData_1->Index, &vol, &cur1);
     GetMaxPowerMethod(chargingData_1->Index, &pow1);
@@ -2610,7 +2610,7 @@ void SetPresentChargingOutputCap(struct ChargingInfoData *chargingData_1, struct
     pow2 = chargingData_2->AvailableChargingPower;
     cur2 = chargingData_2->AvailableChargingCurrent;
 
-#if !defined DD360 && !defined DD360Audi
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
     vol = chargingData_2->MaximumChargingVoltage;
     GetMaxVolAndCurMethod(chargingData_2->Index, &vol, &cur2);
     GetMaxPowerMethod(chargingData_2->Index, &pow2);
@@ -3320,10 +3320,10 @@ int main(int argc, char *argv[])
                 // 計算 Power
                 _chargingData[_index]->PresentChargingPower = ((float)((_chargingData[_index]->PresentChargingVoltage) * (_chargingData[_index]->PresentChargingCurrent)) / 1000);
 
-                CalOutputPowerAndEnergy(_index); //DS60-120 add
+                //CalOutputPowerAndEnergy(_index); //DS60-120 add
 
                 //DS60-120 remove
-                /*if (chargingTime[_index] == 0 ||
+                if (chargingTime[_index] == 0 ||
                         chargingTime[_index] > _chargingData[_index]->PresentChargedDuration) {
                     chargingTime[_index] = _chargingData[_index]->PresentChargedDuration;
                 } else {
@@ -3339,7 +3339,7 @@ int main(int argc, char *argv[])
                         _chargingData[_index]->PowerConsumption += changingPow;
                         chargingTime[_index] = _chargingData[_index]->PresentChargedDuration;
                     }
-                }*/
+                }
 
                 // 開始確認車端是否同意開始充電
                 GetOutputReq(_index, _chargingData[_index]->Evboard_id);
@@ -3361,11 +3361,14 @@ int main(int argc, char *argv[])
                     }
                 }
 
-                if (_chargingData[_index]->GroundFaultStatus == GFD_FAIL) {
-                    SetIsolationStatus(_index, _chargingData[_index]->GroundFaultStatus, _chargingData[_index]->Evboard_id);
-                } else if (_chargingData[_index]->Type == _Type_CCS_2) {
+                if ((_chargingData[_index]->GroundFaultStatus == GFD_FAIL) ||
+                        (_chargingData[_index]->Type == _Type_CCS_2)) {
                     SetIsolationStatus(_index, _chargingData[_index]->GroundFaultStatus, _chargingData[_index]->Evboard_id);
                 }
+                /*
+                else if (_chargingData[_index]->Type == _Type_CCS_2) {
+                SetIsolationStatus(_index, _chargingData[_index]->GroundFaultStatus, _chargingData[_index]->Evboard_id);
+                }*/
 
                 // GFD 失敗再通知
                 if (priorityLow == 1) {

EVSE/Projects/DD360/Apps/ReModule_LcmControl.c

@@ -339,7 +339,7 @@ void ChangeWarningFunc()
     // 最多一次五筆
     //PRINTF_FUNC("LCM PageIndex = %d \n", ShmSysConfigAndInfo->SysWarningInfo.PageIndex);
     //PRINTF_FUNC("WarningCount = %d \n", ShmSysConfigAndInfo->SysWarningInfo.WarningCount);
-//#if !defined DD360 && !defined DD360Audi
+//#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
     for (i = 0; (i + ShmSysConfigAndInfo->SysWarningInfo.PageIndex * 5) < ShmSysConfigAndInfo->SysWarningInfo.WarningCount; i++) {
         memset(cmd, 0x00, sizeof(cmd));
         if ((i) >= 5) {
@@ -927,7 +927,7 @@ void RefreshPageAnimation(byte value)
 void RefreshConnStatus()
 {
     // Wifi priority is higher than Ethernet
-#if defined DD360 || defined DD360Audi
+#if defined DD360 ||defined DD360Audi || defined DD360ComBox
     uint8_t i = 0;
     uint8_t ehtStatus = 0;
 

EVSE/Projects/DD360/Apps/ReModule_PrimaryComm.c

@@ -37,6 +37,24 @@
 #define YES                 1
 #define NO                  0
 
+typedef struct StChillerInfo {
+    uint8_t ChillerSwitch;
+    uint32_t ChillerOnTime;
+    uint8_t Reserved[3];
+} ChillerInfo;
+
+typedef struct StLedConfig {
+    //OutputDrvValue[0]
+    uint8_t LeftButtonLed: 1;                   //bit 0,    H: ON,      L:OFF
+    uint8_t RightButtonLed: 1;                  //bit 1,    H: ON,      L:OFF
+    uint8_t GreenLED: 1;                          //bit 2,    H: ON,      L:OFF
+    uint8_t YellowLED: 1;                       //bit 3,    H: ON,      L:OFF
+    uint8_t RedLED: 1;                        //bit 4,    H: ON,      L:OFF
+    uint8_t SystemLed4: 1;                      //bit 5,    H: ON,      L:OFF
+    uint8_t AcContactor: 1;                     //bit 6,    H: ON,      L:OFF
+    uint8_t Reserved: 1;                        //bit 7 reserved
+} LedConfig;
+
 typedef unsigned char       byte;
 
 struct SysConfigAndInfo         *ShmSysConfigAndInfo;
@@ -65,17 +83,15 @@ byte _curDeviceStatus[3] = {0, 0, 0}; //DS60-120 add
 byte _reCheckCount[3] = {0, 0, 0}; //DS60-120 add
 struct ChargingInfoData *ChargingData[CHAdeMO_QUANTITY + CCS_QUANTITY + GB_QUANTITY];
 
-#if defined DD360 || defined DD360Audi
+#if defined DD360 ||defined DD360Audi || defined DD360ComBox
 unsigned char ChillerSwitch; //DS60-120 remove
 unsigned int ChillerOnTime; //DS60-120 remove
 #endif //defined DD360 || defined DD360Audi
 
-void PRINTF_FUNC(char *string, ...);
-
 int StoreLogMsg(const char *fmt, ...);
-#define DEBUG_INFO(format, args...) StoreLogMsg("[%s:%d][%s][Info] "format, __FILE__, __LINE__, __FUNCTION__, ##args)
-#define DEBUG_WARN(format, args...) StoreLogMsg("[%s:%d][%s][Warn] "format, __FILE__, __LINE__, __FUNCTION__, ##args)
-#define DEBUG_ERROR(format, args...) StoreLogMsg("[%s:%d][%s][Error] "format, __FILE__, __LINE__, __FUNCTION__, ##args)
+#define log_info(format, args...) StoreLogMsg("[%s:%d][%s][Info] "format, __FILE__, __LINE__, __FUNCTION__, ##args)
+#define log_warn(format, args...) StoreLogMsg("[%s:%d][%s][Warn] "format, __FILE__, __LINE__, __FUNCTION__, ##args)
+#define log_error(format, args...) StoreLogMsg("[%s:%d][%s][Error] "format, __FILE__, __LINE__, __FUNCTION__, ##args)
 
 int StoreLogMsg(const char *fmt, ...)
 {
@@ -119,16 +135,6 @@ int DiffTimeb(struct timeb ST, struct timeb ET)
     return (StopTime - StartTime) * 1000 + ET.millitm - ST.millitm;
 }
 
-void PRINTF_FUNC(char *string, ...)
-{
-    va_list args;
-    char buffer[4096];
-    va_start(args, string);
-    vsnprintf(buffer, sizeof(buffer), string, args);
-    va_end(args);
-
-    DEBUG_INFO("%s \n", buffer);
-}
 //=================================
 // Common routine
 //=================================
@@ -244,20 +250,23 @@ int InitShareMemory()
 void GetFwAndHwVersion()
 {
     if (Query_FW_Ver(Uart1Fd, Addr.IoExtend, &ver) == PASS) {
-        //PRINTF_FUNC("Primary FW Rev = %s \n", ver.Version_FW);
+        //log_info("Primary FW Rev = %s \n", ver.Version_FW);
         strcpy((char *)ShmPrimaryMcuData->version, ver.Version_FW);
         strcpy((char *) ShmSysConfigAndInfo->SysInfo.CsuPrimFwRev, ver.Version_FW);
     }
 
     //if (Query_HW_Ver(Uart1Fd, Addr.IoExtend, &ver) == PASS)
-    //    ;//PRINTF_FUNC("Primary HW Rev  = %s \n", ver.Version_HW);
+    //    ;//log_info("Primary HW Rev  = %s \n", ver.Version_HW);
 }
 
 void GetInputGpioStatus()
 {
-    //PRINTF_FUNC("GetInputGpioStatus \n");
+    uint8_t dispenserSwTmp = 0;
+    static uint8_t dispenserSw = 0;
+
+    //log_info("GetInputGpioStatus \n");
     if (Query_Gpio_Input(Uart1Fd, Addr.IoExtend, &gpio_in) == PASS) {
-#if !defined DD360 && !defined DD360Audi
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
         //DS60-120 add
         if (_curDeviceStatus[_PRIMARY_CHECK_TAG_AC_CONTACT] != gpio_in.AC_Connector) {
             if (_reCheckCount[_PRIMARY_CHECK_TAG_AC_CONTACT] >= 3) {
@@ -300,20 +309,52 @@ void GetInputGpioStatus()
 #endif //!defined DD360 && !defined DD360Audi
 
         ShmPrimaryMcuData->InputDet.bits.SpdDetec = gpio_in.SPD;
-#if defined DD360 ||defined DD360Audi
+#if defined DD360 ||defined DD360Audi || defined DD360ComBox
+
+#if defined DD360ComBox
+        ShmPrimaryMcuData->InputDet.bits.DoorOpen = gpio_in.Door_Open;
+#else
         ShmPrimaryMcuData->InputDet.bits.DoorOpen = ~gpio_in.Door_Open;
+#endif //
 
         ShmPrimaryMcuData->InputDet.bits.Key0 = ~gpio_in.Key[0] & 0x01;
         ShmPrimaryMcuData->InputDet.bits.Key1 = ~gpio_in.Key[1] & 0x01;
         ShmPrimaryMcuData->InputDet.bits.Key2 = ~gpio_in.Key[2] & 0x01;
         ShmPrimaryMcuData->InputDet.bits.Key3 = ~gpio_in.Key[3] & 0x01;
+        //ShmPrimaryMcuData->InputDet.bits.EmergencyButton = gpio_in.Emergency_Btn;
 #else
+
+        ShmPrimaryMcuData->InputDet.bits.Key0 = gpio_in.Key[0] & 0x01;
+        ShmPrimaryMcuData->InputDet.bits.Key1 = gpio_in.Key[1] & 0x01;
+        ShmPrimaryMcuData->InputDet.bits.Key2 = gpio_in.Key[2] & 0x01;
+        ShmPrimaryMcuData->InputDet.bits.Key3 = gpio_in.Key[3] & 0x01;
+        //ShmPrimaryMcuData->InputDet.bits.EmergencyButton = ~gpio_in.Emergency_Btn;
         ShmPrimaryMcuData->InputDet.bits.DoorOpen = gpio_in.Door_Open;
 #endif //defined DD360 ||defined DD360Audi
 
+#if defined DD360ComBox
+        ShmPrimaryMcuData->InputDet.bits.EmergencyButton = ~gpio_in.Emergency_Btn;
+#else
+        ShmPrimaryMcuData->InputDet.bits.EmergencyButton = gpio_in.Emergency_Btn;
+#endif //
+
+        dispenserSwTmp |= (ShmPrimaryMcuData->InputDet.bits.Key0);
+        dispenserSwTmp |= (ShmPrimaryMcuData->InputDet.bits.Key1 << 1);
+        dispenserSwTmp |= (ShmPrimaryMcuData->InputDet.bits.Key2 << 2);
+        dispenserSwTmp |= (ShmPrimaryMcuData->InputDet.bits.Key3 << 3);
+
+        if (dispenserSwTmp != dispenserSw) {
+            dispenserSw = dispenserSwTmp;
+            log_info("Dispenser switch number =  %d, bit = %d, %d, %d, %d\r\n",
+                     dispenserSw,
+                     ShmPrimaryMcuData->InputDet.bits.Key3,
+                     ShmPrimaryMcuData->InputDet.bits.Key2,
+                     ShmPrimaryMcuData->InputDet.bits.Key1,
+                     ShmPrimaryMcuData->InputDet.bits.Key0);
+        }
+
         ShmPrimaryMcuData->InputDet.bits.Button1 = gpio_in.Button[0];
         ShmPrimaryMcuData->InputDet.bits.Button2 = gpio_in.Button[1];
-        ShmPrimaryMcuData->InputDet.bits.EmergencyButton = gpio_in.Emergency_Btn;
 
         /*printf(" gpio_in.Key[0]~ gpio_in.Key[3]=%d, %d, %d, %d\n",
         ShmPrimaryMcuData->InputDet.bits.Key0 , ShmPrimaryMcuData->InputDet.bits.Key1,
@@ -321,12 +362,12 @@ void GetInputGpioStatus()
         printf("ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CcsLiquidChillerWaterLevelWarning=%d\n", ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CcsLiquidChillerWaterLevelWarning);
         printf("ShmStatusCodeData->FaultCode.FaultEvents.bits.CcsLiquidChillerWaterLevelFault=%d\n", ShmStatusCodeData->FaultCode.FaultEvents.bits.CcsLiquidChillerWaterLevelFault);
         */
-        //PRINTF_FUNC("left = %d \n", ShmPrimaryMcuData->InputDet.bits.Button1);
-        //PRINTF_FUNC("right = %d \n", ShmPrimaryMcuData->InputDet.bits.Button2);
-        //PRINTF_FUNC("ShmSysConfigAndInfo->SysInfo.AcContactorStatus = %d \n", ShmSysConfigAndInfo->SysInfo.AcContactorStatus);
-#if !defined DD360 && !defined DD360Audi
+        //log_info("left = %d \n", ShmPrimaryMcuData->InputDet.bits.Button1);
+        //log_info("right = %d \n", ShmPrimaryMcuData->InputDet.bits.Button2);
+        //log_info("ShmSysConfigAndInfo->SysInfo.AcContactorStatus = %d \n", ShmSysConfigAndInfo->SysInfo.AcContactorStatus);
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
         if (ShmPrimaryMcuData->InputDet.bits.AcMainBreakerDetec == YES) {
-            DEBUG_ERROR("AC Mainbreaker occur. \n");
+            log_error("AC Mainbreaker occur. \n");
         }
 #endif //!defined DD360 && !defined DD360Audi
     }
@@ -374,51 +415,86 @@ void GetMeterConsumption(byte index)
 }
 #endif //defined METER_ENABLE
 
-void SetOutputGpio(byte flash)
+static void checkChillerStatus(Gpio_out *gpio)
 {
-    Gpio_out gpio;
-    gpio.Button_LED[0] = flash;
-    gpio.Button_LED[1] = flash;
+    uint8_t gunIndex = 0;
+    uint8_t chillerCount = 0;
+    static ChillerInfo fChillerInfo[2] = {0};
+    Gpio_out *pGpio = (Gpio_out *)gpio;
+
+    if ((strncmp((char *)&ShmSysConfigAndInfo->SysConfig.ModelName[7], "V", 1) == 0) ||
+            (strncmp((char *)&ShmSysConfigAndInfo->SysConfig.ModelName[7], "F", 1) == 0)) {
+        chillerCount++;
+    }
 
-    gpio.System_LED[0] = 0x00;
-    gpio.System_LED[1] = 0x00;
-    gpio.System_LED[2] = 0x00;
-    gpio.System_LED[3] = 0x00;
+    if ((strncmp((char *)&ShmSysConfigAndInfo->SysConfig.ModelName[9], "V", 1) == 0) ||
+            (strncmp((char *)&ShmSysConfigAndInfo->SysConfig.ModelName[9], "F", 1) == 0)) {
+        chillerCount++;
+    }
 
-#if defined DD360 || defined DD360Audi
-    if ((ChargingData[0]->PresentChargingCurrent) >= 150) {
-        ChillerSwitch = 1;
-        ChillerOnTime = time((time_t *)NULL);
-    } else {
-        if (ChillerSwitch == 1) {
-            if ((ChargingData[0]->PresentChargingCurrent) >= 100) {
-                ChillerSwitch = 1;
-                ChillerOnTime = time((time_t *)NULL);
-            } else {
-                if ((time((time_t *)NULL) - ChillerOnTime) >= 600) {
-                    ChillerSwitch = 0;
+    if (chillerCount == 0) {
+        pGpio->AC_Connector = 0x00;
+        return;
+    }
+
+    for (gunIndex = 0; gunIndex < chillerCount; gunIndex++) {
+        if ((ChargingData[gunIndex]->PresentChargingCurrent) >= 150) {
+            fChillerInfo[gunIndex].ChillerSwitch = YES;
+            fChillerInfo[gunIndex].ChillerOnTime = time((time_t *)NULL);
+        } else {
+            if (fChillerInfo[gunIndex].ChillerSwitch == YES) {
+                if ((ChargingData[gunIndex]->PresentChargingCurrent) >= 100) {
+                    fChillerInfo[gunIndex].ChillerSwitch = YES;
+                    fChillerInfo[gunIndex].ChillerOnTime = time((time_t *)NULL);
                 } else {
-                    ChillerSwitch = 1;
+                    if ((time((time_t *)NULL) - fChillerInfo[gunIndex].ChillerOnTime) >= 600) {
+                        fChillerInfo[gunIndex].ChillerSwitch = NO;
+                    } else {
+                        fChillerInfo[gunIndex].ChillerSwitch = YES;
+                    }
                 }
+            } else {
+                fChillerInfo[gunIndex].ChillerSwitch = NO;
             }
-        } else {
-            ChillerSwitch = 0;
         }
     }
-    gpio.AC_Connector = ChillerSwitch;//Chiller ON/OFF Control, "0: Chiller disable, 1: Chiller enable"
 
-    //printf("ChargingData[0]->PresentChargingCurrent=%f,ChargingData[1]->PresentChargingCurrent=%f,ChillerSwitch=%d\n",ChargingData[0]->PresentChargingCurrent,ChargingData[1]->PresentChargingCurrent,ChillerSwitch);
-#else
-    gpio.AC_Connector = 0x00;
-#endif //defined DD360 || DD360Audi
+    pGpio->AC_Connector = fChillerInfo[gunIndex].ChillerSwitch;//Chiller ON/OFF Control, "0: Chiller disable, 1: Chiller enable"
+}
 
-    gpio.AC_Breaker = 0x00;
+void SetOutputGpio(uint8_t outputValue)
+{
+    Gpio_out gpio;
+    LedConfig *pLedConfig = (LedConfig *)&outputValue;
 
-    if (Config_Gpio_Output(Uart1Fd, Addr.IoExtend, &gpio) == PASS) {
-        //PRINTF_FUNC("SetOutputGpio sucessfully. %d \n", flash);
+    if (strcmp((char *)ShmSysConfigAndInfo->SysInfo.LcmHwRev, " ") == 0x00) {
+        if (flash == NO) {
+            flash = YES;
+        } else {
+            flash = NO;
+        }
     } else {
-        //PRINTF_FUNC("SetOutputGpio fail. \n");
+        if (flash == NO) {
+            flash = YES;
+        }
     }
+
+    pLedConfig->LeftButtonLed = flash;
+    pLedConfig->RightButtonLed = flash;
+
+    gpio.Button_LED[0] = pLedConfig->LeftButtonLed;
+    gpio.Button_LED[1] = pLedConfig->RightButtonLed;
+
+    gpio.System_LED[0] = pLedConfig->GreenLED;
+    gpio.System_LED[1] = pLedConfig->YellowLED;
+    gpio.System_LED[2] = pLedConfig->RedLED;
+    gpio.System_LED[3] = 0x00;
+
+    checkChillerStatus(&gpio);
+
+    gpio.AC_Breaker = 0x00;
+
+    Config_Gpio_Output(Uart1Fd, Addr.IoExtend, &gpio);
 }
 
 void SetRtcData()
@@ -428,7 +504,7 @@ void SetRtcData()
 
     ftime(&csuTime);
     tmCSU = localtime(&csuTime.time);
-//  PRINTF_FUNC("Time : %04d-%02d-%02d %02d:%02d:%02d \n", tmCSU->tm_year + 1900,
+//  log_info("Time : %04d-%02d-%02d %02d:%02d:%02d \n", tmCSU->tm_year + 1900,
 //          tmCSU->tm_mon + 1, tmCSU->tm_mday, tmCSU->tm_hour, tmCSU->tm_min,
 //          tmCSU->tm_sec);
 
@@ -453,9 +529,9 @@ void SetRtcData()
     rtc.RtcData[13] = '0' + (tmCSU->tm_sec) / 1 % 10;
 
     if (Config_Rtc_Data(Uart1Fd, Addr.IoExtend, &rtc) == PASS) {
-        //PRINTF_FUNC("SetRtc sucessfully. \n");
+        //log_info("SetRtc sucessfully. \n");
     } else {
-        //PRINTF_FUNC("SetRtc fail. \n");
+        //log_info("SetRtc fail. \n");
     }
 }
 
@@ -476,7 +552,7 @@ int InitComPort()
     fd = open(priPortName, O_RDWR);
     if (fd <= 0) {
 #ifdef SystemLogMessage
-        DEBUG_ERROR("open 407 Communication port NG \n");
+        log_error("open 407 Communication port NG \n");
 #endif
         return -1;
     }
@@ -535,7 +611,7 @@ void Initialization() //DS60-120 add
         isPass = true;
         for (byte _index = 0; _index < gun_count; _index++) {
             if (!FindChargingInfoData(_index, &ChargingData[0])) {
-                DEBUG_ERROR("EvComm (main) : FindChargingInfoData false \n");
+                log_error("EvComm (main) : FindChargingInfoData false \n");
                 isPass = false;
                 break;
             }
@@ -547,7 +623,7 @@ void Initialization() //DS60-120 add
 int main(void)
 {
     if (InitShareMemory() == FAIL) {
-        DEBUG_ERROR("InitShareMemory NG\r\n");
+        log_error("InitShareMemory NG\r\n");
         if (ShmStatusCodeData != NULL) {
             ShmStatusCodeData->AlarmCode.AlarmEvents.bits.FailToCreateShareMemory = 1;
         }
@@ -558,17 +634,17 @@ int main(void)
     //DS60-120 remove
     //for (byte _index = 0; _index < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; _index++) {
     //    if (!FindChargingInfoData(_index, &ChargingData[0])) {
-    //        DEBUG_ERROR("FindChargingInfoData false \n");
+    //        log_error("FindChargingInfoData false \n");
     //        break;
     //    }
     //}
     ChillerSwitch = 0;
     Uart1Fd = InitComPort();
-    //PRINTF_FUNC("407 Port id = %d \n", Uart1Fd);
+    //log_info("407 Port id = %d \n", Uart1Fd);
 
     if (Uart1Fd < 0) {
 #ifdef SystemLogMessage
-        DEBUG_ERROR("InitComPort (Uart1 : AM3352 - STM32) NG");
+        log_error("InitComPort (Uart1 : AM3352 - STM32) NG");
 #endif
         if (ShmStatusCodeData != NULL) {
             ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CsuInitFailed = 1;
@@ -586,35 +662,16 @@ int main(void)
     byte _count = 0;
 
     for (;;) {
-        if (strcmp((char *)ShmSysConfigAndInfo->SysInfo.LcmHwRev, " ") == 0x00) {
-            if ((GetTimeoutValue(_flash_time) / 1000) > 1000) {
-                if (flash == NO) {
-                    flash = YES;
-                } else {
-                    flash = NO;
-                }
-                SetOutputGpio(flash);
-                gettimeofday(&_flash_time, NULL);
-            }
-        } else {
-            if ((GetTimeoutValue(_flash_time) / 1000) > 5000) {
-                if (flash == NO) {
-                    flash = YES;
-                }
-
-                SetOutputGpio(flash);
-                gettimeofday(&_flash_time, NULL);
-            }
-        }
-
         // 程序開始之前~ 必須先確定 FW 版本與硬體版本，確認後!!~ 該模組才算是真正的 Initial Comp.
         // 模組更新 FW 後，需重新做
         if (ShmPrimaryMcuData->SelfTest_Comp != PASS) {
-            //PRINTF_FUNC("(407) Get Fw and Hw Ver. \n");
+            //log_info("(407) Get Fw and Hw Ver. \n");
             GetFwAndHwVersion();
             sleep(1);
             ShmPrimaryMcuData->SelfTest_Comp = PASS;
         } else {
+            SetOutputGpio(ShmPrimaryMcuData->OutputDrv.OutputDrvValue[0]);
+
             GetInputGpioStatus();
 
 #if defined METER_ENABLE //DS60-120 add

EVSE/Projects/DD360/Apps/internalComm.c

@@ -38,7 +38,7 @@
 #define PASS                1
 #define FAIL                -1
 
-#if !defined DD360 && !defined DD360Audi
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
 struct Address Addr = {0x01, 0x02, 0x03, 0x05, 0x06, 0xFF};
 #else
 struct Address Addr = {0x01, 0x02, 0x09, 0x05, 0x06, 0xFF};

EVSE/Projects/DD360/Apps/replaceOther.sh

@@ -0,0 +1,8 @@
+#/bin/bash
+
+rm -rf /opt/ti-processor-sdk-linux-am335x-evm-04.02.00.09/EVSE/Projects/DD360/Apps;
+cp -r /opt/ti-processor-sdk-linux-am335x-evm-04.02.00.09/EVSE/Projects/DD360Audi/Apps /opt/ti-processor-sdk-linux-am335x-evm-04.02.00.09/EVSE/Projects/DD360/;
+
+rm -rf /opt/ti-processor-sdk-linux-am335x-evm-04.02.00.09/EVSE/Projects/DD360ComBox/Apps;
+cp -r /opt/ti-processor-sdk-linux-am335x-evm-04.02.00.09/EVSE/Projects/DD360Audi/Apps /opt/ti-processor-sdk-linux-am335x-evm-04.02.00.09/EVSE/Projects/DD360ComBox/;
+

EVSE/Projects/DD360Audi/Apps/FactoryConfig.c

@@ -104,7 +104,7 @@ int main(int argc, char *argv[])
     */
     //********** System **********// udhcpc -i eth1 -s ./dhcp_script/eth1.script
     //
-    strcpy((char *)SysConfig.ModelName, "DDYC182V0UE2AD");
+    strcpy((char *)SysConfig.ModelName, "DXYE18200EE1E4");
     strcpy((char *)SysConfig.SerialNumber, "SERIALFORRD");
 
     memset(SysConfig.SystemId, 0x00, sizeof(SysConfig.SystemId));

EVSE/Projects/DD360Audi/Apps/Module_InternalComm.c

@@ -2321,7 +2321,7 @@ int main(void)
 //              printRelayStatus = true;
 //          }
         }
-#ifndef NO_FAN_BOARD
+#if !defined NO_FAN_BOARD && !defined DD360ComBox
         if (ShmFanModuleData->SelfTest_Comp == YES) {
             if (GetTimeoutValue(_priority_time) / 1000 >= 1000) {
                 //GetPsuTempForFanSpeed();

EVSE/Projects/DD360Audi/Apps/Module_LcmControl.c

@@ -336,7 +336,7 @@ void ChangeWarningFunc()
     // 最多一次五筆
     //PRINTF_FUNC("LCM PageIndex = %d \n", ShmSysConfigAndInfo->SysWarningInfo.PageIndex);
     //PRINTF_FUNC("WarningCount = %d \n", ShmSysConfigAndInfo->SysWarningInfo.WarningCount);
-#if !defined DD360 && !defined DD360Audi
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
     for (i = 0; (i + ShmSysConfigAndInfo->SysWarningInfo.PageIndex * 5) < ShmSysConfigAndInfo->SysWarningInfo.WarningCount; i++) {
         memset(cmd, 0x00, sizeof(cmd));
         if ((i) >= 5) {
@@ -918,7 +918,7 @@ void RefreshPageAnimation(byte value)
 void RefreshConnStatus()
 {
     // Wifi priority is higher than Ethernet
-#if defined DD360 || defined DD360Audi
+#if defined DD360 ||defined DD360Audi || defined DD360ComBox
     uint8_t i = 0;
     unsigned char flag[4] = {0};
 

EVSE/Projects/DD360Audi/Apps/Module_PrimaryComm.c

@@ -257,7 +257,7 @@ void GetInputGpioStatus()
 {
     //PRINTF_FUNC("GetInputGpioStatus \n");
     if (Query_Gpio_Input(Uart1Fd, Addr.IoExtend, &gpio_in) == PASS) {
-#if !defined DD360 && !defined DD360Audi
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
         ShmSysConfigAndInfo->SysInfo.AcContactorStatus = ShmPrimaryMcuData->InputDet.bits.AcContactorDetec = gpio_in.AC_Connector;
         ShmPrimaryMcuData->InputDet.bits.AcMainBreakerDetec = gpio_in.AC_MainBreaker;
 #else
@@ -284,7 +284,7 @@ void GetInputGpioStatus()
         //PRINTF_FUNC("left = %d \n", ShmPrimaryMcuData->InputDet.bits.Button1);
         //PRINTF_FUNC("right = %d \n", ShmPrimaryMcuData->InputDet.bits.Button2);
         //PRINTF_FUNC("ShmSysConfigAndInfo->SysInfo.AcContactorStatus = %d \n", ShmSysConfigAndInfo->SysInfo.AcContactorStatus);
-#if !defined DD360 && !defined DD360Audi
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
         if (ShmPrimaryMcuData->InputDet.bits.AcMainBreakerDetec == YES) {
             DEBUG_ERROR("AC Mainbreaker occur. \n");
         }
@@ -303,7 +303,7 @@ void SetOutputGpio(byte flash)
     gpio.System_LED[2] = 0x00;
     gpio.System_LED[3] = 0x00;
 
-#if defined DD360 || defined DD360Audi
+#if defined DD360 ||defined DD360Audi || defined DD360ComBox
     if ((ChargingData[0]->PresentChargingCurrent) >= 150) {
         ChillerSwitch = 1;
         ChillerOnTime = time((time_t *)NULL);

EVSE/Projects/DD360Audi/Apps/ReMain.c

@@ -33,7 +33,7 @@
 #include <dirent.h>
 #include "timeout.h"
 
-#if defined DD360 || defined DD360Audi
+#if defined DD360 ||defined DD360Audi || defined DD360ComBox
 #include "AudiCust.h"
 #endif //defined DD360Audi
 
@@ -53,7 +53,7 @@
 #define MtdBlockSize                            0x600000
 #define SYSFS_GPIO_DIR                          "/sys/class/gpio"
 #define UPGRADE_FAN                             0x02
-#if defined DD360 || defined DD360Audi
+#if defined DD360 ||defined DD360Audi || defined DD360ComBox
 #define UPGRADE_RB                              0x09 //0x09 for DD360 dispenser
 #else
 #define UPGRADE_RB                              0x03 //other module use
@@ -84,6 +84,18 @@
 #define GUN_COMP_WAIT_TIMEOUT                   10
 #define GUN_PRECHARGING_TIMEOUT                 60
 
+typedef struct StLedConfig {
+    //OutputDrvValue[0]
+    uint8_t LeftButtonLed: 1;                   //bit 0,    H: ON,      L:OFF
+    uint8_t RightButtonLed: 1;                  //bit 1,    H: ON,      L:OFF
+    uint8_t GreenLED: 1;                        //bit 2,    H: ON,      L:OFF
+    uint8_t YellowLED: 1;                       //bit 3,    H: ON,      L:OFF
+    uint8_t RedLED: 1;                          //bit 4,    H: ON,      L:OFF
+    uint8_t SystemLed4: 1;                      //bit 5,    H: ON,      L:OFF
+    uint8_t AcContactor: 1;                     //bit 6,    H: ON,      L:OFF
+    uint8_t Reserved: 1;                        //bit 7 reserved
+} LedConfig;
+
 char *valid_Internet[2] = {"8.8.8.8", "180.76.76.76"};
 unsigned char mask_table[] = { 0x01, 0x02, 0x04, 0x08, 0x10, 0x20, 0x40, 0x80 };
 int whileLoopTime = 10000; // 10 ms
@@ -153,7 +165,7 @@ struct MeterInformation         *ShmCsuMeterData;
 struct DcCommonInformation      *ShmDcCommonData;
 #endif //defined METER_ENABLE
 
-#if defined DD360 || defined DD360Audi
+#if defined DD360 ||defined DD360Audi || defined DD360ComBox
 static AudiCustInfo             *gAudiCustInfo = NULL; //Jerry add
 #endif //defined DD360Audi
 
@@ -317,6 +329,100 @@ static void confirmSelGun(uint8_t selGun)
 }
 #endif // defined DD360Audi
 
+static void startPrimaryLedIndicatorCtrlFork(void)
+{
+    pid_t pid = fork();
+    if (pid == 0) {
+        uint8_t totalGun = ShmSysConfigAndInfo->SysConfig.TotalConnectorCount;
+        uint8_t gunIndex = 0;
+        int isContinue = 1;
+        LedConfig *pLedConfig = (LedConfig *)&ShmPrimaryMcuData->OutputDrv.OutputDrvValue[0];
+
+        while (isContinue) {
+            for (gunIndex = 0; gunIndex < totalGun; gunIndex++) {
+                //printf("led indicator status = %d\r\n", chargingInfo[gunIndex]->SystemStatus);
+                //printf("level = %d\r\n", ShmSysConfigAndInfo->SysWarningInfo.Level);
+                switch (chargingInfo[gunIndex]->SystemStatus) {
+                case S_BOOTING:
+                    pLedConfig->RedLED = YES;
+                    pLedConfig->YellowLED = YES;
+                    pLedConfig->GreenLED = YES;
+                    break;
+
+                case S_IDLE:
+                case S_RESERVATION:
+                case S_AUTHORIZING:
+                case S_REASSIGN_CHECK:
+                case S_REASSIGN:
+                case S_PREPARNING:
+                case S_PREPARING_FOR_EV:
+                case S_PREPARING_FOR_EVSE:
+                case S_CCS_PRECHARGE_ST0:
+                case S_CCS_PRECHARGE_ST1:
+                    pLedConfig->RedLED = NO;
+                    pLedConfig->YellowLED = NO;
+
+                    if (pLedConfig->GreenLED == YES) {
+                        pLedConfig->GreenLED = NO;
+                    } else {
+                        pLedConfig->GreenLED = YES;
+                    }
+                    break;
+
+                case S_CHARGING:
+                    pLedConfig->RedLED = NO;
+                    if (pLedConfig->YellowLED == YES) {
+                        pLedConfig->YellowLED = NO;
+                    } else {
+                        pLedConfig->YellowLED = YES;
+                    }
+                    pLedConfig->GreenLED = NO;
+                    break;
+
+                case S_ALARM:
+                case S_TERMINATING:
+                case S_COMPLETE:
+                    if (ShmSysConfigAndInfo->SysWarningInfo.Level == 2) {
+                        pLedConfig->YellowLED = NO;
+                        pLedConfig->GreenLED = NO;
+                        if (pLedConfig->RedLED == YES) {
+                            pLedConfig->RedLED = NO;
+                        } else {
+                            pLedConfig->RedLED = YES;
+                        }
+                    } else {
+                        pLedConfig->RedLED = NO;
+                        pLedConfig->YellowLED = NO;
+                        pLedConfig->GreenLED = YES;
+                    }
+                    break;
+
+                case S_MAINTAIN:
+                case S_FAULT:
+                    pLedConfig->YellowLED = NO;
+                    pLedConfig->GreenLED = NO;
+                    if (ShmSysConfigAndInfo->SysWarningInfo.Level == 2) {
+                        if (pLedConfig->RedLED == YES) {
+                            pLedConfig->RedLED = NO;
+                        } else {
+                            pLedConfig->RedLED = YES;
+                        }
+                    }
+                    break;
+
+                case S_BOOKING:
+                case S_DEBUG:
+                case S_UPDATE:
+                case S_NONE:
+                    break;
+                }
+
+                usleep(500000);
+            }//switch
+        }//for
+    }//while
+}
+
 //================================================
 // initial can-bus
 //================================================
@@ -702,7 +808,7 @@ int CreateShareMemory()
     memset(ShmDcCommonData, 0, sizeof(struct DcCommonInformation));
 #endif //defined METER_ENABLE
 
-#if defined DD360 || defined DD360Audi
+#if defined DD360 ||defined DD360Audi || defined DD360ComBox
     //creat Audi customization info
     if ((MeterSMId = shmget(ShmAudiCustInfoKey, sizeof(AudiCustInfo), IPC_CREAT | 0777)) < 0) {
         return FAIL;
@@ -820,7 +926,7 @@ void InitGPIO()
     system("echo \"out\" > /sys/class/gpio/gpio116/direction");
     system("echo 0 > /sys/class/gpio/gpio116/value");
 
-#if !defined DD360 && !defined DD360Audi
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
     /* (C14) EMU0.gpio3[7] */  /*CP open/short feature enable/disable, pull low for default enable*/
     system("echo 103 > /sys/class/gpio/export");
     system("echo \"out\" > /sys/class/gpio/gpio103/direction");
@@ -1027,7 +1133,7 @@ int isReachableInternet()
     }
     pclose(fp);
 
-#if defined DD360 || defined DD360Audi
+#if defined DD360 ||defined DD360Audi || defined DD360ComBox
     if (ShmStatusCodeData->AlarmCode.AlarmEvents.bits.DisconnectedFromDo == NORMAL) {
         result = FAIL;
     } else {
@@ -1063,7 +1169,7 @@ int isReachableInternet()
 void InitEthernet()
 {
     char tmpbuf[256];
-#if !defined DD360 && !defined DD360Audi
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
     bool ethResult = false;
     uint8_t cnt_pingDNS_Fail = 0;
 #endif //!defined DD360 && !defined DD360Audi
@@ -1117,7 +1223,7 @@ void InitEthernet()
     if (pid == 0) {
         log_info("InitEthernet = %d\r\n", pid);
         for (;;) {
-#if !defined DD360 && !defined DD360Audi
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
             if (isRouteFail()) {
                 //PRINTF_FUNC("eth0 not in route, restart eht0. \n");
                 system("/sbin/ifconfig eth0 down;/sbin/ifconfig eth0 up");
@@ -1597,7 +1703,7 @@ bool DisplaySelfTestFailReason()
     }
 
     if (ShmSysConfigAndInfo->SysInfo.AcContactorStatus == NO) {
-#if !defined DD360 && !defined DD360Audi
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
         // AC Contact 未搭上
         ShmStatusCodeData->AlarmCode.AlarmEvents.bits.AcContactStestFail = true;
         result = true;
@@ -1650,7 +1756,7 @@ void SelfTestRun()
                     log_info("Relay Board FW Rev = %s", ShmSysConfigAndInfo->SysInfo.RelayModuleFwRev);
                     ShmRelayModuleData->SelfTest_Comp = YES;
                 }
-#ifndef NO_FAN_BOARD
+#if !defined NO_FAN_BOARD && !defined DD360ComBox
                 if ((strlen((char *)ShmSysConfigAndInfo->SysInfo.FanModuleFwRev) != 0 ||
                         ShmSysConfigAndInfo->SysInfo.FanModuleFwRev[0] != '\0')
                         && (ShmFanModuleData->SelfTest_Comp != YES)
@@ -1756,7 +1862,7 @@ void SelfTestRun()
             case _STEST_AC_CONTACTOR: {
                 //ShmPsuData->Work_Step = _TEST_COMPLETE;
                 // 因為 30KW 以下沒有 Relay feedback 功能，所以暫時先直接跳過
-#if !defined DD360 && !defined DD360Audi
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
                 if (ShmSysConfigAndInfo->SysInfo.AcContactorStatus == YES) {
                     ShmSysConfigAndInfo->SysInfo.SelfTestSeq = _STEST_PSU_DETECT;
                     log_info("AC contactor self test OK");
@@ -1768,7 +1874,7 @@ void SelfTestRun()
             }
             break;
             case _STEST_PSU_DETECT: {
-#if !defined DD360 && !defined DD360Audi
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
                 if (ShmPsuData->Work_Step >= GET_SYS_CAP) {
                     ShmSysConfigAndInfo->SysInfo.SelfTestSeq = _STEST_PSU_CAP;
                 }
@@ -1778,7 +1884,7 @@ void SelfTestRun()
             }
             break;
             case _STEST_PSU_CAP: {
-#if !defined DD360 && !defined DD360Audi
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
                 // 此測試是要確認當前總輸出能力
                 // 如果沒有 PSU 模組請 bypass
                 if (ShmPsuData->Work_Step == BOOTING_COMPLETE) {
@@ -1813,7 +1919,7 @@ int SpawnTask()
     system("/root/Module_InternalComm &");
     system("/root/Module_ProduceUtils &");
 
-#if defined DD360 || defined DD360Audi
+#if defined DD360 ||defined DD360Audi || defined DD360ComBox
     system("/root/DoComm &");
 #else
     system("/root/Module_PsuComm &");
@@ -2398,7 +2504,7 @@ void EmcOccureByString(char *code)
     // 嚴重的急停有以下幾種 : EMC 按鈕、Mainbreak、Dooropen
     // 其錯誤等級為 2
 
-#if defined DD360 || defined DD360Audi
+#if defined DD360 ||defined DD360Audi || defined DD360ComBox
     //DS60-120 remove
     if (strncmp(code, "012251", 6) == EQUAL ||
             strncmp(code, "012252", 6) == EQUAL ||
@@ -2423,7 +2529,7 @@ void EmcOccureByString(char *code)
                 ChargingAlarmProcess(gun);
             }
         }
-#if defined DD360 || defined DD360Audi
+#if defined DD360 ||defined DD360Audi || defined DD360ComBox
         StopChargingProcessByString(level);
         InformOcppErrOccur(4);
 #endif //defined DD360 || defined DD360Audi
@@ -2935,19 +3041,19 @@ void CheckGunTypeFromHw()
     for (i = 0; i < 2; i++) {
         switch (tmp[i]) {
         case 0x01:
-            log_info("BD%d(%s) = %s ", i + 1, i == 1 ? "Left" : "Right", "CHAdeMO");
+            log_info("BD%d(%s) = %s ", i + 1, i == 0 ? "Left" : "Right", "CHAdeMO");
             break;
 
         case 0x10:
-            log_info("BD%d(%s) = %s ", i + 1, i == 1 ? "Left" : "Right", "CCS");
+            log_info("BD%d(%s) = %s ", i + 1, i == 0 ? "Left" : "Right", "CCS");
             break;
 
         case 0x11:
-            log_info("BD%d(%s) = %s ", i + 1, i == 1 ? "Left" : "Right", "GBT");
+            log_info("BD%d(%s) = %s ", i + 1, i == 0 ? "Left" : "Right", "GBT");
             break;
 
         case 0x00:
-            log_info("BD%d(%s) = %s ", i + 1, i == 1 ? "Left" : "Right", "None");
+            log_info("BD%d(%s) = %s ", i + 1, i == 0 ? "Left" : "Right", "None");
             break;
         }
     }
@@ -3122,7 +3228,7 @@ void UserScanFunction()
                     } else {
                         _authorizeIndex = ShmSysConfigAndInfo->SysInfo.CurGunSelected;
                     }
-#if !defined DD360 && !defined DD360Audi
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
                     StartSystemTimeoutDet(Timeout_AuthorizingForStop);
                     AuthorizingStart();
 #else
@@ -3155,14 +3261,14 @@ void UserScanFunction()
     } else {
         // 透過後臺停止充電的判斷
         if (isAuthorizedComplete()
-#if !defined DD360 && !defined DD360Audi
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
                 || (ShmSysConfigAndInfo->SysInfo.OcppConnStatus == NO &&
                     ShmSysConfigAndInfo->SysConfig.OfflinePolicy == _OFFLINE_POLICY_FREE_CHARGING)
 #endif //!defined DD360 && !defined DD360Audi
            ) {
             // 判斷後台回覆狀態
             if (canStartCharging()
-#if !defined DD360 && !defined DD360Audi
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
                     || (ShmSysConfigAndInfo->SysInfo.OcppConnStatus == NO &&
                         ShmSysConfigAndInfo->SysConfig.OfflinePolicy == _OFFLINE_POLICY_FREE_CHARGING)
 #endif //!defined DD360 && !defined DD360Audi
@@ -3229,14 +3335,14 @@ void ScannerCardProcess()
 
         // 確認驗證卡號完成沒
         if (isAuthorizedComplete()
-#if !defined DD360 && !defined DD360Audi
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
                 || ShmSysConfigAndInfo->SysConfig.OfflinePolicy == _OFFLINE_POLICY_FREE_CHARGING
 #endif //!defined DD360 && !defined DD360Audi
            ) {
             StopSystemTimeoutDet();
             // 判斷後台回覆狀態
             if (canStartCharging()
-#if !defined DD360 && !defined DD360Audi
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
                     || ShmSysConfigAndInfo->SysConfig.OfflinePolicy == _OFFLINE_POLICY_FREE_CHARGING
 #endif //!defined DD360 && !defined DD360Audi
                ) {
@@ -3540,7 +3646,7 @@ void KillTask()
     system("killall Module_LcmControl");
     system("killall Module_InternalComm");
     //system("killall DoComm");
-#if !defined DD360 && !defined DD360Audi
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
     system("killall Module_PsuComm");
     system("killall OcppBackend &");
     system("killall Module_4g &");
@@ -3553,7 +3659,7 @@ void KillTaskExceptPrimary()
     ChangeLcmByIndex(_LCM_FIX);
     system("killall Module_EvComm");
     system("killall Module_InternalComm");
-#if !defined DD360 && !defined DD360Audi
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
     system("killall Module_PsuComm");
     system("killall Module_4g &");
     system("killall Module_Wifi &");
@@ -3568,7 +3674,7 @@ void KillAllTask()
     system("killall Module_EvComm");
     system("killall Module_LcmControl");
     system("killall Module_InternalComm");
-#if !defined DD360 && !defined DD360Audi
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
     system("killall Module_PsuComm");
     system("killall OcppBackend &");
     system("killall Module_4g &");
@@ -5421,6 +5527,20 @@ static void powerCabinetPsuAlarmStatus(void)
     }
 }
 
+static void autoStartChargingForComBox(uint8_t gunIndex)
+{
+#if defined DD360ComBox
+    if ((chargingInfo[gunIndex]->ConnectorPlugIn == YES) &&
+            (chargingInfo[gunIndex]->SystemStatus == S_IDLE)
+       ) {
+        ShmSysConfigAndInfo->SysInfo.CurGunSelected = gunIndex;
+        strcpy((char *)&ShmSysConfigAndInfo->SysConfig.UserId, "AutoStartCharging");
+    }
+#else
+    return;
+#endif //DD360ComBox
+}
+
 int main(void)
 {
     uint8_t evBoardStopState = 0;
@@ -5465,6 +5585,7 @@ int main(void)
     }
     CreateTimeoutFork();
     log_info("Start self test... \n");
+    startPrimaryLedIndicatorCtrlFork();
     SelfTestRun();
     StopSystemTimeoutDet();
     log_info("Self test finished : SelfTestSeq = %d, Work_Step = %d ",
@@ -5537,6 +5658,7 @@ int main(void)
     CheckFwSlotStatusLog();
     AdjustChargerCurrent();
     gettimeofday(&_cmdMainPriority_time, NULL);
+
     for (;;) {
         CheckOcppStatus();
         ChkPrimaryStatus();
@@ -5555,7 +5677,7 @@ int main(void)
         ClearAlarmCodeWhenAcOff();
         // 確認是否要回到充電中的槍畫面邏輯判斷
         CheckReturnToChargingConn();
-#if defined DD360 || defined DD360Audi
+#if defined DD360 ||defined DD360Audi || defined DD360ComBox
         //確認Power cabinet PSU Status
         powerCabinetPsuAlarmStatus();
 #endif // defined DD360 || defined DD360Audi
@@ -5612,6 +5734,8 @@ int main(void)
 #endif //defined METER_ENABLE
 
         for (byte gun_index = 0; gun_index < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; gun_index++) {
+            autoStartChargingForComBox(gun_index); //for DD360ComBox
+
             CheckGpioInStatus();
             CheckErrorOccurStatus(gun_index);
             ChkOcppStatus(gun_index);
@@ -5683,7 +5807,7 @@ int main(void)
                     }
 
                     ClearDetectPluginFlag();
-//#if !defined DD360 && !defined DD360Audi
+//#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
                     UpdateErrorCodeToOcpp(gun_index);
 //#endif //!defined DD360 && !defined DD360Audi
                     setChargerMode(gun_index, MODE_FAULT);
@@ -5707,7 +5831,7 @@ int main(void)
 #endif //0
 
                     if (ShmSysConfigAndInfo->SysInfo.MainChargingMode == _MAIN_CHARGING_MODE_AVER) {
-#if !defined DD360 && !defined DD360Audi
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
                         if (ShmSysConfigAndInfo->SysInfo.AcContactorStatus == YES)
 #else
                         if (1)
@@ -5845,7 +5969,7 @@ int main(void)
                     }
                     StopSystemTimeoutDet();
                 }
-#if !defined DD360 && !defined DD360Audi
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
                 bool isRessign = false;
                 if (ShmSysConfigAndInfo->SysConfig.TotalConnectorCount > 1 && ShmSysConfigAndInfo->SysInfo.IsAlternatvieConf == NO) {
                     if (ShmSysConfigAndInfo->SysInfo.MainChargingMode == _MAIN_CHARGING_MODE_MAX) {
@@ -5884,7 +6008,7 @@ int main(void)
 #endif // !defined DD360 && !defined DD360Audi
 
                 if (0) { // if (isRessign)
-#if defined DD360 || defined DD360Audi
+#if defined DD360 ||defined DD360Audi || defined DD360ComBox
                     setChargerMode(gun_index, MODE_PRECHARGE);
 #else
                     setChargerMode(gun_index, MODE_REASSIGN);
@@ -6136,7 +6260,7 @@ int main(void)
                     ftime(&startChargingTime[gun_index]);
                     strcpy((char *)ShmOCPP16Data->StartTransaction[gun_index].ResponseIdTagInfo.Status, ""); //DS60-120 add
                     ChangeStartOrStopDateTime(YES, gun_index);
-#if !defined DD360 && !defined DD360Audi
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
                     OcppStartTransation(gun_index);
 #endif //!defined DD360 && !defined DD360Audi
                 }

EVSE/Projects/DD360Audi/Apps/ReModule_EvComm.c

@@ -2578,14 +2578,14 @@ void SetPresentChargingOutputCap(struct ChargingInfoData *chargingData_1, struct
     float pow1 = 0, cur1 = 0;
     float pow2 = 0, cur2 = 0;
 
-#if !defined DD360 && !defined DD360Audi
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
     float vol = 0;
 #endif //!defined DD360 && !defined DD360Audi
 
     pow1 = chargingData_1->AvailableChargingPower;
     cur1 = chargingData_1->AvailableChargingCurrent;
 
-#if !defined DD360 && !defined DD360Audi
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
     vol = chargingData_1->MaximumChargingVoltage;
     GetMaxVolAndCurMethod(chargingData_1->Index, &vol, &cur1);
     GetMaxPowerMethod(chargingData_1->Index, &pow1);
@@ -2610,7 +2610,7 @@ void SetPresentChargingOutputCap(struct ChargingInfoData *chargingData_1, struct
     pow2 = chargingData_2->AvailableChargingPower;
     cur2 = chargingData_2->AvailableChargingCurrent;
 
-#if !defined DD360 && !defined DD360Audi
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
     vol = chargingData_2->MaximumChargingVoltage;
     GetMaxVolAndCurMethod(chargingData_2->Index, &vol, &cur2);
     GetMaxPowerMethod(chargingData_2->Index, &pow2);
@@ -3320,10 +3320,10 @@ int main(int argc, char *argv[])
                 // 計算 Power
                 _chargingData[_index]->PresentChargingPower = ((float)((_chargingData[_index]->PresentChargingVoltage) * (_chargingData[_index]->PresentChargingCurrent)) / 1000);
 
-                CalOutputPowerAndEnergy(_index); //DS60-120 add
+                //CalOutputPowerAndEnergy(_index); //DS60-120 add
 
                 //DS60-120 remove
-                /*if (chargingTime[_index] == 0 ||
+                if (chargingTime[_index] == 0 ||
                         chargingTime[_index] > _chargingData[_index]->PresentChargedDuration) {
                     chargingTime[_index] = _chargingData[_index]->PresentChargedDuration;
                 } else {
@@ -3339,7 +3339,7 @@ int main(int argc, char *argv[])
                         _chargingData[_index]->PowerConsumption += changingPow;
                         chargingTime[_index] = _chargingData[_index]->PresentChargedDuration;
                     }
-                }*/
+                }
 
                 // 開始確認車端是否同意開始充電
                 GetOutputReq(_index, _chargingData[_index]->Evboard_id);
@@ -3361,11 +3361,14 @@ int main(int argc, char *argv[])
                     }
                 }
 
-                if (_chargingData[_index]->GroundFaultStatus == GFD_FAIL) {
-                    SetIsolationStatus(_index, _chargingData[_index]->GroundFaultStatus, _chargingData[_index]->Evboard_id);
-                } else if (_chargingData[_index]->Type == _Type_CCS_2) {
+                if ((_chargingData[_index]->GroundFaultStatus == GFD_FAIL) ||
+                        (_chargingData[_index]->Type == _Type_CCS_2)) {
                     SetIsolationStatus(_index, _chargingData[_index]->GroundFaultStatus, _chargingData[_index]->Evboard_id);
                 }
+                /*
+                else if (_chargingData[_index]->Type == _Type_CCS_2) {
+                SetIsolationStatus(_index, _chargingData[_index]->GroundFaultStatus, _chargingData[_index]->Evboard_id);
+                }*/
 
                 // GFD 失敗再通知
                 if (priorityLow == 1) {

EVSE/Projects/DD360Audi/Apps/ReModule_LcmControl.c

@@ -339,7 +339,7 @@ void ChangeWarningFunc()
     // 最多一次五筆
     //PRINTF_FUNC("LCM PageIndex = %d \n", ShmSysConfigAndInfo->SysWarningInfo.PageIndex);
     //PRINTF_FUNC("WarningCount = %d \n", ShmSysConfigAndInfo->SysWarningInfo.WarningCount);
-//#if !defined DD360 && !defined DD360Audi
+//#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
     for (i = 0; (i + ShmSysConfigAndInfo->SysWarningInfo.PageIndex * 5) < ShmSysConfigAndInfo->SysWarningInfo.WarningCount; i++) {
         memset(cmd, 0x00, sizeof(cmd));
         if ((i) >= 5) {
@@ -927,7 +927,7 @@ void RefreshPageAnimation(byte value)
 void RefreshConnStatus()
 {
     // Wifi priority is higher than Ethernet
-#if defined DD360 || defined DD360Audi
+#if defined DD360 ||defined DD360Audi || defined DD360ComBox
     uint8_t i = 0;
     uint8_t ehtStatus = 0;
 

EVSE/Projects/DD360Audi/Apps/ReModule_PrimaryComm.c

@@ -37,6 +37,24 @@
 #define YES                 1
 #define NO                  0
 
+typedef struct StChillerInfo {
+    uint8_t ChillerSwitch;
+    uint32_t ChillerOnTime;
+    uint8_t Reserved[3];
+} ChillerInfo;
+
+typedef struct StLedConfig {
+    //OutputDrvValue[0]
+    uint8_t LeftButtonLed: 1;                   //bit 0,    H: ON,      L:OFF
+    uint8_t RightButtonLed: 1;                  //bit 1,    H: ON,      L:OFF
+    uint8_t GreenLED: 1;                          //bit 2,    H: ON,      L:OFF
+    uint8_t YellowLED: 1;                       //bit 3,    H: ON,      L:OFF
+    uint8_t RedLED: 1;                        //bit 4,    H: ON,      L:OFF
+    uint8_t SystemLed4: 1;                      //bit 5,    H: ON,      L:OFF
+    uint8_t AcContactor: 1;                     //bit 6,    H: ON,      L:OFF
+    uint8_t Reserved: 1;                        //bit 7 reserved
+} LedConfig;
+
 typedef unsigned char       byte;
 
 struct SysConfigAndInfo         *ShmSysConfigAndInfo;
@@ -65,17 +83,15 @@ byte _curDeviceStatus[3] = {0, 0, 0}; //DS60-120 add
 byte _reCheckCount[3] = {0, 0, 0}; //DS60-120 add
 struct ChargingInfoData *ChargingData[CHAdeMO_QUANTITY + CCS_QUANTITY + GB_QUANTITY];
 
-#if defined DD360 || defined DD360Audi
+#if defined DD360 ||defined DD360Audi || defined DD360ComBox
 unsigned char ChillerSwitch; //DS60-120 remove
 unsigned int ChillerOnTime; //DS60-120 remove
 #endif //defined DD360 || defined DD360Audi
 
-void PRINTF_FUNC(char *string, ...);
-
 int StoreLogMsg(const char *fmt, ...);
-#define DEBUG_INFO(format, args...) StoreLogMsg("[%s:%d][%s][Info] "format, __FILE__, __LINE__, __FUNCTION__, ##args)
-#define DEBUG_WARN(format, args...) StoreLogMsg("[%s:%d][%s][Warn] "format, __FILE__, __LINE__, __FUNCTION__, ##args)
-#define DEBUG_ERROR(format, args...) StoreLogMsg("[%s:%d][%s][Error] "format, __FILE__, __LINE__, __FUNCTION__, ##args)
+#define log_info(format, args...) StoreLogMsg("[%s:%d][%s][Info] "format, __FILE__, __LINE__, __FUNCTION__, ##args)
+#define log_warn(format, args...) StoreLogMsg("[%s:%d][%s][Warn] "format, __FILE__, __LINE__, __FUNCTION__, ##args)
+#define log_error(format, args...) StoreLogMsg("[%s:%d][%s][Error] "format, __FILE__, __LINE__, __FUNCTION__, ##args)
 
 int StoreLogMsg(const char *fmt, ...)
 {
@@ -119,16 +135,6 @@ int DiffTimeb(struct timeb ST, struct timeb ET)
     return (StopTime - StartTime) * 1000 + ET.millitm - ST.millitm;
 }
 
-void PRINTF_FUNC(char *string, ...)
-{
-    va_list args;
-    char buffer[4096];
-    va_start(args, string);
-    vsnprintf(buffer, sizeof(buffer), string, args);
-    va_end(args);
-
-    DEBUG_INFO("%s \n", buffer);
-}
 //=================================
 // Common routine
 //=================================
@@ -244,20 +250,23 @@ int InitShareMemory()
 void GetFwAndHwVersion()
 {
     if (Query_FW_Ver(Uart1Fd, Addr.IoExtend, &ver) == PASS) {
-        //PRINTF_FUNC("Primary FW Rev = %s \n", ver.Version_FW);
+        //log_info("Primary FW Rev = %s \n", ver.Version_FW);
         strcpy((char *)ShmPrimaryMcuData->version, ver.Version_FW);
         strcpy((char *) ShmSysConfigAndInfo->SysInfo.CsuPrimFwRev, ver.Version_FW);
     }
 
     //if (Query_HW_Ver(Uart1Fd, Addr.IoExtend, &ver) == PASS)
-    //    ;//PRINTF_FUNC("Primary HW Rev  = %s \n", ver.Version_HW);
+    //    ;//log_info("Primary HW Rev  = %s \n", ver.Version_HW);
 }
 
 void GetInputGpioStatus()
 {
-    //PRINTF_FUNC("GetInputGpioStatus \n");
+    uint8_t dispenserSwTmp = 0;
+    static uint8_t dispenserSw = 0;
+
+    //log_info("GetInputGpioStatus \n");
     if (Query_Gpio_Input(Uart1Fd, Addr.IoExtend, &gpio_in) == PASS) {
-#if !defined DD360 && !defined DD360Audi
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
         //DS60-120 add
         if (_curDeviceStatus[_PRIMARY_CHECK_TAG_AC_CONTACT] != gpio_in.AC_Connector) {
             if (_reCheckCount[_PRIMARY_CHECK_TAG_AC_CONTACT] >= 3) {
@@ -300,20 +309,52 @@ void GetInputGpioStatus()
 #endif //!defined DD360 && !defined DD360Audi
 
         ShmPrimaryMcuData->InputDet.bits.SpdDetec = gpio_in.SPD;
-#if defined DD360 ||defined DD360Audi
+#if defined DD360 ||defined DD360Audi || defined DD360ComBox
+
+#if defined DD360ComBox
+        ShmPrimaryMcuData->InputDet.bits.DoorOpen = gpio_in.Door_Open;
+#else
         ShmPrimaryMcuData->InputDet.bits.DoorOpen = ~gpio_in.Door_Open;
+#endif //
 
         ShmPrimaryMcuData->InputDet.bits.Key0 = ~gpio_in.Key[0] & 0x01;
         ShmPrimaryMcuData->InputDet.bits.Key1 = ~gpio_in.Key[1] & 0x01;
         ShmPrimaryMcuData->InputDet.bits.Key2 = ~gpio_in.Key[2] & 0x01;
         ShmPrimaryMcuData->InputDet.bits.Key3 = ~gpio_in.Key[3] & 0x01;
+        //ShmPrimaryMcuData->InputDet.bits.EmergencyButton = gpio_in.Emergency_Btn;
 #else
+
+        ShmPrimaryMcuData->InputDet.bits.Key0 = gpio_in.Key[0] & 0x01;
+        ShmPrimaryMcuData->InputDet.bits.Key1 = gpio_in.Key[1] & 0x01;
+        ShmPrimaryMcuData->InputDet.bits.Key2 = gpio_in.Key[2] & 0x01;
+        ShmPrimaryMcuData->InputDet.bits.Key3 = gpio_in.Key[3] & 0x01;
+        //ShmPrimaryMcuData->InputDet.bits.EmergencyButton = ~gpio_in.Emergency_Btn;
         ShmPrimaryMcuData->InputDet.bits.DoorOpen = gpio_in.Door_Open;
 #endif //defined DD360 ||defined DD360Audi
 
+#if defined DD360ComBox
+        ShmPrimaryMcuData->InputDet.bits.EmergencyButton = ~gpio_in.Emergency_Btn;
+#else
+        ShmPrimaryMcuData->InputDet.bits.EmergencyButton = gpio_in.Emergency_Btn;
+#endif //
+
+        dispenserSwTmp |= (ShmPrimaryMcuData->InputDet.bits.Key0);
+        dispenserSwTmp |= (ShmPrimaryMcuData->InputDet.bits.Key1 << 1);
+        dispenserSwTmp |= (ShmPrimaryMcuData->InputDet.bits.Key2 << 2);
+        dispenserSwTmp |= (ShmPrimaryMcuData->InputDet.bits.Key3 << 3);
+
+        if (dispenserSwTmp != dispenserSw) {
+            dispenserSw = dispenserSwTmp;
+            log_info("Dispenser switch number =  %d, bit = %d, %d, %d, %d\r\n",
+                     dispenserSw,
+                     ShmPrimaryMcuData->InputDet.bits.Key3,
+                     ShmPrimaryMcuData->InputDet.bits.Key2,
+                     ShmPrimaryMcuData->InputDet.bits.Key1,
+                     ShmPrimaryMcuData->InputDet.bits.Key0);
+        }
+
         ShmPrimaryMcuData->InputDet.bits.Button1 = gpio_in.Button[0];
         ShmPrimaryMcuData->InputDet.bits.Button2 = gpio_in.Button[1];
-        ShmPrimaryMcuData->InputDet.bits.EmergencyButton = gpio_in.Emergency_Btn;
 
         /*printf(" gpio_in.Key[0]~ gpio_in.Key[3]=%d, %d, %d, %d\n",
         ShmPrimaryMcuData->InputDet.bits.Key0 , ShmPrimaryMcuData->InputDet.bits.Key1,
@@ -321,12 +362,12 @@ void GetInputGpioStatus()
         printf("ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CcsLiquidChillerWaterLevelWarning=%d\n", ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CcsLiquidChillerWaterLevelWarning);
         printf("ShmStatusCodeData->FaultCode.FaultEvents.bits.CcsLiquidChillerWaterLevelFault=%d\n", ShmStatusCodeData->FaultCode.FaultEvents.bits.CcsLiquidChillerWaterLevelFault);
         */
-        //PRINTF_FUNC("left = %d \n", ShmPrimaryMcuData->InputDet.bits.Button1);
-        //PRINTF_FUNC("right = %d \n", ShmPrimaryMcuData->InputDet.bits.Button2);
-        //PRINTF_FUNC("ShmSysConfigAndInfo->SysInfo.AcContactorStatus = %d \n", ShmSysConfigAndInfo->SysInfo.AcContactorStatus);
-#if !defined DD360 && !defined DD360Audi
+        //log_info("left = %d \n", ShmPrimaryMcuData->InputDet.bits.Button1);
+        //log_info("right = %d \n", ShmPrimaryMcuData->InputDet.bits.Button2);
+        //log_info("ShmSysConfigAndInfo->SysInfo.AcContactorStatus = %d \n", ShmSysConfigAndInfo->SysInfo.AcContactorStatus);
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
         if (ShmPrimaryMcuData->InputDet.bits.AcMainBreakerDetec == YES) {
-            DEBUG_ERROR("AC Mainbreaker occur. \n");
+            log_error("AC Mainbreaker occur. \n");
         }
 #endif //!defined DD360 && !defined DD360Audi
     }
@@ -374,51 +415,86 @@ void GetMeterConsumption(byte index)
 }
 #endif //defined METER_ENABLE
 
-void SetOutputGpio(byte flash)
+static void checkChillerStatus(Gpio_out *gpio)
 {
-    Gpio_out gpio;
-    gpio.Button_LED[0] = flash;
-    gpio.Button_LED[1] = flash;
+    uint8_t gunIndex = 0;
+    uint8_t chillerCount = 0;
+    static ChillerInfo fChillerInfo[2] = {0};
+    Gpio_out *pGpio = (Gpio_out *)gpio;
+
+    if ((strncmp((char *)&ShmSysConfigAndInfo->SysConfig.ModelName[7], "V", 1) == 0) ||
+            (strncmp((char *)&ShmSysConfigAndInfo->SysConfig.ModelName[7], "F", 1) == 0)) {
+        chillerCount++;
+    }
 
-    gpio.System_LED[0] = 0x00;
-    gpio.System_LED[1] = 0x00;
-    gpio.System_LED[2] = 0x00;
-    gpio.System_LED[3] = 0x00;
+    if ((strncmp((char *)&ShmSysConfigAndInfo->SysConfig.ModelName[9], "V", 1) == 0) ||
+            (strncmp((char *)&ShmSysConfigAndInfo->SysConfig.ModelName[9], "F", 1) == 0)) {
+        chillerCount++;
+    }
 
-#if defined DD360 || defined DD360Audi
-    if ((ChargingData[0]->PresentChargingCurrent) >= 150) {
-        ChillerSwitch = 1;
-        ChillerOnTime = time((time_t *)NULL);
-    } else {
-        if (ChillerSwitch == 1) {
-            if ((ChargingData[0]->PresentChargingCurrent) >= 100) {
-                ChillerSwitch = 1;
-                ChillerOnTime = time((time_t *)NULL);
-            } else {
-                if ((time((time_t *)NULL) - ChillerOnTime) >= 600) {
-                    ChillerSwitch = 0;
+    if (chillerCount == 0) {
+        pGpio->AC_Connector = 0x00;
+        return;
+    }
+
+    for (gunIndex = 0; gunIndex < chillerCount; gunIndex++) {
+        if ((ChargingData[gunIndex]->PresentChargingCurrent) >= 150) {
+            fChillerInfo[gunIndex].ChillerSwitch = YES;
+            fChillerInfo[gunIndex].ChillerOnTime = time((time_t *)NULL);
+        } else {
+            if (fChillerInfo[gunIndex].ChillerSwitch == YES) {
+                if ((ChargingData[gunIndex]->PresentChargingCurrent) >= 100) {
+                    fChillerInfo[gunIndex].ChillerSwitch = YES;
+                    fChillerInfo[gunIndex].ChillerOnTime = time((time_t *)NULL);
                 } else {
-                    ChillerSwitch = 1;
+                    if ((time((time_t *)NULL) - fChillerInfo[gunIndex].ChillerOnTime) >= 600) {
+                        fChillerInfo[gunIndex].ChillerSwitch = NO;
+                    } else {
+                        fChillerInfo[gunIndex].ChillerSwitch = YES;
+                    }
                 }
+            } else {
+                fChillerInfo[gunIndex].ChillerSwitch = NO;
             }
-        } else {
-            ChillerSwitch = 0;
         }
     }
-    gpio.AC_Connector = ChillerSwitch;//Chiller ON/OFF Control, "0: Chiller disable, 1: Chiller enable"
 
-    //printf("ChargingData[0]->PresentChargingCurrent=%f,ChargingData[1]->PresentChargingCurrent=%f,ChillerSwitch=%d\n",ChargingData[0]->PresentChargingCurrent,ChargingData[1]->PresentChargingCurrent,ChillerSwitch);
-#else
-    gpio.AC_Connector = 0x00;
-#endif //defined DD360 || DD360Audi
+    pGpio->AC_Connector = fChillerInfo[gunIndex].ChillerSwitch;//Chiller ON/OFF Control, "0: Chiller disable, 1: Chiller enable"
+}
 
-    gpio.AC_Breaker = 0x00;
+void SetOutputGpio(uint8_t outputValue)
+{
+    Gpio_out gpio;
+    LedConfig *pLedConfig = (LedConfig *)&outputValue;
 
-    if (Config_Gpio_Output(Uart1Fd, Addr.IoExtend, &gpio) == PASS) {
-        //PRINTF_FUNC("SetOutputGpio sucessfully. %d \n", flash);
+    if (strcmp((char *)ShmSysConfigAndInfo->SysInfo.LcmHwRev, " ") == 0x00) {
+        if (flash == NO) {
+            flash = YES;
+        } else {
+            flash = NO;
+        }
     } else {
-        //PRINTF_FUNC("SetOutputGpio fail. \n");
+        if (flash == NO) {
+            flash = YES;
+        }
     }
+
+    pLedConfig->LeftButtonLed = flash;
+    pLedConfig->RightButtonLed = flash;
+
+    gpio.Button_LED[0] = pLedConfig->LeftButtonLed;
+    gpio.Button_LED[1] = pLedConfig->RightButtonLed;
+
+    gpio.System_LED[0] = pLedConfig->GreenLED;
+    gpio.System_LED[1] = pLedConfig->YellowLED;
+    gpio.System_LED[2] = pLedConfig->RedLED;
+    gpio.System_LED[3] = 0x00;
+
+    checkChillerStatus(&gpio);
+
+    gpio.AC_Breaker = 0x00;
+
+    Config_Gpio_Output(Uart1Fd, Addr.IoExtend, &gpio);
 }
 
 void SetRtcData()
@@ -428,7 +504,7 @@ void SetRtcData()
 
     ftime(&csuTime);
     tmCSU = localtime(&csuTime.time);
-//  PRINTF_FUNC("Time : %04d-%02d-%02d %02d:%02d:%02d \n", tmCSU->tm_year + 1900,
+//  log_info("Time : %04d-%02d-%02d %02d:%02d:%02d \n", tmCSU->tm_year + 1900,
 //          tmCSU->tm_mon + 1, tmCSU->tm_mday, tmCSU->tm_hour, tmCSU->tm_min,
 //          tmCSU->tm_sec);
 
@@ -453,9 +529,9 @@ void SetRtcData()
     rtc.RtcData[13] = '0' + (tmCSU->tm_sec) / 1 % 10;
 
     if (Config_Rtc_Data(Uart1Fd, Addr.IoExtend, &rtc) == PASS) {
-        //PRINTF_FUNC("SetRtc sucessfully. \n");
+        //log_info("SetRtc sucessfully. \n");
     } else {
-        //PRINTF_FUNC("SetRtc fail. \n");
+        //log_info("SetRtc fail. \n");
     }
 }
 
@@ -476,7 +552,7 @@ int InitComPort()
     fd = open(priPortName, O_RDWR);
     if (fd <= 0) {
 #ifdef SystemLogMessage
-        DEBUG_ERROR("open 407 Communication port NG \n");
+        log_error("open 407 Communication port NG \n");
 #endif
         return -1;
     }
@@ -535,7 +611,7 @@ void Initialization() //DS60-120 add
         isPass = true;
         for (byte _index = 0; _index < gun_count; _index++) {
             if (!FindChargingInfoData(_index, &ChargingData[0])) {
-                DEBUG_ERROR("EvComm (main) : FindChargingInfoData false \n");
+                log_error("EvComm (main) : FindChargingInfoData false \n");
                 isPass = false;
                 break;
             }
@@ -547,7 +623,7 @@ void Initialization() //DS60-120 add
 int main(void)
 {
     if (InitShareMemory() == FAIL) {
-        DEBUG_ERROR("InitShareMemory NG\r\n");
+        log_error("InitShareMemory NG\r\n");
         if (ShmStatusCodeData != NULL) {
             ShmStatusCodeData->AlarmCode.AlarmEvents.bits.FailToCreateShareMemory = 1;
         }
@@ -558,17 +634,17 @@ int main(void)
     //DS60-120 remove
     //for (byte _index = 0; _index < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; _index++) {
     //    if (!FindChargingInfoData(_index, &ChargingData[0])) {
-    //        DEBUG_ERROR("FindChargingInfoData false \n");
+    //        log_error("FindChargingInfoData false \n");
     //        break;
     //    }
     //}
     ChillerSwitch = 0;
     Uart1Fd = InitComPort();
-    //PRINTF_FUNC("407 Port id = %d \n", Uart1Fd);
+    //log_info("407 Port id = %d \n", Uart1Fd);
 
     if (Uart1Fd < 0) {
 #ifdef SystemLogMessage
-        DEBUG_ERROR("InitComPort (Uart1 : AM3352 - STM32) NG");
+        log_error("InitComPort (Uart1 : AM3352 - STM32) NG");
 #endif
         if (ShmStatusCodeData != NULL) {
             ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CsuInitFailed = 1;
@@ -586,35 +662,16 @@ int main(void)
     byte _count = 0;
 
     for (;;) {
-        if (strcmp((char *)ShmSysConfigAndInfo->SysInfo.LcmHwRev, " ") == 0x00) {
-            if ((GetTimeoutValue(_flash_time) / 1000) > 1000) {
-                if (flash == NO) {
-                    flash = YES;
-                } else {
-                    flash = NO;
-                }
-                SetOutputGpio(flash);
-                gettimeofday(&_flash_time, NULL);
-            }
-        } else {
-            if ((GetTimeoutValue(_flash_time) / 1000) > 5000) {
-                if (flash == NO) {
-                    flash = YES;
-                }
-
-                SetOutputGpio(flash);
-                gettimeofday(&_flash_time, NULL);
-            }
-        }
-
         // 程序開始之前~ 必須先確定 FW 版本與硬體版本，確認後!!~ 該模組才算是真正的 Initial Comp.
         // 模組更新 FW 後，需重新做
         if (ShmPrimaryMcuData->SelfTest_Comp != PASS) {
-            //PRINTF_FUNC("(407) Get Fw and Hw Ver. \n");
+            //log_info("(407) Get Fw and Hw Ver. \n");
             GetFwAndHwVersion();
             sleep(1);
             ShmPrimaryMcuData->SelfTest_Comp = PASS;
         } else {
+            SetOutputGpio(ShmPrimaryMcuData->OutputDrv.OutputDrvValue[0]);
+
             GetInputGpioStatus();
 
 #if defined METER_ENABLE //DS60-120 add

EVSE/Projects/DD360Audi/Apps/internalComm.c

@@ -38,7 +38,7 @@
 #define PASS                1
 #define FAIL                -1
 
-#if !defined DD360 && !defined DD360Audi
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
 struct Address Addr = {0x01, 0x02, 0x03, 0x05, 0x06, 0xFF};
 #else
 struct Address Addr = {0x01, 0x02, 0x09, 0x05, 0x06, 0xFF};

EVSE/Projects/DD360Audi/Apps/replaceOther.sh

@@ -0,0 +1,8 @@
+#/bin/bash
+
+rm -rf /opt/ti-processor-sdk-linux-am335x-evm-04.02.00.09/EVSE/Projects/DD360/Apps;
+cp -r /opt/ti-processor-sdk-linux-am335x-evm-04.02.00.09/EVSE/Projects/DD360Audi/Apps /opt/ti-processor-sdk-linux-am335x-evm-04.02.00.09/EVSE/Projects/DD360/;
+
+rm -rf /opt/ti-processor-sdk-linux-am335x-evm-04.02.00.09/EVSE/Projects/DD360ComBox/Apps;
+cp -r /opt/ti-processor-sdk-linux-am335x-evm-04.02.00.09/EVSE/Projects/DD360Audi/Apps /opt/ti-processor-sdk-linux-am335x-evm-04.02.00.09/EVSE/Projects/DD360ComBox/;
+

EVSE/Projects/DD360ComBox/Apps/AudiCust.h

@@ -0,0 +1,96 @@
+#ifndef _AUDI_CUSTOM_H_
+#define _AUDI_CUSTOM_H_
+
+#include <stdint.h>
+
+//------------------------------------------------------------------------------
+//--- //For Audi for Audi customization ---
+//------------------------------------------------------------------------------
+#define ShmAudiCustInfoKey                      1014
+
+#define SEL_GUN_RELEASE                         0x00
+#define SEL_GUN_CONFIRM                         0x01
+#define SEL_GUN_ATHOR                           0x02
+#define SEL_GUN_PLUG_IT                         0x03
+//#define SEL_GUN_CHARGING                        0x04
+//#define SEL_GUN_CHARGING_COMP                   0x05
+
+#define LEFT_GUN_NUM                            0
+#define RIGHT_GUN_NUM                           1
+
+#define SEL_GUN_TIMEOUT                         120
+
+#define DESTROY_ALL_SEL                         0x03
+
+#define FAIL_BALANCE_PRICES                     -65535.00
+
+//------------------------------------------------------------------------------
+//--- remote control ---
+//------------------------------------------------------------------------------
+//#define RT_NON_ACTION                           0x00
+//#define RT_HARDWARE_REBOOT                      0x01
+//#define RT_SOFTWARE_RESTART                     0x02
+
+//------------------------------------------------------------------------------
+//--- power cabinet Ethernet device status ---
+//------------------------------------------------------------------------------
+#define DEV_ST_DISABLE                          0x00
+#define DEV_ST_ENABLE_USE                       0x01
+#define DEV_ST_ENABLE_NO_USE                    0x02
+
+#define EV_BOARD_STOP_CHARGING                  1
+#define POWER_CABINET_STOP_CHARGING             2
+
+//------------------------------------------------------------------------------
+typedef struct StEthDevStatus {
+    uint8_t Backend;
+    uint8_t Ethernet;
+    uint8_t Wifi;
+    uint8_t FourG;
+} EthDevStatus;
+
+typedef struct StSelGunInfo {
+    uint8_t LeftGun;
+    uint8_t RightGun;
+    uint8_t Reserved[2];
+} SelGunInfo;
+
+typedef struct StPricesInfo {
+    //uint8_t Currency;
+    float UserPrices;           //unit = 0.01 dollar, value / 100
+    //float TotalCost;            //unit = 0.01 dollar, value / 100
+    float Balance;              //unit = 0.01 dollar, value / 100
+    //float DefaultPrices;        //unit = 0.01 dollar, value / 100
+    uint8_t Reserved[4];
+} PricesInfo;
+
+//typedef struct StOperativeInfo {
+//    uint8_t ChangeReq;
+//    uint8_t ConnectorID;
+//    uint8_t AvailabilityReq;
+//    uint8_t Reserved;
+//} OperativeInfo;
+
+//typedef struct StStartCharge {
+//    uint8_t ConnectorID;
+//    uint8_t Status;
+//    uint8_t Reserved[2];
+//} StartCharge;
+
+typedef struct StRemoteSetup {
+    //uint8_t Execution;
+    uint16_t ConnectionTimeout;
+    //float DefaultPrices;
+    //OperativeInfo Operative;
+    //StartCharge StartCharge;
+    uint8_t Reserved[2];
+} RemoteSetup;
+
+typedef struct StAudiCustInfo {
+    SelGunInfo SelGunInfo;
+    PricesInfo PricesInfo[2];
+    RemoteSetup RemoteSetup;
+    EthDevStatus EthDevStatus;
+} AudiCustInfo;
+
+#endif /* _AUDI_CUSTOM_H_ */

EVSE/Projects/DD360ComBox/Apps/Config.h

@@ -0,0 +1,240 @@
+/*
+ * Config.h
+ *
+ *  Created on: 2019年4月23日
+ *      Author: foluswen
+ */
+#ifndef CONFIG_H_
+#define CONFIG_H_
+
+#define ShmCsuMeterKey          2001
+#define ShmCommonKey            2002
+
+typedef unsigned char           byte;
+
+#define TOTAL_QUANTITY_GUN          4               //Max Count
+
+#define MODE_BOOT                   0
+#define MODE_IDLE                   1
+#define MODE_AUTHORIZING            2
+#define MODE_REASSIGN_CHECK         3
+#define MODE_REASSIGN               4
+#define MODE_PRECHARGE              5
+#define MODE_PREPARE_FOR_EV         6
+#define MODE_PREPARE_FOR_EVSE       7
+#define MODE_CHARGING               8
+#define MODE_TERMINATING            9
+#define MODE_COMPLETE               10
+#define MODE_ALARM                  11
+#define MODE_FAULT                  12
+#define MODE_RESERVATION            13
+#define MODE_BOOKING                14
+#define MODE_MAINTAIN               15
+#define MODE_DEBUG                  16
+#define MODE_CCS_PRECHARGE_STEP0    17  // ready for ccs precharge processing, For D+ relay to precharge relay
+#define MODE_CCS_PRECHARGE_STEP1    18  // waitting for ev board inform to enter to charging, For precharge relay to D+ relay
+#define MODE_UPDATE                 19
+
+#define GFD_WAIT            0
+#define GFD_PASS            1
+#define GFD_FAIL            2
+#define GFD_WARNING         3
+
+#define PRECHARGE_WAIT              0
+#define PRECHARGE_READY             1
+#define PRECHARGE_PRERELAY_PASS     2
+#define PRECHARGE_CHARELAY_PASS     3
+
+#define BOOTTING            0
+#define BOOT_COMPLETE       1
+
+enum _SYSTEM_STATUS {
+    S_BOOTING =                         0,
+    S_IDLE,
+    S_AUTHORIZING,
+    S_REASSIGN_CHECK,
+    S_REASSIGN,
+    S_PREPARNING,
+    S_PREPARING_FOR_EV,
+    S_PREPARING_FOR_EVSE,
+    S_CHARGING,
+    S_TERMINATING,
+    S_COMPLETE,
+    S_ALARM,
+    S_FAULT,
+    S_RESERVATION,
+    S_BOOKING,
+    S_MAINTAIN,
+    S_DEBUG,
+    S_CCS_PRECHARGE_ST0,
+    S_CCS_PRECHARGE_ST1,
+    S_UPDATE,
+    S_NONE,
+};
+
+enum _AC_SYSTEM_STATUS {
+    AC_SYS_NONE =   0,
+    AC_SYS_A,
+    AC_SYS_B,
+    AC_SYS_C,
+    AC_SYS_D,
+    AC_SYS_E
+};
+
+enum _GUN_TYPE {
+    _Type_Chademo =         0,
+    _Type_CCS_2,
+    _Type_GB,
+    _Type_AC,
+};
+
+enum _LCM_INDEX {
+    _LCM_INIT =             0x00,
+    _LCM_IDLE =             0x01,
+    _LCM_AUTHORIZING =      0x02,
+    _LCM_AUTHORIZ_COMP =    0x03,
+    _LCM_AUTHORIZ_FAIL =    0x04,
+    _LCM_WAIT_FOR_PLUG =    0x05,
+    _LCM_PRE_CHARGE =       0x06,
+    _LCM_CHARGING =         0x07,
+    _LCM_COMPLETE =         0x08,
+    _LCM_FIX =              0x09,
+    _LCM_SELECT_GUN =       0x0A,
+    _LCM_NONE =             0xFF,
+};
+
+enum _SELF_TEST_SEQ {
+    _STEST_VERSION = 0x00,
+    _STEST_AC_CONTACTOR = 0x01,
+    _STEST_PSU_DETECT = 0x02,
+    _STEST_PSU_CAP = 0x03,
+    _STEST_FAIL = 0x04,
+    _STEST_COMPLETE = 0xEE,
+};
+
+enum _MODULE_PSU_WORK_STEP {
+    INITIAL_START       =       0,
+    GET_PSU_COUNT       =       1,
+    GET_SYS_CAP         =       2,
+    BOOTING_COMPLETE    =       3,
+
+    _WORK_CHARGING      =       10,
+
+    _TEST_MODE          =       20,
+
+    _NO_WORKING         =       254,
+    _INIT_PSU_STATUS    =       255
+};
+
+enum _OFFLINE_POLICY {
+    _OFFLINE_POLICY_LOCAL_LIST = 0x00,
+    _OFFLINE_POLICY_PHIHONG_RFID_TAG = 0x01,
+    _OFFLINE_POLICY_FREE_CHARGING = 0x02,
+    _OFFLINE_POLICY_NO_CHARGING = 0x03,
+};
+
+enum _REASSIGNED_RESOURCE_STEP {
+    _REASSIGNED_NONE =              0,  //
+    _REASSIGNED_PREPARE_M_TO_A =    1,  // 系統收到需要降載需求 (輸出總電流降低)，PSU Task 收到將狀態切換至下個狀態
+    _REASSIGNED_GET_NEW_CAP =       2,  // 充電中的重新取得屬於自己火線上的總能量並透過小板通知車端 - 超過10秒直接跳下一步
+    _REASSIGNED_ADJUST_M_TO_A =     3,  // 模塊重新分配完成
+    _REASSIGNED_RELAY_M_TO_A =      4,  // 切斷橋接的 Relay
+
+    _REASSIGNED_PREPARE_A_TO_M =    11,
+    _REASSIGNED_ADJUST_A_TO_M =     12, // 模塊升壓
+    _REASSIGNED_RELAY_A_TO_M =      13, // 搭接橋接的 Relay
+    _REASSIGNED_WAITING =           14,
+    _REASSIGNED_COMP =              15
+};
+
+enum _MAIN_CHARGING_MODE {
+    _MAIN_CHARGING_MODE_MAX = 0,
+    _MAIN_CHARGING_MODE_AVER = 1,
+};
+
+enum _EXTRA_ERR_PROCESS {
+    _EXTRA_ERR_PROCESS_NONE = 0,
+    _EXTRA_ERR_PROCESS_INUVP = 1,
+    _EXTRA_ERR_PROCESS_INOVP = 2
+};
+
+enum _CHARGER_TYPE {
+    _CHARGER_TYPE_IEC = 0,
+    _CHARGER_TYPE_UL = 1,
+};
+
+enum _SYS_WIFI_MODE {
+    _SYS_WIFI_MODE_DISABLE = 0,
+    _SYS_WIFI_MODE_STATION = 1,
+    _SYS_WIFI_MODE_AP = 2
+};
+
+enum _LED_INTENSITY_LV {
+    _LED_INTENSITY_DARKEST   = 0,
+    _LED_INTENSITY_MEDIUM    = 1,
+    _LED_INTENSITY_BRIGHTEST = 2
+};
+
+enum _CCS_COMM_PROTOCOL {
+    _CCS_COMM_V2GMessage_DIN70121       = 0x01,
+    _CCS_COMM_V2GMessage_ISO15118_2014  = 0x02,
+    _CCS_COMM_V2GMessage_ISO15118_2018  = 0x03
+};
+
+enum _ETHERNET_USAGE {
+    _ETHERNET_USAGE_NONE    = 0,
+    _ETHERNET_USAGE_LAN,
+    _ETHERNET_USAGE_WIFI,
+    _ETHERNET_USAGE_3G_4g
+};
+
+enum _PRIMARY_CHECK_TAG {
+    _PRIMARY_CHECK_TAG_AC_CONTACT       = 0,
+    _PRIMARY_CHECK_TAG_MAIN_BREAKER     = 1,
+};
+
+struct StructMeter {
+    float curMeterValue;
+    float newMeterValue;
+    byte isCalculation;
+    float _chargingValue;
+    float _curTotalCharging;
+};
+
+struct MeterInformation {
+    struct StructMeter _meter[2];
+    byte isWorking;
+};
+
+enum _CCS_VERSION_CHECK_TAG {
+    _CCS_VERSION_CHECK_TAG_V015S0       = 0,
+    _CCS_VERSION_CHECK_TAG_V013S0       = 1,
+};
+
+enum RELAY_STATUS_ERROR_INDEX {
+    RELAY_SMR1_P_STATUS =   0,
+    RELAY_SMR1_N_STATUS =   1,
+    RELAY_SMR2_P_STATUS =   2,
+    RELAY_SMR2_N_STATUS =   3,
+    RELAY_PARA_P_STATUS =   4,
+    RELAY_PARA_N_STATUS =   5,
+};
+
+enum RELAY_STATUS_ERROR_TYPE {
+    RELAY_STATUS_ERROR_NONE = 0,
+    RELAY_STATUS_ERROR_WELDING = 10,
+    RELAY_STATUS_ERROR_DRIVING = 11
+};
+
+struct DcCommonInformation {
+    // check if the guns are of the same type
+    byte SysGunAreSameType;
+    // to check the ccs version
+    byte CcsVersion;
+    // for relay welding/driving check
+    char RelayCheckStatus[6];
+    char GunRelayWeldingOccur[2];
+    char GunRelayDrivingOccur[2];
+};
+
+#endif /* CONFIG_H_ */

EVSE/Projects/DD360ComBox/Apps/DoComm.c

@@ -0,0 +1,1252 @@
+#include    <sys/time.h>
+#include    <sys/timeb.h>
+#include    <sys/types.h>
+#include    <sys/stat.h>
+#include    <sys/types.h>
+#include    <sys/ioctl.h>
+#include    <sys/socket.h>
+#include    <sys/ipc.h>
+#include    <sys/shm.h>
+#include    <sys/shm.h>
+#include    <sys/mman.h>
+#include    <linux/can.h>
+#include    <linux/can/raw.h>
+#include    <linux/wireless.h>
+#include    <arpa/inet.h>
+#include    <netinet/in.h>
+#include <signal.h>
+#include    <unistd.h>
+#include    <stdarg.h>
+#include    <stdio.h>      /*標準輸入輸出定義*/
+#include    <stdlib.h>     /*標準函數庫定義*/
+#include    <unistd.h>     /*Unix 標準函數定義*/
+#include    <fcntl.h>      /*檔控制定義*/
+#include    <termios.h>    /*PPSIX 終端控制定義*/
+#include    <errno.h>      /*錯誤號定義*/
+#include    <errno.h>
+#include    <string.h>
+#include    <time.h>
+#include    <ctype.h>
+#include    <ifaddrs.h>
+#include    "../../define.h"
+#include    "Config.h"
+
+//#define Debug
+
+#define DoIPAddress "192.168.100.1"
+#define DoTcpPort       36000
+#define TriggerMsgeNum      20
+
+int StoreLogMsg(const char *fmt, ...);
+#define DEBUG_INFO(format, args...) StoreLogMsg("[%s:%d][%s][Info] "format, __FILE__, __LINE__, __FUNCTION__, ##args)
+#define DEBUG_WARN(format, args...) StoreLogMsg("[%s:%d][%s][Warn] "format, __FILE__, __LINE__, __FUNCTION__, ##args)
+#define DEBUG_ERROR(format, args...) StoreLogMsg("[%s:%d][%s][Error] "format, __FILE__, __LINE__, __FUNCTION__, ##args)
+
+struct ApplicationPacket {
+    unsigned char Se;
+    unsigned char Id;
+    unsigned char Op;
+    unsigned char Len;
+    unsigned char RegisterNum;
+    unsigned char Data[250];
+};
+
+struct SysConfigAndInfo         *ShmSysConfigAndInfo;
+struct StatusCodeData           *ShmStatusCodeData;
+struct PsuData              *ShmPsuData;
+struct OCPP16Data               *ShmOCPP16Data;
+struct PrimaryMcuData           *ShmPrimaryMcuData;
+int                             TcpSock = 0;
+unsigned char                   PacketSe;
+struct ChargingInfoData         *ChargingData[CHAdeMO_QUANTITY + CCS_QUANTITY + GB_QUANTITY];
+struct timeb                    TriggerTimeUp[2][TriggerMsgeNum];
+struct WARNING_CODE_INFO        PreSysWarningInfo;
+int DisconnectFlag;
+
+int StoreLogMsg(const char *fmt, ...)
+{
+    char Buf[4096 + 256];
+    char buffer[4096];
+    va_list args;
+    struct timeb  SeqEndTime;
+    struct tm *tm;
+
+    va_start(args, fmt);
+    int rc = vsnprintf(buffer, sizeof(buffer), fmt, args);
+    va_end(args);
+
+    memset(Buf, 0, sizeof(Buf));
+    ftime(&SeqEndTime);
+    SeqEndTime.time = time(NULL);
+    tm = localtime(&SeqEndTime.time);
+
+    if (ShmSysConfigAndInfo->SysConfig.SwitchDebugFlag == 1) {
+        sprintf(Buf, "%02d:%02d:%02d:%03d - %s",
+                tm->tm_hour, tm->tm_min, tm->tm_sec, SeqEndTime.millitm, buffer);
+        printf("%s \n", Buf);
+    } else {
+        sprintf(Buf, "echo \"%04d-%02d-%02d %02d:%02d:%02d:%03d - %s\" >> /Storage/SystemLog/[%04d.%02d]SystemLog",
+                tm->tm_year + 1900, tm->tm_mon + 1, tm->tm_mday, tm->tm_hour, tm->tm_min, tm->tm_sec, SeqEndTime.millitm,
+                buffer,
+                tm->tm_year + 1900, tm->tm_mon + 1);
+        system(Buf);
+    }
+
+    return rc;
+}
+
+int DiffTimeb(struct timeb ST, struct timeb ET)
+{
+    //return milli-second
+    unsigned int StartTime, StopTime;
+
+    StartTime = (unsigned int)ST.time;
+    StopTime = (unsigned int)ET.time;
+    return (StopTime - StartTime) * 1000 + ET.millitm - ST.millitm;
+}
+
+int InitShareMemory()
+{
+    int result = 1;
+    int MeterSMId;
+
+    if ((MeterSMId = shmget(ShmSysConfigAndInfoKey, sizeof(struct SysConfigAndInfo),  0777)) < 0) {
+        DEBUG_ERROR("shmget ShmSysConfigAndInfo NG\n");
+        result = 0;
+    } else if ((ShmSysConfigAndInfo = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+        DEBUG_ERROR("[shmat ShmSysConfigAndInfo NG\n");
+        result = 0;
+    }
+
+    if ((MeterSMId = shmget(ShmStatusCodeKey, sizeof(struct StatusCodeData),  0777)) < 0) {
+        DEBUG_ERROR("shmget ShmStatusCodeData NG\n");
+        result = 0;
+    } else if ((ShmStatusCodeData = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+        DEBUG_ERROR("shmat ShmStatusCodeData NG\n");
+        result = 0;
+    }
+    //creat ShmPsuData
+    if ((MeterSMId = shmget(ShmPsuKey, sizeof(struct PsuData),  0777)) < 0) {
+        DEBUG_ERROR("shmget ShmPsuData NG \n");
+        result = 0;
+    } else if ((ShmPsuData = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+        DEBUG_ERROR("shmat ShmPsuData NG \n");
+        result = 0;
+    }
+    //creat ShmOCPP16Data
+    if ((MeterSMId = shmget(ShmOcppModuleKey, sizeof(struct OCPP16Data),  0777)) < 0) {
+        DEBUG_ERROR("shmget ShmOCPP16Data NG \n");
+        result = 0;
+    } else if ((ShmOCPP16Data = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+        DEBUG_ERROR("shmat ShmOCPP16Data NG \n");
+        result = 0;
+    }
+
+    if ((MeterSMId = shmget(ShmPrimaryMcuKey, sizeof(struct PrimaryMcuData), 0777)) < 0) {
+        DEBUG_ERROR("shmget ShmPrimaryMcuData NG\n");
+        result = 0;
+    } else if ((ShmPrimaryMcuData = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+        DEBUG_ERROR("shmat ShmPrimaryMcuData NG\n");
+        result = 0;
+    }
+    return result;
+}
+
+int CheckNetworkStatus()
+{
+    //printf("ShmSysConfigAndInfo->SysConfig.Eth0Interface.EthIpAddress=%s\n",ShmSysConfigAndInfo->SysConfig.Eth0Interface.EthIpAddress);
+    if (strstr(ShmSysConfigAndInfo->SysConfig.Eth0Interface.EthIpAddress, "192.168.100") != NULL) {
+        return 1;
+    } else {
+        return 0;
+    }
+}
+
+int TcpConnected()
+{
+    struct sockaddr_in dest;
+    struct timeval tv;
+    int flag;
+
+    if (TcpSock > 0) {
+        close(TcpSock);
+    }
+
+    if ((TcpSock = socket(AF_INET, SOCK_STREAM, 0)) < 0) {
+        DEBUG_ERROR("Open TCP socket NG");
+        return -1;
+    }
+    /*   flag=fcntl (TcpSock, F_GETFL, 0);
+       if(flag>=0)
+       {
+           flag |= O_NONBLOCK;
+           fcntl(TcpSock,F_SETFL, flag );
+       }*/
+    tv.tv_sec = 0;
+    tv.tv_usec = 100000;
+    setsockopt(TcpSock, SOL_SOCKET,  SO_RCVTIMEO, &tv, sizeof(struct timeval));
+    setsockopt(TcpSock, SOL_SOCKET, SO_SNDTIMEO, &tv, sizeof(struct timeval));
+    flag = 1;
+    setsockopt(TcpSock, SOL_SOCKET, MSG_NOSIGNAL, &flag, sizeof(flag));
+
+    memset(&dest, 0, sizeof(dest));
+    dest.sin_family = AF_INET;
+    dest.sin_port = htons(DoTcpPort);
+    inet_aton(DoIPAddress, (struct in_addr *) &dest.sin_addr.s_addr);
+
+    if (connect(TcpSock, (struct sockaddr *) &dest, sizeof(dest)) != 0) {
+        close(TcpSock);
+        return -1;
+    }
+    return TcpSock;
+}
+void AddFaultCodeToBuf(unsigned char *Code)
+{
+    if (ShmSysConfigAndInfo->SysWarningInfo.WarningCount < 10) {
+        memcpy(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[ShmSysConfigAndInfo->SysWarningInfo.WarningCount][0], Code, strlen(Code));
+        ShmSysConfigAndInfo->SysWarningInfo.WarningCount++;
+    }
+}
+
+void RemoveFaultCodeToBuf(unsigned char *Code)
+{
+    unsigned char find = 0x01;
+    char _code[7];
+    sprintf(_code, "%s", Code);
+
+    // 把相關的錯誤碼一次移除，避免重複顯示
+    while (find) {
+        find = 0x00;
+        for (unsigned char i = 0; i < ShmSysConfigAndInfo->SysWarningInfo.WarningCount; i++) {
+            if (find == 0x00) {
+                if (memcmp(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i][0], _code, 7) == 0) {
+                    find = 0x01;
+                }
+            } else {
+                memcpy(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i - 1][0],
+                       &ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i][0], 7);
+            }
+        }
+
+        if (find) {
+            ShmSysConfigAndInfo->SysWarningInfo.WarningCount--;
+        }
+    }
+}
+
+int StatusCodeProcessing(unsigned char *StatusCode)
+{
+    unsigned char Rtn = 0;
+    int ByteCount, BitCount;
+    unsigned char tmp, EventCodeTmp[7];
+
+    if (strlen(StatusCode) != 6) {
+        return 0;
+    }
+    memset(EventCodeTmp, 0, sizeof(EventCodeTmp));
+    memcpy(EventCodeTmp, StatusCode, strlen(StatusCode));
+
+    if (*(StatusCode + 1) == 0x34) { //alarm from power cabinet itself
+        if (StatusCode[0] == 0x30) { //trigger
+            for (unsigned char i = 0; i < ShmSysConfigAndInfo->SysWarningInfo.WarningCount; i++) {
+                if (memcmp(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i][0], EventCodeTmp, 7) == 0) {
+                    Rtn = 1;
+                    break;
+                }
+            }
+            if (Rtn == 0) {
+                AddFaultCodeToBuf(EventCodeTmp);
+            }
+            Rtn = 1;
+        } else if (StatusCode[0] == 0x31) { //recovery
+            RemoveFaultCodeToBuf(EventCodeTmp);
+            Rtn = 1;
+        }
+    } else {
+        switch (*(StatusCode + 2)) {
+        case 0x31://Fault
+            for (ByteCount = 0; ByteCount < (sizeof(FaultStatusCode) / 6); ByteCount++) {
+                if (memcmp(FaultStatusCode[ByteCount] + 1, StatusCode + 1, 5) == 0) {
+                    if (StatusCode[0] == 0x30) { //trigger
+                        ShmStatusCodeData->FaultCode.FaultEvents.FaultVal[ByteCount / 8] |= 1 << (ByteCount % 8);
+                    } else if (StatusCode[0] == 0x31) { //recovery
+                        ShmStatusCodeData->FaultCode.FaultEvents.FaultVal[ByteCount / 8] &= 0 << (ByteCount % 8);
+                    }
+                    Rtn = 1;
+                    break;
+                }
+            }
+            break;
+        case 0x32://Alarm
+            for (ByteCount = 0; ByteCount < (sizeof(AlarmStatusCode) / 6); ByteCount++) {
+                if (memcmp(AlarmStatusCode[ByteCount] + 1, StatusCode + 1, 5) == 0) {
+
+                    if (StatusCode[0] == 0x30) { //trigger
+                        ShmStatusCodeData->AlarmCode.AlarmEvents.AlarmVal[ByteCount / 8] |= 1 << (ByteCount % 8);
+                    } else if (StatusCode[0] == 0x31) { //recovery
+                        ShmStatusCodeData->AlarmCode.AlarmEvents.AlarmVal[ByteCount / 8] &= 0 << (ByteCount % 8);
+                    }
+                    Rtn = 1;
+                    break;
+                }
+            }
+            break;
+        case 0x33://Information
+            for (ByteCount = 0; ByteCount < (sizeof(InfoStatusCode) / 6); ByteCount++) {
+                if (memcmp(InfoStatusCode[ByteCount] + 1, StatusCode + 1, 5) == 0) {
+                    if (StatusCode[0] == 0x30) { //trigger
+                        ShmStatusCodeData->InfoCode.InfoEvents.InfoVal[ByteCount / 8] |= 1 << (ByteCount % 8);
+                    } else if (StatusCode[0] == 0x31) { //recovery
+                        ShmStatusCodeData->InfoCode.InfoEvents.InfoVal[ByteCount / 8] &= 0 << (ByteCount % 8);
+                    }
+                    Rtn = 1;
+                    break;
+                }
+            }
+            break;
+        default:
+            break;
+        }
+    }
+
+    return Rtn;
+}
+
+int SendPacket(unsigned char Id, unsigned char Op, unsigned char RegNum, unsigned char DataLen, unsigned char *Data)
+{
+    int Rtn = 0, PacketLen, Tmp;
+    struct ApplicationPacket SendBuffer;
+    struct timeb ST, ET;
+
+    memset(&SendBuffer, 0, sizeof(struct ApplicationPacket));
+    SendBuffer.Se = (PacketSe++);
+    SendBuffer.Id = Id;
+    SendBuffer.Op = Op;
+    SendBuffer.Len = DataLen + 1;
+    SendBuffer.RegisterNum = RegNum;
+    if (DataLen > 0) {
+        memcpy(SendBuffer.Data, Data, DataLen);
+    }
+    PacketLen = SendBuffer.Len + 4;
+    ftime(&ST);
+    while (Rtn < PacketLen) {
+        Tmp = send(TcpSock, &SendBuffer + Rtn, PacketLen - Rtn, MSG_NOSIGNAL);
+        if (Tmp > 0) {
+            Rtn += Tmp;
+        }
+        ftime(&ET);
+        if (DiffTimeb(ST, ET) > 500) {
+            DisconnectFlag++;
+            if (DisconnectFlag >= 10) {
+                DisconnectFlag = 10;
+            }
+#ifdef Debug
+            printf("Send Packet Timeout(%d/%d): SE=%d, ID=%d, OP=%d, Reg=%d",
+                   Rtn, PacketLen, PacketSe, Id, Op, RegNum);
+#endif
+            return 0;
+        }
+    }
+    return Rtn;
+}
+
+int RecvPacket(unsigned char *DataLen, struct ApplicationPacket *Packet)
+{
+    int Rtn = 0, Tmp;
+    unsigned char TmpBuf[250];
+    struct timeb ST, ET;
+
+    memset(Packet, 0, sizeof(struct ApplicationPacket));
+    memset(TmpBuf, 0, sizeof(TmpBuf));
+    ftime(&ST);
+    while (Rtn < 5) {
+        Tmp = recv(TcpSock, TmpBuf + Rtn, 5 - Rtn, 0);
+        if (Tmp > 0) {
+            Rtn += Tmp;
+        }
+        ftime(&ET);
+        if (DiffTimeb(ST, ET) > 500) {
+            DisconnectFlag++;
+            if (DisconnectFlag >= 10) {
+                DisconnectFlag = 10;
+            }
+#ifdef Debug
+            printf("Recv Packet header Timeout(%d/5)(disconnect count=%d): SE=%d, ID=%d, OP=%d, Len=%d, Reg=%d",
+                   Rtn, DisconnectFlag, TmpBuf[0], TmpBuf[1], TmpBuf[2], TmpBuf[3], TmpBuf[4]);
+#endif
+            return 0;
+        }
+    }
+    if ((TmpBuf[0] > 255)/*||(TmpBuf[1]>2)*/ || (TmpBuf[2] > 3) || (TmpBuf[3] > 250)) {
+        DEBUG_INFO("Recv Wrong Packet header (%d/5): SE=%d, ID=%d, OP=%d, Len=%d, Reg=%d",
+                   Rtn, TmpBuf[0], TmpBuf[1], TmpBuf[2], TmpBuf[3], TmpBuf[4]);
+        return 0;
+    }
+    memcpy(Packet, TmpBuf, 5);
+    *DataLen = Packet->Len - 1;
+    memset(TmpBuf, 0, sizeof(TmpBuf));
+    Rtn = 0;
+    ftime(&ST);
+    while (Rtn < *DataLen) {
+        Tmp = recv(TcpSock, TmpBuf + Rtn, *DataLen - Rtn, 0);
+        if (Tmp > 0) {
+            Rtn += Tmp;
+        }
+        ftime(&ET);
+        if (DiffTimeb(ST, ET) > 500) {
+            DEBUG_INFO("Recv Packet Timeout(%d/%d): SE=%d, ID=%d, OP=%d, Reg=%d",
+                       Rtn, *DataLen, Packet->Se, Packet->Id, Packet->Op, Packet->RegisterNum);
+            return 0;
+        }
+    }
+    memcpy(Packet->Data, TmpBuf, *DataLen);
+    DisconnectFlag = 0;
+    return Rtn;
+}
+
+int WriteModelName()
+{
+    unsigned char Tmp = 0;
+    unsigned char TmpBuf[255];
+    struct ApplicationPacket PacketData;
+
+    memset(TmpBuf, 0, sizeof(TmpBuf));
+    memset(&PacketData, 0, sizeof(struct ApplicationPacket));
+
+    memcpy(TmpBuf, ShmSysConfigAndInfo->SysConfig.ModelName, strlen(ShmSysConfigAndInfo->SysConfig.ModelName));
+    Tmp = (unsigned char)(ShmPrimaryMcuData->InputDet.bits.Key2 << 2 | ShmPrimaryMcuData->InputDet.bits.Key1 << 1 | ShmPrimaryMcuData->InputDet.bits.Key0);
+    TmpBuf[strlen(ShmSysConfigAndInfo->SysConfig.ModelName)] = Tmp; //Dispenser switch value
+#ifdef Debug
+    printf("WriteModelName(%s)(%d) => ", ShmSysConfigAndInfo->SysConfig.ModelName, Tmp);
+#endif
+    if (SendPacket(0xFF, 0x02, 0x01, strlen(ShmSysConfigAndInfo->SysConfig.ModelName) + 1, TmpBuf) <= 0) {
+#ifdef Debug
+        printf("SendPacket Fail\n");
+#endif
+        return -1;
+    }
+    if (RecvPacket(&Tmp, &PacketData) <= 0) {
+#ifdef Debug
+        printf("RecvPacket Fail\n");
+#endif
+        return -1;
+    }
+    if (PacketData.Data[0] != 1) { //!=OK
+#ifdef Debug
+        printf("NG\n");
+#endif
+        return -1;
+    }
+#ifdef Debug
+    printf("OK\n");
+#endif
+    return 1;
+}
+
+int ReadConnectorID()
+{
+    unsigned char Tmp = 0;
+    struct ApplicationPacket PacketData;
+
+    memset(&PacketData, 0, sizeof(struct ApplicationPacket));
+#ifdef Debug
+    printf("ReadConnectorID => ");
+#endif
+    if (SendPacket(0xFF, 0x01, 0x02, 0, PacketData.Data) <= 0) {
+#ifdef Debug
+        printf("SendPacket Fail\n");
+#endif
+        return -1;
+    }
+    if (RecvPacket(&Tmp, &PacketData) <= 0) {
+#ifdef Debug
+        printf("RecvPacket Fail\n");
+#endif
+        return -1;
+    }
+    if (PacketData.Data[0] != 1) { //!=OK
+#ifdef Debug
+        printf("NG\n");
+#endif
+        return -1;
+    }
+#ifdef Debug
+    printf("OK (Left connector ID = %d, Right connector ID = %d)\n", PacketData.Data[1], PacketData.Data[2]);
+#endif
+    return 1;
+}
+
+int ReadDoStatus()
+{
+    unsigned char Tmp = 0, count, Rtn;
+    struct ApplicationPacket PacketData;
+    unsigned char StatusArray[20][6];
+    unsigned char EventCodeTmp[7];
+
+    memset(&PacketData, 0, sizeof(struct ApplicationPacket));
+    memset(StatusArray, 0, sizeof(StatusArray));
+#ifdef Debug
+    printf("ReadDoStatus => ");
+#endif
+    if (SendPacket(0x01, 0x01, 0x03, 0, PacketData.Data) <= 0) {
+#ifdef Debug
+        printf("SendPacket Fail\n");
+#endif
+        return -1;
+    }
+    if (RecvPacket(&Tmp, &PacketData) <= 0) {
+#ifdef Debug
+        printf("RecvPacket Fail\n");
+#endif
+        return -1;
+    }
+    if (PacketData.Data[0] != 1) { //!=OK
+#ifdef Debug
+        printf("NG\n");
+#endif
+        return -1;
+    }
+    Tmp--;//decrase OK/NG byte
+    if (Tmp < 6) {
+        if (ShmSysConfigAndInfo->SysWarningInfo.WarningCount > 0) {
+            for (unsigned char i = 0; i < ShmSysConfigAndInfo->SysWarningInfo.WarningCount; i++) {
+                if (ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i][1] >= 0x33) { //from backend or power cabinet
+                    memset(EventCodeTmp, 0, sizeof(EventCodeTmp));
+                    memcpy(EventCodeTmp, ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i], sizeof(EventCodeTmp));
+                    RemoveFaultCodeToBuf(EventCodeTmp);
+                }
+            }
+        }
+#ifdef Debug
+        printf("no alarm (%d)\n", Tmp);
+#endif
+        return -1;
+    }
+#ifdef Debug
+    printf("OK, (%d) ", Tmp);
+    //printf("PacketData.Se=%d\n",PacketData.Se);
+    //printf("PacketData.Id=%d\n",PacketData.Id);
+    //printf("PacketData.Op=%d\n",PacketData.Op);
+    //printf("PacketData.Len=%d\n",PacketData.Len);
+    //printf("PacketData.RegisterNum=%d\n",PacketData.RegisterNum);
+    //for(Rtn=0;Rtn<=PacketData.Len-1;Rtn++)
+    //printf("PacketData.Data[%d]=0x%x\n",Rtn,PacketData.Data[Rtn]);
+#endif
+    for (count = 0; count < Tmp; count += 6) {
+        //if((Tmp-count)<6)
+        strncpy(StatusArray[count / 6], (PacketData.Data + 1) + count, 6);
+        Rtn = 0;
+        for (unsigned char i = 0; i < ShmSysConfigAndInfo->SysWarningInfo.WarningCount; i++) {
+            if (memcmp(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i][0], StatusArray[count / 6], 6) == 0) {
+                Rtn = 1;
+                break;
+            }
+        }
+        if (Rtn == 0) {
+            AddFaultCodeToBuf(StatusArray[count / 6]);
+        }
+        //Rtn=StatusCodeProcessing(StatusArray[count/6]);
+#ifdef Debug
+        printf("(%d)(%s) = %s,  ", count / 6, Rtn == 1 ? "Process OK" : "Process NG", StatusArray[count / 6]);
+#endif
+    }
+    for (unsigned char i = 0; i < ShmSysConfigAndInfo->SysWarningInfo.WarningCount; i++) {
+        if (ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i][1] >= 0x33) { //from backend or power cabinet
+            Rtn = 0;
+            for (count = 0; count < (Tmp / 6); count++) {
+                if (memcmp(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i][0], StatusArray[count], 6) == 0) {
+                    Rtn = 1;
+                    break;
+                }
+            }
+            if (Rtn == 0) {
+                memset(EventCodeTmp, 0, sizeof(EventCodeTmp));
+                memcpy(EventCodeTmp, ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i], sizeof(EventCodeTmp));
+                RemoveFaultCodeToBuf(EventCodeTmp);
+            }
+        }
+    }
+#ifdef Debug
+    printf("\n");
+#endif
+    return 1;
+}
+
+int WriteDdStatus()
+{
+    unsigned char Tmp = 0, count;
+    unsigned char TmpBuf[255], CurWarnCodeTmp[10][6], PreWarnCodeTmp[10][6];
+    struct ApplicationPacket PacketData;
+
+    if ((ShmSysConfigAndInfo->SysWarningInfo.WarningCount <= 0) && (PreSysWarningInfo.WarningCount <= 0)) {
+        return -1;
+    }
+    memset(CurWarnCodeTmp, 0, sizeof(CurWarnCodeTmp));
+    Tmp = ShmSysConfigAndInfo->SysWarningInfo.WarningCount;
+    for (count = 0; count < Tmp; count++) {
+        memcpy(CurWarnCodeTmp[count], ShmSysConfigAndInfo->SysWarningInfo.WarningCode[count], 6);
+    }
+    memset(PreWarnCodeTmp, 0, sizeof(PreWarnCodeTmp));
+    Tmp = PreSysWarningInfo.WarningCount;
+    for (count = 0; count < Tmp; count++) {
+        memcpy(PreWarnCodeTmp[count], PreSysWarningInfo.WarningCode[count], 6);
+    }
+    if (strcmp(CurWarnCodeTmp, PreWarnCodeTmp) == 0) {
+        return -1;
+    }
+
+
+    /*memset(TmpBuf,0,sizeof(TmpBuf));
+    Tmp=ShmSysConfigAndInfo->SysWarningInfo.WarningCount;
+    for(count=0;count<Tmp;count++)
+    {
+        memcpy(TmpBuf+(count*6),ShmSysConfigAndInfo->SysWarningInfo.WarningCode[count],6);
+        #ifdef Debug
+        printf("WriteDdStatus(%d) = %s", count, ShmSysConfigAndInfo->SysWarningInfo.WarningCode[count]);
+        #endif
+    }
+    if(SendPacket(0x01, 0x02, 0x04,strlen(TmpBuf), TmpBuf)<=0)
+        return -1;
+    */
+#ifdef Debug
+    printf("WriteDdStatus => ");
+#endif
+    if (SendPacket(0x01, 0x02, 0x04, strlen(CurWarnCodeTmp), CurWarnCodeTmp) <= 0) {
+#ifdef Debug
+        printf("SendPacket Fail\n");
+#endif
+        return -1;
+    }
+    memset(&PacketData, 0, sizeof(struct ApplicationPacket));
+    if (RecvPacket(&Tmp, &PacketData) <= 0) {
+#ifdef Debug
+        printf("RecvPacket Fail\n");
+#endif
+        return -1;
+    }
+    if (PacketData.Data[0] != 1) { //!=OK
+#ifdef Debug
+        printf("NG\n");
+#endif
+        return -1;
+    }
+    memset(&PreSysWarningInfo, 0, sizeof(struct WARNING_CODE_INFO));
+    memcpy(&PreSysWarningInfo, &(ShmSysConfigAndInfo->SysWarningInfo), sizeof(struct WARNING_CODE_INFO));
+#ifdef Debug
+    printf("OK,  ");
+    Tmp = ShmSysConfigAndInfo->SysWarningInfo.WarningCount;
+    for (count = 0; count < Tmp; count++) {
+        printf("(%d)%s,  ", count, ShmSysConfigAndInfo->SysWarningInfo.WarningCode[count]);
+    }
+    printf("\n");
+#endif
+    return 1;
+}
+
+int ReadChargingCapability(unsigned char PlugNum)
+{
+    unsigned char Tmp = 0;
+    struct ApplicationPacket PacketData;
+    float MaxVolt, MaxCurrent, MaxPower;
+
+#ifdef Debug
+    printf("Read Charging Capability => ");
+#endif
+    memset(&PacketData, 0, sizeof(struct ApplicationPacket));
+    if (SendPacket(PlugNum, 0x01, 0x05, 0, PacketData.Data) <= 0) {
+#ifdef Debug
+        printf("SendPacket Fail\n");
+#endif
+        return -1;
+    }
+    if (RecvPacket(&Tmp, &PacketData) <= 0) {
+#ifdef Debug
+        printf("RecvPacket Fail\n");
+#endif
+        return -1;
+    }
+    if (PacketData.Data[0] != 1) { //!=OK
+#ifdef Debug
+        printf("NG\n");
+#endif
+        return -1;
+    }
+    MaxVolt = (float)(PacketData.Data[1] << 8 | PacketData.Data[2]);
+    MaxCurrent = (float)(PacketData.Data[3] << 8 | PacketData.Data[4]);
+    MaxPower = (float)(PacketData.Data[5] << 8 | PacketData.Data[6]);
+    if ((MaxVolt >= 0) && (MaxVolt <= 10000)) {
+        ChargingData[PlugNum - 1]->MaximumChargingVoltage = MaxVolt;
+    }
+    if ((MaxCurrent >= 0) && (MaxCurrent <= 5000)) {
+        ChargingData[PlugNum - 1]->AvailableChargingCurrent = MaxCurrent;
+    }
+    if ((MaxPower >= 0) && (MaxPower <= 3600)) {
+        ChargingData[PlugNum - 1]->AvailableChargingPower = MaxPower;
+    }
+#ifdef Debug
+    printf(" MaxVolt=%f, MaxCurrent=%f, MaxPower=%f,\n", MaxVolt, MaxCurrent, MaxPower);
+#endif
+    return 1;
+}
+
+int WriteChargingTarget(unsigned char PlugNum)
+{
+    unsigned char Tmp = 0;
+    unsigned char TmpBuf[255];
+    struct ApplicationPacket PacketData;
+    float ChargingVolt, ChargingAmp;
+
+    memset(TmpBuf, 0, sizeof(TmpBuf));
+    memset(&PacketData, 0, sizeof(struct ApplicationPacket));
+
+    ChargingVolt = ChargingData[PlugNum - 1]->EvBatterytargetVoltage;
+    ChargingAmp = ChargingData[PlugNum - 1]->EvBatterytargetCurrent;
+    ChargingVolt *= 10;
+    ChargingAmp *= 10;
+    TmpBuf[0] = ((unsigned short)ChargingVolt >> 8) & 0xFF;
+    TmpBuf[1] = ((unsigned short)ChargingVolt) & 0xFF;
+    TmpBuf[2] = ((unsigned short)ChargingAmp >> 8) & 0xFF;
+    TmpBuf[3] = ((unsigned short)ChargingAmp) & 0xFF;
+#ifdef Debug
+    printf("WriteChargingTarget(%d), EvBatterytargetVoltage=%f,EvBatteryMaxVoltage=%f => ",
+           PlugNum, ChargingData[PlugNum - 1]->EvBatterytargetVoltage, ChargingData[PlugNum - 1]->EvBatteryMaxVoltage);
+#endif
+    if (SendPacket(PlugNum, 0x02, 0x06, 4, TmpBuf) <= 0) {
+#ifdef Debug
+        printf("SendPacket Fail\n");
+#endif
+        return -1;
+    }
+    if (RecvPacket(&Tmp, &PacketData) <= 0) {
+#ifdef Debug
+        printf("RecvPacket Fail\n");
+#endif
+        return -1;
+    }
+    if (PacketData.Data[0] != 1) { //!=OK
+#ifdef Debug
+        printf("NG\n");
+#endif
+        return -1;
+    }
+#ifdef Debug
+    printf("ChargingVolt=%f, ChargingAmp=%f\n", ChargingVolt / 10, ChargingAmp / 10);
+#endif
+
+    return 1;
+}
+int ReadSoftwareUpdate()
+{
+    unsigned char Tmp = 0;
+    struct ApplicationPacket PacketData;
+
+    memset(&PacketData, 0, sizeof(struct ApplicationPacket));
+
+    if (SendPacket(0x01, 0x01, 0x07, 0, PacketData.Data) <= 0) {
+        return -1;
+    }
+    if (RecvPacket(&Tmp, &PacketData) <= 0) {
+        return -1;
+    }
+    if (PacketData.Data[0] != 1) { //!=OK
+        return -1;
+    }
+    if (PacketData.Data[1] != 0x01) { //not update
+        return -1;
+    }
+    return PacketData.Data[1];
+}
+int WritePlugInStatus(unsigned char PlugNum)
+{
+    unsigned char Tmp = 0;
+    unsigned char TmpBuf[255];
+    struct ApplicationPacket PacketData;
+
+    memset(TmpBuf, 0, sizeof(TmpBuf));
+    memset(&PacketData, 0, sizeof(struct ApplicationPacket));
+    TmpBuf[0] = ChargingData[PlugNum - 1]->ConnectorPlugIn;
+#ifdef Debug
+    printf("WritePlugInStatus(%d) =>", PlugNum);
+#endif
+    if (SendPacket(PlugNum, 0x02, 0x08, 1, TmpBuf) <= 0) {
+#ifdef Debug
+        printf("SendPacket Fail\n");
+#endif
+        return -1;
+    }
+    if (RecvPacket(&Tmp, &PacketData) <= 0) {
+#ifdef Debug
+        printf("RecvPacket Fail\n");
+#endif
+        return -1;
+    }
+    if (PacketData.Data[0] != 1) { //!=OK
+#ifdef Debug
+        printf("NG\n");
+#endif
+        return -1;
+    }
+#ifdef Debug
+    printf(" %s\n", TmpBuf[0] == 1 ? "Plug-in" : "Un-plug");
+#endif
+
+    return 1;
+}
+
+int WriteConnectorState(unsigned char PlugNum)
+{
+    unsigned char Tmp = 0;
+    unsigned char TmpBuf[255];
+    struct ApplicationPacket PacketData;
+
+
+    memset(TmpBuf, 0, sizeof(TmpBuf));
+    memset(&PacketData, 0, sizeof(struct ApplicationPacket));
+
+    if (ChargingData[PlugNum - 1]->SystemStatus <= 2) {
+        TmpBuf[0] = 0;    //idle
+    } else if ((ChargingData[PlugNum - 1]->SystemStatus <= 7) || (ChargingData[PlugNum - 1]->SystemStatus == 17) || (ChargingData[PlugNum - 1]->SystemStatus == 18)) {
+        TmpBuf[0] = 1;    //preparing
+    } else if (ChargingData[PlugNum - 1]->SystemStatus == 8) {
+        TmpBuf[0] = 2;    //charging
+    } else if (ChargingData[PlugNum - 1]->SystemStatus == 9) {
+        TmpBuf[0] = 3;    //terminating
+    }
+
+#ifdef Debug
+    printf("WriteConnectorState(%d) SystemStatus=%d,TmpBuf[0]=%d => ", PlugNum, ChargingData[PlugNum - 1]->SystemStatus, TmpBuf[0]);
+#endif
+    if (SendPacket(PlugNum, 0x02, 0x09, 1, TmpBuf) <= 0) {
+#ifdef Debug
+        printf("SendPacket Fail\n");
+#endif
+        return -1;
+    }
+    if (RecvPacket(&Tmp, &PacketData) <= 0) {
+#ifdef Debug
+        printf("RecvPacket Fail\n");
+#endif
+        return -1;
+    }
+    if (PacketData.Data[0] != 1) { //!=OK
+#ifdef Debug
+        printf("NG\n");
+#endif
+        return -1;
+    }
+#ifdef Debug
+    printf(" %d\n", TmpBuf[0]);
+#endif
+
+    return 1;
+}
+
+int WriteUserID(unsigned char ConnectorID, unsigned char *UserID)
+{
+    unsigned char Tmp = 0;
+    unsigned char TmpBuf[255];
+    struct ApplicationPacket PacketData;
+
+    if (strlen(UserID) <= 0) {
+        return -1;
+    }
+    memset(TmpBuf, 0, sizeof(TmpBuf));
+    memset(&PacketData, 0, sizeof(struct ApplicationPacket));
+    strcpy(TmpBuf, UserID);
+#ifdef Debug
+    printf("WriteUserID(%d) => ", ConnectorID);
+#endif
+    if (SendPacket(ConnectorID, 0x02, 0x0A, strlen(TmpBuf), TmpBuf) <= 0) {
+#ifdef Debug
+        printf("SendPacket Fail\n");
+#endif
+        return -1;
+    }
+    if (RecvPacket(&Tmp, &PacketData) <= 0) {
+#ifdef Debug
+        printf("RecvPacket Fail\n");
+#endif
+        return -1;
+    }
+    if (PacketData.Data[0] != 1) { //!=OK
+#ifdef Debug
+        printf("NG\n");
+#endif
+        return -1;
+    }
+#ifdef Debug
+    printf(" StartUserId=%s, PacketData.Data[1]=%d\n", TmpBuf, PacketData.Data[1]);
+#endif
+    return PacketData.Data[1];
+}
+
+int ReadChargePermission(unsigned char PlugNum)
+{
+    unsigned char Tmp = 0;
+    struct ApplicationPacket PacketData;
+
+
+    memset(&PacketData, 0, sizeof(struct ApplicationPacket));
+#ifdef Debug
+    printf("ReadChargePermission[%d] => ", PlugNum);
+#endif
+    if (SendPacket(PlugNum, 0x01, 0x0B, 0, PacketData.Data) <= 0) {
+#ifdef Debug
+        printf("SendPacket Fail\n");
+#endif
+        return -1;
+    }
+    if (RecvPacket(&Tmp, &PacketData) <= 0) {
+#ifdef Debug
+        printf("RecvPacket Fail\n");
+#endif
+        return -1;
+    }
+    if (PacketData.Data[0] != 1) { //!=OK
+#ifdef Debug
+        printf("NG\n");
+#endif
+        return -1;
+    }
+#ifdef Debug
+    printf(" %s\n", PacketData.Data[1] == 1 ? "Permitted" : "NOT permitted" );
+#endif
+
+    return PacketData.Data[1];
+}
+
+int FindChargingInfoData(byte target, struct ChargingInfoData **chargingData)
+{
+    for (byte index = 0; index < CHAdeMO_QUANTITY; index++) {
+        if (ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].Index == target) {
+            chargingData[target] = &ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index];
+            return 1;
+        }
+    }
+
+    for (byte index = 0; index < CCS_QUANTITY; index++) {
+        if (ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].Index == target) {
+            chargingData[target] = &ShmSysConfigAndInfo->SysInfo.CcsChargingData[index];
+            return 1;
+        }
+    }
+
+    for (byte index = 0; index < GB_QUANTITY; index++) {
+        if (ShmSysConfigAndInfo->SysInfo.GbChargingData[index].Index == target) {
+            chargingData[target] = &ShmSysConfigAndInfo->SysInfo.GbChargingData[index];
+            return 1;
+        }
+    }
+
+    return 0;
+}
+
+int MessageTrigger(unsigned char connectorID)
+{
+    struct timeb  NowTime;
+    unsigned char Reg;
+    for (Reg = 0; Reg < TriggerMsgeNum; Reg++) {
+        ftime(&NowTime);
+        switch (Reg) {
+        case 3://ReadDoStatus
+            if (DiffTimeb(TriggerTimeUp[connectorID - 1][Reg], NowTime) > 1000) {
+                if (ReadDoStatus()) {
+                    ftime(&TriggerTimeUp[connectorID - 1][Reg]);
+                }
+            }
+            break;
+        case 4://WriteDdStatus
+            if (DiffTimeb(TriggerTimeUp[connectorID - 1][Reg], NowTime) > 1000) {
+                if (WriteDdStatus()) {
+                    ftime(&TriggerTimeUp[connectorID - 1][Reg]);
+                }
+            }
+            break;
+        /*case 5://ReadChargingCapability
+            if(DiffTimeb(TriggerTimeUp[connectorID-1][Reg],NowTime)>200)
+            {
+                if(ReadChargingCapability(connectorID))
+                {
+                    ftime(&TriggerTimeUp[connectorID-1][Reg]);
+                }
+            }
+            break;
+        case 6://WriteChargingTarget
+            if(DiffTimeb(TriggerTimeUp[connectorID-1][Reg],NowTime)>100)
+            {
+                if(WriteChargingTarget(connectorID))
+                {
+                    ftime(&TriggerTimeUp[connectorID-1][Reg]);
+                }
+            }
+            break;*/
+        case 8://WritePlugInStatus
+            if (DiffTimeb(TriggerTimeUp[connectorID - 1][Reg], NowTime) > 1000) {
+                if (WritePlugInStatus(connectorID)) {
+                    ftime(&TriggerTimeUp[connectorID - 1][Reg]);
+                }
+            }
+            break;
+        case 9://WriteConnectorState
+            if (DiffTimeb(TriggerTimeUp[connectorID - 1][Reg], NowTime) > 1000) {
+                if (WriteConnectorState(connectorID)) {
+                    ftime(&TriggerTimeUp[connectorID - 1][Reg]);
+                }
+            }
+            break;
+        /*case 0x0B://ReadChargePermission
+            if(DiffTimeb(TriggerTimeUp[connectorID-1][Reg],NowTime)>1000)
+            {
+                if(ReadChargePermission(connectorID))
+                {
+                    ftime(&TriggerTimeUp[connectorID-1][Reg]);
+                }
+            }
+            break;*/
+        default:
+            break;
+        }
+    }
+}
+
+int main(int argc, char *argv[])
+{
+    unsigned char Tmp, PlugNum;
+    int Rtn;
+    struct timeb  AuthNowTime;
+
+    /**************** Initialization **********/
+    if (InitShareMemory() == 0) {
+#ifdef SystemLogMessage
+        DEBUG_ERROR("InitShareMemory NG\n");
+#endif
+        if (ShmStatusCodeData != NULL) {
+            ShmStatusCodeData->AlarmCode.AlarmEvents.bits.FailToCreateShareMemory = 1;
+        }
+        sleep(5);
+        return 0;
+    }
+
+ReConnect:
+    memset(&PreSysWarningInfo, 0, sizeof(struct WARNING_CODE_INFO));
+    PacketSe = 0;
+    DisconnectFlag = 0;
+    for (byte _index = 0; _index < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; _index++) {
+        if (!FindChargingInfoData(_index, &ChargingData[0])) {
+            DEBUG_ERROR("FindChargingInfoData false \n");
+            break;
+        }
+    }
+
+    /**************** Check Network **********/
+    DEBUG_INFO("Check Dispenser Network Information");
+    while (!CheckNetworkStatus()) {
+        sleep(1);
+        if (DisconnectFlag >= 10) {
+            ShmStatusCodeData->AlarmCode.AlarmEvents.bits.DisconnectedFromDo = 1;
+        } else {
+            DisconnectFlag++;
+        }
+    }
+    DEBUG_INFO("Dispenser Network Information checked: IP=%s Netmask=%s, Gateway=%s",
+               ShmSysConfigAndInfo->SysConfig.Eth0Interface.EthIpAddress,
+               ShmSysConfigAndInfo->SysConfig.Eth0Interface.EthSubmaskAddress,
+               ShmSysConfigAndInfo->SysConfig.Eth0Interface.EthGatewayAddress);
+
+    /**************** Power cabinet connection **********/
+    DEBUG_INFO("Connect to Power Cabinet");
+    while (TcpConnected() < 0) {
+        sleep(1);
+        if (DisconnectFlag >= 5) {
+            ShmStatusCodeData->AlarmCode.AlarmEvents.bits.DisconnectedFromDo = 1;
+        } else {
+            DisconnectFlag++;
+        }
+    }
+    DEBUG_INFO("Power cabinet connected(TcpSock=%d): IP=%s Netmask=%s, Gateway=%s",
+               TcpSock,
+               ShmSysConfigAndInfo->SysConfig.Eth0Interface.EthIpAddress,
+               ShmSysConfigAndInfo->SysConfig.Eth0Interface.EthSubmaskAddress,
+               ShmSysConfigAndInfo->SysConfig.Eth0Interface.EthGatewayAddress);
+
+    /**************** Write Model Name**********/
+    DEBUG_INFO("Write Model Name");
+    while (WriteModelName() < 0) {
+        sleep(1);
+        if (DisconnectFlag >= 5) {
+            ShmStatusCodeData->AlarmCode.AlarmEvents.bits.DisconnectedFromDo = 1;
+        } else {
+            DisconnectFlag++;
+        }
+    }
+    DEBUG_INFO("Write Model Name OK: %s", ShmSysConfigAndInfo->SysConfig.ModelName);
+
+    /**************** Get Connector ID**********/
+    DEBUG_INFO("Get Connector ID");
+    while (ReadConnectorID() < 0) {
+        sleep(1);
+        if (DisconnectFlag >= 5) {
+            ShmStatusCodeData->AlarmCode.AlarmEvents.bits.DisconnectedFromDo = 1;
+        } else {
+            DisconnectFlag++;
+        }
+    }
+    DEBUG_INFO("Get Connector ID OK");
+    /*while(1)
+    {
+        //for self testin main.c
+        if(ShmSysConfigAndInfo->SysInfo.SelfTestSeq >= _STEST_PSU_DETECT)
+        {
+            ShmSysConfigAndInfo->SysInfo.SelfTestSeq = _STEST_PSU_CAP;
+            break;
+        }
+    }*/
+    for (Tmp = 0; Tmp < TriggerMsgeNum; Tmp++) {
+        ftime(&TriggerTimeUp[0][Tmp]);
+        ftime(&TriggerTimeUp[1][Tmp]);
+        usleep(50000);
+    }
+    ShmStatusCodeData->AlarmCode.AlarmEvents.bits.DisconnectedFromDo = 0;
+    DEBUG_INFO("Start Communication");
+    /**************** Data transmission**********/
+    while (1) {
+        if ((ShmOCPP16Data->SpMsg.bits.AuthorizeReq == 1) || (ShmSysConfigAndInfo->SysInfo.AuthorizeFlag == 1)) {
+            ftime(&AuthNowTime);
+            if (DiffTimeb(TriggerTimeUp[0][10], AuthNowTime) > 1000) {
+                Rtn = WriteUserID(ShmSysConfigAndInfo->SysInfo.CurGunSelected, ShmSysConfigAndInfo->SysConfig.UserId);
+                if (Rtn >= 0) {
+                    memset(ShmOCPP16Data->Authorize.ResponseIdTagInfo.Status, 0, sizeof(ShmOCPP16Data->Authorize.ResponseIdTagInfo.Status));
+                    if (Rtn == 0) {
+                        strcpy(ShmOCPP16Data->Authorize.ResponseIdTagInfo.Status, "Invalid");
+                    } else {
+                        strcpy(ShmOCPP16Data->Authorize.ResponseIdTagInfo.Status, "Accepted");
+                    }
+                    ShmOCPP16Data->SpMsg.bits.AuthorizeConf = 1; //isAuthorizedComplete
+                    ShmOCPP16Data->SpMsg.bits.AuthorizeReq = 0;
+                    ShmSysConfigAndInfo->SysInfo.AuthorizeFlag = 0;
+                    ShmPsuData->SystemAvailablePower = 0;
+                    ShmPsuData->SystemPresentPsuQuantity = 0;
+                }
+                ftime(&TriggerTimeUp[0][10]);
+            }
+        }
+
+        for (PlugNum = 1; PlugNum <= ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; PlugNum++) {
+            //printf("ChargingData[PlugNum-1]->SystemStatus=%d\n",ChargingData[PlugNum-1]->SystemStatus);
+            //printf("ShmOCPP16Data->SpMsg.bits.AuthorizeReq=%d\n",ShmOCPP16Data->SpMsg.bits.AuthorizeReq);
+            //printf("ShmSysConfigAndInfo->SysInfo.AuthorizeFlag=%d\n",ShmSysConfigAndInfo->SysInfo.AuthorizeFlag);
+            //printf("ChargingData[%d]->FireChargingVoltage=%f\n",PlugNum,ChargingData[PlugNum-1]->FireChargingVoltage);
+            //printf("ChargingData[%d]->PresentChargingCurrent=%f\n",PlugNum,ChargingData[PlugNum-1]->PresentChargingCurrent);
+            switch (ChargingData[PlugNum - 1]->SystemStatus) {
+            case S_IDLE:
+            case S_RESERVATION:
+            case S_MAINTAIN:
+            case S_ALARM:
+            case S_AUTHORIZING:
+                if ((ShmOCPP16Data->SpMsg.bits.AuthorizeReq == 1) || (ShmSysConfigAndInfo->SysInfo.AuthorizeFlag == 1)) {
+                    ftime(&AuthNowTime);
+                    if (DiffTimeb(TriggerTimeUp[PlugNum - 1][10], AuthNowTime) > 1000) {
+                        Rtn = WriteUserID(ShmSysConfigAndInfo->SysInfo.CurGunSelected, ShmSysConfigAndInfo->SysConfig.UserId);
+                        if (Rtn >= 0) {
+                            memset(ShmOCPP16Data->Authorize.ResponseIdTagInfo.Status, 0, sizeof(ShmOCPP16Data->Authorize.ResponseIdTagInfo.Status));
+                            if (Rtn == 0) {
+                                strcpy(ShmOCPP16Data->Authorize.ResponseIdTagInfo.Status, "Invalid");
+                            } else {
+                                strcpy(ShmOCPP16Data->Authorize.ResponseIdTagInfo.Status, "Accepted");
+                            }
+                            ShmOCPP16Data->SpMsg.bits.AuthorizeConf = 1; //isAuthorizedComplete
+                            ShmOCPP16Data->SpMsg.bits.AuthorizeReq = 0;
+                            ShmSysConfigAndInfo->SysInfo.AuthorizeFlag = 0;
+                            ShmPsuData->SystemAvailablePower = 0;
+                            ShmPsuData->SystemPresentPsuQuantity = 0;
+                            ftime(&TriggerTimeUp[PlugNum - 1][10]);
+
+                        }
+                        ftime(&TriggerTimeUp[PlugNum - 1][10]);
+                    }
+                }
+                /*if(ReadSoftwareUpdate())//0x07
+                {
+                    //firmware update
+                }*/
+                break;
+            case S_PREPARNING: //get permission
+                //printf("S_PREPARNING\n");
+                ftime(&AuthNowTime);
+                if (DiffTimeb(TriggerTimeUp[PlugNum - 1][11], AuthNowTime) > 1000) {
+                    if ((ReadChargePermission(PlugNum)) && (ReadChargingCapability(PlugNum))) {
+                        ShmPsuData->SystemAvailablePower = ChargingData[0]->AvailableChargingPower + ChargingData[1]->AvailableChargingPower;
+                        ShmPsuData->SystemPresentPsuQuantity = ShmPsuData->SystemAvailablePower / 30;
+                    }
+                    ftime(&TriggerTimeUp[PlugNum - 1][11]);
+                }
+                break;
+            case S_PREPARING_FOR_EV://wait connector lock
+                //printf("S_PREPARING_FOR_EV\n");
+                ftime(&AuthNowTime);
+                if (DiffTimeb(TriggerTimeUp[PlugNum - 1][5], AuthNowTime) > 1000) {
+                    ReadChargingCapability(PlugNum);
+                    ftime(&TriggerTimeUp[PlugNum - 1][5]);
+                }
+                ftime(&AuthNowTime);
+                if (DiffTimeb(TriggerTimeUp[PlugNum - 1][11], AuthNowTime) > 1000) {
+                    if (ReadChargePermission(PlugNum) == 0) {
+                        DEBUG_INFO("Stop charging by power cabinet's permission");
+                        ChargingData[PlugNum - 1]->StopChargeFlag = 1;
+                    }
+                    ftime(&TriggerTimeUp[PlugNum - 1][11]);
+                }
+                break;
+            case S_PREPARING_FOR_EVSE: //insaulation test
+            case S_CCS_PRECHARGE_ST0:
+            case S_CCS_PRECHARGE_ST1:
+                //printf("S_PREPARING_FOR_EVSE\n");
+                WriteChargingTarget(PlugNum);
+                ftime(&AuthNowTime);
+                if (DiffTimeb(TriggerTimeUp[PlugNum - 1][5], AuthNowTime) > 1000) {
+                    ReadChargingCapability(PlugNum);
+                    ftime(&TriggerTimeUp[PlugNum - 1][5]);
+                }
+                ftime(&AuthNowTime);
+                if (DiffTimeb(TriggerTimeUp[PlugNum - 1][11], AuthNowTime) > 1000) {
+                    if (ReadChargePermission(PlugNum) == 0) {
+                        DEBUG_INFO("Stop charging by power cabinet's permission");
+                        ChargingData[PlugNum - 1]->StopChargeFlag = 1;
+                    }
+                    ftime(&TriggerTimeUp[PlugNum - 1][11]);
+                }
+                break;
+            case S_CHARGING: //charging
+            case S_TERMINATING:
+                //printf("S_CHARGING,S_TERMINATING\n");
+                ftime(&AuthNowTime);
+                if (DiffTimeb(TriggerTimeUp[PlugNum - 1][5], AuthNowTime) > 1000) {
+                    ReadChargingCapability(PlugNum);
+                    ftime(&TriggerTimeUp[PlugNum - 1][5]);
+                }
+                ftime(&AuthNowTime);
+                if (DiffTimeb(TriggerTimeUp[PlugNum - 1][11], AuthNowTime) > 1000) {
+                    if (ReadChargePermission(PlugNum) == 0) {
+                        DEBUG_INFO("Stop charging by power cabinet's permission");
+                        ChargingData[PlugNum - 1]->StopChargeFlag = 1;
+                    }
+                    ftime(&TriggerTimeUp[PlugNum - 1][11]);
+                }
+                WriteChargingTarget(PlugNum);
+                //printf("ChargingData[%d]->FireChargingVoltage=%f\n",PlugNum,ChargingData[PlugNum-1]->FireChargingVoltage);
+                //printf("ChargingData[%d]->PresentChargingCurrent=%f\n",PlugNum,ChargingData[PlugNum-1]->PresentChargingCurrent);
+                break;
+            default:
+                break;
+            }//switch   case
+            MessageTrigger(PlugNum);
+        }//for connector #
+        if (DisconnectFlag >= 10) {
+            if (ShmStatusCodeData->AlarmCode.AlarmEvents.bits.DisconnectedFromDo == 0) {
+                ShmStatusCodeData->AlarmCode.AlarmEvents.bits.DisconnectedFromDo = 1;
+                DEBUG_INFO("Disconnected from power cabinet...re-connecting");
+            }
+            goto ReConnect;
+        }
+    }//while(1)
+}

EVSE/Projects/DD360ComBox/Apps/Ev_Comm.c

@@ -0,0 +1,196 @@
+#include "Module_EvComm.h"
+#include 	<linux/can.h>
+#include 	<linux/can/raw.h>
+#include 	<string.h>
+#include    <stdio.h>      /*標準輸入輸出定義*/
+#include    <stdlib.h>     /*標準函數庫定義*/
+#include    <unistd.h>     /*Unix 標準函數定義*/
+#include    <fcntl.h>      /*檔控制定義*/
+#include    <termios.h>    /*PPSIX 終端控制定義*/
+#include    <errno.h>      /*錯誤號定義*/
+
+//================================================
+//================================================
+// CANBUS send cmd
+//================================================
+//================================================
+
+int PackageIdCmd(int cmd)
+{
+	return cmd | 0x80000000;
+}
+
+void SendCmdToEvboard(int cmd, byte *data, byte dataLen)
+{
+    struct can_frame frame;
+
+    frame.can_id = cmd;
+    frame.can_dlc = dataLen;
+    memcpy(frame.data, data, sizeof(frame.data));
+
+    write(CanFd, &frame, sizeof(struct can_frame));
+}
+
+void SetTargetAddr(byte *target_number, byte index)
+{
+	int id = PackageIdCmd(Ev_Cmd.address_assignment + index);
+	//printf("intCmd = %x \n", cmd & CAN_EFF_MASK);
+	//cmd = cmd & CAN_EFF_MASK;
+
+	byte data[8];
+
+	data[0] = *target_number;
+	data[1] = *(target_number + 1);
+	data[2] = *(target_number + 2);
+	data[3] = *(target_number + 3);
+	data[4] = index;
+
+	SendCmdToEvboard(id, data, 5);
+}
+
+void GetFirmwareVersion(byte gun_index, byte toId)
+{
+	int id = PackageIdCmd(Ev_Cmd.get_firmware_ver + toId);
+	byte data[8];
+
+	SendCmdToEvboard(id, data, 0);
+}
+
+void SyncRtcInfo(byte gun_index, byte toId, int epoch)
+{
+	int id = PackageIdCmd(Ev_Cmd.sync_rtc_info + toId);
+	byte data[8];
+
+	data[0] = epoch & 0xff;
+	data[1] = (epoch >> 8) & 0xff;
+	data[2] = (epoch >> 16) & 0xff;
+	data[3] = (epoch >> 24) & 0xff;
+
+	SendCmdToEvboard(id, data, 4);
+}
+
+void GetHardwareVersion(byte gun_index, byte toId)
+{
+	int id = PackageIdCmd(Ev_Cmd.get_hardware_ver + toId);
+	byte data[8];
+
+	SendCmdToEvboard(id, data, 0);
+}
+
+void SetChargingPermission(byte gun_index, byte permissionStatus, short aOutputPw, short aOutputCur, short aOutputVol, byte toId)
+{
+	int id = PackageIdCmd(Ev_Cmd.charging_permission + toId);
+	byte data[8];
+
+	data[0] = permissionStatus;
+	data[1] = aOutputPw & 0xff;
+	data[2] = (aOutputPw >> 8) & 0xff;
+	data[3] = aOutputCur & 0xff;
+	data[4] = (aOutputCur >> 8) & 0xff;
+	data[5] = aOutputVol & 0xff;
+	data[6] = (aOutputVol >> 8) & 0xff;
+	data[7] = 0xf0;
+
+	SendCmdToEvboard(id, data, sizeof(data));
+}
+
+void SetPresentOutputPower(short outputVol_b1, short outputCur_b1, short outputVol_b2, short outputCur_b2)
+{
+	int id = PackageIdCmd(Ev_Cmd.present_output_power);
+	byte data[8];
+
+	data[0] = outputVol_b1 & 0xff;
+	data[1] = (outputVol_b1 >> 8) & 0xff;
+	data[2] = outputCur_b1 & 0xff;
+	data[3] = (outputCur_b1 >> 8) & 0xff;
+	data[4] = outputVol_b2 & 0xff;
+	data[5] = (outputVol_b2 >> 8) & 0xff;
+	data[6] = outputCur_b2 & 0xff;
+	data[7] = (outputCur_b2 >> 8) & 0xff;
+
+	SendCmdToEvboard(id, data, 8);
+}
+
+void SetPresentOutputCapacity(short aOutputPw_b1, short aOutputCur_b1, short aOutputPw_b2, short aOutputCur_b2)
+{
+	int id = PackageIdCmd(Ev_Cmd.present_output_cap);
+	byte data[8];
+
+	data[0] = aOutputPw_b1 & 0xff;
+	data[1] = (aOutputPw_b1 >> 8) & 0xff;
+	data[2] = aOutputCur_b1 & 0xff;
+	data[3] = (aOutputCur_b1 >> 8) & 0xff;
+	data[4] = aOutputPw_b2 & 0xff;
+	data[5] = (aOutputPw_b2 >> 8) & 0xff;
+	data[6] = aOutputCur_b2 & 0xff;
+	data[7] = (aOutputCur_b2 >> 8) & 0xff;
+
+	SendCmdToEvboard(id, data, 8);
+}
+
+void GetOutputReq(byte gun_index, byte toId)
+{
+	int id = PackageIdCmd(Ev_Cmd.get_output_req + toId);
+	byte data[8];
+
+	SendCmdToEvboard(id, data, 0);
+}
+
+void GetEvBatteryInfo(byte gun_index, byte toId)
+{
+	int id = PackageIdCmd(Ev_Cmd.get_battery_info + toId);
+	byte data[8];
+
+	SendCmdToEvboard(id, data, 0);
+}
+
+void EvseStopChargingEvent(byte stopResult, byte *stopReason, byte toId)
+{
+	int id = PackageIdCmd(Ev_Cmd.evse_stop_charging + toId);
+	byte data[8];
+
+	data[0] = stopResult;
+	data[1] = *stopReason;
+	data[2] = *(stopReason + 1);
+	data[3] = *(stopReason + 2);
+	data[4] = *(stopReason + 3);
+	data[5] = *(stopReason + 4);
+	data[6] = *(stopReason + 5);
+
+	SendCmdToEvboard(id, data, 7);
+}
+
+void GetMiscellaneousInfo(byte gun_index, byte relayStatus, float power, float voltage, byte toId)
+{
+	int id = PackageIdCmd(Ev_Cmd.get_miscellaneous_info + toId);
+	byte data[8];
+
+	int _power = power * 10;
+
+	data[0] = relayStatus;
+	data[1] = (int)_power & 0xff;
+	data[2] = ((int)_power >> 8) & 0xff;
+	data[3] = (int)voltage & 0xff;
+	data[4] = ((int)voltage >> 8) & 0xff;
+
+	SendCmdToEvboard(id, data, 5);
+}
+
+void SetIsolationStatus(byte gun_index, byte result, byte toId)
+{
+	int id = PackageIdCmd(Ev_Cmd.isolation_status + toId);
+	byte data[8];
+
+	data[0] = result;
+	SendCmdToEvboard(id, data, 1);
+}
+
+void SetEvsePrechargeInfo(byte gun_index, byte result, byte toId)
+{
+	int id = PackageIdCmd(Ev_Cmd.evse_precharge_info + toId);
+	byte data[8];
+
+	data[0] = result;
+	SendCmdToEvboard(id, data, 1);
+}
+

EVSE/Projects/DD360ComBox/Apps/FactoryConfig.c

@@ -0,0 +1,307 @@
+#include    <sys/time.h>
+#include    <sys/timeb.h>
+#include    <sys/types.h>
+#include    <sys/stat.h>
+#include    <sys/types.h>
+#include    <sys/ioctl.h>
+#include    <sys/socket.h>
+#include    <sys/ipc.h>
+#include    <sys/shm.h>
+#include    <sys/shm.h>
+#include    <sys/mman.h>
+#include    <linux/can.h>
+#include    <linux/can/raw.h>
+#include    <linux/wireless.h>
+#include    <arpa/inet.h>
+#include    <netinet/in.h>
+
+#include    <unistd.h>
+#include    <stdarg.h>
+#include    <stdio.h>      /*標準輸入輸出定義*/
+#include    <stdlib.h>     /*標準函數庫定義*/
+#include    <unistd.h>     /*Unix 標準函數定義*/
+#include    <fcntl.h>      /*檔控制定義*/
+#include    <termios.h>    /*PPSIX 終端控制定義*/
+#include    <errno.h>      /*錯誤號定義*/
+#include    <errno.h>
+#include    <string.h>
+#include    <time.h>
+#include    <ctype.h>
+#include    <ifaddrs.h>
+#include    "../../define.h"
+#include    "Config.h"
+
+#define Debug
+#define ARRAY_SIZE(A)       (sizeof(A) / sizeof(A[0]))
+#define PASS                1
+#define FAIL                -1
+#define OUTPUT_FLASH        0x01
+#define OUTPUT_FILE         0x02
+
+struct SysConfigData            SysConfig;
+
+int StoreLogMsg(const char *fmt, ...);
+
+int StoreLogMsg(const char *fmt, ...)
+{
+    char Buf[4096 + 256];
+    char buffer[4096];
+    va_list args;
+    struct timeb  SeqEndTime;
+    struct tm *tm;
+
+    va_start(args, fmt);
+    int rc = vsnprintf(buffer, sizeof(buffer), fmt, args);
+    va_end(args);
+
+    memset(Buf, 0, sizeof(Buf));
+    ftime(&SeqEndTime);
+    SeqEndTime.time = time(NULL);
+    tm = localtime(&SeqEndTime.time);
+
+    sprintf(Buf, "echo \"%04d-%02d-%02d %02d:%02d:%02d:%03d - %s\" >> /Storage/SystemLog/[%04d.%02d]SystemLog",
+            tm->tm_year + 1900, tm->tm_mon + 1, tm->tm_mday, tm->tm_hour, tm->tm_min, tm->tm_sec, SeqEndTime.millitm,
+            buffer,
+            tm->tm_year + 1900, tm->tm_mon + 1);
+    system(Buf);
+
+    return rc;
+}
+
+void helpOutput(void)
+{
+    printf("Usage: Module_FactoryConfig [OPTION]...\r\n\r\n");
+    printf("Generate factory default configuration value\r\n\r\n");
+    printf("OPTION:\r\n");
+    printf("	-a Write to file(/mnt) & flash\r\n");
+    printf("	-f Write to file(/mnt)\r\n");
+    printf("	-m Write to flash\r\n");
+}
+
+/**************************************************************************************/
+/************This task will create Factory default confgiuration file *****************/
+/***********and store it into mtdblock 10,11,12                               ****************/
+/**************************************************************************************/
+int main(int argc, char *argv[])
+{
+    unsigned char outType = 0;
+    unsigned int i, Chk, MtdBlockSize = 0x600000;
+    unsigned char *ptr;
+    int fd, wrd;
+
+    ptr = malloc(MtdBlockSize);
+    if (ptr == NULL) {
+#ifdef SystemLogMessage
+        StoreLogMsg("[FactoryConfig]main: malloc for SysConfigData NG");
+#endif
+        return 0;
+    }
+    memset(ptr, 0, MtdBlockSize);
+    memset(&SysConfig, 0, sizeof(struct SysConfigData));
+
+    /*
+     * TODO: Set factory default configuration
+    */
+    //********** System **********// udhcpc -i eth1 -s ./dhcp_script/eth1.script
+    //
+    strcpy((char *)SysConfig.ModelName, "DXYE18200EE1E4");
+    strcpy((char *)SysConfig.SerialNumber, "SERIALFORRD");
+
+    memset(SysConfig.SystemId, 0x00, sizeof(SysConfig.SystemId));
+    char Dash = '-';
+
+    strcat((char *)SysConfig.SystemId, (char *)SysConfig.ModelName);
+    strncat((char *)SysConfig.SystemId, &Dash, 1);
+    strcat((char *)SysConfig.SystemId, (char *)SysConfig.SerialNumber);
+
+    strcpy((char *)SysConfig.SystemDateTime, "");
+    SysConfig.AuthorisationMode = AUTH_MODE_ENABLE;
+    SysConfig.DefaultLanguage = 0;
+    SysConfig.RfidCardNumEndian = 0;
+    SysConfig.AcPlugInTimes = 0;
+    SysConfig.GbPlugInTimes = 0;
+    SysConfig.Ccs1PlugInTime = 0;
+    SysConfig.Ccs2PlugInTimes = 0;
+    SysConfig.ChademoPlugInTimes = 0;
+    SysConfig.BillingData.isBilling = 0;
+    SysConfig.isAPP = 1;
+    SysConfig.isQRCode = 1;
+    SysConfig.isRFID = 1;
+    //********** Charging **********//
+    SysConfig.MaxChargingEnergy = 0;
+    SysConfig.MaxChargingCurrent = 500;     // 最大可輸出電流 (整樁)
+    SysConfig.MaxChargingDuration = 0;
+    SysConfig.AcMaxChargingCurrent = 0;
+    SysConfig.PhaseLossPolicy = 0;
+    /*+++ 20200908, vern, modify it +++*/
+    /*for(unsigned char i = 0; i < 10; i++)
+        strcpy((char *)SysConfig.LocalWhiteCard, "");*/
+    memset(SysConfig.LocalWhiteCard, 0, sizeof(SysConfig.LocalWhiteCard));
+    /*--- 20200908, vern, modify it ---*/
+    strcpy((char *)SysConfig.UserId, "");
+    //********** Network **********//
+    strcpy((char *)SysConfig.FtpServer, "");
+    SysConfig.Eth0Interface.EthDhcpClient = 0;
+    strcpy((char *) SysConfig.Eth0Interface.EthIpAddress, "192.168.1.10");
+    strcpy((char *) SysConfig.Eth0Interface.EthSubmaskAddress, "255.255.255.0");
+    strcpy((char *) SysConfig.Eth0Interface.EthGatewayAddress, "192.168.1.254");
+    SysConfig.Eth1Interface.EthDhcpClient = 0;
+    strcpy((char *) SysConfig.Eth1Interface.EthIpAddress, "192.168.0.10");
+    strcpy((char *) SysConfig.Eth1Interface.EthSubmaskAddress, "255.255.255.0");
+    strcpy((char *) SysConfig.Eth1Interface.EthGatewayAddress, "192.168.0.254");
+    if (SysConfig.ModelName[10] == 'W') {
+        SysConfig.AthInterface.WifiMode = 2;
+    } else {
+        SysConfig.AthInterface.WifiMode = 0;
+    }
+    strcpy((char *) SysConfig.AthInterface.WifiSsid, "");
+    strcpy((char *) SysConfig.AthInterface.WifiPassword, "");
+    SysConfig.AthInterface.WifiRssi = 0;
+    SysConfig.AthInterface.WifiDhcpServer = 0;
+    SysConfig.AthInterface.WifiDhcpClient = 0;
+    strcpy((char *) SysConfig.AthInterface.WifiMacAddress, "");
+    strcpy((char *) SysConfig.AthInterface.WifiIpAddress, "");
+    strcpy((char *) SysConfig.AthInterface.WifiSubmaskAddress, "");
+    strcpy((char *) SysConfig.AthInterface.WifiGatewayAddress, "");
+    SysConfig.AthInterface.WifiNetworkConn = 0;
+    strcpy((char *) SysConfig.TelecomInterface.TelcomModelName, "");
+    strcpy((char *) SysConfig.TelecomInterface.TelcomSoftwareVer, "");
+    //strcpy((char *) SysConfig.TelecomInterface.TelcomApn, "Internet");
+    strcpy((char *) SysConfig.TelecomInterface.TelcomApn, "");
+    SysConfig.TelecomInterface.TelcomRssi = 0;
+    strcpy((char *) SysConfig.TelecomInterface.TelcomChapPapId, " ");
+    strcpy((char *) SysConfig.TelecomInterface.TelcomChapPapPwd, " ");
+    strcpy((char *) SysConfig.TelecomInterface.TelcomModemImei, "");
+    strcpy((char *) SysConfig.TelecomInterface.TelcomSimImsi, "");
+    strcpy((char *) SysConfig.TelecomInterface.TelcomSimIccid, "");
+    SysConfig.TelecomInterface.TelcomSimStatus = 0;
+    SysConfig.TelecomInterface.TelcomModemMode = 0;
+    strcpy((char *) SysConfig.TelecomInterface.TelcomIpAddress, "");
+    SysConfig.TelecomInterface.TelcomNetworkConn = 0;
+    strcpy((char *)SysConfig.chargePointVendor, "Phihong Technology");
+    //********** Backend **********//
+    SysConfig.BackendConnTimeout = 300; //300 seconds
+    SysConfig.OfflinePolicy = 2;
+    SysConfig.OfflineMaxChargeEnergy = 0;
+    SysConfig.OfflineMaxChargeDuration = 0;
+    strcpy((char *) SysConfig.OcppServerURL, "");
+    strcpy((char *) SysConfig.ChargeBoxId, "");
+    SysConfig.LedInfo.Intensity = 2;
+
+    //copy default configuration to pointer
+    memcpy(ptr, &SysConfig, sizeof(struct SysConfigData));
+
+    //calculate CRC
+    Chk = 0;
+    for (i = 0; i < (MtdBlockSize - 4); i++) {
+        Chk += *(ptr + i);
+    }
+    memcpy( ptr + MtdBlockSize - 4, &Chk, 4);
+
+    /*
+    * Parameter process
+    */
+    if (argc > 1) {
+        char *arg = argv[1];
+        switch (arg[0]) {
+        case '-':
+            switch (arg[1]) {
+            case 'a':
+                outType |= OUTPUT_FILE;
+                outType |= OUTPUT_FLASH;
+                break;
+            case 'f':
+                outType |= OUTPUT_FILE;
+                break;
+            case 'm':
+                outType |= OUTPUT_FLASH;
+                break;
+            default:
+                helpOutput();
+                break;
+            }
+            break;
+        default:
+            helpOutput();
+            break;
+        }
+    } else {
+        helpOutput();
+    }
+
+    /*
+     * Configuration bin file generate
+    */
+    if ((outType & OUTPUT_FILE) > 0) {
+        fd = open("/mnt/FactoryDefaultConfig.bin", O_RDWR | O_CREAT);
+        if (fd < 0) {
+            StoreLogMsg("[FactoryConfig]main: open /mnt/FactoryDefaultConfig.bin NG");
+            free(ptr);
+            return 0;
+        }
+        wrd = write(fd, ptr, MtdBlockSize);
+        close(fd);
+        if (wrd < MtdBlockSize) {
+            StoreLogMsg("write /mnt/FactoryDefaultConfig.bin NG\r\n");
+            free(ptr);
+            return 0;
+        }
+        StoreLogMsg("FactoryConfig write to file in /mnt OK.\r\n");
+    }
+
+    /*
+    * Flash memory write
+    */
+    if ((outType & OUTPUT_FLASH) > 0) {
+        // Save factory default setting value to flash factory default setting block
+        fd = open("/dev/mtdblock12", O_RDWR);
+        if (fd < 0) {
+            StoreLogMsg("open /dev/mtdblock12 NG\r\n");
+            free(ptr);
+            return 0;
+        }
+        wrd = write(fd, ptr, MtdBlockSize);
+        close(fd);
+        if (wrd < MtdBlockSize) {
+            StoreLogMsg("write /dev/mtdblock12 NG\r\n");
+            free(ptr);
+            return 0;
+        }
+
+        // Save factory default setting value to flash backup setting block
+        fd = open("/dev/mtdblock11", O_RDWR);
+        if (fd < 0) {
+            StoreLogMsg("open /dev/mtdblock11 NG\r\n");
+            free(ptr);
+            return 0;
+        }
+        wrd = write(fd, ptr, MtdBlockSize);
+        close(fd);
+        if (wrd < MtdBlockSize) {
+            StoreLogMsg("write /dev/mtdblock11 NG\r\n");
+            free(ptr);
+            return 0;
+        }
+
+        // Save factory default setting value to flash setting block
+        fd = open("/dev/mtdblock10", O_RDWR);
+        if (fd < 0) {
+            StoreLogMsg("open /dev/mtdblock10 NG\r\n");
+            free(ptr);
+            return 0;
+        }
+        wrd = write(fd, ptr, MtdBlockSize);
+        close(fd);
+        if (wrd < MtdBlockSize) {
+            StoreLogMsg("write /dev/mtdblock10 NG\r\n");
+            free(ptr);
+            return 0;
+        }
+        StoreLogMsg("FactoryConfig write to flash OK\r\n");
+    }
+
+    free(ptr);
+
+    return FAIL;
+}
+

EVSE/Projects/DD360ComBox/Apps/Makefile

@@ -0,0 +1,145 @@
+-include ../../../../Rules.make
+export PATH=/bin:/sbin:/usr/bin:$(SDK_PATH_TARGET)/usr/bin:$PATH
+
+ModularizationPath = ../../../Modularization
+RootPath = ../Images/root
+OutputPath = ../output
+
+DEFINE = -D $(Project)
+
+CFLAGS = -O0 -g3 -Wall -c -fmessage-length=0
+TFLAGS = -lrt -lm -lpthread
+
+#define library variable
+Internal485ProtocolLib = -L $(ModularizationPath)/Internal485Protocol -lInternal485Protocol
+#PsuCommProtocolLib = -L $(ModularizationPath)/PsuCommProtocol -lPsuCommProtocol
+
+#define library variable
+Lib_Module_RFID = "-L$(ModularizationPath)" -lModule_RFID
+RFID_H = -include$(ModularizationPath)/Module_RFID.h
+
+Lib_Module_Upgrade = "-L$(ModularizationPath)" -lModule_Upgrade
+ModuleUpgrade_H = -include$(ModularizationPath)/Module_Upgrade.h
+
+Lib_SQLite3 = "-L$(ModularizationPath)/ocppfiles" -lsqlite3
+SQLite3_H = -include$(ModularizationPath)/ocppfiles/sqlite3.h
+
+Lib_Module_RatedCurrent = "-L$(ModularizationPath)" -lModule_RatedCurrent
+RatedCurrent_H = -include$(ModularizationPath)/Module_RatedCurrent.h
+
+InfypwrPsuComm_H = -include$(ModularizationPath)/Infypwr_PsuCommObj.h
+InfypwrPsuComm_A = $(ModularizationPath)/libInfypwr_PsuCommObj.a
+
+all: CopyFile apps
+#apps: Module_CSU Module_EvComm Module_EventLogging Module_InternalComm Module_LcmControl Module_PrimaryComm Module_PsuComm
+# ReadCmdline kill.sh
+apps: MainTask DoCommTask EvCommTask \
+		EventLoggingTask InternalCommTask LcmControlTask \
+			PrimaryCommTask ReadCmdlineTask UnsafetyOutputTool \
+				FactoryConfigApp OtherTools CleanExec
+
+LOG_INC = Log
+
+MainTask:
+	$(CC) -D $(Project) -includeConfig.h $(SQLite3_H) $(ModuleUpgrade_H) $(RFID_H) $(RatedCurrent_H) $(CFLAGS) -o main.o ReMain.c
+	$(CC) -D $(Project) -includeConfig.h $(SQLite3_H) $(ModuleUpgrade_H) $(RFID_H) $(RatedCurrent_H) $(CFLAGS) -o timeout.o timeout.c
+	$(CC) $(TFLAGS) -o main main.o timeout.o ${Lib_Module_RFID} ${Lib_Module_Upgrade} ${Lib_SQLite3} $(Lib_Module_RatedCurrent)
+
+DoCommTask:
+	$(CC) -D $(Project) -includeConfig.h $(CFLAGS) -o DoComm.o ReDoComm.c
+	$(CC) -o DoComm DoComm.o
+
+EvCommTask:
+	$(CC) -D $(Project) -includeConfig.h $(CFLAGS) -o Ev_Comm.o Ev_Comm.c
+	$(CC) -D $(Project) -includeConfig.h $(CFLAGS) -o Module_EvComm.o ReModule_EvComm.c
+	$(CC) -o Module_EvComm Ev_Comm.o Module_EvComm.o
+
+EventLoggingTask:
+	$(CC) -D $(Project) -includeConfig.h $(SQLite3_H) $(CFLAGS) -o Module_EventLogging.o ReModule_EventLogging.c
+	$(CC) -o Module_EventLogging Module_EventLogging.o ${Lib_SQLite3}
+
+InternalCommTask:
+	$(CC) -D $(Project) -includeConfig.h $(CFLAGS) -o internalComm.o internalComm.c
+	$(CC) -D $(Project) -includeConfig.h $(CFLAGS) -o Module_InternalComm.o ReModule_InternalComm.c
+	$(CC) -o Module_InternalComm Module_InternalComm.o internalComm.o
+
+LcmControlTask:
+	$(CC) -D $(Project) -includeConfig.h $(CFLAGS) -o Module_LcmControl.o ReModule_LcmControl.c
+	$(CC) -o Module_LcmControl Module_LcmControl.o
+
+PrimaryCommTask:
+	$(CC) -D $(Project) -includeConfig.h $(CFLAGS) -o Module_PrimaryComm.o ReModule_PrimaryComm.c
+	$(CC) -D $(Project) -includeConfig.h $(CFLAGS) -o PrimaryComm.o PrimaryComm.c
+	$(CC) -o Module_PrimaryComm Module_PrimaryComm.o PrimaryComm.o
+
+PsuCommTask:
+	$(CC) -D $(Project) $(InfypwrPsuComm_H) -includeConfig.h $(CFLAGS) -o Module_PsuComm.o Module_PsuComm.c
+	$(CC) -o Module_PsuComm Module_PsuComm.o $(InfypwrPsuComm_A)
+
+ReadCmdlineTask:
+	$(CC) -D $(Project) -includeConfig.h $(CFLAGS) -o ReadCmdline.o ReadCmdline.c
+	$(CC) -o ReadCmdline ReadCmdline.o
+
+UnsafetyOutputTool:
+	$(CC) -D $(Project) $(InfypwrPsuComm_H) $(CFLAGS) -o OutputTask.o OutputTask.c
+	$(CC) -o UnsafetyOutputTask OutputTask.o $(InfypwrPsuComm_A)
+
+FactoryConfigApp:
+	@echo "===== Module_FactoryConfig_Task =================================="
+	rm -f FactoryConfig
+#	gcc -D $(Project) "-I../../" -o FactoryConfig "./FactoryConfig.c"
+#	mkdir -p /Storage/SystemLog
+#	./FactoryConfig -f;true
+#	cp /mnt/FactoryDefaultConfig.bin ../Images
+#	rm -f FactoryConfig;
+	$(CC) -D $(Project) $(CFLAGS) -o FactoryConfig.o FactoryConfig.c
+	$(CC) -o FactoryConfig FactoryConfig.o
+
+OtherTools:
+	cp -f init.sh $(RootPath)
+	cp -f kill.sh $(RootPath)
+	cp -f web.sh $(RootPath)
+	cp -f main $(RootPath)
+	cp -f DoComm $(RootPath)
+	cp -f Module_EvComm $(RootPath)
+	cp -f Module_EventLogging $(RootPath)
+	cp -f Module_InternalComm $(RootPath)
+	cp -f Module_LcmControl $(RootPath)
+	cp -f Module_PrimaryComm $(RootPath)
+	#cp -f Module_PsuComm $(RootPath)
+	cp -f ReadCmdline $(RootPath)
+	cp -f UnsafetyOutputTask $(RootPath)
+	cp -f FactoryConfig $(RootPath)
+
+	if [ ! -d $(OutputPath) ]; then mkdir -p $(OutputPath); fi
+	cp -f init.sh $(OutputPath)
+	cp -f kill.sh $(OutputPath)
+	cp -f web.sh $(OutputPath)
+	cp -f main $(OutputPath)
+	cp -f DoComm $(OutputPath)
+	cp -f Module_EvComm $(OutputPath)
+	cp -f Module_EventLogging $(OutputPath)
+	cp -f Module_InternalComm $(OutputPath)
+	cp -f Module_LcmControl $(OutputPath)
+	cp -f Module_PrimaryComm $(OutputPath)
+	#cp -f Module_PsuComm $(OutputPath)
+	cp -f ReadCmdline $(OutputPath)
+	cp -f UnsafetyOutputTask $(OutputPath)
+	cp -f FactoryConfig $(OutputPath)
+
+CopyFile:
+	rm -rfv ../Images/root
+	mkdir -p ../Images/root
+
+CleanExec:
+	rm -f *.o
+	rm main
+	rm Module_EvComm
+	rm Module_EventLogging
+	rm Module_InternalComm
+	rm Module_LcmControl
+	rm Module_PrimaryComm
+	#rm Module_PsuComm
+	rm ReadCmdline
+	rm FactoryConfig
+	rm DoComm

EVSE/Projects/DD360ComBox/Apps/Module_EvComm.c

@@ -0,0 +1,2934 @@
+#include    <sys/time.h>
+#include    <sys/timeb.h>
+#include    <sys/types.h>
+#include    <sys/stat.h>
+#include    <sys/types.h>
+#include    <sys/ioctl.h>
+#include    <sys/socket.h>
+#include    <sys/ipc.h>
+#include    <sys/shm.h>
+#include    <sys/shm.h>
+#include    <sys/mman.h>
+#include    <linux/can.h>
+#include    <linux/can/raw.h>
+#include    <linux/wireless.h>
+#include    <arpa/inet.h>
+#include    <netinet/in.h>
+
+#include    <unistd.h>
+#include    <stdarg.h>
+#include    <stdio.h>      /*標準輸入輸出定義*/
+#include    <stdlib.h>     /*標準函數庫定義*/
+#include    <unistd.h>     /*Unix 標準函數定義*/
+#include    <fcntl.h>      /*檔控制定義*/
+#include    <termios.h>    /*PPSIX 終端控制定義*/
+#include    <errno.h>      /*錯誤號定義*/
+#include    <errno.h>
+#include    <string.h>
+#include    <time.h>
+#include    <ctype.h>
+#include    <ifaddrs.h>
+#include    "../../define.h"
+#include    "Module_EvComm.h"
+
+#define ARRAY_SIZE(A)       (sizeof(A) / sizeof(A[0]))
+#define PASS                1
+#define FAIL                -1
+#define START               1
+#define STOP                0
+#define YES                 1
+#define NO                  0
+#define EQUAL               0
+
+struct SysConfigAndInfo         *ShmSysConfigAndInfo;
+struct StatusCodeData           *ShmStatusCodeData;
+struct FanModuleData            *ShmFanModuleData;
+struct CHAdeMOData              *ShmCHAdeMOData;
+struct GBTData                  *ShmGBTData;
+struct CcsData                  *ShmCcsData;
+
+byte gun_count;
+int chargingTime[CHAdeMO_QUANTITY + CCS_QUANTITY + GB_QUANTITY];
+struct timeval _chk_ratingPower_timeout[CHAdeMO_QUANTITY + CCS_QUANTITY + GB_QUANTITY];
+
+float _pow_1 = 0;
+float _cur_1 = 0;
+float _pow_2 = 0;
+float _cur_2 = 0;
+
+float _outVol_1 = 0;
+float _outCur_1 = 0;
+float _outVol_2 = 0;
+float _outCur_2 = 0;
+
+// 限制最大充電電壓，因應不同 type 槍線來限制
+// Chademo : 500V, 125A,
+// GB : 750, 120A
+// CCS : 950V, 120A
+float maxChargingVol[2] = { 5000, 9500 };           // 限制最大充電電壓，如依照模塊則填上 0
+// 限制最大充電電流與能量透過 Web
+float maxChargingCur[2] = { 5000, 1200 };           // 限制最大充電電流，如依照模塊則填上 0
+float maxChargingPow = 0;                           // 限制最大充電能量，如依照模塊則填上 0
+
+// 槍資訊
+struct ChargingInfoData *_chargingData[CHAdeMO_QUANTITY + CCS_QUANTITY + GB_QUANTITY];
+
+struct Ev_Board_Cmd Ev_Cmd = {
+    0,
+    0x00000200,
+    0x00000400,
+    0x00000500,
+    0x00000600,
+    0x00000700,
+    0x00000800,
+    0x00000900,
+    0x00000A00,
+    0x00000C00,
+    0x00000D00,
+
+    0x00000E00,
+    0x00000F00,
+    0x00001000,
+    0x00001100,
+
+    0x00001200,
+    0x00001400,
+    0x00001500,
+};
+
+unsigned char mask_table[] = { 0x01, 0x02, 0x04, 0x08, 0x10, 0x20, 0x40, 0x80 };
+
+void PRINTF_FUNC(char *string, ...);
+
+void GetMaxVolAndCurMethod(byte index, float *vol, float *cur);
+void GetMaxPowerMethod(byte index, float *pow);
+unsigned long GetTimeoutValue(struct timeval _sour_time);
+
+#define DEBUG_INFO(format, args...) StoreLogMsg("[%s:%d][%s][Info] "format, __FILE__, __LINE__, __FUNCTION__, ##args)
+#define DEBUG_WARN(format, args...) StoreLogMsg("[%s:%d][%s][Warn] "format, __FILE__, __LINE__, __FUNCTION__, ##args)
+#define DEBUG_ERROR(format, args...) StoreLogMsg("[%s:%d][%s][Error] "format, __FILE__, __LINE__, __FUNCTION__, ##args)
+
+unsigned long GetTimeoutValue(struct timeval _sour_time)
+{
+    struct timeval _end_time;
+    gettimeofday(&_end_time, NULL);
+
+    return 1000000 * (_end_time.tv_sec - _sour_time.tv_sec) + _end_time.tv_usec - _sour_time.tv_usec;
+}
+
+int StoreLogMsg(const char *fmt, ...)
+{
+    char Buf[4096 + 256];
+    char buffer[4096];
+    va_list args;
+    struct timeb  SeqEndTime;
+    struct tm *tm;
+
+    va_start(args, fmt);
+    int rc = vsnprintf(buffer, sizeof(buffer), fmt, args);
+    va_end(args);
+
+    memset(Buf, 0, sizeof(Buf));
+    ftime(&SeqEndTime);
+    SeqEndTime.time = time(NULL);
+    tm = localtime(&SeqEndTime.time);
+
+    if (ShmSysConfigAndInfo->SysConfig.SwitchDebugFlag == YES) {
+        sprintf(Buf, "%02d:%02d:%02d:%03d - %s",
+                tm->tm_hour, tm->tm_min, tm->tm_sec, SeqEndTime.millitm, buffer);
+        printf("%s \n", Buf);
+    } else {
+        sprintf(Buf, "echo \"%04d-%02d-%02d %02d:%02d:%02d:%03d - %s\" >> /Storage/SystemLog/[%04d.%02d]SystemLog",
+                tm->tm_year + 1900, tm->tm_mon + 1, tm->tm_mday, tm->tm_hour, tm->tm_min, tm->tm_sec, SeqEndTime.millitm,
+                buffer,
+                tm->tm_year + 1900, tm->tm_mon + 1);
+        system(Buf);
+    }
+
+    return rc;
+}
+
+int DiffTimeb(struct timeb ST, struct timeb ET)
+{
+    //return milli-second
+    unsigned int StartTime, StopTime;
+
+    StartTime = (unsigned int)ST.time;
+    StopTime = (unsigned int)ET.time;
+    return (StopTime - StartTime) * 1000 + ET.millitm - ST.millitm;
+}
+
+void PRINTF_FUNC(char *string, ...)
+{
+    va_list args;
+    char buffer[4096];
+    va_start(args, string);
+    vsnprintf(buffer, sizeof(buffer), string, args);
+    va_end(args);
+
+    DEBUG_INFO("%s \n", buffer);
+}
+
+//=================================
+// Common routine
+//=================================
+void getTimeString(char *buff)
+{
+    time_t timep;
+    struct tm *p;
+    time(&timep);
+    p = gmtime(&timep);
+
+    sprintf(buff, "[%04d-%02d-%02d %02d:%02d:%02d]", (1900 + p->tm_year), (1 + p->tm_mon), p->tm_mday, p->tm_hour, p->tm_hour, p->tm_sec);
+}
+
+bool CheckUniqNumber(byte value)
+{
+    for (byte index = 0; index < gun_count; index++) {
+        if (_chargingData[index]->Evboard_id == value) {
+            struct timeval _end_time;
+            gettimeofday(&_end_time, NULL);
+            unsigned long diff = 1000000 *  (_end_time.tv_sec - _id_assign_time.tv_sec) + _end_time.tv_usec - _id_assign_time.tv_usec;
+            if (diff >= 3000000) {
+                gettimeofday(&_id_assign_time, NULL);
+                return true;
+            } else {
+                return false;
+            }
+        }
+    }
+
+    gettimeofday(&_id_assign_time, NULL);
+    return true;
+}
+
+//==========================================
+// Init all share memory
+//==========================================
+int InitShareMemory()
+{
+    int result = PASS;
+    int MeterSMId;
+
+    //initial ShmSysConfigAndInfo
+    if ((MeterSMId = shmget(ShmSysConfigAndInfoKey, sizeof(struct SysConfigAndInfo),  0777)) < 0) {
+#ifdef SystemLogMessage
+        DEBUG_ERROR("shmget ShmSysConfigAndInfo NG\n");
+#endif
+        result = FAIL;
+    } else if ((ShmSysConfigAndInfo = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+#ifdef SystemLogMessage
+        DEBUG_ERROR("shmat ShmSysConfigAndInfo NG\n");
+#endif
+        result = FAIL;
+    } else
+    {}
+
+    //initial ShmStatusCodeData
+    if ((MeterSMId = shmget(ShmStatusCodeKey, sizeof(struct StatusCodeData),  0777)) < 0) {
+#ifdef SystemLogMessage
+        DEBUG_ERROR("shmget ShmStatusCodeData NG\n");
+#endif
+        result = FAIL;
+    } else if ((ShmStatusCodeData = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+#ifdef SystemLogMessage
+        DEBUG_ERROR("shmat ShmStatusCodeData NG\n");
+#endif
+        result = FAIL;
+    } else
+    {}
+
+    if (CHAdeMO_QUANTITY > 0) {
+        if ((MeterSMId = shmget(ShmCHAdeMOCommKey, sizeof(struct CHAdeMOData),  IPC_CREAT | 0777)) < 0) {
+#ifdef SystemLogMessage
+            DEBUG_ERROR("[shmget ShmCHAdeMOData NG \n");
+#endif
+            return FAIL;
+        } else if ((ShmCHAdeMOData = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+#ifdef SystemLogMessage
+            DEBUG_ERROR("shmat ShmCHAdeMOData NG \n");
+#endif
+            return FAIL;
+        } else
+        {}
+    }
+    if (GB_QUANTITY > 0) {
+        if ((MeterSMId = shmget(ShmGBTCommKey, sizeof(struct GBTData),  IPC_CREAT | 0777)) < 0) {
+#ifdef SystemLogMessage
+            DEBUG_ERROR("[shmget ShmGBTData NG \n");
+#endif
+            return FAIL;
+        } else if ((ShmGBTData = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+#ifdef SystemLogMessage
+            DEBUG_ERROR("shmat ShmGBTData NG \n");
+#endif
+            return FAIL;
+        } else
+        {}
+    }
+
+    if (CCS_QUANTITY > 0) {
+        if ((MeterSMId = shmget(ShmCcsCommKey, sizeof(struct CcsData),  IPC_CREAT | 0777)) < 0) {
+#ifdef SystemLogMessage
+            DEBUG_ERROR("shmget ShmCcsData NG \n");
+#endif
+            return FAIL;
+        } else if ((ShmCcsData = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+#ifdef SystemLogMessage
+            DEBUG_ERROR("shmat ShmCcsData NG \n");
+#endif
+            return FAIL;
+        } else
+        {}
+    }
+
+    return result;
+}
+
+//================================================
+// initial can-bus
+//================================================
+int InitCanBus()
+{
+    int                     s0, nbytes;
+    struct timeval          tv;
+    struct ifreq            ifr0;
+    struct sockaddr_can     addr0;
+
+    system("/sbin/ip link set can0 down");
+    system("/sbin/ip link set can0 type can bitrate 500000 restart-ms 100");
+    system("/sbin/ip link set can0 up");
+
+    s0 = socket(PF_CAN, SOCK_RAW, CAN_RAW);
+
+    tv.tv_sec = 0;
+    tv.tv_usec = 10000;
+    if (setsockopt(s0, SOL_SOCKET, SO_RCVTIMEO, (char *)&tv, sizeof(struct  timeval)) < 0) {
+#ifdef SystemLogMessage
+        DEBUG_ERROR("Set SO_RCVTIMEO NG");
+#endif
+    }
+    nbytes = 40960;
+    if (setsockopt(s0, SOL_SOCKET,  SO_RCVBUF, &nbytes, sizeof(int)) < 0) {
+#ifdef SystemLogMessage
+        DEBUG_ERROR("Set SO_RCVBUF NG");
+#endif
+    }
+    nbytes = 40960;
+    if (setsockopt(s0, SOL_SOCKET, SO_SNDBUF, &nbytes, sizeof(int)) < 0) {
+#ifdef SystemLogMessage
+        DEBUG_ERROR("Set SO_SNDBUF NG");
+#endif
+    }
+
+    strcpy(ifr0.ifr_name, "can0" );
+    ioctl(s0, SIOCGIFINDEX, &ifr0); /* ifr.ifr_ifindex gets filled with that device's index */
+    addr0.can_family = AF_CAN;
+    addr0.can_ifindex = ifr0.ifr_ifindex;
+    bind(s0, (struct sockaddr *)&addr0, sizeof(addr0));
+    return s0;
+}
+
+//================================================
+//================================================
+// CANBUS receive task
+//================================================
+//================================================
+bool FindChargingInfoData(byte target, struct ChargingInfoData **chargingData)
+{
+    for (byte index = 0; index < CHAdeMO_QUANTITY; index++) {
+        if (ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].Index == target) {
+            chargingData[target] = &ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index];
+            return true;
+        }
+    }
+
+    for (byte index = 0; index < CCS_QUANTITY; index++) {
+        if (ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].Index == target) {
+            chargingData[target] = &ShmSysConfigAndInfo->SysInfo.CcsChargingData[index];
+            return true;
+        }
+    }
+
+    for (byte index = 0; index < GB_QUANTITY; index++) {
+        if (ShmSysConfigAndInfo->SysInfo.GbChargingData[index].Index == target) {
+            chargingData[target] = &ShmSysConfigAndInfo->SysInfo.GbChargingData[index];
+            return true;
+        }
+    }
+
+    return false;
+}
+
+void AddrAssignment(byte *data)
+{
+    byte target_number[8];
+    byte index = 0x00;
+
+    memcpy(target_number, data, sizeof(target_number));
+    index = *(data + 4);
+
+    if (gun_count == 1) {
+        index = 0x01;
+    }
+//  if (CheckUniqNumber(index))
+    {
+        PRINTF_FUNC("EV board id = %x \n", index);
+//      PRINTF_FUNC("target_number[0] = %x \n", target_number[0]);
+//      PRINTF_FUNC("target_number[1] = %x \n", target_number[1]);
+//      PRINTF_FUNC("target_number[2] = %x \n", target_number[2]);
+//      PRINTF_FUNC("target_number[3] = %x \n", target_number[3]);
+//      PRINTF_FUNC("target_number[4] = %x \n", target_number[4]);
+
+        PRINTF_FUNC("SetTargetAddr = %d, type = %d \n", index, _chargingData[index - 1]->Type);
+        SetTargetAddr(target_number, index);
+    }
+}
+
+void ClearAbnormalStatus_Chademo(byte gun_index)
+{
+    bool isCleanCheck = false;
+    char code[7];
+
+    if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "", 6) == EQUAL) {
+        return;
+    }
+
+    if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023700", 6) == EQUAL &&
+            ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoEvCommFail == YES) {
+        memcpy(code, "023700", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023704", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBatteryMalfun == YES) {
+        memcpy(code, "023704", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023705", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoNoPermission == YES) {
+        memcpy(code, "023705", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023706", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBatteryIncompatibility == YES) {
+        memcpy(code, "023706", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023707", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBatteryOVP == YES) {
+        memcpy(code, "023707", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023708", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBatteryUVP == YES) {
+        memcpy(code, "023708", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023709", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBatteryOTP == YES) {
+        memcpy(code, "023709", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023710", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBatteryCurrentDiff == YES) {
+        memcpy(code, "023710", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023711", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBatteryVoltageDiff == YES) {
+        memcpy(code, "023711", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023712", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoShiftPosition == YES) {
+        memcpy(code, "023712", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023713", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBatteryOtherFault == YES) {
+        memcpy(code, "023713", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023714", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoChargingSystemError == YES) {
+        memcpy(code, "023714", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023715", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoEvNormalStop == YES) {
+        memcpy(code, "023715", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023716", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoTempSensorBroken == YES) {
+        memcpy(code, "023716", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023717", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoConnectorLockFail == YES) {
+        memcpy(code, "023717", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023718", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoD1OnNoReceive == YES) {
+        memcpy(code, "023718", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023719", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBmsKtoJTimeout == YES) {
+        memcpy(code, "023719", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023720", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBmsChargeAllowTimeout == YES) {
+        memcpy(code, "023720", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023721", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoWaitGfdTimeout == YES) {
+        memcpy(code, "023721", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023722", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBmsEvRelayTimeout == YES) {
+        memcpy(code, "023722", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023723", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBmsReqCurrentTimeout == YES) {
+        memcpy(code, "023723", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023724", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBmsKtoJOffTimeout == YES) {
+        memcpy(code, "023724", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023725", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBmsEvRelayOffTimeout == YES) {
+        memcpy(code, "023725", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023726", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoAdcMoreThan10V == YES) {
+        memcpy(code, "023726", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023727", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoAdcMoreThan20V == YES) {
+        memcpy(code, "023727", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023728", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBmsChargeBeforeStop == YES) {
+        memcpy(code, "023728", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023729", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoChargerGetNormalStop == YES) {
+        memcpy(code, "023729", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023730", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoChargerGetEmergencyStop == YES) {
+        memcpy(code, "023730", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023731", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoIsolationResultFail == YES) {
+        memcpy(code, "023731", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023732", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoMissLinkWithMotherBoard == YES) {
+        memcpy(code, "023732", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023733", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoOutputVolMoreThanLimit == YES) {
+        memcpy(code, "023733", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023734", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoReqCurrentMoreThanLimit == YES) {
+        memcpy(code, "023734", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023735", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoReCapBmsEqrCurrentExceed == YES) {
+        memcpy(code, "023735", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023736", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoChargeRemainCountDown == YES) {
+        memcpy(code, "023736", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    }
+
+    if (isCleanCheck) {
+        for (byte index = 0; index < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; index++) {
+            if (index != gun_index || ShmSysConfigAndInfo->SysConfig.TotalConnectorCount == 1) {
+                PRINTF_FUNC("CHA clean error : index = %d, EvConnAlarmCode = %s, code = %s \n", index, _chargingData[index]->EvConnAlarmCode, code);
+                if (strncmp((char *)_chargingData[index]->EvConnAlarmCode, code, 6) != EQUAL) {
+                    if (strncmp(code, "023700", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoEvCommFail = NO; }
+                    if (strncmp(code, "023704", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBatteryMalfun = NO; }
+                    if (strncmp(code, "023705", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoNoPermission = NO; }
+                    if (strncmp(code, "023706", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBatteryIncompatibility = NO; }
+                    if (strncmp(code, "023707", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBatteryOVP = NO; }
+                    if (strncmp(code, "023708", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBatteryUVP = NO; }
+                    if (strncmp(code, "023709", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBatteryOTP = NO; }
+                    if (strncmp(code, "023710", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBatteryCurrentDiff = NO; }
+                    if (strncmp(code, "023711", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBatteryVoltageDiff = NO; }
+                    if (strncmp(code, "023712", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoShiftPosition = NO; }
+                    if (strncmp(code, "023713", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBatteryOtherFault = NO; }
+                    if (strncmp(code, "023714", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoChargingSystemError = NO; }
+                    if (strncmp(code, "023715", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoEvNormalStop = NO; }
+                    if (strncmp(code, "023716", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoTempSensorBroken = NO; }
+                    if (strncmp(code, "023717", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoConnectorLockFail = NO; }
+                    if (strncmp(code, "023718", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoD1OnNoReceive = NO; }
+                    if (strncmp(code, "023719", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBmsKtoJTimeout = NO; }
+                    if (strncmp(code, "023720", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBmsChargeAllowTimeout = NO; }
+                    if (strncmp(code, "023721", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoWaitGfdTimeout = NO; }
+                    if (strncmp(code, "023722", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBmsEvRelayTimeout = NO; }
+                    if (strncmp(code, "023723", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBmsReqCurrentTimeout = NO; }
+                    if (strncmp(code, "023724", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBmsKtoJOffTimeout = NO; }
+                    if (strncmp(code, "023725", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBmsEvRelayOffTimeout = NO; }
+                    if (strncmp(code, "023726", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoAdcMoreThan10V = NO; }
+                    if (strncmp(code, "023727", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoAdcMoreThan20V = NO; }
+                    if (strncmp(code, "023728", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBmsChargeBeforeStop = NO; }
+                    if (strncmp(code, "023729", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoChargerGetNormalStop = NO; }
+                    if (strncmp(code, "023730", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoChargerGetEmergencyStop = NO; }
+                    if (strncmp(code, "023731", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoIsolationResultFail = NO; }
+                    if (strncmp(code, "023732", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoMissLinkWithMotherBoard = NO; }
+                    if (strncmp(code, "023733", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoOutputVolMoreThanLimit = NO; }
+                    if (strncmp(code, "023734", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoReqCurrentMoreThanLimit = NO; }
+                    if (strncmp(code, "023735", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoReCapBmsEqrCurrentExceed = NO; }
+                    if (strncmp(code, "023736", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoChargeRemainCountDown = NO; }
+                }
+            }
+        }
+    }
+}
+
+void ClearAbnormalStatus_GB(byte gun_index)
+{
+    bool isCleanCheck = false;
+    char code[7];
+
+    if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "", 6) == EQUAL) {
+        return;
+    }
+
+    if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023702", 6) == EQUAL &&
+            ShmStatusCodeData->InfoCode.InfoEvents.bits.GbEvCommFail == YES) {
+        memcpy(code, "023702", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023900", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_LOS_CC1 == YES) {
+        memcpy(code, "023900", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023901", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_CONNECTOR_LOCK_FAIL == YES) {
+        memcpy(code, "023901", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023902", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_BATTERY_INCOMPATIBLE == YES) {
+        memcpy(code, "023902", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023903", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_BMS_BROAA_TIMEOUT == YES) {
+        memcpy(code, "023903", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023904", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_CSU_PRECHARGE_TIMEOUT == YES) {
+        memcpy(code, "023904", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023905", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_BMS_PRESENT_VOLTAGE_FAULT == YES) {
+        memcpy(code, "023905", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023906", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_BMS_VOLTAGE_OVER_RANGE == YES) {
+        memcpy(code, "023906", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023907", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_BSM_CHARGE_ALLOW_00_10MIN_COUUNTDONE == YES) {
+        memcpy(code, "023907", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023908", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_WAIT_GROUNDFAULT_TIMEOUT == YES) {
+        memcpy(code, "023908", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023909", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_ADC_MORE_THAN_10V == YES) {
+        memcpy(code, "023909", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023910", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_ADC_MORE_THAN_60V == YES) {
+        memcpy(code, "023910", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023911", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_CHARGER_GET_NORMAL_STOP_CMD == YES) {
+        memcpy(code, "023911", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023912", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_CHARGER_GET_EMERGENCY_STOP_CMD == YES) {
+        memcpy(code, "023912", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023913", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_ISOLATION_RESULT_FAIL == YES) {
+        memcpy(code, "023913", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023914", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_MOTHER_BOARD_MISS_LINK == YES) {
+        memcpy(code, "023914", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023915", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_OUTPUT_VOLTAGE_MORE_THAN_LIMIT == YES) {
+        memcpy(code, "023915", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023916", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_REQ_CURRENT_MORE_THAN_LIMIT == YES) {
+        memcpy(code, "023916", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023917", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_OUTPUT_VOLTAGE_MORE_THAN_10_PERCENT == YES) {
+        memcpy(code, "023917", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023918", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_OUTPUT_VOLTAGE_DIFF_BCS_5_PERCENT == YES) {
+        memcpy(code, "023918", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023919", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_STOP_ADC_MORE_THAN_10V == YES) {
+        memcpy(code, "023919", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023930", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_CEM_BHM_TIMEOUT == YES) {
+        memcpy(code, "023930", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023931", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_CEM_BRM_TIMEOUT == YES) {
+        memcpy(code, "023931", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023932", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_CEM_BCP_TIMEOUT == YES) {
+        memcpy(code, "023932", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023933", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_CEM_BRO_TIMEOUT == YES) {
+        memcpy(code, "023933", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023934", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_CEM_BCL_TIMEOUT == YES) {
+        memcpy(code, "023934", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023935", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_CEM_BCS_TIMEOUT == YES) {
+        memcpy(code, "023935", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023936", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_CEM_BSM_TIMEOUT == YES) {
+        memcpy(code, "023936", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023937", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_CEM_BST_TIMEOUT == YES) {
+        memcpy(code, "023937", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023938", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_CEM_BSD_TIMEOUT == YES) {
+        memcpy(code, "023938", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023939", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_CEM_BEM_OTHER_TIMEOUT == YES) {
+        memcpy(code, "023939", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023940", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BEM_CRM_TIMEOUT == YES) {
+        memcpy(code, "023940", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023941", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BEM_CRMAA_TIMEOUT == YES) {
+        memcpy(code, "023941", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023942", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BEM_CTS_CML_TIMEOUT == YES) {
+        memcpy(code, "023942", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023943", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BEM_CRO_TIMEOUT == YES) {
+        memcpy(code, "023943", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023944", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BEM_CCS_TIMEOUT == YES) {
+        memcpy(code, "023944", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023945", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BEM_CST_TIMEOUT == YES) {
+        memcpy(code, "023945", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023946", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BEM_CSD_TIMEOUT == YES) {
+        memcpy(code, "023946", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023947", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BEM_BEM_OTHER_TIMEOUT == YES) {
+        memcpy(code, "023947", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023950", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_SOC_GOAL == YES) {
+        memcpy(code, "023950", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023951", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_TOTAL_VOLTAGE_GOAL == YES) {
+        memcpy(code, "023951", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023952", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_CELL_VOLTAGE_GOAL == YES) {
+        memcpy(code, "023952", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023953", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_GET_CST == YES) {
+        memcpy(code, "023953", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023954", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_ISOLATION == YES) {
+        memcpy(code, "023954", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023955", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_OUTPUT_CONNECTOR_OTP == YES) {
+        memcpy(code, "023955", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023956", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_COMPONENT == YES) {
+        memcpy(code, "023956", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023957", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_CHARGE_CONNECTOR == YES) {
+        memcpy(code, "023957", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023958", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_OTP == YES) {
+        memcpy(code, "023958", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023959", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_OTHER == YES) {
+        memcpy(code, "023959", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023960", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_HIGH_V == YES) {
+        memcpy(code, "023960", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023961", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_CC2 == YES) {
+        memcpy(code, "023961", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023962", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_CURRENT == YES) {
+        memcpy(code, "023962", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023963", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_VOLTAGE == YES) {
+        memcpy(code, "023963", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023964", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GET_BST_NO_REASON == YES) {
+        memcpy(code, "023964", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023970", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BSM_CELL_OVER_VOLTAGE == YES) {
+        memcpy(code, "023970", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023971", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BSM_CELL_UNDER_VOLTAGE == YES) {
+        memcpy(code, "023971", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023972", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BSM_OVER_SOC == YES) {
+        memcpy(code, "023972", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023973", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BSM_UNDER_SOC == YES) {
+        memcpy(code, "023973", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023974", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BSM_CURRENT == YES) {
+        memcpy(code, "023974", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023975", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BSM_TEMPERATURE == YES) {
+        memcpy(code, "023975", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023976", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BSM_ISOLATE == YES) {
+        memcpy(code, "023976", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023977", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BSM_OUTPUT_CONNECTOR == YES) {
+        memcpy(code, "023977", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    }
+
+    if (isCleanCheck) {
+        for (byte index = 0; index < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; index++) {
+            if (index != gun_index || ShmSysConfigAndInfo->SysConfig.TotalConnectorCount == 1) {
+                PRINTF_FUNC("GBT clean error : index = %d, EvConnAlarmCode = %s, code = %s \n", index, _chargingData[index]->EvConnAlarmCode, code);
+                if (strncmp((char *)_chargingData[index]->EvConnAlarmCode, code, 6) != EQUAL) {
+                    if (strncmp(code, "023702", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.GbEvCommFail = NO; }
+                    if (strncmp(code, "023900", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_LOS_CC1 = NO; }
+                    if (strncmp(code, "023901", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_CONNECTOR_LOCK_FAIL = NO; }
+                    if (strncmp(code, "023902", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_BATTERY_INCOMPATIBLE = NO; }
+                    if (strncmp(code, "023903", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_BMS_BROAA_TIMEOUT = NO; }
+                    if (strncmp(code, "023904", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_CSU_PRECHARGE_TIMEOUT = NO; }
+                    if (strncmp(code, "023905", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_BMS_PRESENT_VOLTAGE_FAULT = NO; }
+                    if (strncmp(code, "023906", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_BMS_VOLTAGE_OVER_RANGE = NO; }
+                    if (strncmp(code, "023907", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_BSM_CHARGE_ALLOW_00_10MIN_COUUNTDONE = NO; }
+                    if (strncmp(code, "023908", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_WAIT_GROUNDFAULT_TIMEOUT = NO; }
+                    if (strncmp(code, "023909", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_ADC_MORE_THAN_10V = NO; }
+                    if (strncmp(code, "023910", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_ADC_MORE_THAN_60V = NO; }
+                    if (strncmp(code, "023911", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_CHARGER_GET_NORMAL_STOP_CMD = NO; }
+                    if (strncmp(code, "023912", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_CHARGER_GET_EMERGENCY_STOP_CMD = NO; }
+                    if (strncmp(code, "023913", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_ISOLATION_RESULT_FAIL = NO; }
+                    if (strncmp(code, "023914", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_MOTHER_BOARD_MISS_LINK = NO; }
+                    if (strncmp(code, "023915", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_OUTPUT_VOLTAGE_MORE_THAN_LIMIT = NO; }
+                    if (strncmp(code, "023916", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_REQ_CURRENT_MORE_THAN_LIMIT = NO; }
+                    if (strncmp(code, "023917", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_OUTPUT_VOLTAGE_MORE_THAN_10_PERCENT = NO; }
+                    if (strncmp(code, "023918", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_OUTPUT_VOLTAGE_DIFF_BCS_5_PERCENT = NO; }
+                    if (strncmp(code, "023919", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_STOP_ADC_MORE_THAN_10V = NO; }
+                    if (strncmp(code, "023930", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_CEM_BHM_TIMEOUT = NO; }
+                    if (strncmp(code, "023931", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_CEM_BRM_TIMEOUT = NO; }
+                    if (strncmp(code, "023932", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_CEM_BCP_TIMEOUT = NO; }
+                    if (strncmp(code, "023933", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_CEM_BRO_TIMEOUT = NO; }
+                    if (strncmp(code, "023934", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_CEM_BCL_TIMEOUT = NO; }
+                    if (strncmp(code, "023935", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_CEM_BCS_TIMEOUT = NO; }
+                    if (strncmp(code, "023936", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_CEM_BSM_TIMEOUT = NO; }
+                    if (strncmp(code, "023937", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_CEM_BST_TIMEOUT = NO; }
+                    if (strncmp(code, "023938", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_CEM_BSD_TIMEOUT = NO; }
+                    if (strncmp(code, "023939", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_CEM_BEM_OTHER_TIMEOUT = NO; }
+                    if (strncmp(code, "023940", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BEM_CRM_TIMEOUT = NO; }
+                    if (strncmp(code, "023941", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BEM_CRMAA_TIMEOUT = NO; }
+                    if (strncmp(code, "023942", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BEM_CTS_CML_TIMEOUT = NO; }
+                    if (strncmp(code, "023943", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BEM_CRO_TIMEOUT = NO; }
+                    if (strncmp(code, "023944", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BEM_CCS_TIMEOUT = NO; }
+                    if (strncmp(code, "023945", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BEM_CST_TIMEOUT = NO; }
+                    if (strncmp(code, "023946", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BEM_CSD_TIMEOUT = NO; }
+                    if (strncmp(code, "023947", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BEM_BEM_OTHER_TIMEOUT = NO; }
+                    if (strncmp(code, "023950", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_SOC_GOAL = NO; }
+                    if (strncmp(code, "023951", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_TOTAL_VOLTAGE_GOAL = NO; }
+                    if (strncmp(code, "023952", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_CELL_VOLTAGE_GOAL = NO; }
+                    if (strncmp(code, "023953", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_GET_CST = NO; }
+                    if (strncmp(code, "023954", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_ISOLATION = NO; }
+                    if (strncmp(code, "023955", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_OUTPUT_CONNECTOR_OTP = NO; }
+                    if (strncmp(code, "023956", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_COMPONENT = NO; }
+                    if (strncmp(code, "023957", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_CHARGE_CONNECTOR = NO; }
+                    if (strncmp(code, "023958", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_OTP = NO; }
+                    if (strncmp(code, "023959", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_OTHER = NO; }
+                    if (strncmp(code, "023960", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_HIGH_V = NO; }
+                    if (strncmp(code, "023961", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_CC2 = NO; }
+                    if (strncmp(code, "023962", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_CURRENT = NO; }
+                    if (strncmp(code, "023963", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_VOLTAGE = NO; }
+                    if (strncmp(code, "023964", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GET_BST_NO_REASON = NO; }
+                    if (strncmp(code, "023970", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BSM_CELL_OVER_VOLTAGE = NO; }
+                    if (strncmp(code, "023971", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BSM_CELL_UNDER_VOLTAGE = NO; }
+                    if (strncmp(code, "023972", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BSM_OVER_SOC = NO; }
+                    if (strncmp(code, "023973", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BSM_UNDER_SOC = NO; }
+                    if (strncmp(code, "023974", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BSM_CURRENT = NO; }
+                    if (strncmp(code, "023975", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BSM_TEMPERATURE = NO; }
+                    if (strncmp(code, "023976", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BSM_ISOLATE = NO; }
+                    if (strncmp(code, "023977", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BSM_OUTPUT_CONNECTOR = NO; }
+                }
+            }
+        }
+    }
+}
+
+void ClearAbnormalStatus_CCS(byte gun_index)
+{
+    bool isCleanCheck = false;
+    char code[7];
+
+    if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "", 6) == EQUAL) {
+        return;
+    }
+
+    if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023701", 6) == EQUAL &&
+            ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsEvCommFail == YES) {
+        memcpy(code, "023701", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023737", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsRESTemperatureInhibit == YES) {
+        memcpy(code, "023737", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023738", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsEVShiftPosition == YES) {
+        memcpy(code, "023738", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023739", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsChargerConnectorLockFault == YES) {
+        memcpy(code, "023739", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023740", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsEVRESSMalfunction == YES) {
+        memcpy(code, "023740", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023741", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsChargingCurrentdifferential == YES) {
+        memcpy(code, "023741", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023742", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsChargingVoltageOutOfRange == YES) {
+        memcpy(code, "023742", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023743", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsChargingSystemIncompatibility == YES) {
+        memcpy(code, "023743", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023744", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsEmergencyEvent == YES) {
+        memcpy(code, "023744", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023745", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsBreaker == YES) {
+        memcpy(code, "023745", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023746", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsNoData == YES) {
+        memcpy(code, "023746", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023747", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.Ccsreserved_by_DIN_A == YES) {
+        memcpy(code, "023747", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023748", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.Ccsreserved_by_DIN_B == YES) {
+        memcpy(code, "023748", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023749", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.Ccsreserved_by_DIN_C == YES) {
+        memcpy(code, "023749", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023750", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.Ccsreserved_by_ISO_1 == YES) {
+        memcpy(code, "023750", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023751", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.Ccsreserved_by_ISO_2 == YES) {
+        memcpy(code, "023751", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023752", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.Ccsreserved_by_ISO_3 == YES) {
+        memcpy(code, "023752", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023753", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.Ccsreserved_by_OEM_1 == YES) {
+        memcpy(code, "023753", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023754", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.Ccsreserved_by_OEM_2 == YES) {
+        memcpy(code, "023754", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023755", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.Ccsreserved_by_OEM_3 == YES) {
+        memcpy(code, "023755", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023756", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.Ccsreserved_by_OEM_4 == YES) {
+        memcpy(code, "023756", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023757", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.Ccsreserved_by_OEM_5 == YES) {
+        memcpy(code, "023757", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023758", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsSequenceError == YES) {
+        memcpy(code, "023758", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023759", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsSignatureError == YES) {
+        memcpy(code, "023759", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023760", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsUnknownSession == YES) {
+        memcpy(code, "023760", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023761", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsServiceIDInvalid == YES) {
+        memcpy(code, "023761", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023762", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsPaymentSelectionInvalid == YES) {
+        memcpy(code, "023762", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023763", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsIdentificationSelectionInvalid == YES) {
+        memcpy(code, "023763", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023764", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsServiceSelectionInvalid == YES) {
+        memcpy(code, "023764", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023765", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCertificateExpired == YES) {
+        memcpy(code, "023765", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023766", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCertificateNotYetValid == YES) {
+        memcpy(code, "023766", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023767", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCertificateRevoked == YES) {
+        memcpy(code, "023767", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023768", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsNoCertificateAvailable == YES) {
+        memcpy(code, "023768", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023769", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCertChainError == YES) {
+        memcpy(code, "023769", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023770", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCertValidationError == YES) {
+        memcpy(code, "023770", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023771", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCertVerificationError == YES) {
+        memcpy(code, "023771", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023772", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsContractCanceled == YES) {
+        memcpy(code, "023772", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023773", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsChallengeInvalid == YES) {
+        memcpy(code, "023773", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023774", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsWrongEnergyTransferMode == YES) {
+        memcpy(code, "023774", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023775", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsWrongChargeParameter == YES) {
+        memcpy(code, "023775", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023776", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsChargingProfileInvalid == YES) {
+        memcpy(code, "023776", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023777", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTariffSelectionInvalid == YES) {
+        memcpy(code, "023777", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023778", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsEVSEPresentVoltageToLow == YES) {
+        memcpy(code, "023778", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023779", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsPowerDeliveryNotApplied == YES) {
+        memcpy(code, "023779", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023780", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsMeteringSignatureNotValid == YES) {
+        memcpy(code, "023780", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023781", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsNoChargeServiceSelected == YES) {
+        memcpy(code, "023781", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023782", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsContactorError == YES) {
+        memcpy(code, "023782", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023783", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCertificateNotAllowedAtThisEVSE == YES) {
+        memcpy(code, "023783", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023784", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsGAChargeStop == YES) {
+        memcpy(code, "023784", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023785", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsAlignmentError == YES) {
+        memcpy(code, "023785", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023786", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsACDError == YES) {
+        memcpy(code, "023786", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023787", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsAssociationError == YES) {
+        memcpy(code, "023787", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023788", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsEVSEChargeAbort == YES) {
+        memcpy(code, "023788", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023789", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsNoSupportedAppProtocol == YES) {
+        memcpy(code, "023789", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023790", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsContractNotAccepted == YES) {
+        memcpy(code, "023790", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023791", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsMOUnknown == YES) {
+        memcpy(code, "023791", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023792", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsOEM_Prov_CertificateRevoke == YES) {
+        memcpy(code, "023792", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023793", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsOEM_SubCA1_CertificateRevoked == YES) {
+        memcpy(code, "023793", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023794", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsOEM_SubCA2_CertificateRevoked == YES) {
+        memcpy(code, "023794", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023795", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsOEM_RootCA_CertificateRevoked == YES) {
+        memcpy(code, "023795", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023796", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsMO_Prov_CertificateRevoked == YES) {
+        memcpy(code, "023796", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023797", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsMO_SubCA1_CertificateRevoked == YES) {
+        memcpy(code, "023797", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023798", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsMO_SubCA2_CertificateRevoked == YES) {
+        memcpy(code, "023798", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023799", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsMO_RootCA_CertificateRevoked == YES) {
+        memcpy(code, "023799", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023800", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCPS_Prov_CertificateRevoked == YES) {
+        memcpy(code, "023800", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023801", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCPS_SubCA1_CertificateRevoked == YES) {
+        memcpy(code, "023801", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023802", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCPS_SubCA2_CertificateRevoked == YES) {
+        memcpy(code, "023802", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023803", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCPS_RootCA_CertificateRevoked == YES) {
+        memcpy(code, "023803", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023809", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_EVSE_SLAC_init == YES) {
+        memcpy(code, "023809", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023810", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_match_response == YES) {
+        memcpy(code, "023810", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023811", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_match_sequence == YES) {
+        memcpy(code, "023811", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023812", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_EVSE_match_MNBC == YES) {
+        memcpy(code, "023812", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023813", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_EVSE_avg_atten_calc == YES) {
+        memcpy(code, "023813", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023814", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_match_response == YES) {
+        memcpy(code, "023814", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023815", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_EVSE_match_session == YES) {
+        memcpy(code, "023815", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023816", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_EVSE_assoc_session == YES) {
+        memcpy(code, "023816", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023817", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_EVSE_vald_toggle == YES) {
+        memcpy(code, "023817", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023818", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsSeccSlacTimeoutCmMnbcSound == YES) {
+        memcpy(code, "023818", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023819", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsSeccSlacTimeoutCmValidateReq == YES) {
+        memcpy(code, "023819", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023823", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsUDP_TT_match_join == YES) {
+        memcpy(code, "023823", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023824", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTCP_TT_match_join == YES) {
+        memcpy(code, "023824", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023825", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_amp_map_exchange == YES) {
+        memcpy(code, "023825", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023826", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_link_ready_notification == YES) {
+        memcpy(code, "023826", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023832", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsSupportedAppProtocolRes == YES) {
+        memcpy(code, "023832", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023833", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsSessionSetupRes == YES) {
+        memcpy(code, "023833", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023834", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsServiceDiscoveryRes == YES) {
+        memcpy(code, "023834", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023835", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsServicePaymentSelectionRes == YES) {
+        memcpy(code, "023835", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023836", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsContractAuthenticationRes == YES) {
+        memcpy(code, "023836", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023837", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsChargeParameterDiscoveryRes == YES) {
+        memcpy(code, "023837", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023838", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsPowerDeliveryRes == YES) {
+        memcpy(code, "023838", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023839", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCableCheckRes == YES) {
+        memcpy(code, "023839", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023840", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsPreChargeRes == YES) {
+        memcpy(code, "023840", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023841", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCurrentDemandRes == YES) {
+        memcpy(code, "023841", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023842", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsWeldingDetectionRes == YES) {
+        memcpy(code, "023842", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023843", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsSessionStopRes == YES) {
+        memcpy(code, "023843", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023844", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsSequence_Time == YES) {
+        memcpy(code, "023844", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023845", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsReadyToCharge_Performance_Time == YES) {
+        memcpy(code, "023845", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023846", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCommunicationSetup_Performance_Time == YES) {
+        memcpy(code, "023846", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023847", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCableCheck_Performance_Time == YES) {
+        memcpy(code, "023847", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023848", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCPState_Detection_Time == YES) {
+        memcpy(code, "023848", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023849", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCPOscillator_Retain_Time == YES) {
+        memcpy(code, "023849", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023850", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsSeccTimeoutV2GPreChargePerformaceTime == YES) {
+        memcpy(code, "023850", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023855", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_GET_EV_TARGET_INFO == YES) {
+        memcpy(code, "023855", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023856", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_GET_EV_TARGET_INFO == YES) {
+        memcpy(code, "023856", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023857", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_GET_EV_BATTERY_INFO == YES) {
+        memcpy(code, "023857", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023858", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_GET_EV_BATTERY_INFO == YES) {
+        memcpy(code, "023858", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023859", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_EV_STOP_EVENT == YES) {
+        memcpy(code, "023859", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023860", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_EV_STOP_EVENT == YES) {
+        memcpy(code, "023860", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023861", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_EVSE_STOP_EVENT == YES) {
+        memcpy(code, "023861", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023862", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_EVSE_STOP_EVENT == YES) {
+        memcpy(code, "023862", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023863", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_GET_MISC_INFO == YES) {
+        memcpy(code, "023863", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023864", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_GET_MISC_INFO == YES) {
+        memcpy(code, "023864", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023865", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_DOWNLOAD_REQUEST == YES) {
+        memcpy(code, "023865", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023866", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_DOWNLOAD_REQUEST == YES) {
+        memcpy(code, "023866", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023867", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_START_BLOCK_TRANSFER == YES) {
+        memcpy(code, "023867", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023868", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_START_BLOCK_TRANSFER == YES) {
+        memcpy(code, "023868", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023869", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_DATA_TRANSFER == YES) {
+        memcpy(code, "023869", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023870", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_DATA_TRANSFER == YES) {
+        memcpy(code, "023870", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023871", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_DOWNLOAD_FINISH == YES) {
+        memcpy(code, "023871", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023872", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_DOWNLOAD_FINISH == YES) {
+        memcpy(code, "023872", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023873", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_ISOLATION_STATUS == YES) {
+        memcpy(code, "023873", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023874", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_ISOLATION_STATUS == YES) {
+        memcpy(code, "023874", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023875", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_CONNECTOR_INFO == YES) {
+        memcpy(code, "023875", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023876", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_CONNECTOR_INFO == YES) {
+        memcpy(code, "023876", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023877", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_RTC_INFO == YES) {
+        memcpy(code, "023877", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023878", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_RTC_INFO == YES) {
+        memcpy(code, "023878", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023879", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_EVSE_PRECHARGE_INFO == YES) {
+        memcpy(code, "023879", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023880", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_EVSE_PRECHARGE_INFO == YES) {
+        memcpy(code, "023880", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023881", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsMSG_Sequence == YES) {
+        memcpy(code, "023881", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023882", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCAN_MSG_Unrecognized_CMD_ID == YES) {
+        memcpy(code, "023882", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023883", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsDIN_Msg_Decode_Error == YES) {
+        memcpy(code, "023883", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023884", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsDIN_Msg_Encode_Error == YES) {
+        memcpy(code, "023884", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023885", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsISO1_Msg_Decode_Error == YES) {
+        memcpy(code, "023885", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023886", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsISO1_Msg_Encode_Error == YES) {
+        memcpy(code, "023886", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023887", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsISO2_Msg_Decode_Error == YES) {
+        memcpy(code, "023887", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023888", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsISO2_Msg_Encode_Error == YES) {
+        memcpy(code, "023888", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023889", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCpStatus_Error == YES) {
+        memcpy(code, "023889", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023890", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsUnexpectVolBeforeCharing_Error == YES) {
+        memcpy(code, "023890", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023891", 6) == EQUAL &&
+               ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsSeccNotReadyForCharging == YES) {
+        memcpy(code, "023891", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    }
+//  else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023892", 6) == EQUAL &&
+//          ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsSeccTimeoutQCA7000Comm == YES)
+//  {
+//      memcpy(code, "023892", 6);
+//      memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+//      isCleanCheck = true;
+//  }
+    else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023893", 6) == EQUAL &&
+             ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsSeccFailForQCA7000SetKey == YES) {
+        memcpy(code, "023893", 6);
+        memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+        isCleanCheck = true;
+    }
+
+    if (isCleanCheck) {
+        for (byte index = 0; index < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; index++) {
+            if (index != gun_index || ShmSysConfigAndInfo->SysConfig.TotalConnectorCount == 1) {
+                PRINTF_FUNC("CCS clean error : index = %d, EvConnAlarmCode = %s, code = %s \n", index, _chargingData[index]->EvConnAlarmCode, code);
+                if (strncmp((char *)_chargingData[index]->EvConnAlarmCode, code, 6) != EQUAL) {
+                    if (strncmp(code, "023701", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsEvCommFail = NO; }
+                    if (strncmp(code, "023737", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsRESTemperatureInhibit = NO; }
+                    if (strncmp(code, "023738", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsEVShiftPosition = NO; }
+                    if (strncmp(code, "023739", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsChargerConnectorLockFault = NO; }
+                    if (strncmp(code, "023740", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsEVRESSMalfunction = NO; }
+                    if (strncmp(code, "023741", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsChargingCurrentdifferential = NO; }
+                    if (strncmp(code, "023742", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsChargingVoltageOutOfRange = NO; }
+                    if (strncmp(code, "023743", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsChargingSystemIncompatibility = NO; }
+                    if (strncmp(code, "023744", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsEmergencyEvent = NO; }
+                    if (strncmp(code, "023745", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsBreaker = NO; }
+                    if (strncmp(code, "023746", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsNoData = NO; }
+                    if (strncmp(code, "023747", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.Ccsreserved_by_DIN_A = NO; }
+                    if (strncmp(code, "023748", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.Ccsreserved_by_DIN_B = NO; }
+                    if (strncmp(code, "023749", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.Ccsreserved_by_DIN_C = NO; }
+                    if (strncmp(code, "023750", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.Ccsreserved_by_ISO_1 = NO; }
+                    if (strncmp(code, "023751", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.Ccsreserved_by_ISO_2 = NO; }
+                    if (strncmp(code, "023752", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.Ccsreserved_by_ISO_3 = NO; }
+                    if (strncmp(code, "023753", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.Ccsreserved_by_OEM_1 = NO; }
+                    if (strncmp(code, "023754", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.Ccsreserved_by_OEM_2 = NO; }
+                    if (strncmp(code, "023755", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.Ccsreserved_by_OEM_3 = NO; }
+                    if (strncmp(code, "023756", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.Ccsreserved_by_OEM_4 = NO; }
+                    if (strncmp(code, "023757", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.Ccsreserved_by_OEM_5 = NO; }
+                    if (strncmp(code, "023758", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsSequenceError = NO; }
+                    if (strncmp(code, "023759", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsSignatureError = NO; }
+                    if (strncmp(code, "023760", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsUnknownSession = NO; }
+                    if (strncmp(code, "023761", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsServiceIDInvalid = NO; }
+                    if (strncmp(code, "023762", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsPaymentSelectionInvalid = NO; }
+                    if (strncmp(code, "023763", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsIdentificationSelectionInvalid = NO; }
+                    if (strncmp(code, "023764", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsServiceSelectionInvalid = NO; }
+                    if (strncmp(code, "023765", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCertificateExpired = NO; }
+                    if (strncmp(code, "023766", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCertificateNotYetValid = NO; }
+                    if (strncmp(code, "023767", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCertificateRevoked = NO; }
+                    if (strncmp(code, "023768", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsNoCertificateAvailable = NO; }
+                    if (strncmp(code, "023769", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCertChainError = NO; }
+                    if (strncmp(code, "023770", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCertValidationError = NO; }
+                    if (strncmp(code, "023771", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCertVerificationError = NO; }
+                    if (strncmp(code, "023772", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsContractCanceled = NO; }
+                    if (strncmp(code, "023773", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsChallengeInvalid = NO; }
+                    if (strncmp(code, "023774", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsWrongEnergyTransferMode = NO; }
+                    if (strncmp(code, "023775", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsWrongChargeParameter = NO; }
+                    if (strncmp(code, "023776", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsChargingProfileInvalid = NO; }
+                    if (strncmp(code, "023777", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTariffSelectionInvalid = NO; }
+                    if (strncmp(code, "023778", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsEVSEPresentVoltageToLow = NO; }
+                    if (strncmp(code, "023779", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsPowerDeliveryNotApplied = NO; }
+                    if (strncmp(code, "023780", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsMeteringSignatureNotValid = NO; }
+                    if (strncmp(code, "023781", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsNoChargeServiceSelected = NO; }
+                    if (strncmp(code, "023782", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsContactorError = NO; }
+                    if (strncmp(code, "023783", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCertificateNotAllowedAtThisEVSE = NO; }
+                    if (strncmp(code, "023784", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsGAChargeStop = NO; }
+                    if (strncmp(code, "023785", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsAlignmentError = NO; }
+                    if (strncmp(code, "023786", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsACDError = NO; }
+                    if (strncmp(code, "023787", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsAssociationError = NO; }
+                    if (strncmp(code, "023788", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsEVSEChargeAbort = NO; }
+                    if (strncmp(code, "023789", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsNoSupportedAppProtocol = NO; }
+                    if (strncmp(code, "023790", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsContractNotAccepted = NO; }
+                    if (strncmp(code, "023791", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsMOUnknown = NO; }
+                    if (strncmp(code, "023792", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsOEM_Prov_CertificateRevoke = NO; }
+                    if (strncmp(code, "023793", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsOEM_SubCA1_CertificateRevoked = NO; }
+                    if (strncmp(code, "023794", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsOEM_SubCA2_CertificateRevoked = NO; }
+                    if (strncmp(code, "023795", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsOEM_RootCA_CertificateRevoked = NO; }
+                    if (strncmp(code, "023796", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsMO_Prov_CertificateRevoked = NO; }
+                    if (strncmp(code, "023797", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsMO_SubCA1_CertificateRevoked = NO; }
+                    if (strncmp(code, "023798", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsMO_SubCA2_CertificateRevoked = NO; }
+                    if (strncmp(code, "023799", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsMO_RootCA_CertificateRevoked = NO; }
+                    if (strncmp(code, "023800", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCPS_Prov_CertificateRevoked = NO; }
+                    if (strncmp(code, "023801", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCPS_SubCA1_CertificateRevoked = NO; }
+                    if (strncmp(code, "023802", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCPS_SubCA2_CertificateRevoked = NO; }
+                    if (strncmp(code, "023803", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCPS_RootCA_CertificateRevoked = NO; }
+                    if (strncmp(code, "023809", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_EVSE_SLAC_init = NO; }
+                    if (strncmp(code, "023810", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_match_response = NO; }
+                    if (strncmp(code, "023811", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_match_sequence = NO; }
+                    if (strncmp(code, "023812", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_EVSE_match_MNBC = NO; }
+                    if (strncmp(code, "023813", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_EVSE_avg_atten_calc = NO; }
+                    if (strncmp(code, "023814", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_match_response = NO; }
+                    if (strncmp(code, "023815", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_EVSE_match_session = NO; }
+                    if (strncmp(code, "023816", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_EVSE_assoc_session = NO; }
+                    if (strncmp(code, "023817", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_EVSE_vald_toggle = NO; }
+                    if (strncmp(code, "023818", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsSeccSlacTimeoutCmMnbcSound = NO; }
+                    if (strncmp(code, "023819", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsSeccSlacTimeoutCmValidateReq = NO; }
+                    if (strncmp(code, "023823", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsUDP_TT_match_join = NO; }
+                    if (strncmp(code, "023824", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTCP_TT_match_join = NO; }
+                    if (strncmp(code, "023825", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_amp_map_exchange = NO; }
+                    if (strncmp(code, "023826", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_link_ready_notification = NO; }
+                    if (strncmp(code, "023832", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsSupportedAppProtocolRes = NO; }
+                    if (strncmp(code, "023833", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsSessionSetupRes = NO; }
+                    if (strncmp(code, "023834", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsServiceDiscoveryRes = NO; }
+                    if (strncmp(code, "023835", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsServicePaymentSelectionRes = NO; }
+                    if (strncmp(code, "023836", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsContractAuthenticationRes = NO; }
+                    if (strncmp(code, "023837", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsChargeParameterDiscoveryRes = NO; }
+                    if (strncmp(code, "023838", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsPowerDeliveryRes = NO; }
+                    if (strncmp(code, "023839", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCableCheckRes = NO; }
+                    if (strncmp(code, "023840", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsPreChargeRes = NO; }
+                    if (strncmp(code, "023841", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCurrentDemandRes = NO; }
+                    if (strncmp(code, "023842", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsWeldingDetectionRes = NO; }
+                    if (strncmp(code, "023843", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsSessionStopRes = NO; }
+                    if (strncmp(code, "023844", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsSequence_Time = NO; }
+                    if (strncmp(code, "023845", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsReadyToCharge_Performance_Time = NO; }
+                    if (strncmp(code, "023846", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCommunicationSetup_Performance_Time = NO; }
+                    if (strncmp(code, "023847", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCableCheck_Performance_Time = NO; }
+                    if (strncmp(code, "023848", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCPState_Detection_Time = NO; }
+                    if (strncmp(code, "023849", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCPOscillator_Retain_Time = NO; }
+                    if (strncmp(code, "023850", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsSeccTimeoutV2GPreChargePerformaceTime = NO; }
+                    if (strncmp(code, "023855", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_GET_EV_TARGET_INFO = NO; }
+                    if (strncmp(code, "023856", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_GET_EV_TARGET_INFO = NO; }
+                    if (strncmp(code, "023857", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_GET_EV_BATTERY_INFO = NO; }
+                    if (strncmp(code, "023858", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_GET_EV_BATTERY_INFO = NO; }
+                    if (strncmp(code, "023859", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_EV_STOP_EVENT = NO; }
+                    if (strncmp(code, "023860", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_EV_STOP_EVENT = NO; }
+                    if (strncmp(code, "023861", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_EVSE_STOP_EVENT = NO; }
+                    if (strncmp(code, "023862", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_EVSE_STOP_EVENT = NO; }
+                    if (strncmp(code, "023863", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_GET_MISC_INFO = NO; }
+                    if (strncmp(code, "023864", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_GET_MISC_INFO = NO; }
+                    if (strncmp(code, "023865", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_DOWNLOAD_REQUEST = NO; }
+                    if (strncmp(code, "023866", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_DOWNLOAD_REQUEST = NO; }
+                    if (strncmp(code, "023867", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_START_BLOCK_TRANSFER = NO; }
+                    if (strncmp(code, "023868", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_START_BLOCK_TRANSFER = NO; }
+                    if (strncmp(code, "023869", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_DATA_TRANSFER = NO; }
+                    if (strncmp(code, "023870", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_DATA_TRANSFER = NO; }
+                    if (strncmp(code, "023871", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_DOWNLOAD_FINISH = NO; }
+                    if (strncmp(code, "023872", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_DOWNLOAD_FINISH = NO; }
+                    if (strncmp(code, "023873", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_ISOLATION_STATUS = NO; }
+                    if (strncmp(code, "023874", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_ISOLATION_STATUS = NO; }
+                    if (strncmp(code, "023875", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_CONNECTOR_INFO = NO; }
+                    if (strncmp(code, "023876", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_CONNECTOR_INFO = NO; }
+                    if (strncmp(code, "023877", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_RTC_INFO = NO; }
+                    if (strncmp(code, "023878", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_RTC_INFO = NO; }
+                    if (strncmp(code, "023879", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_EVSE_PRECHARGE_INFO = NO; }
+                    if (strncmp(code, "023880", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_EVSE_PRECHARGE_INFO = NO; }
+                    if (strncmp(code, "023881", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsMSG_Sequence = NO; }
+                    if (strncmp(code, "023882", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCAN_MSG_Unrecognized_CMD_ID = NO; }
+                    if (strncmp(code, "023883", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsDIN_Msg_Decode_Error = NO; }
+                    if (strncmp(code, "023884", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsDIN_Msg_Encode_Error = NO; }
+                    if (strncmp(code, "023885", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsISO1_Msg_Decode_Error = NO; }
+                    if (strncmp(code, "023886", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsISO1_Msg_Encode_Error = NO; }
+                    if (strncmp(code, "023887", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsISO2_Msg_Decode_Error = NO; }
+                    if (strncmp(code, "023888", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsISO2_Msg_Encode_Error = NO; }
+                    if (strncmp(code, "023889", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCpStatus_Error = NO; }
+                    if (strncmp(code, "023890", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsUnexpectVolBeforeCharing_Error = NO; }
+                    if (strncmp(code, "023891", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsSeccNotReadyForCharging = NO; }
+                    //if (strncmp(code, "023892", 6) == EQUAL) ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsSeccTimeoutQCA7000Comm = NO;
+                    if (strncmp(code, "023893", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsSeccFailForQCA7000SetKey = NO; }
+                }
+            }
+        }
+    }
+}
+
+void AbnormalStopAnalysis(byte gun_index, byte *errCode)
+{
+    char string[7];
+    sprintf(string, "%d%d%d%d%d%d", *(errCode + 0), *(errCode + 1), *(errCode + 2), *(errCode + 3), *(errCode + 4), *(errCode + 5));
+
+    PRINTF_FUNC("NOTIFICATION_EV_STOP : Err Code = %s \n", string);
+    if (strncmp(string, "000000", 6) == EQUAL ||
+            strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "", 6) != EQUAL) {
+        return;
+    }
+
+    memcpy(_chargingData[gun_index]->EvConnAlarmCode, string, 6);
+    PRINTF_FUNC("NOTIFICATION_EV_STOP : EvConnAlarmCode = %s \n", _chargingData[gun_index]->EvConnAlarmCode);
+
+    if (strcmp(string, "023700") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoEvCommFail = YES; }
+    if (strcmp(string, "023704") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBatteryMalfun = YES; }
+    if (strcmp(string, "023705") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoNoPermission = YES; }
+    if (strcmp(string, "023706") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBatteryIncompatibility = YES; }
+    if (strcmp(string, "023707") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBatteryOVP = YES; }
+    if (strcmp(string, "023708") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBatteryUVP = YES; }
+    if (strcmp(string, "023709") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBatteryOTP = YES; }
+    if (strcmp(string, "023710") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBatteryCurrentDiff = YES; }
+    if (strcmp(string, "023711") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBatteryVoltageDiff = YES; }
+    if (strcmp(string, "023712") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoShiftPosition = YES; }
+    if (strcmp(string, "023713") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBatteryOtherFault = YES; }
+    if (strcmp(string, "023714") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoChargingSystemError = YES; }
+    if (strcmp(string, "023715") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoEvNormalStop = YES; }
+    if (strcmp(string, "023716") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoTempSensorBroken = YES; }
+    if (strcmp(string, "023717") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoConnectorLockFail = YES; }
+    if (strcmp(string, "023718") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoD1OnNoReceive = YES; }
+    if (strcmp(string, "023719") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBmsKtoJTimeout = YES; }
+    if (strcmp(string, "023720") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBmsChargeAllowTimeout = YES; }
+    if (strcmp(string, "023721") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoWaitGfdTimeout = YES; }
+    if (strcmp(string, "023722") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBmsEvRelayTimeout = YES; }
+    if (strcmp(string, "023723") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBmsReqCurrentTimeout = YES; }
+    if (strcmp(string, "023724") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBmsKtoJOffTimeout = YES; }
+    if (strcmp(string, "023725") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBmsEvRelayOffTimeout = YES; }
+    if (strcmp(string, "023726") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoAdcMoreThan10V = YES; }
+    if (strcmp(string, "023727") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoAdcMoreThan20V = YES; }
+    if (strcmp(string, "023728") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBmsChargeBeforeStop = YES; }
+    if (strcmp(string, "023729") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoChargerGetNormalStop = YES; }
+    if (strcmp(string, "023730") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoChargerGetEmergencyStop = YES; }
+    if (strcmp(string, "023731") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoIsolationResultFail = YES; }
+    if (strcmp(string, "023732") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoMissLinkWithMotherBoard = YES; }
+    if (strcmp(string, "023733") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoOutputVolMoreThanLimit = YES; }
+    if (strcmp(string, "023734") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoReqCurrentMoreThanLimit = YES; }
+    if (strcmp(string, "023735") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoReCapBmsEqrCurrentExceed = YES; }
+    if (strcmp(string, "023736") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoChargeRemainCountDown = YES; }
+
+    if (strcmp(string, "023701") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsEvCommFail = YES; }
+    if (strcmp(string, "023737") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsRESTemperatureInhibit = YES; }
+    if (strcmp(string, "023738") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsEVShiftPosition = YES; }
+    if (strcmp(string, "023739") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsChargerConnectorLockFault = YES; }
+    if (strcmp(string, "023740") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsEVRESSMalfunction = YES; }
+    if (strcmp(string, "023741") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsChargingCurrentdifferential = YES; }
+    if (strcmp(string, "023742") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsChargingVoltageOutOfRange = YES; }
+    if (strcmp(string, "023743") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsChargingSystemIncompatibility = YES; }
+    if (strcmp(string, "023744") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsEmergencyEvent = YES; }
+    if (strcmp(string, "023745") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsBreaker = YES; }
+    if (strcmp(string, "023746") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsNoData = YES; }
+    if (strcmp(string, "023747") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.Ccsreserved_by_DIN_A = YES; }
+    if (strcmp(string, "023748") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.Ccsreserved_by_DIN_B = YES; }
+    if (strcmp(string, "023749") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.Ccsreserved_by_DIN_C = YES; }
+    if (strcmp(string, "023750") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.Ccsreserved_by_ISO_1 = YES; }
+    if (strcmp(string, "023751") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.Ccsreserved_by_ISO_2 = YES; }
+    if (strcmp(string, "023752") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.Ccsreserved_by_ISO_3 = YES; }
+    if (strcmp(string, "023753") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.Ccsreserved_by_OEM_1 = YES; }
+    if (strcmp(string, "023754") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.Ccsreserved_by_OEM_2 = YES; }
+    if (strcmp(string, "023755") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.Ccsreserved_by_OEM_3 = YES; }
+    if (strcmp(string, "023756") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.Ccsreserved_by_OEM_4 = YES; }
+    if (strcmp(string, "023757") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.Ccsreserved_by_OEM_5 = YES; }
+    if (strcmp(string, "023758") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsSequenceError = YES; }
+    if (strcmp(string, "023759") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsSignatureError = YES; }
+    if (strcmp(string, "023760") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsUnknownSession = YES; }
+    if (strcmp(string, "023761") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsServiceIDInvalid = YES; }
+    if (strcmp(string, "023762") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsPaymentSelectionInvalid = YES; }
+    if (strcmp(string, "023763") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsIdentificationSelectionInvalid = YES; }
+    if (strcmp(string, "023764") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsServiceSelectionInvalid = YES; }
+    if (strcmp(string, "023765") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCertificateExpired = YES; }
+    if (strcmp(string, "023766") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCertificateNotYetValid = YES; }
+    if (strcmp(string, "023767") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCertificateRevoked = YES; }
+    if (strcmp(string, "023768") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsNoCertificateAvailable = YES; }
+    if (strcmp(string, "023769") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCertChainError = YES; }
+    if (strcmp(string, "023770") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCertValidationError = YES; }
+    if (strcmp(string, "023771") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCertVerificationError = YES; }
+    if (strcmp(string, "023772") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsContractCanceled = YES; }
+    if (strcmp(string, "023773") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsChallengeInvalid = YES; }
+    if (strcmp(string, "023774") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsWrongEnergyTransferMode = YES; }
+    if (strcmp(string, "023775") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsWrongChargeParameter = YES; }
+    if (strcmp(string, "023776") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsChargingProfileInvalid = YES; }
+    if (strcmp(string, "023777") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTariffSelectionInvalid = YES; }
+    if (strcmp(string, "023778") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsEVSEPresentVoltageToLow = YES; }
+    if (strcmp(string, "023779") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsPowerDeliveryNotApplied = YES; }
+    if (strcmp(string, "023780") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsMeteringSignatureNotValid = YES; }
+    if (strcmp(string, "023781") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsNoChargeServiceSelected = YES; }
+    if (strcmp(string, "023782") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsContactorError = YES; }
+    if (strcmp(string, "023783") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCertificateNotAllowedAtThisEVSE = YES; }
+    if (strcmp(string, "023784") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsGAChargeStop = YES; }
+    if (strcmp(string, "023785") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsAlignmentError = YES; }
+    if (strcmp(string, "023786") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsACDError = YES; }
+    if (strcmp(string, "023787") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsAssociationError = YES; }
+    if (strcmp(string, "023788") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsEVSEChargeAbort = YES; }
+    if (strcmp(string, "023789") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsNoSupportedAppProtocol = YES; }
+    if (strcmp(string, "023790") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsContractNotAccepted = YES; }
+    if (strcmp(string, "023791") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsMOUnknown = YES; }
+    if (strcmp(string, "023792") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsOEM_Prov_CertificateRevoke = YES; }
+    if (strcmp(string, "023793") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsOEM_SubCA1_CertificateRevoked = YES; }
+    if (strcmp(string, "023794") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsOEM_SubCA2_CertificateRevoked = YES; }
+    if (strcmp(string, "023795") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsOEM_RootCA_CertificateRevoked = YES; }
+    if (strcmp(string, "023796") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsMO_Prov_CertificateRevoked = YES; }
+    if (strcmp(string, "023797") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsMO_SubCA1_CertificateRevoked = YES; }
+    if (strcmp(string, "023798") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsMO_SubCA2_CertificateRevoked = YES; }
+    if (strcmp(string, "023799") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsMO_RootCA_CertificateRevoked = YES; }
+    if (strcmp(string, "023800") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCPS_Prov_CertificateRevoked = YES; }
+    if (strcmp(string, "023801") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCPS_SubCA1_CertificateRevoked = YES; }
+    if (strcmp(string, "023802") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCPS_SubCA2_CertificateRevoked = YES; }
+    if (strcmp(string, "023803") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCPS_RootCA_CertificateRevoked = YES; }
+    if (strcmp(string, "023809") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_EVSE_SLAC_init = YES; }
+    if (strcmp(string, "023810") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_match_response = YES; }
+    if (strcmp(string, "023811") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_match_sequence = YES; }
+    if (strcmp(string, "023812") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_EVSE_match_MNBC = YES; }
+    if (strcmp(string, "023813") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_EVSE_avg_atten_calc = YES; }
+    if (strcmp(string, "023814") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_match_response = YES; }
+    if (strcmp(string, "023815") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_EVSE_match_session = YES; }
+    if (strcmp(string, "023816") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_EVSE_assoc_session = YES; }
+    if (strcmp(string, "023817") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_EVSE_vald_toggle = YES; }
+    if (strcmp(string, "023818") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsSeccSlacTimeoutCmMnbcSound = YES; }
+    if (strcmp(string, "023819") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsSeccSlacTimeoutCmValidateReq = YES; }
+    if (strcmp(string, "023823") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsUDP_TT_match_join = YES; }
+    if (strcmp(string, "023824") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTCP_TT_match_join = YES; }
+    if (strcmp(string, "023825") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_amp_map_exchange = YES; }
+    if (strcmp(string, "023826") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_link_ready_notification = YES; }
+    if (strcmp(string, "023832") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsSupportedAppProtocolRes = YES; }
+    if (strcmp(string, "023833") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsSessionSetupRes = YES; }
+    if (strcmp(string, "023834") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsServiceDiscoveryRes = YES; }
+    if (strcmp(string, "023835") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsServicePaymentSelectionRes = YES; }
+    if (strcmp(string, "023836") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsContractAuthenticationRes = YES; }
+    if (strcmp(string, "023837") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsChargeParameterDiscoveryRes = YES; }
+    if (strcmp(string, "023838") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsPowerDeliveryRes = YES; }
+    if (strcmp(string, "023839") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCableCheckRes = YES; }
+    if (strcmp(string, "023840") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsPreChargeRes = YES; }
+    if (strcmp(string, "023841") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCurrentDemandRes = YES; }
+    if (strcmp(string, "023842") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsWeldingDetectionRes = YES; }
+    if (strcmp(string, "023843") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsSessionStopRes = YES; }
+    if (strcmp(string, "023844") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsSequence_Time = YES; }
+    if (strcmp(string, "023845") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsReadyToCharge_Performance_Time = YES; }
+    if (strcmp(string, "023846") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCommunicationSetup_Performance_Time = YES; }
+    if (strcmp(string, "023847") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCableCheck_Performance_Time = YES; }
+    if (strcmp(string, "023848") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCPState_Detection_Time = YES; }
+    if (strcmp(string, "023849") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCPOscillator_Retain_Time = YES; }
+    if (strcmp(string, "023850") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsSeccTimeoutV2GPreChargePerformaceTime = YES; }
+    if (strcmp(string, "023855") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_GET_EV_TARGET_INFO = YES; }
+    if (strcmp(string, "023856") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_GET_EV_TARGET_INFO = YES; }
+    if (strcmp(string, "023857") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_GET_EV_BATTERY_INFO = YES; }
+    if (strcmp(string, "023858") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_GET_EV_BATTERY_INFO = YES; }
+    if (strcmp(string, "023859") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_EV_STOP_EVENT = YES; }
+    if (strcmp(string, "023860") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_EV_STOP_EVENT = YES; }
+    if (strcmp(string, "023861") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_EVSE_STOP_EVENT = YES; }
+    if (strcmp(string, "023862") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_EVSE_STOP_EVENT = YES; }
+    if (strcmp(string, "023863") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_GET_MISC_INFO = YES; }
+    if (strcmp(string, "023864") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_GET_MISC_INFO = YES; }
+    if (strcmp(string, "023865") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_DOWNLOAD_REQUEST = YES; }
+    if (strcmp(string, "023866") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_DOWNLOAD_REQUEST = YES; }
+    if (strcmp(string, "023867") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_START_BLOCK_TRANSFER = YES; }
+    if (strcmp(string, "023868") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_START_BLOCK_TRANSFER = YES; }
+    if (strcmp(string, "023869") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_DATA_TRANSFER = YES; }
+    if (strcmp(string, "023870") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_DATA_TRANSFER = YES; }
+    if (strcmp(string, "023871") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_DOWNLOAD_FINISH = YES; }
+    if (strcmp(string, "023872") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_DOWNLOAD_FINISH = YES; }
+    if (strcmp(string, "023873") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_ISOLATION_STATUS = YES; }
+    if (strcmp(string, "023874") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_ISOLATION_STATUS = YES; }
+    if (strcmp(string, "023875") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_CONNECTOR_INFO = YES; }
+    if (strcmp(string, "023876") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_CONNECTOR_INFO = YES; }
+    if (strcmp(string, "023877") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_RTC_INFO = YES; }
+    if (strcmp(string, "023878") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_RTC_INFO = YES; }
+    if (strcmp(string, "023879") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_EVSE_PRECHARGE_INFO = YES; }
+    if (strcmp(string, "023880") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_EVSE_PRECHARGE_INFO = YES; }
+    if (strcmp(string, "023881") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsMSG_Sequence = YES; }
+    if (strcmp(string, "023882") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCAN_MSG_Unrecognized_CMD_ID = YES; }
+    if (strcmp(string, "023883") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsDIN_Msg_Decode_Error = YES; }
+    if (strcmp(string, "023884") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsDIN_Msg_Encode_Error = YES; }
+    if (strcmp(string, "023885") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsISO1_Msg_Decode_Error = YES; }
+    if (strcmp(string, "023886") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsISO1_Msg_Encode_Error = YES; }
+    if (strcmp(string, "023887") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsISO2_Msg_Decode_Error = YES; }
+    if (strcmp(string, "023888") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsISO2_Msg_Encode_Error = YES; }
+    if (strcmp(string, "023889") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCpStatus_Error = YES; }
+    if (strcmp(string, "023890") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsUnexpectVolBeforeCharing_Error = YES; }
+    if (strcmp(string, "023891") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsSeccNotReadyForCharging = YES; }
+    if (strcmp(string, "023892") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsSeccTimeoutQCA7000Comm = YES; }
+    if (strcmp(string, "023893") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsSeccFailForQCA7000SetKey = YES; }
+
+    if (strcmp(string, "023702") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.GbEvCommFail = YES; }
+    if (strcmp(string, "023900") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_LOS_CC1 = YES; }
+    if (strcmp(string, "023901") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_CONNECTOR_LOCK_FAIL = YES; }
+    if (strcmp(string, "023902") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_BATTERY_INCOMPATIBLE = YES; }
+    if (strcmp(string, "023903") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_BMS_BROAA_TIMEOUT = YES; }
+    if (strcmp(string, "023904") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_CSU_PRECHARGE_TIMEOUT = YES; }
+    if (strcmp(string, "023905") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_BMS_PRESENT_VOLTAGE_FAULT = YES; }
+    if (strcmp(string, "023906") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_BMS_VOLTAGE_OVER_RANGE = YES; }
+    if (strcmp(string, "023907") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_BSM_CHARGE_ALLOW_00_10MIN_COUUNTDONE = YES; }
+    if (strcmp(string, "023908") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_WAIT_GROUNDFAULT_TIMEOUT = YES; }
+    if (strcmp(string, "023909") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_ADC_MORE_THAN_10V = YES; }
+    if (strcmp(string, "023910") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_ADC_MORE_THAN_60V = YES; }
+    if (strcmp(string, "023911") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_CHARGER_GET_NORMAL_STOP_CMD = YES; }
+    if (strcmp(string, "023912") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_CHARGER_GET_EMERGENCY_STOP_CMD = YES; }
+    if (strcmp(string, "023913") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_ISOLATION_RESULT_FAIL = YES; }
+    if (strcmp(string, "023914") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_MOTHER_BOARD_MISS_LINK = YES; }
+    if (strcmp(string, "023915") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_OUTPUT_VOLTAGE_MORE_THAN_LIMIT = YES; }
+    if (strcmp(string, "023916") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_REQ_CURRENT_MORE_THAN_LIMIT = YES; }
+    if (strcmp(string, "023917") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_OUTPUT_VOLTAGE_MORE_THAN_10_PERCENT = YES; }
+    if (strcmp(string, "023918") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_OUTPUT_VOLTAGE_DIFF_BCS_5_PERCENT = YES; }
+    if (strcmp(string, "023919") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_STOP_ADC_MORE_THAN_10V = YES; }
+    if (strcmp(string, "023930") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_CEM_BHM_TIMEOUT = YES; }
+    if (strcmp(string, "023931") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_CEM_BRM_TIMEOUT = YES; }
+    if (strcmp(string, "023932") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_CEM_BCP_TIMEOUT = YES; }
+    if (strcmp(string, "023933") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_CEM_BRO_TIMEOUT = YES; }
+    if (strcmp(string, "023934") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_CEM_BCL_TIMEOUT = YES; }
+    if (strcmp(string, "023935") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_CEM_BCS_TIMEOUT = YES; }
+    if (strcmp(string, "023936") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_CEM_BSM_TIMEOUT = YES; }
+    if (strcmp(string, "023937") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_CEM_BST_TIMEOUT = YES; }
+    if (strcmp(string, "023938") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_CEM_BSD_TIMEOUT = YES; }
+    if (strcmp(string, "023939") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_CEM_BEM_OTHER_TIMEOUT = YES; }
+    if (strcmp(string, "023940") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BEM_CRM_TIMEOUT = YES; }
+    if (strcmp(string, "023941") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BEM_CRMAA_TIMEOUT = YES; }
+    if (strcmp(string, "023942") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BEM_CTS_CML_TIMEOUT = YES; }
+    if (strcmp(string, "023943") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BEM_CRO_TIMEOUT = YES; }
+    if (strcmp(string, "023944") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BEM_CCS_TIMEOUT = YES; }
+    if (strcmp(string, "023945") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BEM_CST_TIMEOUT = YES; }
+    if (strcmp(string, "023946") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BEM_CSD_TIMEOUT = YES; }
+    if (strcmp(string, "023947") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BEM_BEM_OTHER_TIMEOUT = YES; }
+    if (strcmp(string, "023950") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_SOC_GOAL = YES; }
+    if (strcmp(string, "023951") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_TOTAL_VOLTAGE_GOAL = YES; }
+    if (strcmp(string, "023952") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_CELL_VOLTAGE_GOAL = YES; }
+    if (strcmp(string, "023953") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_GET_CST = YES; }
+    if (strcmp(string, "023954") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_ISOLATION = YES; }
+    if (strcmp(string, "023955") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_OUTPUT_CONNECTOR_OTP = YES; }
+    if (strcmp(string, "023956") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_COMPONENT = YES; }
+    if (strcmp(string, "023957") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_CHARGE_CONNECTOR = YES; }
+    if (strcmp(string, "023958") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_OTP = YES; }
+    if (strcmp(string, "023959") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_OTHER = YES; }
+    if (strcmp(string, "023960") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_HIGH_V = YES; }
+    if (strcmp(string, "023961") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_CC2 = YES; }
+    if (strcmp(string, "023962") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_CURRENT = YES; }
+    if (strcmp(string, "023963") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_VOLTAGE = YES; }
+    if (strcmp(string, "023964") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GET_BST_NO_REASON = YES; }
+    if (strcmp(string, "023970") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BSM_CELL_OVER_VOLTAGE = YES; }
+    if (strcmp(string, "023971") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BSM_CELL_UNDER_VOLTAGE = YES; }
+    if (strcmp(string, "023972") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BSM_OVER_SOC = YES; }
+    if (strcmp(string, "023973") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BSM_UNDER_SOC = YES; }
+    if (strcmp(string, "023974") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BSM_CURRENT = YES; }
+    if (strcmp(string, "023975") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BSM_TEMPERATURE = YES; }
+    if (strcmp(string, "023976") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BSM_ISOLATE = YES; }
+    if (strcmp(string, "023977") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BSM_OUTPUT_CONNECTOR = YES; }
+}
+
+void CANReceiver()
+{
+    pid_t canRecPid;
+
+    canRecPid = fork();
+
+    if (canRecPid > 0) {
+        int nbytes;
+        struct can_frame frame;
+        int intCmd;
+
+        // 槍資訊
+        struct ChargingInfoData *_chargingData[CHAdeMO_QUANTITY + CCS_QUANTITY + GB_QUANTITY];
+        struct timeval _cmd_ack_timeout[CHAdeMO_QUANTITY + CCS_QUANTITY + GB_QUANTITY];
+
+        bool isPass = false;
+        gun_count = ShmSysConfigAndInfo->SysConfig.TotalConnectorCount;
+
+        while (!isPass) {
+            isPass = true;
+            for (byte _index = 0; _index < gun_count; _index++) {
+                if (!FindChargingInfoData(_index, &_chargingData[0])) {
+                    DEBUG_ERROR("EvComm (main) : FindChargingInfoData false \n");
+                    isPass = false;
+                    break;
+                }
+            }
+
+            sleep(1);
+        }
+
+        for (byte _index = 0; _index < gun_count; _index++) {
+            gettimeofday(&_cmd_ack_timeout[_index], NULL);
+        }
+
+        while (1) {
+            memset(&frame, 0, sizeof(struct can_frame));
+            nbytes = read(CanFd, &frame, sizeof(struct can_frame));
+
+            for (byte _index = 0; _index < gun_count; _index++) {
+                if (GetTimeoutValue(_cmd_ack_timeout[_index]) >= 5000000) {
+                    // ACK timeout
+                    //PRINTF_FUNC("gun = %x, ack timeout \n", _index);
+                }
+            }
+
+            if (nbytes > 0) {
+                byte target;
+                byte targetGun = 0x00;
+                intCmd = (int) (frame.can_id & CAN_EFF_MASK);
+
+                if (intCmd == ADDRESS_REQ) {
+                    AddrAssignment(frame.data);
+                    continue;
+                }
+                intCmd = (int) (frame.can_id & CAN_EFF_MASK & 0xFFFFFF00);
+                target = ((byte) (frame.can_id & 0x000000FF));      // 0x01 or 0x02
+
+                for (byte _index = 0; _index < gun_count; _index++) {
+                    if (_chargingData[_index]->Evboard_id == target) {
+                        targetGun = _index;
+                        break;
+                    }
+                }
+
+                if (targetGun < 0 || targetGun >= CHAdeMO_QUANTITY + CCS_QUANTITY + GB_QUANTITY) {
+                    PRINTF_FUNC("EvComm (CANReceiver) : Target index = %x is < 0 or > QUANTITY \n", targetGun);
+                    continue;
+                }
+                if (intCmd == 256) {
+                    continue;
+                }
+
+                gettimeofday(&_cmd_ack_timeout[targetGun], NULL);
+                switch (intCmd) {
+                case NOTIFICATION_EV_STATUS: {
+                    if (_chargingData[targetGun]->ConnectorPlugIn != frame.data[0]) {
+                        PRINTF_FUNC("index = %d, ConnectorPlugIn = %x, data[0] = %x \n", targetGun, _chargingData[targetGun]->ConnectorPlugIn, frame.data[0]);
+                    }
+
+                    _chargingData[targetGun]->ConnectorPlugIn = frame.data[0];
+                    _chargingData[targetGun]->PilotVoltage = frame.data[1];
+
+                    //PRINTF_FUNC("index = %d, ConnectorPlugIn = %x, data[0] = %x \n", targetGun, _chargingData[targetGun]->ConnectorPlugIn, frame.data[0]);
+                    //PRINTF_FUNC("ConnectorPlugIn = %x \n", (-120 + frame.data[1]) / 10);
+                }
+                break;
+                case ACK_EV_FW_VERSION: {
+                    byte ver[16];
+
+                    memset(ver, 0, sizeof(ver));
+                    if (_chargingData[targetGun]->Type == _Type_Chademo) {
+                        memcpy(ver, frame.data, frame.can_dlc);
+                        memcpy(ShmCHAdeMOData->evse[_chargingData[targetGun]->type_index].version, ver, ARRAY_SIZE(ver));
+                        ShmCHAdeMOData->evse[_chargingData[targetGun]->type_index].SelfTest_Comp = PASS;
+                        //PRINTF_FUNC("chademo ver. : %s\n", ShmCHAdeMOData->evse[_chargingData[targetGun]->type_index].version);
+                    } else if (_chargingData[targetGun]->Type == _Type_GB) {
+                        memcpy(ver, frame.data, frame.can_dlc);
+                        memcpy(ShmGBTData->evse[_chargingData[targetGun]->type_index].version, ver, ARRAY_SIZE(ver));
+                        ShmGBTData->evse[_chargingData[targetGun]->type_index].SelfTest_Comp = PASS;
+                        //PRINTF_FUNC("gbt ver. : %s\n", ShmGBTData->evse[_chargingData[targetGun]->type_index].version);
+                    } else if (_chargingData[targetGun]->Type == _Type_CCS_2) {
+                        if (ShmCcsData->CommProtocol == _CCS_COMM_V2GMessage_DIN70121) {
+                            for (byte _vCount = 0, _vPoint = 0; _vCount < frame.can_dlc; _vCount++) {
+                                /*if (_vCount % 2 == 0 && _vCount != 0)
+                                {
+                                    ver[_vCount + _vPoint] = 0x2E;
+                                    _vPoint++;
+                                }*/
+
+                                ver[_vCount + _vPoint] = frame.data[_vCount];
+                            }
+
+                            memcpy(&ShmCcsData->V2GMessage_DIN70121[_chargingData[targetGun]->type_index].version, ver, ARRAY_SIZE(ver));
+                            ShmCcsData->V2GMessage_DIN70121[_chargingData[targetGun]->type_index].SelfTest_Comp = PASS;
+                            //PRINTF_FUNC("CCS FW = %s \n", ShmCcsData->V2GMessage_DIN70121[_chargingData[targetGun]->type_index].version);
+                        }
+                    }
+
+                    if (targetGun == 0) {
+                        memset(ShmSysConfigAndInfo->SysInfo.Connector1FwRev, 0, sizeof(ShmSysConfigAndInfo->SysInfo.Connector1FwRev));
+                        memcpy(ShmSysConfigAndInfo->SysInfo.Connector1FwRev, ver, ARRAY_SIZE(ver));
+                    } else {
+                        memset(ShmSysConfigAndInfo->SysInfo.Connector2FwRev, 0, sizeof(ShmSysConfigAndInfo->SysInfo.Connector2FwRev));
+                        memcpy(ShmSysConfigAndInfo->SysInfo.Connector2FwRev, ver, ARRAY_SIZE(ver));
+                    }
+                }
+                break;
+                case ACK_EV_HW_VERSION: {
+                    //PRINTF_FUNC("Get EV HW = %s \n", frame.data);
+                }
+                break;
+                case ACK_GET_OUTPUT_REQ: {
+                    _chargingData[targetGun]->EvBatterySoc = frame.data[1];
+                    _chargingData[targetGun]->EvBatterytargetVoltage = (float)((frame.data[3] << 8) + frame.data[2]) / 10;
+                    _chargingData[targetGun]->EvBatterytargetCurrent = (float)((frame.data[5] << 8) + frame.data[4]) / 10;
+                    _chargingData[targetGun]->RemainChargingDuration = ((short) frame.data[7] << 8) + (short) frame.data[6];
+
+                    if (_chargingData[targetGun]->Type == _Type_Chademo) {
+                        //if (ShmCHAdeMOData->ev[_chargingData[targetGun]->type_index].EvDetection != frame.data[0])
+                        {
+                            ShmCHAdeMOData->ev[_chargingData[targetGun]->type_index].PresentMsgFlowStatus = frame.data[0];
+                        }
+
+                        ShmCHAdeMOData->ev[_chargingData[targetGun]->type_index].EvDetection = frame.data[0];
+                        ShmCHAdeMOData->ev[_chargingData[targetGun]->type_index].SOC = _chargingData[targetGun]->EvBatterySoc;
+                        ShmCHAdeMOData->ev[_chargingData[targetGun]->type_index].TargetBatteryVoltage = (_chargingData[targetGun]->EvBatterytargetVoltage * 10);
+                        ShmCHAdeMOData->ev[_chargingData[targetGun]->type_index].ChargingCurrentRequest = (_chargingData[targetGun]->EvBatterytargetCurrent * 10);
+                    } else if (_chargingData[targetGun]->Type == _Type_GB) {
+                        //if (ShmGBTData->ev[_chargingData[targetGun]->type_index].EvDetection != frame.data[0])
+                        {
+                            ShmGBTData->ev[_chargingData[targetGun]->type_index].PresentMsgFlowStatus = frame.data[0];
+                        }
+
+                        ShmGBTData->ev[_chargingData[targetGun]->type_index].EvDetection = frame.data[0];
+                        ShmGBTData->ev[_chargingData[targetGun]->type_index].SOC = _chargingData[targetGun]->EvBatterySoc;
+                        ShmGBTData->ev[_chargingData[targetGun]->type_index].TargetBatteryVoltage = (_chargingData[targetGun]->EvBatterytargetVoltage * 10);
+                        ShmGBTData->ev[_chargingData[targetGun]->type_index].ChargingCurrentRequest = (_chargingData[targetGun]->EvBatterytargetCurrent * 10);
+                    } else if (_chargingData[targetGun]->Type == _Type_CCS_2) {
+                        if (ShmCcsData->CommProtocol == _CCS_COMM_V2GMessage_DIN70121) {
+                            ShmCcsData->V2GMessage_DIN70121[_chargingData[targetGun]->type_index].PresentMsgFlowStatus = frame.data[0];
+                        }
+                    }
+
+                    //PRINTF_FUNC("EvBatterytargetVoltage = %f \n", _chargingData[targetGun]->EvBatterytargetVoltage);
+                    //PRINTF_FUNC("EvBatterytargetCurrent = %f \n", _chargingData[targetGun]->EvBatterytargetCurrent);
+                    //PRINTF_FUNC("BatteryVoltage = %d \n", ShmCHAdeMOData->ev[_chargingData[target]->type_index].TargetBatteryVoltage);
+                    //PRINTF_FUNC("CurrentRequest = %d \n", ShmCHAdeMOData->ev[_chargingData[target]->type_index].ChargingCurrentRequest);
+                }
+                break;
+                case ACK_GET_EV_BATTERY_INFO: {
+                    //_chargingData[target].EvACorDCcharging = frame.data[0];
+                    //_chargingData[target]->TotalBatteryCap = ((float) frame.data[4] << 8) + (short) frame.data[3];
+                    _chargingData[targetGun]->EvBatteryMaxVoltage = (((short) frame.data[4] << 8) + (short) frame.data[3]) / 10;
+                    //_chargingData[target]->EvBatteryMaxCurrent = ((float) frame.data[4] << 8) + (short) frame.data[3];
+                    //_chargingData[target].MaxiBatteryCurrent = ((short) frame.data[6] << 8) + (short) frame.data[5];
+                    if (_chargingData[targetGun]->Type == _Type_Chademo) {
+                        ShmCHAdeMOData->ev[_chargingData[targetGun]->type_index].TotalBatteryCapacity = ((short) frame.data[2] << 8) + (short) frame.data[1];
+                        ShmCHAdeMOData->ev[_chargingData[targetGun]->type_index].MaxiBatteryVoltage = _chargingData[targetGun]->EvBatteryMaxVoltage;
+
+                        //PRINTF_FUNC("EvBatteryMaxVoltage = %f \n", _chargingData[target]->EvBatteryMaxVoltage);
+                        //PRINTF_FUNC("TotalBatteryCapacity = %d \n", ShmCHAdeMOData->ev[_chargingData[target]->type_index].TotalBatteryCapacity);
+                        //PRINTF_FUNC("MaxiBatteryVoltage = %d \n", ShmCHAdeMOData->ev[_chargingData[target]->type_index].MaxiBatteryVoltage);
+                    } else if (_chargingData[targetGun]->Type == _Type_GB) {
+                        ShmGBTData->ev[_chargingData[targetGun]->type_index].TotalBatteryCapacity = ((short) frame.data[2] << 8) + (short) frame.data[1];
+                        ShmGBTData->ev[_chargingData[targetGun]->type_index].MaxiBatteryVoltage = _chargingData[targetGun]->EvBatteryMaxVoltage;
+                    } else if (_chargingData[targetGun]->Type == _Type_CCS_2) {
+
+                    }
+                }
+                break;
+                case ACK_GET_MISCELLANEOUS_INFO: {
+                    _chargingData[targetGun]->GunLocked = frame.data[0];
+                    _chargingData[targetGun]->PilotVoltage = (float)(-120 + frame.data[3]) / 10;
+
+                    if (_chargingData[targetGun]->Type == _Type_Chademo) {
+                        ShmCHAdeMOData->evse[_chargingData[targetGun]->type_index].ConnectorTemperatureP = frame.data[1];
+                        ShmCHAdeMOData->evse[_chargingData[targetGun]->type_index].ConnectorTemperatureN = frame.data[2];
+                        ShmCHAdeMOData->evse[_chargingData[targetGun]->type_index].EvboardStatus = frame.data[7];
+                    } else if (_chargingData[targetGun]->Type == _Type_GB) {
+                        ShmGBTData->evse[_chargingData[targetGun]->type_index].ConnectorTemperatureP = frame.data[1];
+                        ShmGBTData->evse[_chargingData[targetGun]->type_index].ConnectorTemperatureN = frame.data[2];
+                        ShmGBTData->evse[_chargingData[targetGun]->type_index].EvboardStatus = frame.data[7];
+                    } else if (_chargingData[targetGun]->Type == _Type_CCS_2) {
+                        if (ShmCcsData->CommProtocol == _CCS_COMM_V2GMessage_DIN70121) {
+                            //ShmCcsData->V2GMessage_DIN70121[_chargingData[targetGun]->type_index]. .ConnectorTemperatureP = frame.data[1];
+                            //ShmCcsData->V2GMessage_DIN70121[_chargingData[targetGun]->type_index]. .ConnectorTemperatureN = frame.data[2];
+                        }
+                    }
+
+                    //PRINTF_FUNC("EvboardStatus = %x \n", ShmCHAdeMOData->evse[_chargingData[target]->type_index].EvboardStatus);
+                    //PRINTF_FUNC("ConnectorPlug locked = %x \n", frame.data[0]);
+                    //PRINTF_FUNC("ConnectorTemp 0= %d \n", ShmCHAdeMOData->evse[_chargingData[target]->type_index].ConnectorTemperatureP);
+                    //PRINTF_FUNC("ConnectorTemp 1= %d \n", ShmCHAdeMOData->evse[_chargingData[target]->type_index].ConnectorTemperatureN);
+                    //PRINTF_FUNC("PilotVoltage = %x \n", (-120 + frame.data[3]) / 10);
+                }
+                break;
+                case ACK_EVSE_ISOLATION_STATUS: {}
+                    break;
+                case ACK_EVSE_PRECHAGE_INFO: {
+                    _chargingData[targetGun]->PrechargeStatus = frame.data[0];
+                }
+                break;
+                case NOTIFICATION_EV_STOP: {
+                    // 車端要求停止
+                    // frame.data[0] : 0x01 => normal stop, 0x02 => ev emergency stop
+                    PRINTF_FUNC("(%d) NOTIFICATION_EV_STOP err level = %d-----------------------------\n", targetGun, frame.data[0]);
+                    //if (frame.data[0] == 0x02)
+                    {
+                        AbnormalStopAnalysis(targetGun, frame.data + 1);
+                    }
+                    _chargingData[targetGun]->StopChargeFlag = YES;
+                }
+                break;
+                default:
+                    PRINTF_FUNC("EV board = %d, Ack none defined. intCmd = %d  \n", targetGun, intCmd);
+                    break;
+                }
+            }
+            usleep(10000);
+        }
+    }
+}
+
+//================================================
+// Main process
+//================================================
+// 檢查 Byte 中某個 Bit 的值
+// _byte : 欲改變的 byte
+// _bit : 該 byte 的第幾個 bit
+unsigned char EvDetectionStatus(unsigned char _byte, unsigned char _bit)
+{
+    return ( _byte & mask_table[_bit] ) != 0x00;
+}
+
+bool IsConnectorPlugIn(struct ChargingInfoData *chargingData)
+{
+    return (chargingData->ConnectorPlugIn == 0x01) ? true : false;
+}
+
+void SetPresentChargingOutputPower(struct ChargingInfoData *chargingData_1, struct ChargingInfoData *chargingData_2)
+{
+    float vol1 = 0, cur1 = 0;
+    float vol2 = 0, cur2 = 0;
+
+    vol1 = chargingData_1->FireChargingVoltage;
+    cur1 = (chargingData_1->PresentChargingCurrent * 10);
+    vol2 = chargingData_2->FireChargingVoltage;
+    cur2 = (chargingData_2->PresentChargingCurrent * 10);
+
+    if (_outVol_1 != vol1 ||
+            _outCur_1 != cur1 ||
+            _outVol_2 != vol2 ||
+            _outCur_2 != cur2) {
+        /*PRINTF_FUNC("G1 -> Output Vol = %f, Output Cur = %f -- G2 -> Output Vol = %f, Output Cur = %f \n",
+            vol1, cur1, vol2, cur2);
+        */
+        _outVol_1 = vol1; _outCur_1 = cur1; _outVol_2 = vol2; _outCur_2 = cur2;
+    }
+
+    SetPresentOutputPower(vol1, cur1, vol2, cur2);
+}
+
+void SetPresentChargingOutputCap(struct ChargingInfoData *chargingData_1, struct ChargingInfoData *chargingData_2)
+{
+    float pow1 = 0, cur1 = 0;
+    float pow2 = 0, cur2 = 0;
+    float vol = 0;
+
+    pow1 = chargingData_1->AvailableChargingPower;
+    cur1 = chargingData_1->AvailableChargingCurrent;
+
+    vol = chargingData_1->MaximumChargingVoltage;
+#ifndef DD360
+    GetMaxVolAndCurMethod(chargingData_1->Index, &vol, &cur1);
+    GetMaxPowerMethod(chargingData_1->Index, &pow1);
+#endif
+
+    pow2 = chargingData_2->AvailableChargingPower;
+    cur2 = chargingData_2->AvailableChargingCurrent;
+    vol = chargingData_2->MaximumChargingVoltage;
+#ifndef DD360
+    GetMaxVolAndCurMethod(chargingData_2->Index, &vol, &cur2);
+    GetMaxPowerMethod(chargingData_2->Index, &pow2);
+#endif
+
+    if (_pow_1 != pow1 ||
+            _cur_1 != cur1 ||
+            _pow_2 != pow2 ||
+            _cur_2 != cur2) {
+        PRINTF_FUNC("To EV (Real) Power_1 = %f, Cur_1 = %f, Power_2 = %f, Cur_2 = %f \n",
+                    pow1, cur1, pow2, cur2);
+        _pow_1 = pow1; _cur_1 = cur1; _pow_2 = pow2; _cur_2 = cur2;
+        chargingData_1->RealMaxCurrent = _cur_1;
+        chargingData_1->RealMaxPower = pow1;
+
+        if (gun_count == 2) {
+            chargingData_2->RealMaxCurrent = cur2;
+            chargingData_2->RealMaxPower = pow2;
+        }
+    }
+
+    SetPresentOutputCapacity(pow1, cur1, pow2, cur2);
+}
+
+void Initialization()
+{
+    bool isPass = false;
+    while (!isPass) {
+        isPass = true;
+        for (byte _index = 0; _index < gun_count; _index++) {
+            if (!FindChargingInfoData(_index, &_chargingData[0])) {
+                DEBUG_ERROR("EvComm (main) : FindChargingInfoData false \n");
+                isPass = false;
+                break;
+            }
+        }
+        sleep(1);
+    }
+}
+
+void GetMaxVolAndCurMethod(byte index, float *vol, float *cur)
+{
+    if (maxChargingVol[index] != 0 && maxChargingVol[index] <= *vol) {
+        *vol = maxChargingVol[index];
+    }
+
+    if (maxChargingCur[index] != 0 && maxChargingCur[index] <= *cur) {
+        *cur = maxChargingCur[index];
+    }
+
+    if (_chargingData[index]->SystemStatus == S_CHARGING &&
+            _chargingData[index]->ChargingProfileCurrent > 0 &&
+            _chargingData[index]->ChargingProfileCurrent <= *cur) {
+        *cur = _chargingData[index]->ChargingProfileCurrent;
+    }
+}
+
+void GetMaxPowerMethod(byte index, float *pow)
+{
+    if (maxChargingPow != 0 && maxChargingPow <= *pow) {
+        *pow = maxChargingPow;
+    }
+
+    if (_chargingData[index]->SystemStatus == S_CHARGING &&
+            _chargingData[index]->ChargingProfilePower > 0 &&
+            _chargingData[index]->ChargingProfilePower <= *pow) {
+        *pow = _chargingData[index]->ChargingProfilePower;
+    }
+}
+
+time_t GetRtcInfoForEpoch()
+{
+    struct timeb csuTime;
+    struct tm *tmCSU;
+    struct tm t;
+    time_t result;
+
+    ftime(&csuTime);
+    tmCSU = localtime(&csuTime.time);
+
+    t.tm_year = tmCSU->tm_year;
+    t.tm_mon = tmCSU->tm_mon;
+    t.tm_mday = tmCSU->tm_mday;
+    t.tm_hour = tmCSU->tm_hour;
+    t.tm_min = tmCSU->tm_min;
+    t.tm_sec = tmCSU->tm_sec;
+    t.tm_isdst = -1;
+    result = mktime(&t);
+
+    return result;
+}
+
+byte GetStopChargingReasonByEvse(byte gunIndex, byte *reason)
+{
+    byte result = NO;
+
+    if (ShmStatusCodeData->AlarmCode.AlarmEvents.bits.EmergencyStopTrip == 0x01) {
+        // 012251
+        *(reason + 5)  = 0;
+        *(reason + 4)  = 1;
+        *(reason + 3)  = 2;
+        *(reason + 2)  = 2;
+        *(reason + 1)  = 5;
+        *(reason + 0)  = 1;
+        result = YES;
+    }
+
+    if (_chargingData[gunIndex]->Type == _Type_Chademo) {
+        if (ShmStatusCodeData->FaultCode.FaultEvents.bits.ChademoOutputRelayDrivingFault == YES) {
+            // 011012
+            *(reason + 5) = 0;
+            *(reason + 4) = 1;
+            *(reason + 3) = 1;
+            *(reason + 2) = 0;
+            *(reason + 1) = 1;
+            *(reason + 0) = 2;
+            result = YES;
+        } else if (ShmStatusCodeData->AlarmCode.AlarmEvents.bits.ChademoOutputUVPFail == YES) {
+            // 012289
+            *(reason + 5) = 0;
+            *(reason + 4) = 1;
+            *(reason + 3) = 2;
+            *(reason + 2) = 2;
+            *(reason + 1) = 8;
+            *(reason + 0) = 9;
+            result = YES;
+        } else if (ShmStatusCodeData->AlarmCode.AlarmEvents.bits.ChademoGfdTrip == YES) {
+            // 012234
+            *(reason + 5) = 0;
+            *(reason + 4) = 1;
+            *(reason + 3) = 2;
+            *(reason + 2) = 2;
+            *(reason + 1) = 3;
+            *(reason + 0) = 4;
+            result = YES;
+        }
+    } else if (_chargingData[gunIndex]->Type == _Type_GB) {
+        if (ShmStatusCodeData->FaultCode.FaultEvents.bits.ChademoOutputRelayDrivingFault == YES) {
+            // 012290
+            *(reason + 5) = 0;
+            *(reason + 4) = 1;
+            *(reason + 3) = 2;
+            *(reason + 2) = 2;
+            *(reason + 1) = 9;
+            *(reason + 0) = 0;
+            result = YES;
+        } else if (ShmStatusCodeData->AlarmCode.AlarmEvents.bits.GbGfdTrip == YES) {
+            // 012236
+            *(reason + 5) = 0;
+            *(reason + 4) = 1;
+            *(reason + 3) = 2;
+            *(reason + 2) = 2;
+            *(reason + 1) = 3;
+            *(reason + 0) = 6;
+            result = YES;
+        }
+    } else if (_chargingData[gunIndex]->Type == _Type_CCS_2) {
+        if (ShmStatusCodeData->FaultCode.FaultEvents.bits.CcsOutputRelayDrivingFault == YES) {
+            // 011014
+            *(reason + 5) = 0;
+            *(reason + 4) = 1;
+            *(reason + 3) = 1;
+            *(reason + 2) = 0;
+            *(reason + 1) = 1;
+            *(reason + 0) = 4;
+            result = YES;
+        } else if (ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CcsOutputUVPFail == YES) {
+            // 012288
+            *(reason + 5) = 0;
+            *(reason + 4) = 1;
+            *(reason + 3) = 2;
+            *(reason + 2) = 2;
+            *(reason + 1) = 8;
+            *(reason + 0) = 8;
+            result = YES;
+        } else if (ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CcsGfdTrip == YES) {
+            // 012235
+            *(reason + 5) = 0;
+            *(reason + 4) = 1;
+            *(reason + 3) = 2;
+            *(reason + 2) = 2;
+            *(reason + 1) = 3;
+            *(reason + 0) = 5;
+            result = YES;
+        }
+    }
+
+    return result;
+}
+
+int main(int argc, char *argv[])
+{
+    if (InitShareMemory() == FAIL) {
+#ifdef SystemLogMessage
+        DEBUG_ERROR("InitShareMemory NG\n");
+#endif
+        if (ShmStatusCodeData != NULL) {
+            ShmStatusCodeData->AlarmCode.AlarmEvents.bits.FailToCreateShareMemory = 1;
+        }
+        sleep(5);
+        return 0;
+    }
+
+    gun_count = ShmSysConfigAndInfo->SysConfig.TotalConnectorCount;
+    Initialization();
+    CanFd = InitCanBus();
+    CANReceiver();
+
+    byte priorityLow = 1;
+    time_t rtc = GetRtcInfoForEpoch();
+    while (CanFd) {
+        for (byte _index = 0; _index < gun_count; _index++) {
+            if (priorityLow == 1) {
+                // 優先權較低 - 只要有回應即不會再詢問
+                if (_chargingData[_index]->Type == _Type_Chademo &&
+                        ShmCHAdeMOData->evse[_chargingData[_index]->type_index].SelfTest_Comp != PASS) {
+                    SyncRtcInfo(_index, _chargingData[_index]->Evboard_id, (int)rtc);
+                    GetFirmwareVersion(_index, _chargingData[_index]->Evboard_id);
+                } else if (_chargingData[_index]->Type == _Type_GB &&
+                           ShmGBTData->evse[_chargingData[_index]->type_index].SelfTest_Comp != PASS) {
+                    SyncRtcInfo(_index, _chargingData[_index]->Evboard_id, (int)rtc);
+                    GetFirmwareVersion(_index, _chargingData[_index]->Evboard_id);
+                } else if (_chargingData[_index]->Type == _Type_CCS_2) {
+                    if (ShmCcsData->CommProtocol == _CCS_COMM_V2GMessage_DIN70121 &&
+                            ShmCcsData->V2GMessage_DIN70121[_chargingData[_index]->type_index].SelfTest_Comp != PASS) {
+                        SyncRtcInfo(_index, _chargingData[_index]->Evboard_id, (int)rtc);
+                        GetFirmwareVersion(_index, _chargingData[_index]->Evboard_id);
+                    }
+                }
+
+                // 固定要取得的資訊 : 1.槍鎖狀態, 2."Connector 1" 溫度, 3."Connector 2" 溫度, 4.Pilot Voltage
+                //PRINTF_FUNC("GetMiscellaneousInfo. index = %d, Eid = %d \n", _index, _chargingData[_index]->Evboard_id);
+                GetMiscellaneousInfo(_index,
+                                     _chargingData[_index]->RelayK1K2Status,
+                                     _chargingData[_index]->PresentChargedEnergy,
+                                     (_chargingData[_index]->PresentChargingVoltage * 10),
+                                     _chargingData[_index]->Evboard_id);
+            }
+
+            switch (_chargingData[_index]->SystemStatus) {
+            case S_IDLE:
+            case S_RESERVATION:
+                if (_chargingData[_index]->Type == _Type_Chademo) {
+                    ClearAbnormalStatus_Chademo(_index);
+                } else if (_chargingData[_index]->Type == _Type_GB) {
+                    ClearAbnormalStatus_GB(_index);
+                } else if (_chargingData[_index]->Type == _Type_CCS_2) {
+                    ClearAbnormalStatus_CCS(_index);
+                }
+
+                if (priorityLow == 1) {
+                    _chargingData[_index]->PresentChargedEnergy = 0;
+                    _chargingData[_index]->PresentChargingPower = 0;
+                    _chargingData[_index]->GroundFaultStatus = GFD_WAIT;
+                    _chargingData[_index]->RealRatingPower = 0;
+                    _chargingData[_index]->StopChargeFlag = NO;
+                    _chargingData[_index]->ChargingFee = 0.0;
+                    _chargingData[_index]->EvBatterySoc = 0;
+                    _chargingData[_index]->PresentChargingVoltage = 0;
+                    _chargingData[_index]->PresentChargingCurrent = 0;
+                    _chargingData[_index]->EvBatteryMaxVoltage = 0;
+
+                    chargingTime[_index] = 0;
+
+                    //maxChargingCur[_index] = ShmSysConfigAndInfo->SysConfig.MaxChargingCurrent * 10;
+                    maxChargingPow = (ShmSysConfigAndInfo->SysConfig.MaxChargingPower * 10);
+                }
+                break;
+            case S_PREPARNING: {
+                // 設定當前輸出
+                if (gun_count == 1) {
+                    SetPresentChargingOutputPower(_chargingData[0], _chargingData[0]);
+                } else if (gun_count == 2) {
+                    SetPresentChargingOutputPower(_chargingData[0], _chargingData[1]);
+                }
+
+                _chargingData[_index]->PowerConsumption = 0;
+            }
+            break;
+            case S_PREPARING_FOR_EV: {
+                // 開始確認車端是否同意開始充電 : 1.SOC, 2.Target Vol, 3.Target Cur, 4.Charging remaining time
+                GetOutputReq(_index, _chargingData[_index]->Evboard_id);
+
+//                  PRINTF_FUNC("PresentChargingVoltage = %f \n", _chargingData[_index]->PresentChargingVoltage);
+//                  PRINTF_FUNC("PresentChargingCurrent = %f \n", _chargingData[_index]->PresentChargingCurrent);
+//                  PRINTF_FUNC("AvailableChargingPower = %f \n", _chargingData[_index]->AvailableChargingPower);
+//                  PRINTF_FUNC("AvailableChargingCurrent = %f \n", _chargingData[_index]->AvailableChargingCurrent);
+//                  PRINTF_FUNC("MaximumChargingVoltage = %f \n", _chargingData[_index]->MaximumChargingVoltage);
+
+                // 設定當前輸出
+                if (gun_count == 1) {
+                    SetPresentChargingOutputPower(_chargingData[0], _chargingData[0]);
+                } else if (gun_count == 2) {
+                    SetPresentChargingOutputPower(_chargingData[0], _chargingData[1]);
+                }
+
+                if (priorityLow == 1) {
+                    float maxVol, maxCur;
+                    // 樁端輸出能力
+                    maxVol = _chargingData[_index]->MaximumChargingVoltage;
+                    maxCur = _chargingData[_index]->AvailableChargingCurrent;
+
+                    GetMaxVolAndCurMethod(_index, &maxVol, &maxCur);
+
+                    PRINTF_FUNC("To EV_%d Max_Vol = %f, Cap_Cur = %f, Cap_Pow = %f \n",
+                                _index, maxVol, maxCur, _chargingData[_index]->AvailableChargingPower);
+                    _chargingData[_index]->RealMaxVoltage = maxVol;
+
+                    SetChargingPermission(_index, START,
+                                          _chargingData[_index]->AvailableChargingPower,
+                                          maxCur,
+                                          maxVol,
+                                          _chargingData[_index]->Evboard_id);
+
+                    // 取得車端電池資訊 : 1.AC or DC ? 2.Total battery cap, 3.Max battery vol, 4.Max battery cur
+                    GetEvBatteryInfo(_index, _chargingData[_index]->Evboard_id);
+                }
+                gettimeofday(&_chk_ratingPower_timeout[_index], NULL);
+            }
+            break;
+            case S_PREPARING_FOR_EVSE:
+            case S_CCS_PRECHARGE_ST0:
+            case S_CCS_PRECHARGE_ST1: {
+                // 開始確認車端是否同意開始充電
+                GetOutputReq(_index, _chargingData[_index]->Evboard_id);
+
+                // 設定當前輸出
+                if (gun_count == 1) {
+                    SetPresentChargingOutputPower(_chargingData[0], _chargingData[0]);
+                } else if (gun_count == 2) {
+                    SetPresentChargingOutputPower(_chargingData[0], _chargingData[1]);
+                }
+
+                if (priorityLow % 5 == 1) {
+                    // 樁端輸出能力改變
+                    if (gun_count == 1) {
+                        SetPresentChargingOutputCap(_chargingData[0], _chargingData[0]);
+                    } else if (gun_count == 2) {
+                        SetPresentChargingOutputCap(_chargingData[0], _chargingData[1]);
+                    }
+                }
+                // 持續通知 Isolation 測試狀態
+                if (priorityLow == 1) {
+                    // 拉 500 V 如果在一秒鐘內 GFD 都符合則 PASS
+//                      if (_chargingData[_index]->FireChargingVoltage >= 3500)
+//                          _chargingData[_index]->GroundFaultStatus = GFD_PASS;
+
+                    //PRINTF_FUNC("To EV_%d GFD = %d \n",   _index, _chargingData[_index]->GroundFaultStatus);
+                    //if(_chargingData[_index]->GroundFaultStatus != GFD_WAIT)
+                    {
+                        //if ((GetTimeoutValue(_derating_time) / 1000) > 1000)
+                        unsigned char _result = _chargingData[_index]->GroundFaultStatus;
+
+                        // GB & Chademo ~ Warning 也先算 Pass，因為 CCS 認證會驗 Warning 故不可更動
+                        if (_chargingData[_index]->Type == _Type_Chademo ||
+                                _chargingData[_index]->Type == _Type_GB) {
+                            if (_result == GFD_WARNING) {
+                                _result = GFD_PASS;
+                            }
+                        }
+
+                        if (_result == GFD_WARNING || _result == GFD_PASS) {
+                            if (((GetTimeoutValue(_chk_ratingPower_timeout[_index]) / 1000) > 12000 &&
+                                    _chargingData[_index]->RealRatingPower > 0) ||
+                                    (GetTimeoutValue(_chk_ratingPower_timeout[_index]) / 1000) > 14000) {
+                                PRINTF_FUNC("**********EvComm : _index= %d, RealRatingPower = %d \n",
+                                            _index, _chargingData[_index]->RealRatingPower);
+                                //_result = GFD_PASS;
+                            } else {
+                                _result = GFD_WAIT;
+                            }
+                        }
+
+                        SetIsolationStatus(_index, _result, _chargingData[_index]->Evboard_id);
+                    }
+
+                    if (_chargingData[_index]->SystemStatus == S_CCS_PRECHARGE_ST0 &&
+                            _chargingData[_index]->PrechargeStatus == PRECHARGE_READY) {
+                        SetEvsePrechargeInfo(_index, PRECHARGE_PRERELAY_PASS, _chargingData[_index]->Evboard_id);
+                    }
+                }
+            }
+            break;
+            case S_CHARGING: {
+                // 計算 Power
+                _chargingData[_index]->PresentChargingPower = ((float)((_chargingData[_index]->PresentChargingVoltage) * (_chargingData[_index]->PresentChargingCurrent)) / 1000);
+
+                if (chargingTime[_index] == 0 ||
+                        chargingTime[_index] > _chargingData[_index]->PresentChargedDuration) {
+                    chargingTime[_index] = _chargingData[_index]->PresentChargedDuration;
+                } else {
+                    int passTime = _chargingData[_index]->PresentChargedDuration - chargingTime[_index];
+
+                    if (passTime > 0) {
+                        float changingPow = (_chargingData[_index]->PresentChargingPower) * passTime / 3600;
+                        if (ShmSysConfigAndInfo->SysConfig.BillingData.isBilling) {
+                            _chargingData[_index]->ChargingFee += changingPow * ShmSysConfigAndInfo->SysConfig.BillingData.Cur_fee;
+                        }
+
+                        _chargingData[_index]->PresentChargedEnergy += changingPow;
+                        _chargingData[_index]->PowerConsumption += changingPow;
+                        chargingTime[_index] = _chargingData[_index]->PresentChargedDuration;
+                    }
+                }
+
+                // 開始確認車端是否同意開始充電
+                GetOutputReq(_index, _chargingData[_index]->Evboard_id);
+
+                // 設定當前輸出
+                if (gun_count == 1) {
+                    SetPresentChargingOutputPower(_chargingData[0], _chargingData[0]);
+                } else if (gun_count == 2) {
+                    SetPresentChargingOutputPower(_chargingData[0], _chargingData[1]);
+                }
+
+                // for test end
+                if (priorityLow % 5 == 0) {
+                    // 樁端輸出能力改變
+                    if (gun_count == 1) {
+                        SetPresentChargingOutputCap(_chargingData[0], _chargingData[0]);
+                    } else if (gun_count == 2) {
+                        SetPresentChargingOutputCap(_chargingData[0], _chargingData[1]);
+                    }
+                }
+
+                if (_chargingData[_index]->GroundFaultStatus == GFD_FAIL) {
+                    SetIsolationStatus(_index, _chargingData[_index]->GroundFaultStatus, _chargingData[_index]->Evboard_id);
+                } else if (_chargingData[_index]->Type == _Type_CCS_2) {
+                    SetIsolationStatus(_index, _chargingData[_index]->GroundFaultStatus, _chargingData[_index]->Evboard_id);
+                }
+
+                // GFD 失敗再通知
+                if (priorityLow == 1) {
+                    if (_chargingData[_index]->Type == _Type_CCS_2 &&
+                            _chargingData[_index]->PrechargeStatus == PRECHARGE_READY) {
+                        SetEvsePrechargeInfo(_index, PRECHARGE_CHARELAY_PASS, _chargingData[_index]->Evboard_id);
+                    }
+                }
+            }
+            break;
+            case S_TERMINATING: {
+                // 設定當前輸出
+                if (gun_count == 1) {
+                    SetPresentChargingOutputPower(_chargingData[0], _chargingData[0]);
+                } else if (gun_count == 2) {
+                    SetPresentChargingOutputPower(_chargingData[0], _chargingData[1]);
+                }
+
+                // 槍鎖還在，則代表是樁端要求的停止
+                if (_chargingData[_index]->GunLocked == START ||
+                        _chargingData[_index]->Type == _Type_CCS_2) {
+                    byte normalStop = 0x01;
+                    byte stopReason[6] = { 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 };
+
+                    if (GetStopChargingReasonByEvse(_index, stopReason)) {
+                        normalStop = 0x02;
+                    }
+
+                    EvseStopChargingEvent(normalStop, stopReason, _chargingData[_index]->Evboard_id);
+                }
+
+                if (_chargingData[_index]->Type == _Type_CCS_2) {
+                    SetIsolationStatus(_index, _chargingData[_index]->GroundFaultStatus, _chargingData[_index]->Evboard_id);
+                }
+
+                GetOutputReq(_index, _chargingData[_index]->Evboard_id);
+            }
+            break;
+            case S_COMPLETE: {
+                // 設定當前輸出
+                if (gun_count == 1) {
+                    SetPresentChargingOutputPower(_chargingData[0], _chargingData[0]);
+                } else if (gun_count == 2) {
+                    SetPresentChargingOutputPower(_chargingData[0], _chargingData[1]);
+                }
+
+                if (priorityLow == 1) {
+                    float maxVol, maxCur;
+
+                    // 樁端輸出能力
+                    maxVol = _chargingData[_index]->MaximumChargingVoltage;
+                    maxCur = _chargingData[_index]->AvailableChargingCurrent;
+
+                    GetMaxVolAndCurMethod(_index, &maxVol, &maxCur);
+                    SetChargingPermission(_index, STOP,
+                                          _chargingData[_index]->AvailableChargingPower,
+                                          maxCur,
+                                          maxVol,
+                                          _chargingData[_index]->Evboard_id);
+                }
+            }
+            break;
+            }
+        }
+        priorityLow >= 20 ? priorityLow = 1 : priorityLow++;
+        usleep(45000); //EV 小板通訊 (50 ms)
+    }
+    DEBUG_INFO("Module_EvComm : Can-bus port = %d \n", CanFd);
+    return FAIL;
+}

EVSE/Projects/DD360ComBox/Apps/Module_EvComm.h

@@ -0,0 +1,88 @@
+#ifndef MODULE_EVCOMM_H_
+#define MODULE_EVCOMM_H_
+
+#include    <stdbool.h>
+
+int CanFd;
+
+typedef unsigned char       byte;
+
+extern struct Ev_Board_Cmd {
+    int none;                           // 0
+    int address_assignment;             // 0x00000200
+    int get_firmware_ver;               // 0x00000400
+    int get_hardware_ver;               // 0x00000500
+    int charging_permission;            // 0x00000600
+    int present_output_power;           // 0x00000700
+    int present_output_cap;             // 0x00000800
+    int get_output_req;                 // 0x00000900
+    int get_battery_info;               // 0x00000A00
+    int evse_stop_charging;             // 0x00000C00
+    int get_miscellaneous_info;         // 0x00000D00
+
+    int download_req;                   // 0x00000E00
+    int start_block_transfer;           // 0x00000F00
+    int data_transfer;                  // 0x00001000
+    int download_finish;                // 0x00001100
+
+    int isolation_status;               // 0x00001200
+    int sync_rtc_info;                  // 0x00001400
+    int evse_precharge_info;            // 0x00001500
+} Ev_Cmd;
+
+extern struct Ev_Cmd_Dir {
+    unsigned short master_to_slave;
+    unsigned short slave_to_master;
+} Ev_Dir;
+
+struct timeval _id_assign_time;
+
+// Send msg to can-bus
+void SetTargetAddr(byte *target_number, byte index);
+
+void GetFirmwareVersion(byte gun_index, byte toId);
+void SyncRtcInfo(byte gun_index, byte toId, int epoch);
+void GetHardwareVersion(byte gun_index, byte toId);
+void SetChargingPermission(byte gun_index, byte permissionStatus, short aOutputPw, short aOutputVol, short aOutputCur, byte toId);
+void SetPresentOutputPower(short outputVol_b1, short outputCur_b1, short outputVol_b2, short outputCur_b2);
+void SetPresentOutputCapacity(short aOutputPw_b1, short aOutputCur_b1, short aOutputPw_b2, short aOutputCur_b2);
+void GetOutputReq(byte gun_index, byte toId);
+void GetEvBatteryInfo(byte gun_index, byte toId);
+void GetMiscellaneousInfo(byte gun_index, byte relayStatus, float power, float voltage, byte toId);
+void SetIsolationStatus(byte gun_index, byte result, byte toId);
+void SetEvsePrechargeInfo(byte gun_index, byte result, byte toId);
+// 發送電樁主動停止充電結果及原因
+void EvseStopChargingEvent(byte stopResult, byte *stopReason, byte toId);
+
+// Receive msg From can-bus.
+
+enum Receieve_PSU_msgf {
+    // 車端主動
+    ADDRESS_REQ =                       0x080001FF,
+    NOTIFICATION_EV_STATUS =            0x08000300,
+    NOTIFICATION_EV_STOP =              0x08000B00,
+
+    // 車端回應
+    ACK_EV_FW_VERSION =                 0x08000400,
+    ACK_EV_HW_VERSION =                 0x08000500,
+    ACK_GET_OUTPUT_REQ =                0x08000900,
+    ACK_GET_EV_BATTERY_INFO =           0x08000A00,
+    ACK_GET_MISCELLANEOUS_INFO =        0x08000D00,
+    ACK_EVSE_ISOLATION_STATUS =         0x08001200,
+    ACK_EVSE_PRECHAGE_INFO =            0x08001500,
+};
+
+//DS60-120 add
+enum EV_LOG_INDEX {
+    EV_LOG_OUTPUT_CAP_POW = 0,
+    EV_LOG_OUTPUT_CAP_CUR = 1,
+    EV_LOG_NOW_OUTPUT_VOL = 2,
+    EV_LOG_NOW_OUTPUT_CUR = 3,
+    EV_LOG_EVSE_MAX_VOL =   4,
+    EV_LOG_EVSE_MAX_CUR =   5,
+    EV_LOG_MAX_BATT_VOL =   6,
+    EV_LOG_REAL_CAP_POW =   7,
+    EV_LOG_SOC =            8
+};
+#endif /* MODULE_EVCOMM_H_ */
+

EVSE/Projects/DD360ComBox/Apps/Module_EventLogging.c

@@ -0,0 +1,324 @@
+#include 	<sys/time.h>
+#include 	<sys/timeb.h>
+#include    <sys/types.h>
+#include    <sys/stat.h>
+#include 	<sys/types.h>
+#include 	<sys/ioctl.h>
+#include 	<sys/socket.h>
+#include 	<sys/ipc.h>
+#include 	<sys/shm.h>
+#include 	<sys/shm.h>
+#include 	<sys/mman.h>
+#include 	<linux/wireless.h>
+#include 	<arpa/inet.h>
+#include 	<netinet/in.h>
+
+#include 	<unistd.h>
+#include 	<stdarg.h>
+#include    <stdio.h>      /*標準輸入輸出定義*/
+#include    <stdlib.h>     /*標準函數庫定義*/
+#include    <unistd.h>     /*Unix 標準函數定義*/
+#include    <fcntl.h>      /*檔控制定義*/
+#include    <termios.h>    /*PPSIX 終端控制定義*/
+#include    <errno.h>      /*錯誤號定義*/
+#include 	<errno.h>
+#include 	<string.h>
+#include	<time.h>
+#include	<ctype.h>
+#include 	<ifaddrs.h>
+#include	"../../define.h"
+
+#define ARRAY_SIZE(A)		(sizeof(A) / sizeof(A[0]))
+#define PASS				1
+#define FAIL				-1
+#define YES					1
+#define NO					0
+
+struct SysConfigAndInfo			*ShmSysConfigAndInfo;
+struct StatusCodeData 			*ShmStatusCodeData;
+
+void PRINTF_FUNC(char *string, ...);
+
+int StoreLogMsg(const char *fmt, ...);
+#define DEBUG_INFO(format, args...) StoreLogMsg("[%s:%d][%s][Info] "format, __FILE__, __LINE__, __FUNCTION__, ##args)
+#define DEBUG_WARN(format, args...) StoreLogMsg("[%s:%d][%s][Warn] "format, __FILE__, __LINE__, __FUNCTION__, ##args)
+#define DEBUG_ERROR(format, args...) StoreLogMsg("[%s:%d][%s][Error] "format, __FILE__, __LINE__, __FUNCTION__, ##args)
+
+int StoreLogMsg(const char *fmt, ...)
+{
+	char Buf[4096+256];
+	char buffer[4096];
+	va_list args;
+	struct timeb  SeqEndTime;
+	struct tm *tm;
+
+	va_start(args, fmt);
+	int rc = vsnprintf(buffer, sizeof(buffer), fmt, args);
+	va_end(args);
+
+	memset(Buf,0,sizeof(Buf));
+	ftime(&SeqEndTime);
+	SeqEndTime.time = time(NULL);
+	tm=localtime(&SeqEndTime.time);
+
+	if (ShmSysConfigAndInfo->SysConfig.SwitchDebugFlag == YES)
+	{
+		sprintf(Buf,"%02d:%02d:%02d:%03d - %s",
+			tm->tm_hour,tm->tm_min,tm->tm_sec,SeqEndTime.millitm, buffer);
+		printf("%s \n", Buf);
+	}
+	else
+	{
+		sprintf(Buf,"echo \"%04d-%02d-%02d %02d:%02d:%02d:%03d - %s\" >> /Storage/SystemLog/[%04d.%02d]SystemLog",
+			tm->tm_year+1900,tm->tm_mon+1,tm->tm_mday,tm->tm_hour,tm->tm_min,tm->tm_sec,SeqEndTime.millitm,
+			buffer,
+			tm->tm_year+1900,tm->tm_mon+1);
+		system(Buf);
+	}
+
+	return rc;
+}
+
+int DiffTimeb(struct timeb ST, struct timeb ET)
+{
+	//return milli-second
+	unsigned int StartTime,StopTime;
+
+	StartTime=(unsigned int)ST.time;
+	StopTime=(unsigned int)ET.time;
+	return (StopTime-StartTime)*1000+ET.millitm-ST.millitm;
+}
+
+void PRINTF_FUNC(char *string, ...)
+{
+	va_list args;
+	char buffer[4096];
+	va_start(args, string);
+	vsnprintf(buffer, sizeof(buffer), string, args);
+	va_end(args);
+
+	DEBUG_INFO("%s \n", buffer);
+}
+
+//=================================
+// Common routine
+//=================================
+char* getTimeString(void)
+{
+	char *result=malloc(21);
+	time_t timep;
+	struct tm *p;
+	time(&timep);
+	p=gmtime(&timep);
+
+	sprintf(result, "[%04d-%02d-%02d %02d:%02d:%02d]", (1900+p->tm_year), (1+p->tm_mon), p->tm_mday, p->tm_hour, p->tm_hour, p->tm_sec);
+
+	return result;
+}
+
+//==========================================
+// Init all share memory
+//==========================================
+int InitShareMemory()
+{
+	int result = PASS;
+	int MeterSMId;
+
+	//creat ShmSysConfigAndInfo
+	if ((MeterSMId = shmget(ShmSysConfigAndInfoKey, sizeof(struct SysConfigAndInfo),  0777)) < 0)
+    {
+		#ifdef SystemLogMessage
+		DEBUG_ERROR("shmget ShmSysConfigAndInfo NG\n");
+		#endif
+		result = FAIL;
+	}
+    else if ((ShmSysConfigAndInfo = shmat(MeterSMId, NULL, 0)) == (void *) -1)
+    {
+    	#ifdef SystemLogMessage
+    	DEBUG_ERROR("shmat ShmSysConfigAndInfo NG\n");
+		#endif
+    	result = FAIL;
+   	 }
+    else
+    {}
+
+   	 //creat ShmStatusCodeData
+   	 if ((MeterSMId = shmget(ShmStatusCodeKey, sizeof(struct StatusCodeData),  0777)) < 0)
+    {
+		#ifdef SystemLogMessage
+   		DEBUG_ERROR("shmget ShmStatusCodeData NG\n");
+		#endif
+   		result = FAIL;
+	}
+    else if ((ShmStatusCodeData = shmat(MeterSMId, NULL, 0)) == (void *) -1)
+    {
+    	#ifdef SystemLogMessage
+    	DEBUG_ERROR("shmat ShmStatusCodeData NG\n");
+		#endif
+    	result = FAIL;
+   	}
+    else
+    {}
+
+    return result;
+}
+
+//================================================
+// Main process
+//================================================
+void AddFaultCodeToBuf(unsigned char *Code)
+{
+	if(ShmSysConfigAndInfo->SysWarningInfo.WarningCount < 10)
+	{
+		memcpy(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[ShmSysConfigAndInfo->SysWarningInfo.WarningCount][0], Code, 7);
+		ShmSysConfigAndInfo->SysWarningInfo.WarningCount++;
+	}
+}
+
+void RemoveFaultCodeToBuf(unsigned char *Code)
+{
+	unsigned char find = 0x01;
+	char _code[7];
+	sprintf(_code,"%s", Code);
+
+	// 把相關的錯誤碼一次移除，避免重複顯示
+	while(find)
+	{
+		find = 0x00;
+		for(unsigned char i = 0; i < ShmSysConfigAndInfo->SysWarningInfo.WarningCount; i++)
+		{
+			if (find == 0x00)
+			{
+				if(memcmp(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i][0], _code, 7) == 0)
+				{
+					find = 0x01;
+				}
+			}
+			else
+			{
+				memcpy(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i - 1][0],
+					&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i][0], 7);
+			}
+		}
+
+		if (find)
+		{
+			ShmSysConfigAndInfo->SysWarningInfo.WarningCount--;
+		}
+	}
+}
+
+int main(void)
+{
+	int ByteCount,BitCount;
+	unsigned char tmp, EventCodeTmp[7];
+
+	if(InitShareMemory() == FAIL)
+	{
+		#ifdef SystemLogMessage
+		DEBUG_ERROR("InitShareMemory NG\n");
+		#endif
+		if(ShmStatusCodeData!=NULL)
+		{
+			ShmStatusCodeData->AlarmCode.AlarmEvents.bits.FailToCreateShareMemory=1;
+		}
+		sleep(5);
+		return 0;
+	}
+
+	for(;;)
+	{
+		//check Fault Status
+		for(ByteCount=0;ByteCount<sizeof(ShmStatusCodeData->FaultCode.PreviousFaultVal);ByteCount++)
+		{
+			if(ShmStatusCodeData->FaultCode.FaultEvents.FaultVal[ByteCount] != ShmStatusCodeData->FaultCode.PreviousFaultVal[ByteCount])
+			{
+				tmp=ShmStatusCodeData->FaultCode.FaultEvents.FaultVal[ByteCount]; //prevent be modified during following process
+				for(BitCount=0;BitCount<8;BitCount++)
+				{
+					if(((tmp>>BitCount)&0x01) != ((ShmStatusCodeData->FaultCode.PreviousFaultVal[ByteCount]>>BitCount)&0x01))
+					{
+						memset(EventCodeTmp,0,sizeof(EventCodeTmp));
+						memcpy(EventCodeTmp,FaultStatusCode[ByteCount*8+BitCount],sizeof(EventCodeTmp)-1);
+						if(((tmp>>BitCount)&0x01)==0)//Recovered
+						{
+							//EventCodeTmp[0]=1;
+							DEBUG_INFO("Recovery Fault Code = %s\n", EventCodeTmp);
+							ShmStatusCodeData->FaultCode.PreviousFaultVal[ByteCount] &= ~(1<<BitCount);
+							RemoveFaultCodeToBuf(EventCodeTmp);
+						}
+						else
+						{
+							DEBUG_INFO("Fault Code = %s\n", EventCodeTmp);
+							ShmStatusCodeData->FaultCode.PreviousFaultVal[ByteCount] |= (1<<BitCount);
+							AddFaultCodeToBuf(EventCodeTmp);
+						}
+					}
+				}
+			}
+		}
+
+		//check Alarm Status
+		for(ByteCount=0;ByteCount<sizeof(ShmStatusCodeData->AlarmCode.PreviousAlarmVal);ByteCount++)
+		{
+			if(ShmStatusCodeData->AlarmCode.AlarmEvents.AlarmVal[ByteCount] != ShmStatusCodeData->AlarmCode.PreviousAlarmVal[ByteCount])
+			{
+				tmp=ShmStatusCodeData->AlarmCode.AlarmEvents.AlarmVal[ByteCount]; //prevent be modified during following process
+				for(BitCount=0;BitCount<8;BitCount++)
+				{
+					if(((tmp>>BitCount)&0x01) != ((ShmStatusCodeData->AlarmCode.PreviousAlarmVal[ByteCount]>>BitCount)&0x01))
+					{
+						memset(EventCodeTmp,0,sizeof(EventCodeTmp));
+						memcpy(EventCodeTmp,AlarmStatusCode[ByteCount*8+BitCount],sizeof(EventCodeTmp)-1);
+						if(((tmp>>BitCount)&0x01)==0)//Recovered
+						{
+							//EventCodeTmp[0]=1;
+							DEBUG_INFO("Recovery Alarm Code = %s\n", EventCodeTmp);
+							ShmStatusCodeData->AlarmCode.PreviousAlarmVal[ByteCount] &= ~(1<<BitCount);
+							RemoveFaultCodeToBuf(EventCodeTmp);
+						}
+						else
+						{
+							DEBUG_INFO("Alarm Code = %s\n", EventCodeTmp);
+							ShmStatusCodeData->AlarmCode.PreviousAlarmVal[ByteCount] |= (1<<BitCount);
+							AddFaultCodeToBuf(EventCodeTmp);
+						}
+					}
+				}
+			}
+		}
+
+		//check Info Status
+		for(ByteCount=0;ByteCount<sizeof(ShmStatusCodeData->InfoCode.PreviousInfoVal);ByteCount++)
+		{
+			if(ShmStatusCodeData->InfoCode.InfoEvents.InfoVal[ByteCount] != ShmStatusCodeData->InfoCode.PreviousInfoVal[ByteCount])
+			{
+				tmp=ShmStatusCodeData->InfoCode.InfoEvents.InfoVal[ByteCount]; //prevent be modified during following process
+				for(BitCount=0;BitCount<8;BitCount++)
+				{
+					if(((tmp>>BitCount)&0x01) != ((ShmStatusCodeData->InfoCode.PreviousInfoVal[ByteCount]>>BitCount)&0x01))
+					{
+						memset(EventCodeTmp,0,sizeof(EventCodeTmp));
+						memcpy(EventCodeTmp,InfoStatusCode[ByteCount*8+BitCount],sizeof(EventCodeTmp)-1);
+						if(((tmp>>BitCount)&0x01)==0)//Recovered
+						{
+							//EventCodeTmp[0]=1;
+							DEBUG_INFO("Recovery Info Code = %s\n", EventCodeTmp);
+							ShmStatusCodeData->InfoCode.PreviousInfoVal[ByteCount] &= ~(1<<BitCount);
+							RemoveFaultCodeToBuf(EventCodeTmp);
+						}
+						else
+						{
+							DEBUG_INFO("Info Code = %s\n", EventCodeTmp);
+							ShmStatusCodeData->InfoCode.PreviousInfoVal[ByteCount] |= (1<<BitCount);
+							AddFaultCodeToBuf(EventCodeTmp);
+						}
+					}
+				}
+			}
+		}
+		usleep(500000);
+	}
+
+	return FAIL;
+}

EVSE/Projects/DD360ComBox/Apps/Module_InternalComm.c

@@ -0,0 +1,2409 @@
+#include    <sys/time.h>
+#include    <sys/timeb.h>
+#include    <sys/types.h>
+#include    <sys/stat.h>
+#include    <sys/types.h>
+#include    <sys/ioctl.h>
+#include    <sys/socket.h>
+#include    <sys/ipc.h>
+#include    <sys/shm.h>
+#include    <sys/shm.h>
+#include    <sys/mman.h>
+#include    <linux/wireless.h>
+#include    <arpa/inet.h>
+#include    <netinet/in.h>
+
+#include    <unistd.h>
+#include    <stdarg.h>
+#include    <stdio.h>      /*標準輸入輸出定義*/
+#include    <stdlib.h>     /*標準函數庫定義*/
+#include    <unistd.h>     /*Unix 標準函數定義*/
+#include    <fcntl.h>      /*檔控制定義*/
+#include    <termios.h>    /*PPSIX 終端控制定義*/
+#include    <errno.h>      /*錯誤號定義*/
+#include    <errno.h>
+#include    <string.h>
+#include    <time.h>
+#include    <ctype.h>
+#include    <ifaddrs.h>
+#include    <math.h>
+#include    "../../define.h"
+#include    "internalComm.h"
+#include    <stdbool.h>
+
+#define AudiCustomized              1
+#define ARRAY_SIZE(A)       (sizeof(A) / sizeof(A[0]))
+#define PASS                1
+#define FAIL                -1
+#define YES                 1
+#define NO                  0
+#define TEN_MINUTES         600
+#define ENV_TEMP_MIN        45
+#define ENV_TEMP_MAX        50
+#define DEFAULT_AC_INDEX    2
+#define EQUAL               0
+#define COLOR_MAX_LV        100
+#define COLOR_MIN_LV        0
+
+#define AC_DEFAULT_VOL      220
+
+#define NO_DEFINE           255
+#define NDEFAULT_AC_INDEX   2
+
+struct SysConfigAndInfo         *ShmSysConfigAndInfo;
+struct StatusCodeData           *ShmStatusCodeData;
+struct FanModuleData            *ShmFanModuleData;
+struct RelayModuleData          *ShmRelayModuleData;
+struct LedModuleData            *ShmLedModuleData;
+struct PsuData                  *ShmPsuData;
+struct OCPP16Data               *ShmOCPP16Data;
+
+#define VIN_MAX_VOLTAGE_IEC     285 // 大於該值 : OVP
+#define VIN_MIN_VOLTAGE_IEC     160 // 小於該值 : UVP
+#define VIN_MAX_VOLTAGE_UL      315 // 大於該值 : OVP // 美規 (W)
+#define VIN_MIN_VOLTAGE_UL      210 // 小於該值 : UVP
+
+#define VIN_DROP_VOLTAGE    150 // 小於該值 : ac drop
+
+#define VOUT_MAX_VOLTAGE    995
+#define VOUT_MIN_VOLTAGE    150
+#define IOUT_MAX_CURRENT    50
+
+#define MAX_FAN_SPEED       14000
+#define MIN_FAN_SPEED       3000
+#define NORMAL_FAN_SPEED    7000
+
+// GFD Status
+#define GFD_IDLE            0
+#define GFD_CABLECHK        1
+#define GFD_PRECHARGE       2
+#define GFD_CHARGING        3
+
+// LED Intensity (rate)
+#define LED_INTENSITY_DARKEST       0.2
+#define LED_INTENSITY_MEDIUM        0.6
+#define LED_INTENSITY_BRIGHTEST     1
+
+// EE Spec
+#define LED_BRIGHTNESS_LV_HIGH      1
+#define LED_BRIGHTNESS_LV_MID       0.5
+#define LED_BRIGHTNESS_LV_LOW       0.2
+
+// 最小切換 Relay 電壓
+#define SELF_TO_CHANGE_RELAY_STATUS         600
+// 透過電壓確認 Relay 是否搭上的依據電壓
+#define CHECK_RELAY_STATUS                  300
+#define CHECK_RELAY_STATUS_GAP              100
+// 安全在停止充電程序中斷開 Relay 的電流
+#define SEFETY_SWITCH_RELAY_CUR             20
+// 確認 Relay Welding 電壓
+#define RELAY_WELDING_DET                   300
+
+byte gunCount;
+byte acgunCount;
+// 槍資訊
+struct ChargingInfoData *_chargingData[CHAdeMO_QUANTITY + CCS_QUANTITY + GB_QUANTITY];
+struct ChargingInfoData *ac_chargingInfo[AC_QUANTITY];
+
+bool _isOutputNoneMatch[CHAdeMO_QUANTITY + CCS_QUANTITY + GB_QUANTITY];
+struct timeval _checkOutputNoneMatchTimer[CHAdeMO_QUANTITY + CCS_QUANTITY + GB_QUANTITY];
+
+bool _isRelayWelding[CHAdeMO_QUANTITY + CCS_QUANTITY + GB_QUANTITY];
+struct timeval _checkRelayWeldingTimer[CHAdeMO_QUANTITY + CCS_QUANTITY + GB_QUANTITY];
+
+bool FindChargingInfoData(byte target, struct ChargingInfoData **chargingData);
+
+int Uart5Fd;
+char *relayRs485PortName = "/dev/ttyS5";
+unsigned short fanSpeedSmoothValue = 500;
+
+bool isStopChargingCount = false;
+struct timeval _close_ac_contactor;
+
+struct timeval _priority_time;
+struct timeval _led_priority_time;
+
+struct timeval  _ac_charging_comp;
+struct timeval  _ac_preparing;
+struct timeb    _ac_startChargingTime;
+struct timeb    _ac_endChargingTime;
+
+unsigned short _setFanSpeed = 0;
+float _beforeChargingTotalEnergy = 0.0;
+byte _checkLedChanged = 3;
+
+Ver ver;
+PresentInputVoltage inputVoltage;
+PresentOutputVoltage outputVoltage;
+FanSpeed fanSpeed;
+Temperature temperature;
+AuxPower auxPower;
+Gfd gfd_adc;
+Gfd_config gfd_config;
+Gpio_in gpio_in;
+Gpio_out gpio_out;
+Relay outputRelay;
+Relay regRelay;
+Rtc rtc;
+Led_Color cur_led_color;
+Led_Color led_color;
+
+Ac_Status acStatus;
+Ac_Led_Status ledStatus;
+Ac_Alarm_code acAlarmCode;
+Ac_Charging_energy acChargingEnergy;
+Ac_Charging_current acChargingCurrent;
+
+#define AC_OVP                      1
+#define AC_UVP                      2
+#define AC_OCP                      4
+#define AC_OTP                      8
+#define AC_GMI_FAULT                16
+#define AC_CP_ERROR                 32
+#define AC_AC_LEAKAGE               64
+#define AC_DC_LEAKAGE               128
+#define AC_SYSTEM_SELFTEST_FAULT    256
+#define AC_HANDSHAKE_TIMEOUT        512
+#define AC_EMC_STOP                 1024
+#define AC_RELAY_WELDING            2048
+#define AC_GF_MODULE_FAULT          4096
+#define AC_SHUTTER_FAULT            8192
+#define AC_LOCKER_FAULT             16384
+#define AC_POWER_DROP               32768
+#define AC_CIRCUIT_SHORT            65536
+#define AC_ROTARY_SWITCH_FAULT      131072
+#define AC_RELAY_DRIVE_FAULT        262144
+
+int _alarm_code[] = {AC_OVP, AC_UVP, AC_OCP, AC_OTP, AC_GMI_FAULT, AC_CP_ERROR, AC_AC_LEAKAGE
+                     , AC_DC_LEAKAGE, AC_SYSTEM_SELFTEST_FAULT, AC_HANDSHAKE_TIMEOUT, AC_EMC_STOP, AC_RELAY_WELDING
+                     , AC_GF_MODULE_FAULT, AC_SHUTTER_FAULT, AC_LOCKER_FAULT, AC_POWER_DROP, AC_CIRCUIT_SHORT
+                     , AC_ROTARY_SWITCH_FAULT, AC_RELAY_DRIVE_FAULT
+                    };
+
+void PRINTF_FUNC(char *string, ...);
+
+int StoreLogMsg(const char *fmt, ...);
+unsigned long GetTimeoutValue(struct timeval _sour_time);
+
+#define DEBUG_INFO(format, args...) StoreLogMsg("[%s:%d][%s][Info] "format, __FILE__, __LINE__, __FUNCTION__, ##args)
+#define DEBUG_WARN(format, args...) StoreLogMsg("[%s:%d][%s][Warn] "format, __FILE__, __LINE__, __FUNCTION__, ##args)
+#define DEBUG_ERROR(format, args...) StoreLogMsg("[%s:%d][%s][Error] "format, __FILE__, __LINE__, __FUNCTION__, ##args)
+
+unsigned long GetTimeoutValue(struct timeval _sour_time)
+{
+    struct timeval _end_time;
+    gettimeofday(&_end_time, NULL);
+
+    return 1000000 * (_end_time.tv_sec - _sour_time.tv_sec) + _end_time.tv_usec - _sour_time.tv_usec;
+}
+
+int StoreLogMsg(const char *fmt, ...)
+{
+    char Buf[4096 + 256];
+    char buffer[4096];
+    va_list args;
+    struct timeb  SeqEndTime;
+    struct tm *tm;
+
+    va_start(args, fmt);
+    int rc = vsnprintf(buffer, sizeof(buffer), fmt, args);
+    va_end(args);
+
+    memset(Buf, 0, sizeof(Buf));
+    ftime(&SeqEndTime);
+    SeqEndTime.time = time(NULL);
+    tm = localtime(&SeqEndTime.time);
+
+    if (ShmSysConfigAndInfo->SysConfig.SwitchDebugFlag == YES) {
+        sprintf(Buf, "%02d:%02d:%02d:%03d - %s",
+                tm->tm_hour, tm->tm_min, tm->tm_sec, SeqEndTime.millitm, buffer);
+        printf("%s \n", Buf);
+    } else {
+        sprintf(Buf, "echo \"%04d-%02d-%02d %02d:%02d:%02d:%03d - %s\" >> /Storage/SystemLog/[%04d.%02d]SystemLog",
+                tm->tm_year + 1900, tm->tm_mon + 1, tm->tm_mday, tm->tm_hour, tm->tm_min, tm->tm_sec, SeqEndTime.millitm,
+                buffer,
+                tm->tm_year + 1900, tm->tm_mon + 1);
+        system(Buf);
+    }
+
+    return rc;
+}
+
+int DiffTimeb(struct timeb ST, struct timeb ET)
+{
+    //return milli-second
+    unsigned int StartTime, StopTime;
+
+    StartTime = (unsigned int) ST.time;
+    StopTime = (unsigned int) ET.time;
+    //return (StopTime-StartTime)*1000+ET.millitm-ST.millitm;
+    return (StopTime - StartTime);
+}
+
+unsigned short MaxValue(unsigned short value1, unsigned short value2)
+{
+    return value1 >= value2 ? value1 : value2;
+}
+
+void PRINTF_FUNC(char *string, ...)
+{
+    va_list args;
+    char buffer[4096];
+    va_start(args, string);
+    vsnprintf(buffer, sizeof(buffer), string, args);
+    va_end(args);
+
+    DEBUG_INFO("%s \n", buffer);
+}
+
+//==========================================
+// Communication Function
+//==========================================
+void GetFwAndHwVersion_Fan()
+{
+    if (Query_FW_Ver(Uart5Fd, Addr.Fan, &ver) == PASS) {
+        // FanModuleData
+        strcpy((char *) ShmFanModuleData->version, ver.Version_FW);
+        // SystemInfo
+        strcpy((char *) ShmSysConfigAndInfo->SysInfo.FanModuleFwRev, ver.Version_FW);
+        //PRINTF_FUNC("GetFwAndHwVersion_Fan s1 = %s \n", ver.Version_FW);
+    }
+
+    if (Query_HW_Ver(Uart5Fd, Addr.Fan, &ver) == PASS) {
+        // SystemInfo
+        strcpy((char *) ShmSysConfigAndInfo->SysInfo.FanModuleHwRev, ver.Version_FW);
+        //PRINTF_FUNC("GetFwAndHwVersion_Fan s2 = %s \n", ver.Version_HW);
+    }
+}
+
+void GetFwAndHwVersion_Relay()
+{
+    if (Query_FW_Ver(Uart5Fd, Addr.Relay, &ver) == PASS) {
+        // RelayModuleData
+        strcpy((char *) ShmRelayModuleData->version, ver.Version_FW);
+        // SystemInfo
+        strcpy((char *) ShmSysConfigAndInfo->SysInfo.RelayModuleFwRev, ver.Version_FW);
+        //PRINTF_FUNC("GetFwAndHwVersion_Relay s1 = %s \n", ver.Version_FW);
+    }
+
+    if (Query_HW_Ver(Uart5Fd, Addr.Relay, &ver) == PASS) {
+        // SystemInfo
+        strcpy((char *) ShmSysConfigAndInfo->SysInfo.RelayModuleHwRev, ver.Version_FW);
+        //PRINTF_FUNC("GetFwAndHwVersion_Relay s2 = %s \n", ver.Version_HW);
+    }
+}
+
+void GetFwAndHwVersion_Led()
+{
+    if (Query_FW_Ver(Uart5Fd, Addr.Led, &ver) == PASS) {
+        // LedModuleData
+        strcpy((char *) ShmLedModuleData->version, ver.Version_FW);
+        // SystemInfo
+        strcpy((char *) ShmSysConfigAndInfo->SysInfo.LedModuleFwRev, ver.Version_FW);
+        //PRINTF_FUNC("GetFwAndHwVersion_Led s1 = %s \n", ver.Version_FW);
+        //ShmLedModuleData->SelfTest_Comp = YES;
+    } else {
+        //PRINTF_FUNC("GetFwAndHwVersion_Led fail \n");
+    }
+
+//  if (Query_HW_Ver(Uart5Fd, Addr.Led, &ver) == PASS)
+//  {
+//      // SystemInfo
+//      strcpy((char *) ShmSysConfigAndInfo->SysInfo.RelayModuleHwRev, ver.Version_FW);
+//      //PRINTF_FUNC("GetFwAndHwVersion_Relay s2 = %s \n", ver.Version_HW);
+//  }
+}
+
+void GetFwVersion_AC()
+{
+    if (Query_FW_Ver(Uart5Fd, Addr.AcPlug, &ver) == PASS) {
+        ac_chargingInfo[0]->SelfTest_Comp = YES;
+        strcpy((char *) ac_chargingInfo[0]->version, ver.Version_FW);
+    }
+}
+
+void GetAcModelName()
+{
+    memset(ShmSysConfigAndInfo->SysConfig.AcModelName, 0x00, sizeof(ShmSysConfigAndInfo->SysConfig.AcModelName));
+    if (Query_Model_Name(Uart5Fd, Addr.AcPlug, ShmSysConfigAndInfo->SysConfig.AcModelName) == PASS) {
+        PRINTF_FUNC("ac model name = %s \n", ShmSysConfigAndInfo->SysConfig.AcModelName);
+    }
+}
+
+void SetRtcData_Relay()
+{
+    struct timeb csuTime;
+    struct tm *tmCSU;
+
+    ftime(&csuTime);
+    tmCSU = localtime(&csuTime.time);
+    //  PRINTF_FUNC("Time : %04d-%02d-%02d %02d:%02d:%02d \n", tmCSU->tm_year + 1900,
+    //          tmCSU->tm_mon + 1, tmCSU->tm_mday, tmCSU->tm_hour, tmCSU->tm_min,
+    //          tmCSU->tm_sec);
+
+    rtc.RtcData[0] = '0' + (tmCSU->tm_year + 1900) / 1000 % 10;
+    rtc.RtcData[1] = '0' + (tmCSU->tm_year + 1900) / 100 % 10;
+    rtc.RtcData[2] = '0' + (tmCSU->tm_year + 1900) / 10 % 10;
+    rtc.RtcData[3] = '0' + (tmCSU->tm_year + 1900) / 1 % 10;
+
+    rtc.RtcData[4] = '0' + (tmCSU->tm_mon + 1) / 10 % 10;
+    rtc.RtcData[5] = '0' + (tmCSU->tm_mon + 1) / 1 % 10;
+
+    rtc.RtcData[6] = '0' + (tmCSU->tm_mday) / 10 % 10;
+    rtc.RtcData[7] = '0' + (tmCSU->tm_mday) / 1 % 10;
+
+    rtc.RtcData[8] = '0' + (tmCSU->tm_hour) / 10 % 10;
+    rtc.RtcData[9] = '0' + (tmCSU->tm_hour) / 1 % 10;
+
+    rtc.RtcData[10] = '0' + (tmCSU->tm_min) / 10 % 10;
+    rtc.RtcData[11] = '0' + (tmCSU->tm_min) / 1 % 10;
+
+    rtc.RtcData[12] = '0' + (tmCSU->tm_sec) / 10 % 10;
+    rtc.RtcData[13] = '0' + (tmCSU->tm_sec) / 1 % 10;
+
+    if (Config_Rtc_Data(Uart5Fd, Addr.Relay, &rtc) == PASS) {
+        //PRINTF_FUNC("SetRtc (RB) sucessfully. \n");
+    }
+}
+
+void SetRtcData_Fan()
+{
+    struct timeb csuTime;
+    struct tm *tmCSU;
+
+    ftime(&csuTime);
+    tmCSU = localtime(&csuTime.time);
+    //  PRINTF_FUNC("Time : %04d-%02d-%02d %02d:%02d:%02d \n", tmCSU->tm_year + 1900,
+    //          tmCSU->tm_mon + 1, tmCSU->tm_mday, tmCSU->tm_hour, tmCSU->tm_min,
+    //          tmCSU->tm_sec);
+
+    rtc.RtcData[0] = '0' + (tmCSU->tm_year + 1900) / 1000 % 10;
+    rtc.RtcData[1] = '0' + (tmCSU->tm_year + 1900) / 100 % 10;
+    rtc.RtcData[2] = '0' + (tmCSU->tm_year + 1900) / 10 % 10;
+    rtc.RtcData[3] = '0' + (tmCSU->tm_year + 1900) / 1 % 10;
+
+    rtc.RtcData[4] = '0' + (tmCSU->tm_mon + 1) / 10 % 10;
+    rtc.RtcData[5] = '0' + (tmCSU->tm_mon + 1) / 1 % 10;
+
+    rtc.RtcData[6] = '0' + (tmCSU->tm_mday) / 10 % 10;
+    rtc.RtcData[7] = '0' + (tmCSU->tm_mday) / 1 % 10;
+
+    rtc.RtcData[8] = '0' + (tmCSU->tm_hour) / 10 % 10;
+    rtc.RtcData[9] = '0' + (tmCSU->tm_hour) / 1 % 10;
+
+    rtc.RtcData[10] = '0' + (tmCSU->tm_min) / 10 % 10;
+    rtc.RtcData[11] = '0' + (tmCSU->tm_min) / 1 % 10;
+
+    rtc.RtcData[12] = '0' + (tmCSU->tm_sec) / 10 % 10;
+    rtc.RtcData[13] = '0' + (tmCSU->tm_sec) / 1 % 10;
+
+    if (Config_Rtc_Data(Uart5Fd, Addr.Fan, &rtc) == PASS) {
+        //PRINTF_FUNC("SetRtc (FB) sucessfully. \n");
+    }
+}
+
+void SetModelName_Fan()
+{
+    if (Config_Model_Name(Uart5Fd, Addr.Fan, ShmSysConfigAndInfo->SysConfig.ModelName) == PASS) {
+        PRINTF_FUNC("Set Model name PASS = %s \n", ShmSysConfigAndInfo->SysConfig.ModelName);
+    }
+}
+
+// AC 三相輸入電壓
+void GetPresentInputVol()
+{
+    if (Query_Present_InputVoltage(Uart5Fd, Addr.Relay, &inputVoltage) == PASS) {
+        // resolution : 0.1
+        ShmSysConfigAndInfo->SysInfo.InputVoltageR = ShmRelayModuleData->InputL1Volt = inputVoltage.L1N_L12;
+        ShmSysConfigAndInfo->SysInfo.InputVoltageS = ShmRelayModuleData->InputL2Volt = inputVoltage.L2N_L23;
+        ShmSysConfigAndInfo->SysInfo.InputVoltageT = ShmRelayModuleData->InputL3Volt = inputVoltage.L3N_L31;
+
+        //********************************************************************************************************//
+#ifndef DD360
+        // Vin (UVP)
+        if (ShmSysConfigAndInfo->SysInfo.ChargerType == _CHARGER_TYPE_IEC) {
+            if (inputVoltage.L1N_L12 < VIN_MIN_VOLTAGE_IEC) {
+                PRINTF_FUNC("In Uvp L1N_L12 = %f \n", inputVoltage.L1N_L12);
+                ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL1InputUVP = YES;
+            } else {
+                ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL1InputUVP = NO;
+            }
+
+            if (inputVoltage.L2N_L23 < VIN_MIN_VOLTAGE_IEC) {
+                PRINTF_FUNC("In Uvp L2N_L23 = %f \n", inputVoltage.L2N_L23);
+                ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL2InputUVP = YES;
+            } else {
+                ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL2InputUVP = NO;
+            }
+
+            if (inputVoltage.L3N_L31 < VIN_MIN_VOLTAGE_IEC) {
+                PRINTF_FUNC("In Uvp L3N_L31 = %f \n", inputVoltage.L3N_L31);
+                ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL3InputUVP = YES;
+            } else {
+                ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL3InputUVP = NO;
+            }
+        } else if (ShmSysConfigAndInfo->SysInfo.ChargerType == _CHARGER_TYPE_UL) {
+            if (inputVoltage.L1N_L12 < VIN_MIN_VOLTAGE_UL) {
+                PRINTF_FUNC("In Uvp L1N_L12 = %f \n", inputVoltage.L1N_L12);
+                ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL1InputUVP = YES;
+            } else {
+                ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL1InputUVP = NO;
+            }
+
+            if (inputVoltage.L2N_L23 < VIN_MIN_VOLTAGE_UL) {
+                PRINTF_FUNC("In Uvp L2N_L23 = %f \n", inputVoltage.L2N_L23);
+                ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL2InputUVP = YES;
+            } else {
+                ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL2InputUVP = NO;
+            }
+
+            if (inputVoltage.L3N_L31 < VIN_MIN_VOLTAGE_UL) {
+                PRINTF_FUNC("In Uvp L3N_L31 = %f \n", inputVoltage.L3N_L31);
+                ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL3InputUVP = YES;
+            } else {
+                ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL3InputUVP = NO;
+            }
+        }
+        //********************************************************************************************************//
+        // Vin (OVP)
+        if (ShmSysConfigAndInfo->SysInfo.ChargerType == _CHARGER_TYPE_IEC) {
+            if (inputVoltage.L1N_L12 > VIN_MAX_VOLTAGE_IEC) {
+                PRINTF_FUNC("In Ovp L1N_L12 = %f \n", inputVoltage.L1N_L12);
+                ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL1InputOVP = YES;
+            } else {
+                ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL1InputOVP = NO;
+            }
+
+            if (inputVoltage.L2N_L23 > VIN_MAX_VOLTAGE_IEC) {
+                PRINTF_FUNC("In Ovp L2N_L23 = %f \n", inputVoltage.L2N_L23);
+                ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL2InputOVP = YES;
+            } else {
+                ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL2InputOVP = NO;
+            }
+
+            if (inputVoltage.L3N_L31 > VIN_MAX_VOLTAGE_IEC) {
+                PRINTF_FUNC("In Ovp L3N_L31 = %f \n", inputVoltage.L3N_L31);
+                ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL3InputOVP = YES;
+            } else {
+                ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL3InputOVP = NO;
+            }
+        } else if (ShmSysConfigAndInfo->SysInfo.ChargerType == _CHARGER_TYPE_UL) {
+            if (inputVoltage.L1N_L12 > VIN_MAX_VOLTAGE_UL) {
+                PRINTF_FUNC("In Ovp L1N_L12 = %f \n", inputVoltage.L1N_L12);
+                ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL1InputOVP = YES;
+            } else {
+                ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL1InputOVP = NO;
+            }
+
+            if (inputVoltage.L2N_L23 > VIN_MAX_VOLTAGE_UL) {
+                PRINTF_FUNC("In Ovp L2N_L23 = %f \n", inputVoltage.L2N_L23);
+                ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL2InputOVP = YES;
+            } else {
+                ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL2InputOVP = NO;
+            }
+
+            if (inputVoltage.L3N_L31 > VIN_MAX_VOLTAGE_UL) {
+                PRINTF_FUNC("In Ovp L3N_L31 = %f \n", inputVoltage.L3N_L31);
+                ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL3InputOVP = YES;
+            } else {
+                ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL3InputOVP = NO;
+            }
+        }
+#endif
+    }
+}
+
+// 左右槍的 Relay 前後的輸出電壓
+void GetPersentOutputVol()
+{
+    if (Query_Present_OutputVoltage(Uart5Fd, Addr.Relay, &outputVoltage) == PASS) {
+//      PRINTF_FUNC("Conn1 fuse 1 = %f \n", outputVoltage.behindFuse_Voltage_C1);
+//      PRINTF_FUNC("Conn1 relay 1 = %f \n", outputVoltage.behindRelay_Voltage_C1);
+//      PRINTF_FUNC("Conn2 fuse 2 = %f \n", outputVoltage.behindFuse_Voltage_C2);
+//      PRINTF_FUNC("Conn2 relay 2 = %f \n", outputVoltage.behindRelay_Voltage_C2);
+
+        //PRINTF_FUNC("outputVoltage.behindFuse_Voltage_C1 = %f \n", outputVoltage.behindFuse_Voltage_C1);
+        //PRINTF_FUNC("outputVoltage.behindFuse_Voltage_C2 = %f \n", outputVoltage.behindFuse_Voltage_C2);
+
+        ShmRelayModuleData->Gun1FuseOutputVolt = outputVoltage.behindFuse_Voltage_C1;
+        ShmRelayModuleData->Gun1RelayOutputVolt = outputVoltage.behindRelay_Voltage_C1;
+        ShmRelayModuleData->Gun2FuseOutputVolt = outputVoltage.behindFuse_Voltage_C2;
+        ShmRelayModuleData->Gun2RelayOutputVolt = outputVoltage.behindRelay_Voltage_C2;
+
+        for (int index = 0; index < gunCount; index++) {
+            if (index == 0) {
+                if (_chargingData[index]->Evboard_id == 0x01) {
+#ifndef DD360
+                    _chargingData[index]->FuseChargingVoltage = ShmRelayModuleData->Gun1FuseOutputVolt;
+#else
+                    _chargingData[index]->PresentChargingCurrent = ShmRelayModuleData->Gun1FuseOutputVolt / 10;
+                    _chargingData[index]->PresentChargingVoltage = _chargingData[index]->FireChargingVoltage / 10;
+                    _chargingData[index]->FuseChargingVoltage = _chargingData[index]->FireChargingVoltage;
+#endif
+                    _chargingData[index]->FireChargingVoltage = ShmRelayModuleData->Gun1RelayOutputVolt;
+
+                } else if (_chargingData[index]->Evboard_id == 0x02) {
+#ifndef DD360
+                    _chargingData[index]->FuseChargingVoltage = ShmRelayModuleData->Gun2FuseOutputVolt;
+#else
+                    _chargingData[index]->PresentChargingCurrent = ShmRelayModuleData->Gun2FuseOutputVolt / 10;
+                    _chargingData[index]->PresentChargingVoltage = _chargingData[index]->FireChargingVoltage / 10;
+                    _chargingData[index]->FuseChargingVoltage = _chargingData[index]->FireChargingVoltage;
+#endif
+                    _chargingData[index]->FireChargingVoltage = ShmRelayModuleData->Gun2RelayOutputVolt;
+                }
+            } else if (index == 1) {
+#ifndef DD360
+                _chargingData[index]->FuseChargingVoltage = ShmRelayModuleData->Gun2FuseOutputVolt;
+#else
+                _chargingData[index]->PresentChargingCurrent = ShmRelayModuleData->Gun2FuseOutputVolt / 10;
+                _chargingData[index]->PresentChargingVoltage = _chargingData[index]->FireChargingVoltage / 10;
+                _chargingData[index]->FuseChargingVoltage = _chargingData[index]->FireChargingVoltage;
+#endif
+                _chargingData[index]->FireChargingVoltage = ShmRelayModuleData->Gun2RelayOutputVolt;
+            }
+
+            //unsigned short Ovp = 0;
+            //unsigned short Ocp = 0;
+            //Ovp = MIN [VOUT_MAX_VOLTAGE, EV_BATTERY_VOLTAGE]  // 最大輸出電壓與電池電壓最大值
+            //Ocp = MIN [IOUT_MAX_CURRENT, EV_CURRENT_REQ]      // 最大輸出電流與需求電流最小值
+            if (_chargingData[index]->Type == _Type_Chademo) {
+                //Ovp = MaxValue(_chargingData[index]->MaximumChargingVoltage, _chargingData[index]->EvBatteryMaxVoltage);
+                //Ocp = MaxValue(_chargingData[index]->PresentChargingCurrent, ShmCHAdeMOData->ev[_chargingData[index]->type_index].ChargingCurrentRequest);
+            } else if (_chargingData[index]->Type == _Type_CCS_2) {
+
+            }
+        }
+    }
+}
+
+// 風扇速度
+void GetFanSpeed()
+{
+    //PRINTF_FUNC("Get fan board speed \n");
+    if (Query_Fan_Speed(Uart5Fd, Addr.Fan, &fanSpeed) == PASS) {
+        ShmFanModuleData->PresentFan1Speed = fanSpeed.speed[0];
+        ShmFanModuleData->PresentFan2Speed = fanSpeed.speed[1];
+        ShmFanModuleData->PresentFan3Speed = fanSpeed.speed[2];
+        ShmFanModuleData->PresentFan4Speed = fanSpeed.speed[3];
+//      PRINTF_FUNC("SystemFanRotaSpeed_1 = %d \n", fanSpeed.speed[0]);
+//      PRINTF_FUNC("SystemFanRotaSpeed_2 = %d \n", fanSpeed.speed[1]);
+//      PRINTF_FUNC("SystemFanRotaSpeed_3 = %d \n", fanSpeed.speed[2]);
+//      PRINTF_FUNC("SystemFanRotaSpeed_4 = %d \n", fanSpeed.speed[3]);
+        // Config_Fan_Speed(Uart5Fd, Addr.Fan, &fanSpeed[0]);
+        //SysInfoData (SystemFanRotaSpeed)
+    }
+}
+
+// 讀取 Relay 狀態
+void GetRelayOutputStatus()
+{
+    if (Query_Relay_Output(Uart5Fd, Addr.Relay, &regRelay) == PASS) {
+#ifndef DD360
+        regRelay.relay_event.bits.AC_Contactor = ShmSysConfigAndInfo->SysInfo.AcContactorStatus;
+#endif
+    }
+}
+
+// 確認 K1 K2 relay 的狀態
+void CheckK1K2RelayOutput(byte index)
+{
+    if (index == 0) {
+        if (_chargingData[index]->Evboard_id == 0x01) {
+            if (regRelay.relay_event.bits.Gun1_N == YES && regRelay.relay_event.bits.Gun1_P == YES) {
+                _chargingData[index]->RelayK1K2Status = YES;
+            } else {
+                _chargingData[index]->RelayK1K2Status = NO;
+            }
+
+            if (_chargingData[index]->Type == _Type_CCS_2) {
+                if (gunCount == 1) {
+#ifndef DD360
+                    if (regRelay.relay_event.bits.Gun1_N == YES && regRelay.relay_event.bits.CCS_Precharge == YES) {
+                        _chargingData[index]->RelayKPK2Status = YES;
+                    } else {
+                        _chargingData[index]->RelayKPK2Status = NO;
+                    }
+#else
+                    if (_chargingData[index]->SystemStatus == S_CCS_PRECHARGE_ST0) {
+                        _chargingData[index]->RelayKPK2Status = YES;
+                    } else {
+                        _chargingData[index]->RelayKPK2Status = NO;
+                    }
+#endif
+                } else {
+                    if (_chargingData[index]->SystemStatus == S_CCS_PRECHARGE_ST0) {
+                        _chargingData[index]->RelayKPK2Status = YES;
+                    } else {
+                        _chargingData[index]->RelayKPK2Status = NO;
+                    }
+                }
+            }
+        } else if (_chargingData[index]->Evboard_id == 0x02) {
+            if (regRelay.relay_event.bits.Gun2_N == YES && regRelay.relay_event.bits.Gun2_P == YES) {
+                _chargingData[index]->RelayK1K2Status = YES;
+            } else {
+                _chargingData[index]->RelayK1K2Status = NO;
+            }
+
+            if (_chargingData[index]->Type == _Type_CCS_2) {
+#ifndef DD360
+                if (regRelay.relay_event.bits.Gun2_N == YES && regRelay.relay_event.bits.CCS_Precharge == YES) {
+                    _chargingData[index]->RelayKPK2Status = YES;
+                } else {
+                    _chargingData[index]->RelayKPK2Status = NO;
+                }
+#else
+                if (_chargingData[index]->SystemStatus == S_CCS_PRECHARGE_ST0) {
+                    _chargingData[index]->RelayKPK2Status = YES;
+                } else {
+                    _chargingData[index]->RelayKPK2Status = NO;
+                }
+#endif
+            }
+        }
+    } else if (index == 1) {
+        if (regRelay.relay_event.bits.Gun2_N == YES && regRelay.relay_event.bits.Gun2_P == YES) {
+            _chargingData[index]->RelayK1K2Status = YES;
+        } else {
+            _chargingData[index]->RelayK1K2Status = NO;
+        }
+
+        if (_chargingData[index]->Type == _Type_CCS_2) {
+#ifndef DD360
+            if (regRelay.relay_event.bits.Gun2_N == YES && regRelay.relay_event.bits.CCS_Precharge == YES) {
+                _chargingData[index]->RelayKPK2Status = YES;
+            } else {
+                _chargingData[index]->RelayKPK2Status = NO;
+            }
+#else
+            if (_chargingData[index]->SystemStatus == S_CCS_PRECHARGE_ST0) {
+                _chargingData[index]->RelayKPK2Status = YES;
+            } else {
+                _chargingData[index]->RelayKPK2Status = NO;
+            }
+#endif
+        }
+    }
+
+    /*if (regRelay.relay_event.bits.Gun1_Parallel_N == YES && regRelay.relay_event.bits.Gun1_Parallel_P == YES)
+        ShmSysConfigAndInfo->SysInfo.BridgeRelayStatus = YES;
+    else
+        ShmSysConfigAndInfo->SysInfo.BridgeRelayStatus = NO;*/
+    ShmSysConfigAndInfo->SysInfo.BridgeRelayStatus = YES;
+
+//  PRINTF_FUNC("Check Relay Output. index = %d, RelayKPK2Status = %d, BridgeRelayStatus = %d \n",
+//          index, _chargingData[index]->RelayKPK2Status, ShmSysConfigAndInfo->SysInfo.BridgeRelayStatus);
+}
+
+void GetGfdAdc()
+{
+    // define : 每 0.2 ~ 1 秒一次
+    // occur : <= 75k 歐姆 @ 150 - 750 Vdc
+    // warning : >= 100 歐姆 && <= 500 歐姆 @ 150-750 Vdc
+    if (Query_Gfd_Adc(Uart5Fd, Addr.Relay, &gfd_adc) == PASS) {
+        for (int i = 0; i < gunCount; i++) {
+            if (_chargingData[i]->Type == 0x09 && !ShmSysConfigAndInfo->SysConfig.AlwaysGfdFlag) {
+                if ((_chargingData[i]->PresentChargingVoltage * 10) >= VOUT_MIN_VOLTAGE) {
+                    _chargingData[i]->GroundFaultStatus = GFD_PASS;
+                }
+                continue;
+            }
+
+            if (i == 0) {
+                if (gfd_adc.result_conn1 == GFD_WARNING) {
+                    gfd_adc.result_conn1 = GFD_PASS;
+                }
+                _chargingData[i]->GroundFaultStatus = gfd_adc.result_conn1;
+//              PRINTF_FUNC("GFD ******** Result = %d, Step = %d, R = %d, Vol = %d \n",
+//                      _chargingData[i]->GroundFaultStatus, gfd_adc.rb_step_1, gfd_adc.Resister_conn1, gfd_adc.voltage_conn1);
+                if (_chargingData[i]->GroundFaultStatus == GFD_FAIL) {
+                    PRINTF_FUNC("GFD Fail. index = %d, Step = %d, R = %d, Vol = %d \n",
+                                i, gfd_adc.rb_step_1, gfd_adc.Resister_conn1, gfd_adc.voltage_conn1);
+                } else if (_chargingData[i]->GroundFaultStatus == GFD_PASS ||
+                           _chargingData[i]->GroundFaultStatus == GFD_WARNING) {
+                    if (_chargingData[i]->GroundFaultStatus == GFD_WARNING) {
+                        PRINTF_FUNC("GFD Warning. index = %d, Result = %d, R = %d, Vol = %d \n",
+                                    i, _chargingData[i]->GroundFaultStatus, gfd_adc.Resister_conn1, gfd_adc.voltage_conn1);
+                    }
+                }
+            } else if (i == 1) {
+                if (gfd_adc.result_conn2 == GFD_WARNING) {
+                    gfd_adc.result_conn2 = GFD_PASS;
+                }
+                _chargingData[i]->GroundFaultStatus = gfd_adc.result_conn2;
+                if (_chargingData[i]->GroundFaultStatus == GFD_FAIL) {
+                    PRINTF_FUNC("GFD Fail. index = %d, Step = %d, R = %d, Vol = %d \n",
+                                i, gfd_adc.rb_step_2, gfd_adc.Resister_conn2, gfd_adc.voltage_conn2);
+                } else if (_chargingData[i]->GroundFaultStatus == GFD_PASS ||
+                           _chargingData[i]->GroundFaultStatus == GFD_WARNING) {
+                    if (_chargingData[i]->GroundFaultStatus == GFD_WARNING) {
+                        PRINTF_FUNC("GFD Warning. index = %d, Result = %d, R = %d, Vol = %d \n",
+                                    i, _chargingData[i]->GroundFaultStatus, gfd_adc.Resister_conn1, gfd_adc.voltage_conn1);
+                    }
+                }
+            }
+        }
+    }
+}
+
+void GetGpioInput()
+{
+    if (Query_Gpio_Input(Uart5Fd, Addr.Aux, &gpio_in) == PASS) {
+        // AC Contactor Status
+        if (gpio_in.AC_MainBreaker == 1) {
+            // AC Main Breaker ON
+            PRINTF_FUNC("RB AC Main Breaker. \n");
+        }
+
+        if (gpio_in.SPD == 1) {
+            // SPD (雷擊保護) ON
+            PRINTF_FUNC("RB SPD. \n");
+        }
+
+        if (gpio_in.Door_Open == 1) {
+            // Door Open
+            PRINTF_FUNC("RB Door Open. \n");
+        }
+
+        if (gpio_in.GFD[0] == 1) {
+            // GFD_1 Trigger
+        }
+
+        if (gpio_in.GFD[1] == 1) {
+            // GFD_2 Trigger
+        }
+
+        if (gpio_in.AC_Drop == 1) {
+            // AC Drop
+            PRINTF_FUNC("RB AC Drop. \n");
+        }
+
+        if (gpio_in.Emergency_IO == 1) {
+            // Emergency IO ON
+            PRINTF_FUNC("RB Emergency IO ON. \n");
+        }
+
+        if (gpio_in.Button_Emergency_Press == 1) {
+            // Emergency button Press
+        }
+
+        if (gpio_in.Button_On_Press == 1) {
+            // On button Press
+        }
+
+        if (gpio_in.Button_Off_Press == 1) {
+            // Off button Press
+        }
+
+        if (gpio_in.Key_1_Press == 1) {
+            // key 1 press
+        }
+
+        if (gpio_in.Key_2_Press == 1) {
+            // key 2 press
+        }
+
+        if (gpio_in.Key_3_Press == 1) {
+            // key 3 press
+        }
+
+        if (gpio_in.Key_4_Press == 1) {
+            // key 4 press
+        }
+    }
+}
+
+// 5V 12V 24V 48V
+void GetAuxPower()
+{
+    if (Query_Aux_PowerVoltage(Uart5Fd, Addr.Fan, &auxPower) == PASS) {
+        ShmSysConfigAndInfo->SysInfo.AuxPower48V = auxPower.voltage[0];
+        ShmSysConfigAndInfo->SysInfo.AuxPower24V = auxPower.voltage[1];
+        //ShmSysConfigAndInfo->SysInfo.AuxPower12V = auxPower.voltage[4];
+        //ShmSysConfigAndInfo->SysInfo.AuxPower5V = auxPower.voltage[6];
+        // aux power voltage
+        //PRINTF_FUNC("aux1 = %x, \n", auxPower.voltage[0]);
+        //PRINTF_FUNC("aux2 = %x, \n", auxPower.voltage[1]);
+    }
+}
+
+void SetFanModuleSpeed()
+{
+    {
+        FanSpeed _fanSpeed;
+
+        _setFanSpeed += fanSpeedSmoothValue;
+
+        if (_setFanSpeed >= ShmFanModuleData->SetFan1Speed) {
+            _setFanSpeed = ShmFanModuleData->SetFan1Speed;
+        }
+
+        //printf("_setFanSpeed = %d \n", _setFanSpeed);
+        _fanSpeed.speed[0] = _setFanSpeed;
+
+        _fanSpeed.speed[1] = _setFanSpeed;
+
+        _fanSpeed.speed[2] = _setFanSpeed;
+
+        _fanSpeed.speed[3] = _setFanSpeed;
+
+        if (Config_Fan_Speed(Uart5Fd, Addr.Fan, &_fanSpeed) == PASS) {
+            //PRINTF_FUNC("successfully Fan\n");
+        }
+    }
+}
+
+//==========================================
+// Common Function
+//==========================================
+void SetK1K2RelayStatus(byte index)
+{
+    if (ShmPsuData->Work_Step >= _TEST_MODE && ShmPsuData->Work_Step <= _TEST_MODE) {
+        if (regRelay.relay_event.bits.Gun1_N == NO) {
+            outputRelay.relay_event.bits.Gun1_N = YES;
+        } else if (regRelay.relay_event.bits.Gun1_P == NO) {
+            outputRelay.relay_event.bits.Gun1_P = YES;
+        }
+        return;
+    }
+
+    if (_chargingData[index]->SystemStatus < S_PREPARING_FOR_EVSE) {
+        if (_chargingData[index]->Evboard_id == 0x01) {
+            if (regRelay.relay_event.bits.Gun1_P == YES) {
+                outputRelay.relay_event.bits.Gun1_P = NO;
+            } else if (regRelay.relay_event.bits.Gun1_N == YES) {
+                outputRelay.relay_event.bits.Gun1_N = NO;
+            }
+
+            if (gunCount == 1 && _chargingData[index]->Type == _Type_CCS_2) {
+                if (regRelay.relay_event.bits.CCS_Precharge == YES) {
+                    outputRelay.relay_event.bits.CCS_Precharge = NO;
+                }
+            }
+        } else if (_chargingData[index]->Evboard_id == 0x02) {
+            if (regRelay.relay_event.bits.Gun2_P == YES) {
+                outputRelay.relay_event.bits.Gun2_P = NO;
+            } else if (regRelay.relay_event.bits.Gun2_N == YES) {
+                outputRelay.relay_event.bits.Gun2_N = NO;
+            }
+
+            if (_chargingData[index]->Type == _Type_CCS_2) {
+                if (regRelay.relay_event.bits.CCS_Precharge == YES) {
+                    outputRelay.relay_event.bits.CCS_Precharge = NO;
+                }
+            }
+        }
+    } else if ((_chargingData[index]->SystemStatus >= S_PREPARING_FOR_EVSE &&
+                _chargingData[index]->SystemStatus <= S_CHARGING)) {
+        if (_chargingData[index]->RelayWeldingCheck == YES) {
+            if (_chargingData[index]->Evboard_id == 0x01) {
+                if (regRelay.relay_event.bits.Gun1_N == NO) {
+                    outputRelay.relay_event.bits.Gun1_N = YES;
+                } else if (regRelay.relay_event.bits.Gun1_P == NO) {
+                    outputRelay.relay_event.bits.Gun1_P = YES;
+                }
+            } else if (_chargingData[index]->Evboard_id == 0x02) {
+                if (regRelay.relay_event.bits.Gun2_N == NO) {
+                    outputRelay.relay_event.bits.Gun2_N = YES;
+                } else if (regRelay.relay_event.bits.Gun2_P == NO) {
+                    outputRelay.relay_event.bits.Gun2_P = YES;
+                }
+            }
+        }
+    } else if ((_chargingData[index]->SystemStatus >= S_TERMINATING &&
+                _chargingData[index]->SystemStatus <= S_COMPLETE)) {
+        if ((_chargingData[index]->PresentChargingCurrent * 10) <= SEFETY_SWITCH_RELAY_CUR) {
+            if (_chargingData[index]->Evboard_id == 0x01) {
+                if (regRelay.relay_event.bits.Gun1_P == YES) {
+                    outputRelay.relay_event.bits.Gun1_P = NO;
+                } else if (regRelay.relay_event.bits.Gun1_N == YES) {
+                    outputRelay.relay_event.bits.Gun1_N = NO;
+                }
+            } else if (_chargingData[index]->Evboard_id == 0x02) {
+                if (regRelay.relay_event.bits.Gun2_P == YES) {
+                    outputRelay.relay_event.bits.Gun2_P = NO;
+                } else if (regRelay.relay_event.bits.Gun2_N == YES) {
+                    outputRelay.relay_event.bits.Gun2_N = NO;
+                }
+            }
+        }
+    } else if (_chargingData[index]->SystemStatus == S_CCS_PRECHARGE_ST0) {
+        if (_chargingData[index]->Evboard_id == 0x01) {
+#ifndef DD360
+            if (_chargingData[index]->Type == _Type_CCS_2) {
+                if (gunCount == 1) {
+                    if (regRelay.relay_event.bits.CCS_Precharge == NO) {
+                        outputRelay.relay_event.bits.CCS_Precharge = YES;
+                    } else if (regRelay.relay_event.bits.CCS_Precharge == YES) {
+                        outputRelay.relay_event.bits.Gun1_P = NO;
+                    }
+                }
+            }
+#endif
+        } else if (_chargingData[index]->Evboard_id == 0x02) {
+#ifndef DD360
+            if (_chargingData[index]->Type == _Type_CCS_2) {
+                if (regRelay.relay_event.bits.CCS_Precharge == NO) {
+                    outputRelay.relay_event.bits.CCS_Precharge = YES;
+                } else if (regRelay.relay_event.bits.CCS_Precharge == YES) {
+                    outputRelay.relay_event.bits.Gun2_P = NO;
+                }
+            }
+#endif
+        }
+    } else if (_chargingData[index]->SystemStatus == S_CCS_PRECHARGE_ST1) {
+        if (_chargingData[index]->Evboard_id == 0x01) {
+#ifndef DD360
+            if (_chargingData[index]->Type == _Type_CCS_2) {
+                if (gunCount == 1) {
+                    if (regRelay.relay_event.bits.Gun1_P == NO) {
+                        outputRelay.relay_event.bits.Gun1_P = YES;
+                    } else if (regRelay.relay_event.bits.Gun1_P == YES) {
+                        outputRelay.relay_event.bits.CCS_Precharge = NO;
+                    }
+                }
+            }
+#endif
+        } else if (_chargingData[index]->Evboard_id == 0x02) {
+#ifndef DD360
+            if (_chargingData[index]->Type == _Type_CCS_2) {
+                if (regRelay.relay_event.bits.Gun2_P == NO) {
+                    outputRelay.relay_event.bits.Gun2_P = YES;
+                } else if (regRelay.relay_event.bits.Gun2_P == YES) {
+                    outputRelay.relay_event.bits.CCS_Precharge = NO;
+                }
+            }
+#endif
+        }
+    }
+}
+
+void CheckAcInputOvpStatus(byte index)
+{
+    if (ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL1InputOVP == YES ||
+            ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL2InputOVP == YES ||
+            ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL3InputOVP == YES) {
+//      if ((_chargingData[index]->SystemStatus >= S_PREPARNING && _chargingData[index]->SystemStatus <= S_CHARGING) ||
+//              (_chargingData[index]->SystemStatus >= S_CCS_PRECHARGE_ST0 && _chargingData[index]->SystemStatus <= S_CCS_PRECHARGE_ST1))
+//      {
+//          if (ShmSysConfigAndInfo->SysInfo.ChargerType == _CHARGER_TYPE_IEC)
+//          {
+//              if (_psuInputVolR > VIN_MAX_VOLTAGE_IEC ||
+//                      _psuInputVolS > VIN_MAX_VOLTAGE_IEC ||
+//                      _psuInputVolT > VIN_MAX_VOLTAGE_IEC)
+//              {
+//                  PRINTF_FUNC("IEC _psuInputVolR = %f, _psuInputVolS = %f, _psuInputVolT = %f \n",
+//                          _psuInputVolR, _psuInputVolS, _psuInputVolT);
+//                  _chargingData[index]->StopChargeFlag = YES;
+//              }
+//
+//          }
+//          else if (ShmSysConfigAndInfo->SysInfo.ChargerType == _CHARGER_TYPE_UL)
+//          {
+//              if (_psuInputVolR > VIN_MAX_VOLTAGE_UL ||
+//                      _psuInputVolS > VIN_MAX_VOLTAGE_UL ||
+//                      _psuInputVolT > VIN_MAX_VOLTAGE_UL)
+//              {
+//                  PRINTF_FUNC("UL _psuInputVolR = %f, _psuInputVolS = %f, _psuInputVolT = %f \n",
+//                          _psuInputVolR, _psuInputVolS, _psuInputVolT);
+//                  _chargingData[index]->StopChargeFlag = YES;
+//              }
+//          }
+//      }
+//      else
+        DEBUG_INFO("CheckAcInputOvpStatus\r\n");
+        _chargingData[index]->StopChargeFlag = YES;
+    }
+}
+
+void CheckPhaseLossStatus(byte index)
+{
+    if (ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL1InputUVP == YES ||
+            ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL2InputUVP == YES ||
+            ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL3InputUVP == YES) {
+        DEBUG_INFO("CheckPhaseLossStatus\r\n");
+        _chargingData[index]->StopChargeFlag = YES;
+    }
+}
+
+void SetParalleRelayStatus()
+{
+    // 之後雙槍單模機種，橋接都會上
+    if (gunCount >= 2) {
+        if (_chargingData[0]->SystemStatus == S_BOOTING || _chargingData[1]->SystemStatus == S_BOOTING ||
+                (_chargingData[0]->SystemStatus == S_IDLE && _chargingData[1]->SystemStatus == S_IDLE)) {
+            // 初始化~ 不搭橋接
+            if (regRelay.relay_event.bits.Gun1_Parallel_P == YES) {
+                outputRelay.relay_event.bits.Gun1_Parallel_P = NO;
+            } else if (regRelay.relay_event.bits.Gun1_Parallel_N == YES) {
+                outputRelay.relay_event.bits.Gun1_Parallel_N = NO;
+            }
+        } else {
+            if (_chargingData[0]->IsReadyToCharging == YES ||
+                    _chargingData[1]->IsReadyToCharging == YES) {
+                // ************需考慮在切換中 - 切開 relay 與搭回 relay 的時機點************
+                if (ShmSysConfigAndInfo->SysInfo.MainChargingMode == _MAIN_CHARGING_MODE_MAX) {
+                    if (ShmSysConfigAndInfo->SysInfo.ReAssignedFlag < _REASSIGNED_RELAY_M_TO_A) {
+                        // 最大充 - 搭上橋接
+                        if (regRelay.relay_event.bits.Gun1_Parallel_N == NO) {
+                            outputRelay.relay_event.bits.Gun1_Parallel_N = YES;
+                        } else if (regRelay.relay_event.bits.Gun1_Parallel_P == NO) {
+                            outputRelay.relay_event.bits.Gun1_Parallel_P = YES;
+                        }
+                    } else {
+                        // 平均充 - 不搭
+                        if (regRelay.relay_event.bits.Gun1_Parallel_P == YES) {
+                            outputRelay.relay_event.bits.Gun1_Parallel_P = NO;
+                        } else if (regRelay.relay_event.bits.Gun1_Parallel_N == YES) {
+                            outputRelay.relay_event.bits.Gun1_Parallel_N = NO;
+                        }
+                    }
+                } else if (ShmSysConfigAndInfo->SysInfo.MainChargingMode == _MAIN_CHARGING_MODE_AVER) {
+                    if (ShmSysConfigAndInfo->SysInfo.ReAssignedFlag < _REASSIGNED_RELAY_A_TO_M) {
+                        // 平均充 - 不搭
+                        if (regRelay.relay_event.bits.Gun1_Parallel_P == YES) {
+                            outputRelay.relay_event.bits.Gun1_Parallel_P = NO;
+                        } else if (regRelay.relay_event.bits.Gun1_Parallel_N == YES) {
+                            outputRelay.relay_event.bits.Gun1_Parallel_N = NO;
+                        }
+                    } else {
+                        // 最大充 - 搭上橋接
+                        if (regRelay.relay_event.bits.Gun1_Parallel_N == NO) {
+                            outputRelay.relay_event.bits.Gun1_Parallel_N = YES;
+                        } else if (regRelay.relay_event.bits.Gun1_Parallel_P == NO) {
+                            outputRelay.relay_event.bits.Gun1_Parallel_P = YES;
+                        }
+                    }
+                }
+            }
+        }
+    }
+}
+
+void CheckAlarmOccur()
+{
+    bool isErr = false;
+    for (byte count = 0; count < sizeof(_alarm_code) / sizeof(_alarm_code[0]); count++) {
+        if (acAlarmCode.AcAlarmCode & _alarm_code[count]) {
+            isErr = true;
+            switch (_alarm_code[count]) {
+            case AC_OVP: ShmStatusCodeData->AlarmCode.AlarmEvents.bits.AcSystemInputOVP = YES; break;
+            case AC_UVP: ShmStatusCodeData->AlarmCode.AlarmEvents.bits.AcSystemInputUVP = YES; break;
+            case AC_OCP: ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemAcOutputOCP = YES; break;
+            case AC_OTP: ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemAmbientOTP = YES; break;
+            case AC_GMI_FAULT: ShmStatusCodeData->AlarmCode.AlarmEvents.bits.AcGroundfaultFail = YES; break;
+            case AC_CP_ERROR: ShmStatusCodeData->InfoCode.InfoEvents.bits.PilotFault = YES; break;
+            case AC_AC_LEAKAGE: ShmStatusCodeData->AlarmCode.AlarmEvents.bits.RcdTrip = YES; break;
+            case AC_DC_LEAKAGE: ShmStatusCodeData->AlarmCode.AlarmEvents.bits.RcdTrip = YES; break;
+            case AC_SYSTEM_SELFTEST_FAULT: ShmStatusCodeData->AlarmCode.AlarmEvents.bits.McuSelftestFail = YES; break;
+            case AC_HANDSHAKE_TIMEOUT: break;
+            //case AC_EMC_STOP: ShmStatusCodeData->AlarmCode.AlarmEvents.bits.EmergencyStopTrip = YES; break;
+            case AC_RELAY_WELDING: ShmStatusCodeData->FaultCode.FaultEvents.bits.AcOutputRelayWelding = YES; break;
+            case AC_GF_MODULE_FAULT: ShmStatusCodeData->FaultCode.FaultEvents.bits.RcdSelfTestFail = YES; break;
+            case AC_SHUTTER_FAULT: break;
+            case AC_LOCKER_FAULT: ShmStatusCodeData->FaultCode.FaultEvents.bits.AcConnectorLockFail = YES; break;
+            case AC_POWER_DROP: ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL1InputDrop = YES; break;
+            case AC_CIRCUIT_SHORT: ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CircuitShort = YES; break;
+            case AC_ROTARY_SWITCH_FAULT: break;
+            case AC_RELAY_DRIVE_FAULT: ShmStatusCodeData->FaultCode.FaultEvents.bits.AcOutputRelayDrivingFault = YES; break;
+            }
+        } else {
+            switch (_alarm_code[count]) {
+            case AC_OVP: ShmStatusCodeData->AlarmCode.AlarmEvents.bits.AcSystemInputOVP = NO; break;
+            case AC_UVP: ShmStatusCodeData->AlarmCode.AlarmEvents.bits.AcSystemInputUVP = NO; break;
+            case AC_OCP: ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemAcOutputOCP = NO; break;
+            case AC_OTP: ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemAmbientOTP = NO; break;
+            case AC_GMI_FAULT: ShmStatusCodeData->AlarmCode.AlarmEvents.bits.AcGroundfaultFail = NO; break;
+            case AC_CP_ERROR: ShmStatusCodeData->InfoCode.InfoEvents.bits.PilotFault = NO; break;
+            case AC_AC_LEAKAGE: ShmStatusCodeData->AlarmCode.AlarmEvents.bits.RcdTrip = NO; break;
+            case AC_DC_LEAKAGE: ShmStatusCodeData->AlarmCode.AlarmEvents.bits.RcdTrip = NO; break;
+            case AC_SYSTEM_SELFTEST_FAULT: ShmStatusCodeData->AlarmCode.AlarmEvents.bits.McuSelftestFail = NO; break;
+            case AC_HANDSHAKE_TIMEOUT: break;
+            //case AC_EMC_STOP: ShmStatusCodeData->AlarmCode.AlarmEvents.bits.EmergencyStopTrip = NO; break;
+            case AC_RELAY_WELDING: ShmStatusCodeData->FaultCode.FaultEvents.bits.AcOutputRelayWelding = NO; break;
+            case AC_GF_MODULE_FAULT: ShmStatusCodeData->FaultCode.FaultEvents.bits.RcdSelfTestFail = NO; break;
+            case AC_SHUTTER_FAULT: break;
+            case AC_LOCKER_FAULT: ShmStatusCodeData->FaultCode.FaultEvents.bits.AcConnectorLockFail = NO; break;
+            case AC_POWER_DROP: ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL1InputDrop = NO; break;
+            case AC_CIRCUIT_SHORT: ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CircuitShort = NO; break;
+            case AC_ROTARY_SWITCH_FAULT:  break;
+            case AC_RELAY_DRIVE_FAULT: ShmStatusCodeData->FaultCode.FaultEvents.bits.AcOutputRelayDrivingFault = NO; break;
+            }
+        }
+    }
+
+    ac_chargingInfo[0]->IsErrorOccur = isErr;
+}
+
+bool IsNoneMatchLedColor()
+{
+    bool result = false;
+
+    if (cur_led_color.Connect_1_Red != led_color.Connect_1_Red ||
+            cur_led_color.Connect_1_Green != led_color.Connect_1_Green ||
+            cur_led_color.Connect_1_Blue != led_color.Connect_1_Blue ||
+            cur_led_color.Connect_2_Red != led_color.Connect_2_Red ||
+            cur_led_color.Connect_2_Green != led_color.Connect_2_Green ||
+            cur_led_color.Connect_2_Blue != led_color.Connect_2_Blue) {
+        result = true;
+    }
+
+    return result;
+}
+
+void SetLedColor(struct ChargingInfoData *chargingData_1, struct ChargingInfoData *chargingData_2)
+{
+    byte _colorBuf = COLOR_MAX_LV * LED_INTENSITY_BRIGHTEST;
+
+    if (ShmSysConfigAndInfo->SysConfig.LedInfo.Intensity == _LED_INTENSITY_DARKEST) {
+        _colorBuf = COLOR_MAX_LV * LED_INTENSITY_DARKEST;
+    } else if (ShmSysConfigAndInfo->SysConfig.LedInfo.Intensity == _LED_INTENSITY_MEDIUM) {
+        _colorBuf = COLOR_MAX_LV * LED_INTENSITY_MEDIUM;
+    }
+
+    //printf("chargingData_1->SystemStatus=%d\n",chargingData_1->SystemStatus);
+    //printf("chargingData_2->SystemStatus=%d\n",chargingData_2->SystemStatus);
+    //printf("ShmSysConfigAndInfo->SysWarningInfo.Level=%d\n",ShmSysConfigAndInfo->SysWarningInfo.Level);
+    if (ShmSysConfigAndInfo->SysWarningInfo.Level == 2) {
+        led_color.Connect_1_Green = COLOR_MIN_LV;
+        led_color.Connect_1_Blue = COLOR_MIN_LV;
+        led_color.Connect_1_Red = _colorBuf;
+        led_color.Connect_2_Green = COLOR_MIN_LV;
+        led_color.Connect_2_Blue = COLOR_MIN_LV;
+        led_color.Connect_2_Red = _colorBuf;
+    } else {
+        if (ShmSysConfigAndInfo->SysInfo.IsAlternatvieConf) {
+            if ((chargingData_1->SystemStatus == S_BOOTING || chargingData_1->SystemStatus == S_IDLE || chargingData_1->SystemStatus == S_RESERVATION) &&
+                    (chargingData_2->SystemStatus == S_BOOTING || chargingData_2->SystemStatus == S_IDLE || chargingData_2->SystemStatus == S_RESERVATION)) {
+#ifdef AudiCustomized
+                led_color.Connect_1_Green = _colorBuf;
+                led_color.Connect_1_Blue = _colorBuf;
+                led_color.Connect_1_Red = _colorBuf;
+                led_color.Connect_2_Green = _colorBuf;
+                led_color.Connect_2_Blue = _colorBuf;
+                led_color.Connect_2_Red = _colorBuf;
+#else
+                led_color.Connect_1_Green = _colorBuf;
+                led_color.Connect_1_Blue = COLOR_MIN_LV;
+                led_color.Connect_1_Red = COLOR_MIN_LV;
+                led_color.Connect_2_Green = _colorBuf;
+                led_color.Connect_2_Blue = COLOR_MIN_LV;
+                led_color.Connect_2_Red = COLOR_MIN_LV;
+#endif
+            } else if ((chargingData_1->SystemStatus >= S_AUTHORIZING && chargingData_1->SystemStatus <= S_COMPLETE) ||
+                       (chargingData_1->SystemStatus >= S_CCS_PRECHARGE_ST0 && chargingData_1->SystemStatus <= S_CCS_PRECHARGE_ST1) ||
+                       (chargingData_2->SystemStatus >= S_AUTHORIZING && chargingData_2->SystemStatus <= S_COMPLETE) ||
+                       (chargingData_2->SystemStatus >= S_CCS_PRECHARGE_ST0 && chargingData_2->SystemStatus <= S_CCS_PRECHARGE_ST1)) {
+                led_color.Connect_1_Green = COLOR_MIN_LV;
+                led_color.Connect_1_Blue = _colorBuf;
+                led_color.Connect_1_Red = COLOR_MIN_LV;
+                led_color.Connect_2_Green = COLOR_MIN_LV;
+                led_color.Connect_2_Blue = _colorBuf;
+                led_color.Connect_2_Red = COLOR_MIN_LV;
+            }
+        } else {
+            if (chargingData_1->SystemStatus == S_BOOTING || chargingData_1->SystemStatus == S_IDLE || chargingData_1->SystemStatus == S_RESERVATION) {
+#ifdef AudiCustomized
+                led_color.Connect_1_Green = _colorBuf;
+                led_color.Connect_1_Blue = _colorBuf;
+                led_color.Connect_1_Red = _colorBuf;
+#else
+                led_color.Connect_1_Green = _colorBuf;
+                led_color.Connect_1_Blue = COLOR_MIN_LV;
+                led_color.Connect_1_Red = COLOR_MIN_LV;
+#endif
+            } else if ((chargingData_1->SystemStatus >= S_AUTHORIZING && chargingData_1->SystemStatus <= S_COMPLETE) ||
+                       (chargingData_1->SystemStatus >= S_CCS_PRECHARGE_ST0 && chargingData_1->SystemStatus <= S_CCS_PRECHARGE_ST1)) {
+                led_color.Connect_1_Green = COLOR_MIN_LV;
+                led_color.Connect_1_Blue = _colorBuf;
+                led_color.Connect_1_Red = COLOR_MIN_LV;
+            }
+
+            // --------------------------------------------------------------------------
+            if (chargingData_2->SystemStatus == S_BOOTING || chargingData_2->SystemStatus == S_IDLE || chargingData_2->SystemStatus == S_RESERVATION) {
+#ifdef AudiCustomized
+                led_color.Connect_2_Green = _colorBuf;
+                led_color.Connect_2_Blue = _colorBuf;
+                led_color.Connect_2_Red = _colorBuf;
+#else
+                led_color.Connect_2_Green = _colorBuf;
+                led_color.Connect_2_Blue = COLOR_MIN_LV;
+                led_color.Connect_2_Red = COLOR_MIN_LV;
+#endif
+            } else if ((chargingData_2->SystemStatus >= S_AUTHORIZING && chargingData_2->SystemStatus <= S_COMPLETE) ||
+                       (chargingData_2->SystemStatus >= S_CCS_PRECHARGE_ST0 && chargingData_2->SystemStatus <= S_CCS_PRECHARGE_ST1)) {
+                led_color.Connect_2_Green = COLOR_MIN_LV;
+                led_color.Connect_2_Blue = _colorBuf;
+                led_color.Connect_2_Red = COLOR_MIN_LV;
+            }
+        }
+    }
+    if (_checkLedChanged > 0) {
+        if (Config_Led_Color(Uart5Fd, Addr.Led, &led_color) == PASS) {
+            _checkLedChanged--;
+
+            cur_led_color.Connect_1_Red     = led_color.Connect_1_Red;
+            cur_led_color.Connect_1_Green   = led_color.Connect_1_Green;
+            cur_led_color.Connect_1_Blue    = led_color.Connect_1_Blue;
+            cur_led_color.Connect_2_Red     = led_color.Connect_2_Red;
+            cur_led_color.Connect_2_Green   = led_color.Connect_2_Green;
+            cur_led_color.Connect_2_Blue    = led_color.Connect_2_Blue;
+        }
+    } else if (IsNoneMatchLedColor()) {
+        _checkLedChanged = 3;
+    }
+}
+//==========================================
+// Init all share memory
+//==========================================
+int InitShareMemory()
+{
+    int result = PASS;
+    int MeterSMId;
+
+    if ((MeterSMId = shmget(ShmSysConfigAndInfoKey, sizeof(struct SysConfigAndInfo),  0777)) < 0) {
+#ifdef SystemLogMessage
+        DEBUG_ERROR("shmget ShmSysConfigAndInfo NG\n");
+#endif
+        result = FAIL;
+    } else if ((ShmSysConfigAndInfo = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+#ifdef SystemLogMessage
+        DEBUG_ERROR("[shmat ShmSysConfigAndInfo NG\n");
+#endif
+        result = FAIL;
+    }
+
+    if ((MeterSMId = shmget(ShmStatusCodeKey, sizeof(struct StatusCodeData),  0777)) < 0) {
+#ifdef SystemLogMessage
+        DEBUG_ERROR("shmget ShmStatusCodeData NG\n");
+#endif
+        result = FAIL;
+    } else if ((ShmStatusCodeData = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+#ifdef SystemLogMessage
+        DEBUG_ERROR("shmat ShmStatusCodeData NG\n");
+#endif
+        result = FAIL;
+    }
+
+    if ((MeterSMId = shmget(ShmFanBdKey, sizeof(struct FanModuleData),  0777)) < 0) {
+#ifdef SystemLogMessage
+        DEBUG_ERROR("shmget ShmFanModuleData NG\n");
+#endif
+        result = FAIL;
+    } else if ((ShmFanModuleData = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+#ifdef SystemLogMessage
+        DEBUG_ERROR("shmat ShmFanModuleData NG\n");
+#endif
+        result = FAIL;
+    }
+    memset(ShmFanModuleData, 0, sizeof(struct FanModuleData));
+
+    if ((MeterSMId = shmget(ShmRelayBdKey, sizeof(struct RelayModuleData),  0777)) < 0) {
+#ifdef SystemLogMessage
+        DEBUG_ERROR("shmget ShmRelayModuleData NG\n");
+#endif
+        result = FAIL;
+    } else if ((ShmRelayModuleData = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+#ifdef SystemLogMessage
+        DEBUG_ERROR("shmat ShmRelayModuleData NG\n");
+#endif
+        result = FAIL;
+    }
+    memset(ShmRelayModuleData, 0, sizeof(struct RelayModuleData));
+
+    if ((MeterSMId = shmget(ShmLedBdKey, sizeof(struct LedModuleData),  0777)) < 0) {
+#ifdef SystemLogMessage
+        DEBUG_ERROR("shmget ShmLedModuleData NG\n");
+#endif
+        result = FAIL;
+    } else if ((ShmLedModuleData = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+#ifdef SystemLogMessage
+        DEBUG_ERROR("shmat ShmLedModuleData NG\n");
+#endif
+        result = FAIL;
+    }
+    memset(ShmLedModuleData, 0, sizeof(struct LedModuleData));
+
+    if ((MeterSMId = shmget(ShmPsuKey, sizeof(struct PsuData),  0777)) < 0) {
+#ifdef SystemLogMessage
+        DEBUG_ERROR("shmget ShmPsuData NG \n");
+#endif
+        result = FAIL;
+    } else if ((ShmPsuData = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+#ifdef SystemLogMessage
+        DEBUG_ERROR("shmat ShmPsuData NG \n");
+#endif
+        result = FAIL;
+    }
+
+    if ((MeterSMId = shmget(ShmOcppModuleKey, sizeof(struct OCPP16Data), 0777)) < 0) {
+#ifdef SystemLogMessage
+        DEBUG_ERROR("shmat ShmOCPP16Data NG \n");
+#endif
+        result = FAIL;
+    } else if ((ShmOCPP16Data = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+#ifdef SystemLogMessage
+        DEBUG_ERROR("shmat ShmOCPP16Data NG \n");
+#endif
+        result = FAIL;
+    }
+
+    return result;
+}
+
+int InitComPort()
+{
+    int fd;
+    struct termios tios;
+
+    fd = open(relayRs485PortName, O_RDWR);
+    if (fd <= 0) {
+#ifdef SystemLogMessage
+        DEBUG_ERROR("Module_InternalComm. InitComPort NG\n");
+#endif
+        if (ShmStatusCodeData != NULL) {
+            ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CsuInitFailed = 1;
+        }
+        sleep(5);
+        return -1;
+    }
+    ioctl (fd, TCGETS, &tios);
+    tios.c_cflag = B115200 | CS8 | CLOCAL | CREAD;
+    tios.c_lflag = 0;
+    tios.c_iflag = 0;
+    tios.c_oflag = 0;
+    tios.c_cc[VMIN] = 0;
+    tios.c_cc[VTIME] = (byte)0;     // timeout 0.5 second
+    tios.c_lflag = 0;
+    tcflush(fd, TCIFLUSH);
+    ioctl (fd, TCSETS, &tios);
+
+    return fd;
+}
+
+//================================================
+// Main process
+//================================================
+bool FindChargingInfoData(byte target, struct ChargingInfoData **chargingData)
+{
+    for (byte index = 0; index < CHAdeMO_QUANTITY; index++) {
+        if (ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].Index
+                == target) {
+            chargingData[target] =
+                &ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index];
+            return true;
+        }
+    }
+
+    for (byte index = 0; index < CCS_QUANTITY; index++) {
+        if (ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].Index
+                == target) {
+            chargingData[target] =
+                &ShmSysConfigAndInfo->SysInfo.CcsChargingData[index];
+            return true;
+        }
+    }
+
+    for (byte index = 0; index < GB_QUANTITY; index++) {
+        if (ShmSysConfigAndInfo->SysInfo.GbChargingData[index].Index
+                == target) {
+            chargingData[target] =
+                &ShmSysConfigAndInfo->SysInfo.GbChargingData[index];
+            return true;
+        }
+    }
+
+    return false;
+}
+
+bool FindAcChargingInfoData(byte target, struct ChargingInfoData **acChargingData)
+{
+    if (target < AC_QUANTITY) {
+        acChargingData[target] = &ShmSysConfigAndInfo->SysInfo.AcChargingData[target];
+        return true;
+    }
+
+    return false;
+}
+
+void Initialization()
+{
+    bool isPass = false;
+
+    for (byte index = 0; index < ARRAY_SIZE(outputRelay.relay_event.relay_status); index++) {
+        outputRelay.relay_event.relay_status[index] = 0x00;
+    }
+
+    while (!isPass) {
+        isPass = true;
+        for (byte _index = 0; _index < gunCount; _index++) {
+            if (!FindChargingInfoData(_index, &_chargingData[0])) {
+                DEBUG_ERROR("InternalComm : FindChargingInfoData false \n");
+                isPass = false;
+                break;
+            }
+        }
+
+        sleep(1);
+    }
+
+    isPass = false;
+
+    if (acgunCount > 0) {
+        while (!isPass) {
+            isPass = true;
+            for (byte _index = 0; _index < acgunCount; _index++) {
+                if (!FindAcChargingInfoData(_index, &ac_chargingInfo[0])) {
+                    DEBUG_ERROR("EvComm : FindAcChargingInfoData false \n");
+                    isPass = false;
+                    break;
+                }
+            }
+
+            sleep(1);
+        }
+    }
+}
+
+bool IsNoneMatchRelayStatus()
+{
+    bool result = false;
+
+    if (/*(regRelay.relay_event.bits.AC_Contactor != outputRelay.relay_event.bits.AC_Contactor) ||
+        (regRelay.relay_event.bits.CCS_Precharge != outputRelay.relay_event.bits.CCS_Precharge) ||*/
+        (regRelay.relay_event.bits.Gun1_P != outputRelay.relay_event.bits.Gun1_P) ||
+        (regRelay.relay_event.bits.Gun1_N != outputRelay.relay_event.bits.Gun1_N) ||
+        (regRelay.relay_event.bits.Gun2_P != outputRelay.relay_event.bits.Gun2_P) ||
+        (regRelay.relay_event.bits.Gun2_N != outputRelay.relay_event.bits.Gun2_N)/* ||
+        (regRelay.relay_event.bits.Gun1_Parallel_P != outputRelay.relay_event.bits.Gun1_Parallel_P) ||
+        (regRelay.relay_event.bits.Gun1_Parallel_N != outputRelay.relay_event.bits.Gun1_Parallel_N)*/) {
+        if (regRelay.relay_event.bits.AC_Contactor != outputRelay.relay_event.bits.AC_Contactor) {
+            PRINTF_FUNC("AC Contact Relay none match. \n");
+        }
+        if (regRelay.relay_event.bits.CCS_Precharge != outputRelay.relay_event.bits.CCS_Precharge) {
+            PRINTF_FUNC("CCS Precharge Relay none match. \n");
+        }
+        if (regRelay.relay_event.bits.Gun1_P != outputRelay.relay_event.bits.Gun1_P) {
+            PRINTF_FUNC("SMR1:D+ Relay none match. \n");
+        }
+        if (regRelay.relay_event.bits.Gun1_N != outputRelay.relay_event.bits.Gun1_N) {
+            PRINTF_FUNC("SMR1:D- Relay none match. \n");
+        }
+        if (regRelay.relay_event.bits.Gun2_P != outputRelay.relay_event.bits.Gun2_P) {
+            PRINTF_FUNC("SMR2:D+ Relay none match. \n");
+        }
+        if (regRelay.relay_event.bits.Gun2_N != outputRelay.relay_event.bits.Gun2_N) {
+            PRINTF_FUNC("SMR2:D- Relay none match. \n");
+        }
+        if (regRelay.relay_event.bits.Gun1_Parallel_P != outputRelay.relay_event.bits.Gun1_Parallel_P) {
+            PRINTF_FUNC("Parallel:D+ Relay none match. \n");
+        }
+        if (regRelay.relay_event.bits.Gun1_Parallel_N != outputRelay.relay_event.bits.Gun1_Parallel_N) {
+            PRINTF_FUNC("Parallel:D- Relay none match. \n");
+        }
+
+        result = true;
+    }
+
+    return result;
+}
+
+void MatchRelayStatus()
+{
+    // 因為 AC Contactor 沒有 Feedback，所以暫時先這樣處理
+    //regRelay.relay_event.bits.AC_Contactor = outputRelay.relay_event.bits.AC_Contactor;
+#ifndef DD360
+    ShmSysConfigAndInfo->SysInfo.AcContactorStatus  = regRelay.relay_event.bits.AC_Contactor = outputRelay.relay_event.bits.AC_Contactor;
+#endif
+    regRelay.relay_event.bits.CCS_Precharge = outputRelay.relay_event.bits.CCS_Precharge;
+    regRelay.relay_event.bits.Gun1_P = outputRelay.relay_event.bits.Gun1_P;
+    regRelay.relay_event.bits.Gun1_N = outputRelay.relay_event.bits.Gun1_N;
+    regRelay.relay_event.bits.Gun2_P = outputRelay.relay_event.bits.Gun2_P;
+    regRelay.relay_event.bits.Gun2_N = outputRelay.relay_event.bits.Gun2_N;
+    regRelay.relay_event.bits.Gun1_Parallel_P = outputRelay.relay_event.bits.Gun1_Parallel_P;
+    regRelay.relay_event.bits.Gun1_Parallel_N = outputRelay.relay_event.bits.Gun1_Parallel_N;
+}
+
+void CheckRelayStatusByADC()
+{
+    if (ShmRelayModuleData->Gun1FuseOutputVolt > 0 && ShmRelayModuleData->Gun1RelayOutputVolt > 0 &&
+            (ShmRelayModuleData->Gun1FuseOutputVolt == ShmRelayModuleData->Gun1RelayOutputVolt)) {
+        // Relay 前後電壓一致
+        _chargingData[0]->RelayK1K2Status = 0x01;
+    } else {
+        _chargingData[0]->RelayK1K2Status = 0x00;
+    }
+
+    if (ShmRelayModuleData->Gun2FuseOutputVolt > 0 && ShmRelayModuleData->Gun2RelayOutputVolt > 0 &&
+            (ShmRelayModuleData->Gun2FuseOutputVolt == ShmRelayModuleData->Gun2RelayOutputVolt)) {
+        // Relay 前後電壓一致
+        _chargingData[1]->RelayK1K2Status = 0x01;
+    } else {
+        _chargingData[1]->RelayK1K2Status = 0x00;
+    }
+}
+
+void SetGfdConfig(byte index, byte resister)
+{
+    gfd_config.index = index;
+    gfd_config.state = resister;
+
+    //PRINTF_FUNC("************************GFD Vol = %d, GFD Res = %d \n", gfd_config.reqVol, gfd_config.resister);
+    if (Config_Gfd_Value(Uart5Fd, Addr.Relay, &gfd_config) == PASS) {
+//      PRINTF_FUNC("Set reqVol = %f, resister = %d \n",
+//              gfd_config.reqVol,
+//              gfd_config.resister);
+    }
+}
+
+void CableCheckDetected(byte index)
+{
+    // Cable Check
+    // 當火線上的電壓 = 車端要求的電壓電流
+    // _chargingData[targetGun]->EvBatterytargetVoltage
+    // 才可以開始偵測 1s
+    // Warning : Rgfd <= 150 歐/V 假設電壓為 500V 則~ Rgfd <= 75000 歐
+    // Pre-Warning : 150 歐/V < Rgfd <= 500 歐/V 假設電壓為 500V 則 75000 歐 < Rgfd <= 250000
+    // SO Normal : Rgfd > 500 歐/V 假設電壓為 500 V 則 Rgfd > 250000 歐
+    if ((_chargingData[index]->Type >= _Type_Chademo && _chargingData[index]->Type <= _Type_GB) ||
+            (_chargingData[index]->Type == 0x09 && ShmSysConfigAndInfo->SysConfig.AlwaysGfdFlag)) {
+        if ((_chargingData[index]->SystemStatus >= S_PREPARING_FOR_EVSE && _chargingData[index]->SystemStatus <= S_TERMINATING) ||
+                (_chargingData[index]->SystemStatus >= S_CCS_PRECHARGE_ST0 && _chargingData[index]->SystemStatus <= S_CCS_PRECHARGE_ST1)) {
+            if (_chargingData[index]->SystemStatus == S_PREPARING_FOR_EVSE &&
+                    _chargingData[index]->RelayWeldingCheck == YES) {
+                SetGfdConfig(index, GFD_CABLECHK);
+            } else if (_chargingData[index]->SystemStatus >= S_CCS_PRECHARGE_ST0 &&
+                       _chargingData[index]->SystemStatus <= S_CCS_PRECHARGE_ST1) {
+                SetGfdConfig(index, GFD_PRECHARGE);
+            } else if (_chargingData[index]->SystemStatus >= S_CHARGING &&
+                       _chargingData[index]->SystemStatus <= S_TERMINATING) {
+                if (_chargingData[index]->Type == _Type_GB || _chargingData[index]->Type == _Type_Chademo) {
+                    SetGfdConfig(index, GFD_IDLE);
+                } else {
+                    SetGfdConfig(index, GFD_CHARGING);
+                }
+            }
+        } else if (_chargingData[index]->SystemStatus == S_COMPLETE || _chargingData[index]->SystemStatus == S_PREPARNING
+                   || _chargingData[index]->SystemStatus == S_IDLE) {
+            SetGfdConfig(index, GFD_IDLE);
+        }
+    }
+}
+
+void CheckOutputPowerOverCarReq(byte index)
+{
+    float fireV = _chargingData[index]->FireChargingVoltage;
+    float carV = _chargingData[index]->EvBatterytargetVoltage * 10;
+
+    if ((_chargingData[index]->EvBatterytargetVoltage * 10) > 1500 &&
+            (_chargingData[index]->Type == _Type_Chademo ||
+             _chargingData[index]->Type == _Type_CCS_2 ||
+             _chargingData[index]->Type == _Type_GB)) {
+        if (fireV >= (carV + (carV * 0.1))) {
+            PRINTF_FUNC("[Module_InternalComm]CheckOutputPowerOverCarReq NG : fire = %f, battery = %f \n",
+                        _chargingData[index]->FireChargingVoltage, (_chargingData[index]->EvBatterytargetVoltage * 10));
+            DEBUG_ERROR("[Module_InternalComm]CheckOutputPowerOverCarReq NG : fire = %f, battery = %f \n",
+                        _chargingData[index]->FireChargingVoltage, (_chargingData[index]->EvBatterytargetVoltage * 10));
+            _chargingData[index]->StopChargeFlag = YES;
+        }
+    }
+}
+
+void CheckOutputVolNoneMatchFire(byte index)
+{
+    if ((_chargingData[index]->EvBatterytargetVoltage * 10) > 1500 &&
+            (_chargingData[index]->Type == _Type_Chademo ||
+             _chargingData[index]->Type == _Type_CCS_2 ||
+             _chargingData[index]->Type == _Type_GB)) {
+        if (((_chargingData[index]->PresentChargingVoltage * 10) < _chargingData[index]->FireChargingVoltage - 300) ||
+                ((_chargingData[index]->PresentChargingVoltage * 10) > _chargingData[index]->FireChargingVoltage + 300)) {
+            if (!_isOutputNoneMatch[index]) {
+                _isOutputNoneMatch[index] = YES;
+                gettimeofday(&_checkOutputNoneMatchTimer[index], NULL);
+            } else {
+                if ((GetTimeoutValue(_checkOutputNoneMatchTimer[index]) / 1000) >= 5000) {
+                    /*PRINTF_FUNC("[Module_InternalComm]CheckOutputVolNoneMatchFire NG (%d) : pre = %f, fire = %f \n",
+                            index, (_chargingData[index]->PresentChargingVoltage * 10), _chargingData[index]->FireChargingVoltage);
+                    DEBUG_ERROR("[Module_InternalComm]CheckOutputVolNoneMatchFire NG (%d): pre = %f, fire = %f \n",
+                            index, (_chargingData[index]->PresentChargingVoltage * 10), _chargingData[index]->FireChargingVoltage);
+                    _chargingData[index]->StopChargeFlag = YES;*/
+                }
+            }
+        } else {
+            _isOutputNoneMatch[index] = NO;
+        }
+    }
+}
+
+void CheckRelayWeldingStatus(byte index)
+{
+    if (!_isRelayWelding[index]) {
+        if ((_chargingData[index]->PresentChargingVoltage * 10) >= VOUT_MIN_VOLTAGE * 10) {
+            gettimeofday(&_checkRelayWeldingTimer[index], NULL);
+            _isRelayWelding[index] = YES;
+        }
+    } else {
+        if ((GetTimeoutValue(_checkRelayWeldingTimer[index]) / 1000) >= 1000) {
+            _chargingData[index]->RelayWeldingCheck = YES;
+            return;
+        }
+
+        if (_chargingData[index]->FireChargingVoltage >= VOUT_MIN_VOLTAGE) {
+            if (_chargingData[index]->Type == _Type_Chademo) {
+                ShmStatusCodeData->FaultCode.FaultEvents.bits.ChademoOutputRelayWelding = YES;
+            } else if (_chargingData[index]->Type == _Type_GB) {
+                ShmStatusCodeData->FaultCode.FaultEvents.bits.GbOutputRelayWelding = YES;
+            } else if (_chargingData[index]->Type == _Type_CCS_2) {
+                ShmStatusCodeData->FaultCode.FaultEvents.bits.CcsOutputRelayWelding = YES;
+            }
+
+            PRINTF_FUNC("CheckRelayWeldingStatus : fail \n");
+            _chargingData[index]->StopChargeFlag = YES;
+        }
+    }
+}
+
+void GetPsuTempForFanSpeed()
+{
+    char temp = 0;
+
+    for (byte index = 0; index < ShmPsuData->GroupCount; index++) {
+        for (byte count = 0; count < ShmPsuData->PsuGroup[index].GroupPresentPsuQuantity; count++) {
+            if (temp < ShmPsuData->PsuGroup[index].PsuModule[count].ExletTemp) {
+                temp = ShmPsuData->PsuGroup[index].PsuModule[count].ExletTemp;
+            }
+        }
+    }
+
+    ShmSysConfigAndInfo->SysInfo.SystemAmbientTemp = temp;
+
+    if (ShmSysConfigAndInfo->SysConfig.SwitchDebugFlag == NO) {
+        if (ShmFanModuleData->TestFanSpeed == NORMAL_FAN_SPEED) {
+            if (temp >= ENV_TEMP_MAX) {
+                ShmFanModuleData->TestFanSpeed = MAX_FAN_SPEED;
+            }
+        } else if (ShmFanModuleData->TestFanSpeed == MAX_FAN_SPEED) {
+            if (temp <= ENV_TEMP_MIN) {
+                ShmFanModuleData->TestFanSpeed = NORMAL_FAN_SPEED;
+            }
+        } else {
+            ShmFanModuleData->TestFanSpeed = NORMAL_FAN_SPEED;
+        }
+    }
+}
+
+void GetFanSpeedByFunction()
+{
+    if (ShmSysConfigAndInfo->SysConfig.SwitchDebugFlag == YES) {
+        return;
+    }
+
+    // 風控修改 :
+    // ******************************************************* //
+    //
+    //       當前PSU輸出總 KW       PSU Temp
+    // 30 x -------------------- x ---------- + 14 x (PSU Temp - 45)
+    //       當前樁最大功率 KW         45
+    //
+    // ******************************************************* //
+
+    // 當前樁最大功率 KW : ShmPsuData->SystemAvailablePower
+    unsigned int _maxPower = ShmPsuData->SystemAvailablePower;
+    // 當前PSU輸出總 KW & PSU Temp :
+    unsigned char temp = 0;
+    float power = 0;
+
+    for (byte index = 0; index < ShmPsuData->GroupCount; index++) {
+        for (byte count = 0; count < ShmPsuData->PsuGroup[index].GroupPresentPsuQuantity; count++) {
+            if (temp < ShmPsuData->PsuGroup[index].PsuModule[count].ExletTemp) {
+                temp = ShmPsuData->PsuGroup[index].PsuModule[count].ExletTemp;
+            }
+        }
+        power += (_chargingData[index]->PresentChargingPower * 10);
+    }
+
+    double _pw_rate = 0;
+    if (_maxPower > 0) {
+        _pw_rate = power / (double)_maxPower;
+    }
+    double _temp_rate = 0;
+    if (temp > 0) {
+        _temp_rate = (double)temp / 45;
+    }
+    unsigned char _temp_diff = 0;
+    if (temp > 45) {
+        _temp_diff = temp - 45;
+    }
+
+    ShmFanModuleData->TestFanSpeed = ((30 * _pw_rate * _temp_rate + 14 * _temp_diff) / 100) * MAX_FAN_SPEED;
+
+    if (ShmFanModuleData->TestFanSpeed > MAX_FAN_SPEED) {
+        ShmFanModuleData->TestFanSpeed = MAX_FAN_SPEED;
+    }
+
+    if (ShmFanModuleData->TestFanSpeed < 0) {
+        ShmFanModuleData->TestFanSpeed = 0;
+    }
+//
+//  printf("power = %f \n", power);
+//  printf("_maxPower = %d \n", _maxPower);
+//  printf("temp = %d \n", temp);
+//
+//  printf("_pw_rate = %f \n", _pw_rate);
+//  printf("_temp_rate = %f \n", _temp_rate);
+//  printf("_temp_diff = %d \n", _temp_diff);
+//  printf("fan rate = %f \n", (30 * _pw_rate * _temp_rate + 14 * _temp_diff));
+//  printf("ShmFanModuleData->TestFanSpeed = %d \n", ShmFanModuleData->TestFanSpeed);
+}
+
+void GetAcStatus()
+{
+    if (Query_AC_Status(Uart5Fd, Addr.AcPlug, &acStatus) == PASS) {
+        ShmSysConfigAndInfo->SysConfig.AcRatingCurrent = acStatus.MaxCurrent;
+
+        if (ShmSysConfigAndInfo->SysConfig.AcMaxChargingCurrent == 0) {
+            ShmSysConfigAndInfo->SysConfig.AcMaxChargingCurrent = ShmSysConfigAndInfo->SysConfig.AcRatingCurrent;
+        }
+
+        ac_chargingInfo[0]->ConnectorPlugIn = acStatus.CpStatus;
+        //  PRINTF_FUNC("CpStatus = %d \n", acStatus.CpStatus);
+        //              printf("CurLimit = %d \n", acStatus.CurLimit);
+        //              printf("PilotVol_P = %d \n", acStatus.PilotVol_P);
+        //              printf("PilotVol_N = %d \n", acStatus.PilotVol_N);
+        //              printf("LockStatus = %d \n", acStatus.LockStatus);
+        //              printf("RelayStatus = %d \n", acStatus.RelayStatus);
+        //              printf("ShutterStatus = %d \n", acStatus.ShutterStatus);
+        //              printf("MeterStatus = %d \n", acStatus.MeterStatus);
+        //              printf("PpStatus = %d \n", acStatus.PpStatus);
+        //              printf("MaxCurrent = %d \n", acStatus.MaxCurrent);
+        //              printf("RotateSwitchStatus = %d \n", acStatus.RelayStatus);
+        //              printf("============================== \n");
+        //
+        //              ac_chargingInfo[0]->SystemStatus = acStatus.CpStatus;
+    }
+//  else
+//      PRINTF_FUNC("GetAcStatus return fail. \n");
+}
+
+void GetAcAlarmCode()
+{
+    if (Query_AC_Alarm_Code(Uart5Fd, Addr.AcPlug, &acAlarmCode) == PASS) {
+        CheckAlarmOccur();
+    }
+}
+
+unsigned char GetChargingEnergy()
+{
+    return Query_Charging_Energy(Uart5Fd, Addr.AcPlug, &acChargingEnergy);
+}
+
+unsigned char GetChargingCurrent()
+{
+    return Query_Charging_Current(Uart5Fd, Addr.AcPlug, &acChargingCurrent);
+}
+
+void ChangeLedStatus()
+{
+    if (ac_chargingInfo[0]->SystemStatus == S_IDLE) {
+        ledStatus.ActionMode = 1;
+    } else if (ac_chargingInfo[0]->SystemStatus == S_PREPARNING) {
+        ledStatus.ActionMode = 3;
+    } else if (ac_chargingInfo[0]->SystemStatus == S_CHARGING) {
+        ledStatus.ActionMode = 4;
+    }
+
+    Config_LED_Status(Uart5Fd, Addr.AcPlug, &ledStatus);
+}
+
+void SetLegacyReq(byte _switch)
+{
+    Config_Legacy_Req(Uart5Fd, Addr.AcPlug, _switch);
+}
+
+void SetCpDuty(byte _value)
+{
+    Config_Ac_Duty(Uart5Fd, Addr.AcPlug, _value);
+}
+
+void ChangeToCsuMode()
+{
+    ac_chargingInfo[0]->IsModeChagned = Config_CSU_Mode(Uart5Fd, Addr.AcPlug);
+
+//  if (ac_chargingInfo[0]->IsModeChagned == PASS)
+//  {
+//      Config_Reset_MCU(Uart5Fd, Addr.AcPlug);
+//  }
+}
+
+void ChangeStartOrStopDateTime(byte isStart)
+{
+    char cmdBuf[32];
+    struct timeb csuTime;
+    struct tm *tmCSU;
+
+    ftime(&csuTime);
+    tmCSU = localtime(&csuTime.time);
+
+    sprintf(cmdBuf, "%04d-%02d-%02d %02d:%02d:%02d", tmCSU->tm_year + 1900,
+            tmCSU->tm_mon + 1, tmCSU->tm_mday, tmCSU->tm_hour, tmCSU->tm_min,
+            tmCSU->tm_sec);
+    if (isStart) {
+        strcpy((char *)ac_chargingInfo[0]->StartDateTime, cmdBuf);
+    } else {
+        strcpy((char *)ac_chargingInfo[0]->StopDateTime, cmdBuf);
+    }
+}
+
+void OcppStartTransation(byte gunIndex)
+{
+    if (strcmp((char *)ac_chargingInfo[0]->StartUserId, "") == EQUAL) {
+        strcpy((char *)ShmOCPP16Data->StartTransaction[gunIndex].IdTag, (char *)ShmOCPP16Data->StartTransaction[gunIndex].IdTag);
+    } else {
+        strcpy((char *)ShmOCPP16Data->StartTransaction[gunIndex].IdTag, (char *)ac_chargingInfo[0]->StartUserId);
+    }
+
+    PRINTF_FUNC("AC IdTag = %s \n", ShmOCPP16Data->StartTransaction[gunIndex].IdTag);
+    ShmOCPP16Data->CpMsg.bits[gunIndex].StartTransactionReq = YES;
+}
+
+void OcppStopTransation(byte gunIndex)
+{
+    if (strcmp((char *)ac_chargingInfo[0]->StartUserId, "") == EQUAL) {
+        strcpy((char *)ShmOCPP16Data->StopTransaction[gunIndex].IdTag, (char *)ShmOCPP16Data->StopTransaction[gunIndex].IdTag);
+    } else {
+        strcpy((char *)ShmOCPP16Data->StopTransaction[gunIndex].IdTag, (char *)ac_chargingInfo[0]->StartUserId);
+    }
+
+    PRINTF_FUNC("AC IdTag = %s \n", ShmOCPP16Data->StopTransaction[gunIndex].IdTag);
+    ShmOCPP16Data->CpMsg.bits[gunIndex].StopTransactionReq = YES;
+}
+
+bool OcppRemoteStop(byte gunIndex)
+{
+    bool result = ShmOCPP16Data->CsMsg.bits[gunIndex].RemoteStopTransactionReq;
+
+    if (ShmOCPP16Data->CsMsg.bits[gunIndex].RemoteStopTransactionReq == YES) {
+        strcpy((char *)ShmOCPP16Data->StopTransaction[gunIndex].StopReason, "Remote");
+        ShmOCPP16Data->CsMsg.bits[gunIndex].RemoteStopTransactionReq = NO;
+    }
+
+    return result;
+}
+
+unsigned char isModeChange()
+{
+    unsigned char result = NO;
+
+    if (ac_chargingInfo[0]->SystemStatus != ac_chargingInfo[0]->PreviousSystemStatus) {
+        result = YES;
+        ac_chargingInfo[0]->PreviousSystemStatus = ac_chargingInfo[0]->SystemStatus;
+    }
+
+    return result;
+}
+
+void AcChargeTypeProcess()
+{
+    if (acgunCount > 0) {
+        //ac_chargingInfo[0]->SelfTest_Comp = YES;
+        //ac_chargingInfo[0]->IsModeChagned = PASS;
+        //---------------------------------------------
+        if (ac_chargingInfo[0]->SelfTest_Comp == NO) {
+            ac_chargingInfo[0]->IsModeChagned = NO;
+            GetFwVersion_AC();
+            GetAcModelName();
+        } else if (ac_chargingInfo[0]->SelfTest_Comp == YES) {
+            if (ac_chargingInfo[0]->IsModeChagned != PASS) {
+                ChangeToCsuMode();
+                return;
+            }
+            GetAcStatus();
+            GetAcAlarmCode();
+
+            byte _status = S_NONE;
+
+            if (ac_chargingInfo[0]->SystemStatus == S_IDLE && ac_chargingInfo[0]->IsErrorOccur) {
+                _status = S_ALARM;
+            } else if (acStatus.CpStatus == AC_SYS_A || ac_chargingInfo[0]->IsErrorOccur) {
+                if (ac_chargingInfo[0]->SystemStatus == S_CHARGING) {
+                    _status = S_TERMINATING;
+                } else if (ac_chargingInfo[0]->SystemStatus >= S_TERMINATING) {
+                    if (GetTimeoutValue(_ac_charging_comp) >= 10000000 && acStatus.CpStatus == AC_SYS_A) {
+                        _status = S_IDLE;
+                    }
+                } else {
+                    _status = S_IDLE;
+                }
+            } else if (ac_chargingInfo[0]->SystemStatus >= S_PREPARNING &&
+                       ac_chargingInfo[0]->SystemStatus < S_CHARGING) {
+                if (acStatus.CpStatus == AC_SYS_C && acStatus.RelayStatus == YES) {
+                    _status = S_CHARGING;
+                } else if (GetTimeoutValue(_ac_preparing) >= 30000000) {
+                    _status = S_IDLE;
+                }
+            } else if ((acStatus.CpStatus == AC_SYS_B || ac_chargingInfo[0]->ConnectorPlugIn == AC_SYS_B) &&
+                       ac_chargingInfo[0]->IsAvailable &&
+                       !ac_chargingInfo[0]->IsErrorOccur &&
+                       (ShmSysConfigAndInfo->SysInfo.WaitForPlugit == YES ||
+                        ShmSysConfigAndInfo->SysConfig.AuthorisationMode == AUTH_MODE_DISABLE)) {
+                if (ac_chargingInfo[0]->RemoteStartFlag == YES) {
+                    PRINTF_FUNC("** AC Remote \n");
+                    ac_chargingInfo[0]->RemoteStartFlag = NO;
+                    strcpy((char *)ac_chargingInfo[0]->StartUserId, "");
+                    ShmSysConfigAndInfo->SysInfo.WaitForPlugit = NO;
+                    _status = S_PREPARNING;
+                } else if (ShmSysConfigAndInfo->SysInfo.OrderCharging == NO_DEFINE) {
+                    PRINTF_FUNC("** UserId = %s \n", ShmSysConfigAndInfo->SysConfig.UserId);
+                    strcpy((char *)ac_chargingInfo[0]->StartUserId, (char *)ShmSysConfigAndInfo->SysConfig.UserId);
+                    PRINTF_FUNC("** CardNumber = %s \n", ac_chargingInfo[0]->StartUserId);
+                    strcpy((char *)ShmSysConfigAndInfo->SysConfig.UserId, "");
+                    ShmSysConfigAndInfo->SysInfo.WaitForPlugit = NO;
+                    _status = S_PREPARNING;
+                }
+            } else if (ac_chargingInfo[0]->SystemStatus == S_CHARGING) {
+                if (OcppRemoteStop(1)) {
+                    _status = S_TERMINATING;
+                }
+            }
+
+            //printf("_status = %d \n", _status);
+
+            if (_status != S_NONE && ac_chargingInfo[0]->SystemStatus != _status) {
+                ac_chargingInfo[0]->SystemStatus = _status;
+            }
+
+            // 設定限制最大充電電流 >= 6 ~ <= 32
+            switch (ac_chargingInfo[0]->SystemStatus) {
+            case S_IDLE:
+            case S_ALARM: {
+                if (isModeChange()) {
+                    ac_chargingInfo[0]->PresentChargedEnergy = 0.0;
+                    ac_chargingInfo[0]->PresentChargingVoltage = 0;
+                    ac_chargingInfo[0]->ChargingFee = 0.0;
+                    strcpy((char *)ac_chargingInfo[0]->StartDateTime, "");
+                    strcpy((char *)ac_chargingInfo[0]->StopDateTime, "");
+                    _beforeChargingTotalEnergy = 0.0;
+                }
+
+                ChangeLedStatus();
+            }
+            break;
+            case S_PREPARNING: {
+                if (isModeChange()) {
+                    ShmSysConfigAndInfo->SysInfo.SystemPage = _LCM_NONE;
+                    ShmSysConfigAndInfo->SysInfo.CurGunSelectedByAc = DEFAULT_AC_INDEX;
+                    if (ShmSysConfigAndInfo->SysInfo.OrderCharging != NO_DEFINE) {
+                        ShmSysConfigAndInfo->SysInfo.OrderCharging = NO_DEFINE;
+                    }
+                    gettimeofday(&_ac_preparing, NULL);
+                }
+
+                if (GetChargingEnergy() == PASS) {
+                    //ac_chargingInfo[0]->PresentChargedEnergy = acChargingEnergy.Energy / 100;
+                    _beforeChargingTotalEnergy = acChargingEnergy.Energy;
+                }
+
+                SetLegacyReq(YES);
+                ChangeLedStatus();
+            }
+            break;
+            case S_CHARGING: {
+                if (isModeChange()) {
+                    ftime(&_ac_startChargingTime);
+                    OcppStartTransation(1);
+                    ChangeStartOrStopDateTime(YES);
+                    ShmSysConfigAndInfo->SysInfo.CurGunSelectedByAc = DEFAULT_AC_INDEX;
+                }
+
+                if (GetChargingEnergy() == PASS) {
+                    if ((acChargingEnergy.Energy - _beforeChargingTotalEnergy) > 0) {
+                        ac_chargingInfo[0]->PresentChargedEnergy += (acChargingEnergy.Energy - _beforeChargingTotalEnergy) / 100;
+                        if (ShmSysConfigAndInfo->SysConfig.BillingData.isBilling) {
+                            ac_chargingInfo[0]->ChargingFee += ac_chargingInfo[0]->PresentChargedEnergy * ShmSysConfigAndInfo->SysConfig.BillingData.Cur_fee;
+                        }
+                    }
+
+                    _beforeChargingTotalEnergy = acChargingEnergy.Energy;
+                }
+
+                if (GetChargingCurrent() == PASS) {
+                    ac_chargingInfo[0]->PresentChargingPower = (((float)(AC_DEFAULT_VOL * acChargingCurrent.OuputCurrentL1) / 10) / 1000);
+                }
+
+                ftime(&_ac_endChargingTime);
+                ac_chargingInfo[0]->PresentChargedDuration = DiffTimeb(_ac_startChargingTime, _ac_endChargingTime);
+                ac_chargingInfo[0]->PresentChargingVoltage = AC_DEFAULT_VOL;
+                ac_chargingInfo[0]->PresentChargingCurrent = ((float)acChargingCurrent.OuputCurrentL1 / 10);
+
+                // 用以判斷是否有在輸出
+                ac_chargingInfo[0]->IsCharging = acStatus.RelayStatus;
+
+                SetCpDuty(ShmSysConfigAndInfo->SysConfig.AcMaxChargingCurrent);
+                ChangeLedStatus();
+            }
+            break;
+            case S_TERMINATING: {
+                if (isModeChange()) {
+                    ChangeStartOrStopDateTime(NO);
+                    gettimeofday(&_ac_charging_comp, NULL);
+                }
+
+                SetLegacyReq(NO);
+                if (acStatus.RelayStatus == NO) {
+                    ac_chargingInfo[0]->SystemStatus = S_COMPLETE;
+                }
+            }
+            break;
+            case S_COMPLETE: {
+                if (isModeChange()) {
+                    gettimeofday(&_ac_charging_comp, NULL);
+                    ftime(&_ac_endChargingTime);
+                    if (strcmp((char *)ac_chargingInfo[0]->StartDateTime, "") != EQUAL) {
+                        // AC 固定為第2把槍
+                        OcppStopTransation(1);
+                    }
+
+                    ChangeStartOrStopDateTime(NO);
+                    ac_chargingInfo[0]->PresentChargedDuration = DiffTimeb(_ac_startChargingTime, _ac_endChargingTime);
+                }
+            }
+            break;
+            }
+        }
+    }
+}
+
+int main(void)
+{
+    if (InitShareMemory() == FAIL) {
+#ifdef SystemLogMessage
+        DEBUG_ERROR("InitShareMemory NG\n");
+#endif
+        if (ShmStatusCodeData != NULL) {
+            ShmStatusCodeData->AlarmCode.AlarmEvents.bits.FailToCreateShareMemory = 1;
+        }
+        sleep(5);
+        return 0;
+    }
+
+    gunCount = ShmSysConfigAndInfo->SysConfig.TotalConnectorCount;
+    acgunCount = ShmSysConfigAndInfo->SysConfig.AcConnectorCount;
+    // Open Uart5 for RB
+    Uart5Fd = InitComPort();
+    Initialization();
+    sleep(3);
+
+    if (Uart5Fd < 0) {
+        PRINTF_FUNC("(Internal) open port error. \n");
+        return 0;
+    }
+
+    outputRelay.relay_event.bits.AC_Contactor = 0x00;
+    outputRelay.relay_event.bits.CCS_Precharge = 0x00;
+    outputRelay.relay_event.bits.Gun1_Parallel_P = 0x00;
+    outputRelay.relay_event.bits.Gun1_Parallel_N = 0x00;
+    outputRelay.relay_event.bits.Gun1_P = 0x00;
+    outputRelay.relay_event.bits.Gun1_N = 0x00;
+    outputRelay.relay_event.bits.Gun2_N = 0x00;
+    outputRelay.relay_event.bits.Gun2_P = 0x00;
+    if (Config_Relay_Output(Uart5Fd, Addr.Relay, &outputRelay) != PASS) {
+        PRINTF_FUNC("Config_Relay_Output fail \n");
+    }
+
+    cur_led_color.Connect_1_Red = COLOR_MIN_LV;
+    cur_led_color.Connect_1_Green = COLOR_MIN_LV;
+    cur_led_color.Connect_1_Blue = COLOR_MIN_LV;
+    cur_led_color.Connect_2_Red = COLOR_MIN_LV;
+    cur_led_color.Connect_2_Green = COLOR_MIN_LV;
+    cur_led_color.Connect_2_Blue = COLOR_MIN_LV;
+
+    //bool printRelayStatus = true;
+    for (;;) {
+        bool isCharging = false;
+        // 程序開始之前~ 必須先確定 FW 版本與硬體版本，確認後!!~ 該模組才算是真正的 Initial Comp.
+        if (ShmRelayModuleData->SelfTest_Comp == NO) {
+            GetFwAndHwVersion_Relay();
+            SetRtcData_Relay();
+            sleep(1);
+        }
+#ifndef NO_FAN_BOARD
+        if (ShmFanModuleData->SelfTest_Comp == NO) {
+            GetFwAndHwVersion_Fan();
+            SetModelName_Fan();
+            SetRtcData_Fan();
+            sleep(1);
+            gettimeofday(&_priority_time, NULL);
+        }
+#endif
+        // 自檢階段處理，自檢階段如果讀不到版號則代表該系統沒有掛燈板
+        if (ShmLedModuleData->SelfTest_Comp == NO) {
+            // 自檢階段
+            //if (ShmSysConfigAndInfo->SysInfo.SelfTestSeq <= _STEST_PSU_CAP)
+            //{
+            GetFwAndHwVersion_Led();
+            sleep(1);
+            gettimeofday(&_led_priority_time, NULL);
+            //}
+            /*else
+            {
+                // 自檢階段沒有問到版號
+                if (ShmStatusCodeData->AlarmCode.AlarmEvents.bits.LedboardStestFail == NO)
+                    ShmStatusCodeData->AlarmCode.AlarmEvents.bits.LedboardStestFail = YES;
+            }*/
+        }
+
+        AcChargeTypeProcess();
+
+        if (ShmRelayModuleData->SelfTest_Comp == YES) {
+            // ==============優先權最高 10 ms ==============
+            // 輸出電壓
+            GetPersentOutputVol();
+
+#ifndef DD360
+            // 三相輸入電壓
+            GetPresentInputVol();
+            // 讀取當前 AC relay 狀態
+            regRelay.relay_event.bits.AC_Contactor = ShmSysConfigAndInfo->SysInfo.AcContactorStatus;
+#endif
+            //GetRelayOutputStatus();
+
+            for (int i = 0; i < gunCount; i++) {
+                // Cable check (Set)
+                CableCheckDetected(i);
+
+                // check k1 k2 relay 狀態
+                CheckK1K2RelayOutput(i);
+
+                // 依據當前各槍的狀態選擇 搭上/放開 Relay
+                SetK1K2RelayStatus(i);
+
+#ifndef DD360
+                if (ShmSysConfigAndInfo->SysConfig.PhaseLossPolicy == YES) {
+                    CheckPhaseLossStatus(i);
+                }
+
+                CheckAcInputOvpStatus(i);
+
+#endif
+                if (_chargingData[i]->SystemStatus == S_IDLE) {
+                    _chargingData[i]->RelayWeldingCheck = NO;
+                    _isRelayWelding[i] = NO;
+                }
+
+                if (_chargingData[i]->SystemStatus == S_BOOTING ||
+                        (_chargingData[i]->SystemStatus >= S_REASSIGN_CHECK && _chargingData[i]->SystemStatus <= S_COMPLETE) ||
+                        (_chargingData[i]->SystemStatus >= S_CCS_PRECHARGE_ST0 && _chargingData[i]->SystemStatus <= S_CCS_PRECHARGE_ST1) ||
+                        ShmSysConfigAndInfo->SysInfo.WaitForPlugit == YES ||
+                        (ShmSysConfigAndInfo->SysInfo.PageIndex >= _LCM_AUTHORIZING && ShmSysConfigAndInfo->SysInfo.PageIndex <= _LCM_WAIT_FOR_PLUG)) {
+                    _chargingData[i]->IsReadyToCharging = YES;
+                    isCharging = true;
+
+                    // 限定只有在槍類別為 GBT 的時候才做 relay welding 的判斷
+                    if (_chargingData[i]->Type == _Type_GB) {
+                        if (_chargingData[i]->SystemStatus >= S_PREPARING_FOR_EVSE &&
+                                _chargingData[i]->RelayWeldingCheck == NO) {
+                            CheckRelayWeldingStatus(i);
+                        }
+                    } else {
+                        _chargingData[i]->RelayWeldingCheck = YES;
+                    }
+
+                    if (_chargingData[i]->SystemStatus == S_CHARGING) {
+                        CheckOutputPowerOverCarReq(i);
+                        CheckOutputVolNoneMatchFire(i);
+                    } else {
+                        _isOutputNoneMatch[i] = NO;
+                    }
+                } else {
+                    _chargingData[i]->IsReadyToCharging = NO;
+                }
+            }
+            // Cable check (Get)
+            GetGfdAdc();
+
+            // 橋接 relay
+            //SetParalleRelayStatus();
+
+            // 搭上 AC Contactor
+//          if (isCharging)
+//              outputRelay.relay_event.bits.AC_Contactor = YES;
+//          else
+//              outputRelay.relay_event.bits.AC_Contactor = NO;
+
+            if (isCharging ||
+                    (ShmPsuData->Work_Step >= _TEST_MODE && ShmPsuData->Work_Step <= _TEST_MODE)) {
+                isStopChargingCount = false;
+                outputRelay.relay_event.bits.AC_Contactor = YES;
+            } else {
+                if (!isStopChargingCount) {
+                    gettimeofday(&_close_ac_contactor, NULL);
+                    isStopChargingCount = true;
+                } else {
+                    if ((outputRelay.relay_event.bits.AC_Contactor == YES && GetTimeoutValue(_close_ac_contactor) / 1000 >= (TEN_MINUTES * 1000))) {
+                        outputRelay.relay_event.bits.AC_Contactor = NO;
+                    }
+                }
+            }
+
+            if (ShmPsuData->Work_Step >= _TEST_MODE && ShmPsuData->Work_Step <= _TEST_MODE) {
+                outputRelay.relay_event.bits.Gun1_N = outputRelay.relay_event.bits.Gun1_P = YES;
+            }
+
+            // 搭上/鬆開 Relay
+            if (IsNoneMatchRelayStatus()) {
+                if (Config_Relay_Output(Uart5Fd, Addr.Relay, &outputRelay)) {
+                    //regRelay.relay_event.bits.AC_Contactor = ShmSysConfigAndInfo->SysInfo.AcContactorStatus;
+                    regRelay.relay_event.bits.CCS_Precharge = outputRelay.relay_event.bits.CCS_Precharge;
+                    regRelay.relay_event.bits.Gun1_P = outputRelay.relay_event.bits.Gun1_P;
+                    regRelay.relay_event.bits.Gun1_N = outputRelay.relay_event.bits.Gun1_N;
+                    regRelay.relay_event.bits.Gun2_P = outputRelay.relay_event.bits.Gun2_P;
+                    regRelay.relay_event.bits.Gun2_N = outputRelay.relay_event.bits.Gun2_N;
+                    regRelay.relay_event.bits.Gun1_Parallel_P = outputRelay.relay_event.bits.Gun1_Parallel_P;
+                    regRelay.relay_event.bits.Gun1_Parallel_N = outputRelay.relay_event.bits.Gun1_Parallel_N;
+
+                    PRINTF_FUNC("Match Relay, AC = %x, g1_p = %x, g1_n = %x, g2_p = %x, g2_n = %x, pre = %x, bri_p = %x, bri_n = %x \n",
+                                regRelay.relay_event.bits.AC_Contactor,
+                                regRelay.relay_event.bits.Gun1_P,
+                                regRelay.relay_event.bits.Gun1_N,
+                                regRelay.relay_event.bits.Gun2_P,
+                                regRelay.relay_event.bits.Gun2_N,
+                                regRelay.relay_event.bits.CCS_Precharge,
+                                regRelay.relay_event.bits.Gun1_Parallel_P,
+                                regRelay.relay_event.bits.Gun1_Parallel_N);
+
+                }
+            }
+
+
+//          if(IsNoneMatchRelayStatus())
+//          {
+//              if (printRelayStatus)
+//              {
+////                    PRINTF_FUNC("Match Relay Target, AC = %x, g1_p = %x, g1_n = %x, g2_p = %x, g2_n = %x, pre = %x, bri_p = %x, bri_n = %x \n",
+////                            outputRelay.relay_event.bits.AC_Contactor,
+////                            outputRelay.relay_event.bits.Gun1_P,
+////                            outputRelay.relay_event.bits.Gun1_N,
+////                            outputRelay.relay_event.bits.Gun2_P,
+////                            outputRelay.relay_event.bits.Gun2_N,
+////                            outputRelay.relay_event.bits.CCS_Precharge,
+////                            outputRelay.relay_event.bits.Gun1_Parallel_P,
+////                            outputRelay.relay_event.bits.Gun1_Parallel_N);
+//              }
+//              printRelayStatus = false;
+//              if (Config_Relay_Output(Uart5Fd, Addr.Relay, &outputRelay))
+//              {
+//                  PRINTF_FUNC("Match Relay Target, AC = %x, g1_p = %x, g1_n = %x, g2_p = %x, g2_n = %x, pre = %x, bri_p = %x, bri_n = %x \n",
+//                          outputRelay.relay_event.bits.AC_Contactor,
+//                          outputRelay.relay_event.bits.Gun1_P,
+//                          outputRelay.relay_event.bits.Gun1_N,
+//                          outputRelay.relay_event.bits.Gun2_P,
+//                          outputRelay.relay_event.bits.Gun2_N,
+//                          outputRelay.relay_event.bits.CCS_Precharge,
+//                          outputRelay.relay_event.bits.Gun1_Parallel_P,
+//                          outputRelay.relay_event.bits.Gun1_Parallel_N);
+//              }
+//          }
+//          else
+//          {
+//              if (!printRelayStatus)
+//              {
+//                  PRINTF_FUNC("Match Relay, AC = %x, g1_p = %x, g1_n = %x, g2_p = %x, g2_n = %x, pre = %x, bri_p = %x, bri_n = %x \n",
+//                          regRelay.relay_event.bits.AC_Contactor,
+//                          regRelay.relay_event.bits.Gun1_P,
+//                          regRelay.relay_event.bits.Gun1_N,
+//                          regRelay.relay_event.bits.Gun2_P,
+//                          regRelay.relay_event.bits.Gun2_N,
+//                          regRelay.relay_event.bits.CCS_Precharge,
+//                          regRelay.relay_event.bits.Gun1_Parallel_P,
+//                          regRelay.relay_event.bits.Gun1_Parallel_N);
+//              }
+//              printRelayStatus = true;
+//          }
+        }
+#if !defined NO_FAN_BOARD && !defined DD360ComBox
+        if (ShmFanModuleData->SelfTest_Comp == YES) {
+            if (GetTimeoutValue(_priority_time) / 1000 >= 1000) {
+                //GetPsuTempForFanSpeed();
+                GetFanSpeedByFunction();
+                GetFanSpeed();
+                ShmSysConfigAndInfo->SysInfo.SystemFanRotaSpeed = _setFanSpeed;
+                gettimeofday(&_priority_time, NULL);
+
+                ShmFanModuleData->SetFan1Speed = ShmFanModuleData->TestFanSpeed;
+                ShmFanModuleData->SetFan2Speed = ShmFanModuleData->TestFanSpeed;
+                ShmFanModuleData->SetFan3Speed = ShmFanModuleData->TestFanSpeed;
+                ShmFanModuleData->SetFan4Speed = ShmFanModuleData->TestFanSpeed;
+
+//              if (isCharging)
+//              {
+////                    if (ShmFanModuleData->PresentFan1Speed < MAX_FAN_SPEED ||
+////                        ShmFanModuleData->PresentFan2Speed < MAX_FAN_SPEED ||
+////                        ShmFanModuleData->PresentFan3Speed < MAX_FAN_SPEED ||
+////                        ShmFanModuleData->PresentFan4Speed < MAX_FAN_SPEED)
+////                    {
+////                        ShmFanModuleData->SetFan1Speed = MAX_FAN_SPEED;
+////                        ShmFanModuleData->SetFan2Speed = MAX_FAN_SPEED;
+////                        ShmFanModuleData->SetFan3Speed = MAX_FAN_SPEED;
+////                        ShmFanModuleData->SetFan4Speed = MAX_FAN_SPEED;
+////                    }
+//
+//                  // 在還沒問到 PSU 溫度~ 還是要有個最小轉速
+//                  ShmFanModuleData->SetFan1Speed = MIN_FAN_SPEED;
+//                  ShmFanModuleData->SetFan2Speed = MIN_FAN_SPEED;
+//                  ShmFanModuleData->SetFan3Speed = MIN_FAN_SPEED;
+//                  ShmFanModuleData->SetFan4Speed = MIN_FAN_SPEED;
+//
+//                  if (ShmFanModuleData->TestFanSpeed > 0)
+//                  {
+//                      ShmFanModuleData->SetFan1Speed = ShmFanModuleData->TestFanSpeed;
+//                      ShmFanModuleData->SetFan2Speed = ShmFanModuleData->TestFanSpeed;
+//                      ShmFanModuleData->SetFan3Speed = ShmFanModuleData->TestFanSpeed;
+//                      ShmFanModuleData->SetFan4Speed = ShmFanModuleData->TestFanSpeed;
+//                  }
+//              }
+//              else
+//              {
+////                    if (ShmFanModuleData->PresentFan1Speed > MIN_FAN_SPEED ||
+////                        ShmFanModuleData->PresentFan2Speed > MIN_FAN_SPEED ||
+////                        ShmFanModuleData->PresentFan3Speed > MIN_FAN_SPEED ||
+////                        ShmFanModuleData->PresentFan4Speed > MIN_FAN_SPEED)
+////                    {
+//                      ShmFanModuleData->SetFan1Speed = MIN_FAN_SPEED;
+//                      ShmFanModuleData->SetFan2Speed = MIN_FAN_SPEED;
+//                      ShmFanModuleData->SetFan3Speed = MIN_FAN_SPEED;
+//                      ShmFanModuleData->SetFan4Speed = MIN_FAN_SPEED;
+////                    }
+//
+//                  // 停止時，如溫度還是很高，則需要維持該轉速直到溫度降低
+//                  if (ShmFanModuleData->TestFanSpeed >= MAX_FAN_SPEED)
+//                  {
+//                      ShmFanModuleData->SetFan1Speed = ShmFanModuleData->TestFanSpeed;
+//                      ShmFanModuleData->SetFan2Speed = ShmFanModuleData->TestFanSpeed;
+//                      ShmFanModuleData->SetFan3Speed = ShmFanModuleData->TestFanSpeed;
+//                      ShmFanModuleData->SetFan4Speed = ShmFanModuleData->TestFanSpeed;
+//                  }
+//              }
+
+                //PRINTF_FUNC("set fan = %d \n", ShmFanModuleData->SetFan1Speed);
+                SetFanModuleSpeed();
+            }
+        }
+#endif
+        if (ShmLedModuleData->SelfTest_Comp == YES) {
+            if (GetTimeoutValue(_led_priority_time) / 1000 >= 1000) {
+                if (gunCount == 1) {
+                    SetLedColor(_chargingData[0], _chargingData[0]);
+                } else if (gunCount == 2) {
+                    SetLedColor(_chargingData[0], _chargingData[1]);
+                }
+
+                gettimeofday(&_led_priority_time, NULL);
+            }
+        }
+
+        usleep(10000);
+    }
+
+    return FAIL;
+}

EVSE/Projects/DD360ComBox/Apps/Module_LcmContro.h

@@ -0,0 +1,196 @@
+#include 	<sys/time.h>
+#include 	<sys/timeb.h>
+#include    <sys/types.h>
+#include    <sys/stat.h>
+#include 	<sys/types.h>
+#include 	<sys/ioctl.h>
+#include 	<sys/socket.h>
+#include 	<sys/ipc.h>
+#include 	<sys/shm.h>
+#include 	<sys/shm.h>
+#include 	<sys/mman.h>
+#include 	<linux/wireless.h>
+#include 	<arpa/inet.h>
+#include 	<netinet/in.h>
+
+#include 	<unistd.h>
+#include 	<stdarg.h>
+#include    <stdio.h>      /*標準輸入輸出定義*/
+#include    <stdlib.h>     /*標準函數庫定義*/
+#include    <unistd.h>     /*Unix 標準函數定義*/
+#include    <fcntl.h>      /*檔控制定義*/
+#include    <termios.h>    /*PPSIX 終端控制定義*/
+#include    <errno.h>      /*錯誤號定義*/
+#include 	<errno.h>
+#include 	<string.h>
+#include	<time.h>
+#include	<ctype.h>
+#include 	<ifaddrs.h>
+#include 	<stdbool.h>
+#include	"../../define.h"
+
+#define ARRAY_SIZE(A)		(sizeof(A) / sizeof(A[0]))
+#define PASS				1
+#define FAIL				-1
+#define YES					1
+#define NO					0
+
+typedef unsigned char 			byte;
+
+struct SysConfigAndInfo			*ShmSysConfigAndInfo;
+struct StatusCodeData 			*ShmStatusCodeData;
+struct FanModuleData			*ShmFanModuleData;
+
+#define NO_DEFINE			255
+#define DEFAULT_AC_INDEX	2
+
+#define TIME_MAX_SEC		2592000 // 一個月，秒數
+#define POWER_MAX_KW		5000
+#define ENERGY_MAX_KWH		5000
+
+#define CMD_TITLE_1				0x5A
+#define CMD_TITLE_2				0xA5
+#define CMD_READ				0x80
+#define CMD_WRITE				0x81
+#define CMD_MULTI_WRITE			0x82
+#define CMD_MULTI_READ			0x83
+
+#define CMD_BACKLIGHT			0x01
+#define CMD_REGISTER			0x03
+
+enum _BATTERY_LEVEL_FOR_MAP
+{
+	_BATTERY_LEVEL_FOR_MAP_EMP = 0x00,
+	_BATTERY_LEVEL_FOR_MAP_LV1 = 0x01,
+	_BATTERY_LEVEL_FOR_MAP_LV2 = 0x02,
+	_BATTERY_LEVEL_FOR_MAP_LV3 = 0x03,
+	_BATTERY_LEVEL_FOR_MAP_LV4 = 0x04,
+	_BATTERY_LEVEL_FOR_MAP_LV5 = 0x05,
+};
+
+int _port;
+//char* pPortName = "/dev/ttyO2";
+char* pPortName = "/dev/ttyS3";
+char* moduleName = "DMT80480T070_09WT";
+byte _totalCount;
+byte acgunCount;
+struct ChargingInfoData *_chargingInfoData[CHAdeMO_QUANTITY + CCS_QUANTITY + GB_QUANTITY];
+struct ChargingInfoData *ac_chargingInfo[AC_QUANTITY];
+
+byte ac_ani_battery_level = _BATTERY_LEVEL_FOR_MAP_LV5;
+byte isDiffStatus = false;
+byte isChangeBattMap = false;
+// 當前選擇的槍號
+short _currentPage = _LCM_NONE;
+short _oldPage = _LCM_NONE;
+byte _gunIndex = 0;
+bool _wifi_conn_status = false;
+bool _battery_display_ani = false;
+byte _curPage_index = 0;
+bool _page_reload = false;
+
+// LCM - HW
+byte _everyPageRollChange = 0;
+short __conn_status = 0x0030;
+short __ethernet_status = 0x0032;
+short __3G4G_status = 0x0036;
+short __wifi_status = 0x003C;
+
+short __sel_gun_btn = 0x0040;
+short __ret_home_btn = 0x0042;
+short __stop_method_btn = 0x0044;
+
+short __qr_code = 0x0250;
+short __main_rfid = 0x0052;
+short __main_qr = 0x0054;
+short __main_app = 0x0056;
+
+short __plug_in_arrow = 0x0060;
+
+short __conn_line = 0x0066;
+
+short __gun_type_index = 0x0070;
+short __qr_code_pre = 0x0280;
+
+short __side_top = 0x0090;
+short __side_down = 0x0092;
+short __side_mid = 0x0094;
+
+short __conn_line_chag = 0x0096;
+short __batt_map = 0x0100;
+short __soc_value_charging = 0x0102;
+short __remain_time_map = 0x0106;
+short __power_map = 0x0108;
+short __energy_map = 0x010A;
+short __remain_time_tx = 0x0110;
+short __output_eng_tx = 0x0120;
+short __total_out_eng_tx = 0x0130;
+short __conn_line_comp = 0x0140;
+short __charging_fee_map = 0x0146;
+short __charging_fee_tx = 0x0150;
+
+short __money_by_rate = 0x0200;
+short __money_rate = 0x0220;
+short __money_rate_map = 0x0230;
+
+// ICON ID
+byte _disappear = 0;
+byte _disconnect = 1;
+byte _connect = 2;
+byte _warning = 3;
+byte _arrow_dark = 4;
+byte _arrow_light = 5;
+byte _3G4G_disconnect = 6;
+byte __3G4G_connect = 7;
+byte _wifi_disconnect = 8;
+byte _wifi_connect = 9;
+byte _logo = 10;
+byte _conn_map1 = 11;
+byte _conn_map2 = 12;
+byte _sel_gun_btn = 13;
+byte _back_home_btn = 14;
+byte _stop_charging_btn = 15;
+byte _stop_charging_btn_scan = 16;
+byte _chademo_dark = 17;
+byte _ccs_dark = 18;
+byte _gbt_dark = 19;
+byte _actype_dark = 20;
+byte _chademo_light = 21;
+byte _ccs_light = 22;
+byte _gbt_light = 23;
+byte _actype_light = 24;
+byte _main_none_rfid = 25;
+byte _main_rfid = 26;
+byte _main_none_app = 27;
+byte _main_app = 28;
+byte _main_none_qr = 29;
+byte _main_qr = 30;
+byte _charging_map1 = 31;
+byte _charging_map2 = 32;
+byte _battery_empty = 33;
+byte _battery_cap_20 = 34;
+byte _battery_cap_40 = 35;
+byte _battery_cap_60 = 36;
+byte _battery_cap_80 = 37;
+byte _battery_cap_100 = 38;
+byte _battery_map = 39;
+byte _power_map = 40;
+byte _time_map = 41;
+byte _complete_map = 42;
+byte _battery_soc_20 = 43;
+byte _battery_soc_40 = 44;
+byte _battery_soc_60 = 45;
+byte _battery_soc_80 = 46;
+byte _battery_soc_100 = 47;
+byte _battery_eng_map = 48;
+byte _money_map = 49;
+byte _elapse_time_map = 50;
+byte _charging_money = 51;
+byte _side_none_rfid = 52;
+byte _side_rfid = 53;
+byte _side_none_app = 54;
+byte _side_app = 55;
+byte _side_none_qr = 56;
+byte _side_qr = 57;
+byte _eth_disconnect = 58;
+byte _eth_connect = 59;

EVSE/Projects/DD360ComBox/Apps/Module_LcmControl.c

@@ -0,0 +1,1526 @@
+#include "ReModule_LcmControl.h"
+#include "Config.h"
+#include "AudiCust.h"
+
+static AudiCustInfo *gAudiCustInfo = NULL;
+bool needReloadQr = true;
+
+void PRINTF_FUNC(char *string, ...);
+
+int StoreLogMsg(const char *fmt, ...);
+#define DEBUG_INFO(format, args...) StoreLogMsg("[%s:%d][%s][Info] "format, __FILE__, __LINE__, __FUNCTION__, ##args)
+#define DEBUG_WARN(format, args...) StoreLogMsg("[%s:%d][%s][Warn] "format, __FILE__, __LINE__, __FUNCTION__, ##args)
+#define DEBUG_ERROR(format, args...) StoreLogMsg("[%s:%d][%s][Error] "format, __FILE__, __LINE__, __FUNCTION__, ##args)
+
+char *getTimeString(void);
+
+//=================================
+// Common routine
+//=================================
+int StoreLogMsg(const char *fmt, ...)
+{
+    char Buf[4096 + 256];
+    char buffer[4096];
+    va_list args;
+    struct timeb  SeqEndTime;
+    struct tm *tm;
+
+    va_start(args, fmt);
+    int rc = vsnprintf(buffer, sizeof(buffer), fmt, args);
+    va_end(args);
+
+    memset(Buf, 0, sizeof(Buf));
+    ftime(&SeqEndTime);
+    SeqEndTime.time = time(NULL);
+    tm = localtime(&SeqEndTime.time);
+
+    if (ShmSysConfigAndInfo->SysConfig.SwitchDebugFlag == YES) {
+        sprintf(Buf, "%02d:%02d:%02d:%03d - %s",
+                tm->tm_hour, tm->tm_min, tm->tm_sec, SeqEndTime.millitm, buffer);
+        printf("%s \n", Buf);
+    } else {
+        sprintf(Buf, "echo \"%04d-%02d-%02d %02d:%02d:%02d:%03d - %s\" >> /Storage/SystemLog/[%04d.%02d]SystemLog",
+                tm->tm_year + 1900, tm->tm_mon + 1, tm->tm_mday, tm->tm_hour, tm->tm_min, tm->tm_sec, SeqEndTime.millitm,
+                buffer,
+                tm->tm_year + 1900, tm->tm_mon + 1);
+        system(Buf);
+    }
+
+    return rc;
+}
+
+char *getTimeString(void)
+{
+    char *result = malloc(21);
+    time_t timep;
+    struct tm *p;
+    time(&timep);
+    p = gmtime(&timep);
+
+    sprintf(result, "[%04d-%02d-%02d %02d:%02d:%02d]", (1900 + p->tm_year), (1 + p->tm_mon), p->tm_mday, p->tm_hour, p->tm_hour, p->tm_sec);
+
+    return result;
+}
+
+void PRINTF_FUNC(char *string, ...)
+{
+    va_list args;
+    char buffer[4096];
+    va_start(args, string);
+    vsnprintf(buffer, sizeof(buffer), string, args);
+    va_end(args);
+
+    DEBUG_INFO("%s \n", buffer);
+}
+
+//==========================================
+// Init all share memory
+//==========================================
+int InitShareMemory()
+{
+    int result = PASS;
+    int MeterSMId;
+
+    //creat ShmSysConfigAndInfo
+    if ((MeterSMId = shmget(ShmSysConfigAndInfoKey, sizeof(struct SysConfigAndInfo),  0777)) < 0) {
+#ifdef SystemLogMessage
+        DEBUG_ERROR("shmget ShmSysConfigAndInfo NG\n");
+#endif
+        result = FAIL;
+    } else if ((ShmSysConfigAndInfo = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+#ifdef SystemLogMessage
+        DEBUG_ERROR("shmat ShmSysConfigAndInfo NG\n");
+#endif
+        result = FAIL;
+    } else
+    {}
+
+    //creat ShmStatusCodeData
+    if ((MeterSMId = shmget(ShmStatusCodeKey, sizeof(struct StatusCodeData),  0777)) < 0) {
+#ifdef SystemLogMessage
+        DEBUG_ERROR("shmget ShmStatusCodeData NG\n");
+#endif
+        result = FAIL;
+    } else if ((ShmStatusCodeData = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+#ifdef SystemLogMessage
+        DEBUG_ERROR("shmat ShmStatusCodeData NG\n");
+#endif
+        result = FAIL;
+    } else
+    {}
+
+    //creat Audi customization info
+    if ((MeterSMId = shmget(ShmAudiCustInfoKey, sizeof(AudiCustInfo), IPC_CREAT | 0777)) < 0) {
+        DEBUG_ERROR("[main]CreatShareMemory:shmget select gun info NG \n");
+        return 0;
+    } else if ((gAudiCustInfo = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+        DEBUG_ERROR("[main]CreatShareMemory:shmat shmget select gun info \n");
+        return 0;
+    }
+
+    //creat ShmStatusCodeData
+    if ((MeterSMId = shmget(ShmPrimaryMcuKey, sizeof(struct PrimaryMcuData), 0777)) < 0) {
+#ifdef SystemLogMessage
+        DEBUG_ERROR("shmget ShmPrimaryMcuData NG\n");
+#endif
+        result = FAIL;
+    } else if ((ShmPrimaryMcuData = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+#ifdef ShmPrimaryMcuData
+        DEBUG_ERROR("shmat ShmPrimaryMcuData NG\n");
+#endif
+        result = FAIL;
+    }
+
+    return result;
+}
+
+//==========================================
+// Open and Close RS232 and R/W
+//==========================================
+int CreateCommunicationLcmPort()
+{
+    int fd;
+    struct termios tios;
+
+    fd = open(pPortName, O_RDWR);
+    if (fd <= 0) {
+#ifdef SystemLogMessage
+        DEBUG_ERROR("open /dev/ttyS3 NG \n");
+#endif
+        return -1;
+    }
+    ioctl(fd, TCGETS, &tios);
+    tios.c_cflag = B115200 | CS8 | CLOCAL | CREAD;
+    tios.c_lflag = 0;
+    tios.c_iflag = 0;
+    tios.c_oflag = 0;
+    tios.c_cc[VMIN] = 0;
+    tios.c_cc[VTIME] = (unsigned char) 5;
+    tios.c_lflag = 0;
+    tcflush(fd, TCIFLUSH);
+    ioctl(fd, TCSETS, &tios);
+
+    return fd;
+}
+
+void CloseCommunicationLcmPort()
+{
+    close(_port);
+}
+
+void WriteCmdToLcm(byte *cmd, byte cmdLen)
+{
+    int len = write(_port, cmd, cmdLen);
+    if (len >= sizeof(cmd)) {
+        //PRINTF_FUNC("Write cmd to LCM successfully. \n");
+    }
+}
+
+void ReadMsgFromLcm(byte *msg, byte readLen)
+{
+    read(_port, msg, readLen);
+
+    if (*msg == CMD_TITLE_1 && *(msg + 1) == CMD_TITLE_2) {
+        if (*(msg + 3) == CMD_WRITE) {
+            switch (*(msg + 4)) {
+            case CMD_REGISTER: {
+                // 頁面
+                strcpy((char *)ShmSysConfigAndInfo->SysInfo.LcmHwRev, moduleName);
+            }
+            break;
+            }
+        } else if (*(msg + 3) == CMD_MULTI_READ) {
+//          switch ((unsigned short) (*(msg + 4) << 8) + (unsigned short) *(msg + 5))
+//          {
+//              case BUTTON_GUN_INDEX:
+//              {
+//                  // 當前選的槍號
+//                  _curGunIndex = (*(msg + 8));
+//              }
+//              break;
+//          }
+        }
+    }
+}
+
+//================================================
+// Function
+//================================================
+void ChangeToOtherPage(short newPage)
+{
+    byte cmd[7];
+    memset(cmd, 0x00, sizeof(cmd));
+
+    cmd[0] = CMD_TITLE_1;
+    cmd[1] = CMD_TITLE_2;
+    cmd[2] = 0x02 + sizeof(newPage);
+    cmd[3] = CMD_READ;
+    cmd[4] = CMD_REGISTER;
+    cmd[5] = newPage >> 8;
+    cmd[6] = newPage & 0x00FF;
+
+    WriteCmdToLcm(cmd, ARRAY_SIZE(cmd));
+    usleep(100000);
+}
+
+void ChangeBackLight(bool islight)
+{
+    byte value = 0x01;
+
+    if (islight) {
+        value = 0x20;
+    }
+    byte cmd[7];
+    memset(cmd, 0x00, sizeof(cmd));
+
+    cmd[0] = CMD_TITLE_1;
+    cmd[1] = CMD_TITLE_2;
+    cmd[2] = 0x03;
+    cmd[3] = CMD_READ;
+    cmd[4] = CMD_BACKLIGHT;
+    cmd[5] = value;
+
+    WriteCmdToLcm(cmd, ARRAY_SIZE(cmd));
+    usleep(100000);
+}
+
+void GetCurrentPage()
+{
+    byte cmd[6];
+    memset(cmd, 0x00, sizeof(cmd));
+    byte msg[8];
+    memset(msg, 0x00, sizeof(msg));
+
+    cmd[0] = CMD_TITLE_1;
+    cmd[1] = CMD_TITLE_2;
+    cmd[2] = 0x03;              // 底下總長度
+    cmd[3] = CMD_WRITE;
+    cmd[4] = CMD_REGISTER;
+    cmd[5] = 0x02;
+
+    WriteCmdToLcm(cmd, ARRAY_SIZE(cmd));
+    usleep(100000);
+    ReadMsgFromLcm(msg, ARRAY_SIZE(msg));
+}
+
+void DisplayValueToLcm(short address, byte *data, byte len)
+{
+    byte cmd[256];
+    memset(cmd, 0x00, sizeof(cmd));
+
+    cmd[0] = CMD_TITLE_1;
+    cmd[1] = CMD_TITLE_2;
+    cmd[2] = 0x03 + len;
+    cmd[3] = CMD_MULTI_WRITE;
+    cmd[4] = address >> 8;
+    cmd[5] = address & 0x00FF;
+
+    for (byte count = 0; count < len; count++) {
+        cmd[6 + count] = *(data + count);
+    }
+
+    WriteCmdToLcm(cmd, cmd[2] + 3);
+}
+
+void ChangeDisplay2Value(short address, short value)
+{
+    byte data[2];
+    data[0] = value >> 8;
+    data[1] = value & 0x00FF;
+
+    DisplayValueToLcm(address, data, sizeof(data));
+}
+
+void GetBtnStatus(short address, byte len)
+{
+    byte cmd[8];
+    memset(cmd, 0x00, sizeof(cmd));
+    byte msg[8];
+    memset(msg, 0x00, sizeof(msg));
+
+    cmd[0] = CMD_TITLE_1;
+    cmd[1] = CMD_TITLE_2;
+    cmd[2] = 0x03 + len;
+    cmd[3] = CMD_MULTI_READ;
+    cmd[4] = address >> 8;
+    cmd[5] = address & 0x00FF;
+    cmd[6] = 0x00 + len;
+
+    WriteCmdToLcm(cmd, cmd[2] + 3);
+    usleep(100000);
+    ReadMsgFromLcm(msg, (len * 2) + sizeof(msg));
+}
+
+//================================================
+// Warning process
+//================================================
+void string2ByteArray(unsigned char *input, byte *output)
+{
+    int loop;
+    int i;
+
+    loop = 0;
+    i = 0;
+
+    while (input[loop] != '\0') {
+        output[i++] = input[loop++];
+    }
+    output[loop] = '\0';
+}
+
+void ChangeWarningFunc()
+{
+    byte cmd[7];
+    byte i = 0, j = 0;
+    //PRINTF_FUNC("ChangeWarningFunc \n");
+    // 最多一次五筆
+    //PRINTF_FUNC("LCM PageIndex = %d \n", ShmSysConfigAndInfo->SysWarningInfo.PageIndex);
+    //PRINTF_FUNC("WarningCount = %d \n", ShmSysConfigAndInfo->SysWarningInfo.WarningCount);
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
+    for (i = 0; (i + ShmSysConfigAndInfo->SysWarningInfo.PageIndex * 5) < ShmSysConfigAndInfo->SysWarningInfo.WarningCount; i++) {
+        memset(cmd, 0x00, sizeof(cmd));
+        if ((i) >= 5) {
+            break;
+        }
+
+        //error code
+        string2ByteArray(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i + ShmSysConfigAndInfo->SysWarningInfo.PageIndex * 5][0], cmd);
+        DisplayValueToLcm(0x0010 + ((i) * 6), cmd, sizeof(cmd));
+        //警告標示
+        memset(cmd, 0x00, sizeof(cmd));
+
+        cmd[0] = 0x00;
+        cmd[1] = 0x01;
+        DisplayValueToLcm(0x0002 + ((i) * 2), cmd, 2);
+    }
+
+    memset(cmd, 0x00, sizeof(cmd));
+    for (; i < 5; i++) {
+        DisplayValueToLcm(0x0010 + ((i) * 6), cmd, sizeof(cmd));
+        DisplayValueToLcm(0x0002 + ((i) * 2), cmd, 2);
+    }
+#else
+    for (i = 0; (i + ShmSysConfigAndInfo->SysWarningInfo.PageIndex * 5) < ShmSysConfigAndInfo->SysWarningInfo.WarningCount; i++) {
+        memset(cmd, 0x00, sizeof(cmd));
+        if ((i - j) >= 5) {
+            break;
+        }
+        if (
+            (memcmp(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i + ShmSysConfigAndInfo->SysWarningInfo.PageIndex * 5][0], "033900", 6) == 0) ||
+            (memcmp(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i + ShmSysConfigAndInfo->SysWarningInfo.PageIndex * 5][0], "033901", 6) == 0) ||
+            (memcmp(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i + ShmSysConfigAndInfo->SysWarningInfo.PageIndex * 5][0], "033902", 6) == 0) ||
+            (memcmp(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i + ShmSysConfigAndInfo->SysWarningInfo.PageIndex * 5][0], "043627", 6) == 0) ||
+            (memcmp(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i + ShmSysConfigAndInfo->SysWarningInfo.PageIndex * 5][0], "043628", 6) == 0) ||
+            (memcmp(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i + ShmSysConfigAndInfo->SysWarningInfo.PageIndex * 5][0], "043622", 6) == 0) ||
+            (memcmp(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i + ShmSysConfigAndInfo->SysWarningInfo.PageIndex * 5][0], "043623", 6) == 0) ||
+            (memcmp(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i + ShmSysConfigAndInfo->SysWarningInfo.PageIndex * 5][0], "043624", 6) == 0) ||
+            (memcmp(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i + ShmSysConfigAndInfo->SysWarningInfo.PageIndex * 5][0], "043625", 6) == 0) ||
+            (memcmp(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i + ShmSysConfigAndInfo->SysWarningInfo.PageIndex * 5][0], "043626", 6) == 0) ||
+            (memcmp(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i + ShmSysConfigAndInfo->SysWarningInfo.PageIndex * 5][0], "042241", 6) == 0) ||
+            (memcmp(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i + ShmSysConfigAndInfo->SysWarningInfo.PageIndex * 5][0], "042242", 6) == 0)
+        ) {
+            j++;
+            continue;
+        }
+        //error code
+        string2ByteArray(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i + ShmSysConfigAndInfo->SysWarningInfo.PageIndex * 5][0], cmd);
+        DisplayValueToLcm(0x0010 + ((i - j) * 6), cmd, sizeof(cmd));
+        //警告標示
+        memset(cmd, 0x00, sizeof(cmd));
+
+        cmd[0] = 0x00;
+        cmd[1] = 0x01;
+        DisplayValueToLcm(0x0002 + ((i - j) * 2), cmd, 2);
+    }
+
+    memset(cmd, 0x00, sizeof(cmd));
+    i = i - j;
+    for (; (i) < 5; i++) {
+        DisplayValueToLcm(0x0010 + ((i) * 6), cmd, sizeof(cmd));
+        DisplayValueToLcm(0x0002 + ((i) * 2), cmd, 2);
+    }
+
+#endif //!defined DD360 && !defined DD360Audi
+}
+
+//================================================
+// QR Code process
+//================================================
+void ChangeQrCode_Idle(char *input)
+{
+#if defined DD360Audi
+    int len = strlen(input) + 3;
+    int loop = 0;
+    int i = 0, j = 0, k = 0, l = 0;
+    uint8_t qrUrl[128] = {0};
+    uint16_t urlLen = 0;
+    uint8_t cmd[len];
+    uint8_t tmpBuf[15] = {0};
+    //uint8_t tmpLen = sizeof(tmpBuf) - 1;
+
+    strncpy((char *)cmd, " ", len);
+
+    while (input[loop] != '\0') {
+        cmd[i++] = input[loop++];
+        l = loop - 1;
+        if (len >= 25) {
+            if (i >= 16 && i <= 19) {
+                tmpBuf[k++] = input[l];
+                //printf("tmpBuf = %s\r\n", tmpBuf);
+            } else if (i >= 21 && i <= 23) {
+                tmpBuf[k++] = input[l];
+            }
+        }
+    }
+    tmpBuf[k] = '\0';
+    //printf("tmpBuf = %s\r\n", tmpBuf);
+    j += sprintf((char *)&cmd[i], ":%d", ShmSysConfigAndInfo->SysInfo.CurGunSelected); ////For Audi
+    cmd[len - 1] = '\0';
+    urlLen = sprintf((char *)qrUrl, "%s%s", NOODOE_QR_CODE_URL, cmd);
+    qrUrl[urlLen] = '\0';
+    //printf("qr url = %s\r\n", qrUrl);
+    DisplayValueToLcm(__qr_code, qrUrl, urlLen);
+
+    j = 0;
+    j += sprintf((char *)&tmpBuf[k], "0%d", ShmSysConfigAndInfo->SysInfo.CurGunSelected); ////For Audi
+    tmpBuf[k + j] = '\0';
+
+    //if (len < 25) {
+    //    strncpy((char *)tmpBuf, (char *)cmd, sizeof(tmpBuf));
+    //}
+    //tmpBuf[tmpLen] = '\0';
+    DisplayValueToLcm(__custStationIdL1, tmpBuf, sizeof(tmpBuf));
+
+    /*if (len > sizeof(tmpBuf)) {
+        strncpy((char *)tmpBuf, (char *)cmd, sizeof(tmpBuf));
+        tmpBuf[tmpLen] = '\0';
+        DisplayValueToLcm(__custStationIdL1, tmpBuf, sizeof(tmpBuf));
+
+        memset(tmpBuf, 0, sizeof(tmpBuf));
+        strncpy((char *)tmpBuf, (char *)&cmd[tmpLen], sizeof(tmpBuf));
+        tmpBuf[tmpLen] = '\0';
+        DisplayValueToLcm(__custStationIdL2, tmpBuf, sizeof(tmpBuf));
+    } else {
+        DisplayValueToLcm(__custStationIdL1, cmd, len);
+
+        strncpy((char *)tmpBuf, " ", sizeof(tmpBuf));
+        tmpBuf[tmpLen] = '\0';
+        DisplayValueToLcm(__custStationIdL2, tmpBuf, sizeof(tmpBuf));
+    }*/
+
+#else
+    int len = strlen(input);
+    byte cmd[len];
+
+    int loop = 0;
+    int i = 0;
+
+    while (input[loop] != '\0') {
+        cmd[i++] = input[loop++];
+    }
+
+    DisplayValueToLcm(__qr_code, cmd, len);
+#endif defined DD360Audi
+}
+
+void ChangeQrCode_Charge(char *input)
+{
+#if defined DD360Audi
+    int len = strlen(input) + 3;
+    int loop = 0;
+    int i = 0, j = 0, k = 0, l = 0;
+    uint8_t qrUrl[128] = {0};
+    uint16_t urlLen = 0;
+    uint8_t cmd[len];
+    uint8_t tmpBuf[15] = {0};
+    //uint8_t tmpLen = sizeof(tmpBuf) - 1;
+
+    strncpy((char *)cmd, " ", len);
+
+    while (input[loop] != '\0') {
+        cmd[i++] = input[loop++];
+        l = loop - 1;
+        if (len >= 25) {
+            if (i >= 16 && i <= 19) {
+                tmpBuf[k++] = input[l];
+                //printf("tmpBuf = %s\r\n", tmpBuf);
+            } else if (i >= 21 && i <= 23) {
+                tmpBuf[k++] = input[l];
+            }
+        }
+    }
+    tmpBuf[k] = '\0';
+    //printf("tmpBuf = %s\r\n", tmpBuf);
+    j += sprintf((char *)&cmd[i], ":%d", ShmSysConfigAndInfo->SysInfo.CurGunSelected); ////For Audi
+    cmd[len - 1] = '\0';
+    urlLen = sprintf((char *)qrUrl, "%s%s", NOODOE_QR_CODE_URL, cmd);
+    qrUrl[urlLen] = '\0';
+    DisplayValueToLcm(__qr_code, qrUrl, urlLen);
+
+    j = 0;
+    j += sprintf((char *)&tmpBuf[k], "0%d", ShmSysConfigAndInfo->SysInfo.CurGunSelected); ////For Audi
+    tmpBuf[k + j] = '\0';
+
+    if (len < 25) {
+        strncpy((char *)tmpBuf, (char *)cmd, sizeof(tmpBuf));
+    }
+    //tmpBuf[tmpLen] = '\0';
+    DisplayValueToLcm(__custStationIdL1, tmpBuf, sizeof(tmpBuf));
+    /*if (len > sizeof(tmpBuf)) {
+        strncpy((char *)tmpBuf, (char *)cmd, sizeof(tmpBuf));
+        tmpBuf[tmpLen] = '\0';
+        DisplayValueToLcm(__custStationIdL1, tmpBuf, sizeof(tmpBuf));
+
+        memset(tmpBuf, 0, sizeof(tmpBuf));
+        strncpy((char *)tmpBuf, (char *)&cmd[tmpLen], sizeof(tmpBuf));
+        tmpBuf[tmpLen] = '\0';
+        DisplayValueToLcm(__custStationIdL2, tmpBuf, sizeof(tmpBuf));
+    } else {
+        DisplayValueToLcm(__custStationIdL1, cmd, len);
+
+        strncpy((char *)tmpBuf, " ", sizeof(tmpBuf));
+        tmpBuf[tmpLen] = '\0';
+        DisplayValueToLcm(__custStationIdL2, tmpBuf, sizeof(tmpBuf));
+    }*/
+
+#else
+    int len = strlen(input);
+    byte cmd[len];
+
+    int loop = 0;
+    int i = 0;
+
+    while (input[loop] != '\0') {
+        cmd[i++] = input[loop++];
+    }
+
+    DisplayValueToLcm(__qr_code_pre, cmd, len);
+#endif //defined DD360Audi
+}
+
+//================================================
+// Change current page
+//================================================
+void ChangeCurPage()
+{
+    //PRINTF_FUNC("cur = %d, new = %d \n", _currentPage, ShmSysConfigAndInfo->SysInfo.PageIndex);
+    if (_currentPage != ShmSysConfigAndInfo->SysInfo.PageIndex) {
+        _currentPage = ShmSysConfigAndInfo->SysInfo.PageIndex;
+        ChangeToOtherPage(_currentPage);
+        _everyPageRollChange = 0;
+    }
+}
+
+//================================================
+// Main process
+//================================================
+byte demoCount = 0;
+void DemoFunction()
+{
+    if (demoCount == 0) {
+        ShmSysConfigAndInfo->SysWarningInfo.WarningCount = 6;
+        memcpy(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[0][0], "000001", 7);
+        memcpy(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[1][0], "000002", 7);
+        memcpy(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[2][0], "000003", 7);
+        memcpy(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[3][0], "000004", 7);
+        memcpy(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[4][0], "000005", 7);
+        memcpy(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[5][0], "000006", 7);
+    } else {
+        if (demoCount == 20) {
+            ShmSysConfigAndInfo->SysInfo.PageIndex = _LCM_SELECT_GUN; //_LCM_IDLE; ////For Audi
+        } else if (demoCount == 80) {
+            ShmSysConfigAndInfo->SysInfo.PageIndex = _LCM_AUTHORIZING;
+        } else if (demoCount == 100) {
+            ShmSysConfigAndInfo->SysInfo.PageIndex = _LCM_AUTHORIZ_COMP;
+        } else if (demoCount == 120) {
+            ShmSysConfigAndInfo->SysInfo.PageIndex = _LCM_AUTHORIZ_FAIL;
+        } else if (demoCount == 140) {
+            ShmSysConfigAndInfo->SysInfo.PageIndex = _LCM_PRE_CHARGE;
+        } else if (demoCount == 180) {
+            ShmSysConfigAndInfo->SysInfo.PageIndex = _LCM_CHARGING;
+        }
+    }
+
+    if (demoCount < 180) {
+        demoCount++;
+    }
+}
+
+//================================================
+// Main process
+//================================================
+bool FindChargingInfoData(byte target, struct ChargingInfoData **_chargingData)
+{
+    for (byte index = 0; index < CHAdeMO_QUANTITY; index++) {
+        if (ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].Index == target) {
+            _chargingData[target] = &ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index];
+            return true;
+        }
+    }
+
+    for (byte index = 0; index < CCS_QUANTITY; index++) {
+        if (ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].Index == target) {
+            _chargingData[target] = &ShmSysConfigAndInfo->SysInfo.CcsChargingData[index];
+            return true;
+        }
+    }
+
+    for (byte index = 0; index < GB_QUANTITY; index++) {
+        if (ShmSysConfigAndInfo->SysInfo.GbChargingData[index].Index == target) {
+            _chargingData[target] = &ShmSysConfigAndInfo->SysInfo.GbChargingData[index];
+            return true;
+        }
+    }
+
+    return false;
+}
+
+bool FindAcChargingInfoData(byte target, struct ChargingInfoData **acChargingData)
+{
+    if (target < AC_QUANTITY) {
+        acChargingData[target] = &ShmSysConfigAndInfo->SysInfo.AcChargingData[target];
+        return true;
+    }
+
+    return false;
+}
+
+/**
+ * [ChangeBalanceValue :print balance information]
+ * @Author
+ * @DateTime 2020-11-26
+ */
+static void ChangeBalanceValue(uint16_t addr, uint8_t index) ////For Audi
+{
+    byte cmd[10] = {0};
+    byte value[10] = {0};
+    uint8_t len = 0;
+    float balance = gAudiCustInfo->PricesInfo[index].Balance;
+
+    if ((balance) == (FAIL_BALANCE_PRICES)) {
+        balance = 0.00;
+    }
+
+    len += sprintf((char *) value, "%.2f", balance);
+    if (len < 6) {
+        sprintf((char *)&value[len], "%s",
+                (byte *)Currency[ShmSysConfigAndInfo->SysConfig.BillingData.Currency]);
+    }
+
+    value[sizeof(value) - 1] = '\0';
+
+    string2ByteArray(value, cmd);
+    DisplayValueToLcm(addr, cmd, sizeof(cmd));
+}
+
+void ChangeAcBattMapAndValue(short page)
+{
+    if (page == _LCM_CHARGING) {
+        if (isDiffStatus != _battery_display_ani) {
+            isChangeBattMap = false;
+            isDiffStatus = _battery_display_ani;
+        }
+
+        if (ac_chargingInfo[0]->IsCharging && !isChangeBattMap) {
+            isChangeBattMap = true;
+            if (ac_ani_battery_level == _BATTERY_LEVEL_FOR_MAP_LV5) {
+                ChangeDisplay2Value(__batt_map, _battery_empty);
+                ac_ani_battery_level = _BATTERY_LEVEL_FOR_MAP_EMP;
+            } else if (ac_ani_battery_level == _BATTERY_LEVEL_FOR_MAP_EMP) {
+                ChangeDisplay2Value(__batt_map, _battery_cap_20);
+                ac_ani_battery_level = _BATTERY_LEVEL_FOR_MAP_LV1;
+            } else if (ac_ani_battery_level == _BATTERY_LEVEL_FOR_MAP_LV1) {
+                ChangeDisplay2Value(__batt_map, _battery_cap_40);
+                ac_ani_battery_level = _BATTERY_LEVEL_FOR_MAP_LV2;
+            } else if (ac_ani_battery_level == _BATTERY_LEVEL_FOR_MAP_LV2) {
+                ChangeDisplay2Value(__batt_map, _battery_cap_60);
+                ac_ani_battery_level = _BATTERY_LEVEL_FOR_MAP_LV3;
+            } else if (ac_ani_battery_level == _BATTERY_LEVEL_FOR_MAP_LV3) {
+                ChangeDisplay2Value(__batt_map, _battery_cap_80);
+                ac_ani_battery_level = _BATTERY_LEVEL_FOR_MAP_LV4;
+            } else if (ac_ani_battery_level == _BATTERY_LEVEL_FOR_MAP_LV4) {
+                ChangeDisplay2Value(__batt_map, _battery_cap_100);
+                ac_ani_battery_level = _BATTERY_LEVEL_FOR_MAP_LV5;
+            }
+        }
+    } else if (page == _LCM_COMPLETE) {
+        if (ac_ani_battery_level == _BATTERY_LEVEL_FOR_MAP_LV5) {
+            ChangeDisplay2Value(__batt_map, _battery_soc_20);
+        } else if (ac_ani_battery_level == _BATTERY_LEVEL_FOR_MAP_EMP) {
+            ChangeDisplay2Value(__batt_map, _battery_soc_20);
+        } else if (ac_ani_battery_level == _BATTERY_LEVEL_FOR_MAP_LV1) {
+            ChangeDisplay2Value(__batt_map, _battery_soc_40);
+        } else if (ac_ani_battery_level == _BATTERY_LEVEL_FOR_MAP_LV2) {
+            ChangeDisplay2Value(__batt_map, _battery_soc_60);
+        } else if (ac_ani_battery_level == _BATTERY_LEVEL_FOR_MAP_LV3) {
+            ChangeDisplay2Value(__batt_map, _battery_soc_80);
+        } else if (ac_ani_battery_level == _BATTERY_LEVEL_FOR_MAP_LV4) {
+            ChangeDisplay2Value(__batt_map, _battery_soc_100);
+        }
+    }
+
+    ChangeDisplay2Value(__soc_value_charging, _disappear);
+}
+
+void ChangeBattMapAndValue(short page, int soc)
+{
+//  srand(time(NULL));
+//  int min = 10;
+//  int max = 90;
+//  soc = rand() % (max - min + 1) + min;
+
+    if (page == _LCM_PRE_CHARGE) {
+        ChangeDisplay2Value(__batt_map_empty, _battery_empty);
+    } else if (page == _LCM_CHARGING) {
+        if (soc < 20) {
+            if (_battery_display_ani) {
+                ChangeDisplay2Value(__batt_map, _battery_empty);
+            } else {
+                ChangeDisplay2Value(__batt_map, _battery_cap_20);
+            }
+        } else if (soc >= 20 && soc < 40) {
+            if (_battery_display_ani) {
+                ChangeDisplay2Value(__batt_map, _battery_cap_20);
+            } else {
+                ChangeDisplay2Value(__batt_map, _battery_cap_40);
+            }
+        } else if (soc >= 40 && soc < 60) {
+            if (_battery_display_ani) {
+                ChangeDisplay2Value(__batt_map, _battery_cap_40);
+            } else {
+                ChangeDisplay2Value(__batt_map, _battery_cap_60);
+            }
+        } else if (soc >= 60 && soc < 80) {
+            if (_battery_display_ani) {
+                ChangeDisplay2Value(__batt_map, _battery_cap_60);
+            } else {
+                ChangeDisplay2Value(__batt_map, _battery_cap_80);
+            }
+        } else if (soc >= 80 && soc <= 100) {
+            ChangeDisplay2Value(__batt_map, _battery_cap_100);
+        }
+    } else if (page == _LCM_COMPLETE) {
+        if (soc < 20) {
+            ChangeDisplay2Value(__batt_map, _battery_soc_20);
+        } else if (soc >= 20 && soc < 40) {
+            ChangeDisplay2Value(__batt_map, _battery_soc_40);
+        } else if (soc >= 40 && soc < 60) {
+            ChangeDisplay2Value(__batt_map, _battery_soc_60);
+        } else if (soc >= 60 && soc < 80) {
+            ChangeDisplay2Value(__batt_map, _battery_soc_80);
+        } else if (soc >= 80 && soc <= 100) {
+            ChangeDisplay2Value(__batt_map, _battery_soc_100);
+        }
+    }
+
+    byte cmd[5];
+    byte value[5];
+
+    memset(cmd, 0x00, sizeof(cmd));
+    memset(value, 0x00, sizeof(value));
+    sprintf((char *)value, "%d%%", soc);
+    string2ByteArray(value, cmd);
+    DisplayValueToLcm(__soc_value_charging, cmd, sizeof(cmd));
+}
+
+void ChangeRemainTime(int sec)
+{
+    int h, m, s;
+    byte cmd[10];
+    byte value[10];
+
+    memset(cmd, 0x00, sizeof(cmd));
+
+//  srand(time(NULL));
+//  int min = 0;
+//  int max = 65536;
+//  sec = rand() % (max - min + 1) + min;
+
+    h = (sec / 3600);
+    m = (sec - (3600 * h)) / 60;
+    s = (sec - (3600 * h) - (m * 60));
+    sprintf((char *)value, "%02d:%02d:%02d", h, m, s);
+    string2ByteArray(value, cmd);
+    DisplayValueToLcm(__remain_time_tx, cmd, sizeof(cmd));
+}
+
+void ChangeChargingEnergyValue(float energy)
+{
+    byte cmd[10];
+    byte value[10];
+
+    memset(cmd, 0x00, sizeof(cmd));
+    if (energy >= 0.05) {
+        energy -= 0.05;
+    }
+    sprintf((char *) value, "%.1f kWh", energy);
+    string2ByteArray(value, cmd);
+    DisplayValueToLcm(__total_out_eng_tx, cmd, sizeof(cmd));
+}
+
+void ChangeChargingPowerValue(float pow)
+{
+    byte cmd[10];
+    byte value[10];
+
+    memset(cmd, 0x00, sizeof(cmd));
+
+//  float min = 0.0;
+//  float max = 50;
+//  pow = (max - min) * rand() / (RAND_MAX + 1.0) + min;
+    sprintf((char *) value, "%.1f kW", pow);
+    string2ByteArray(value, cmd);
+    DisplayValueToLcm(__output_eng_tx, cmd, sizeof(cmd));
+}
+
+void ChangeChargingFeeValue(float fee)
+{
+    byte cmd[10];
+    byte value[10];
+
+    memset(cmd, 0x00, sizeof(cmd));
+
+    sprintf((char *) value, "%.2f", fee);
+    string2ByteArray(value, cmd);
+    DisplayValueToLcm(__charging_fee_tx, cmd, sizeof(cmd));
+}
+
+void DisplayMoneyRate(float money)
+{
+    byte cmd[8];
+    byte value[8];
+
+    memset(cmd, 0x00, sizeof(cmd));
+
+    sprintf((char *) value, "%.2f", money);
+    string2ByteArray(value, cmd);
+    DisplayValueToLcm(__money_by_rate, cmd, sizeof(cmd));
+}
+
+void DisplayMoneyCur(byte *cur)
+{
+    byte cmd[10] = {0};
+    byte buf[10] = {0};
+    uint8_t len = 0;
+
+    *(cur + 3) = '\0';
+    memset(cmd, 0x00, sizeof(cmd));
+    len = sprintf((char *) buf, "%s/kWh", cur);
+    buf[len] = '\0';
+    string2ByteArray(buf, cmd);
+    DisplayValueToLcm(__money_rate, cmd, sizeof(cmd));
+}
+
+void RefreshPageAnimation(byte value)
+{
+    switch (_currentPage) {
+    case _LCM_IDLE: {
+
+    }
+    break;
+    case _LCM_WAIT_FOR_PLUG: {
+        if (_everyPageRollChange == 0) {
+            ChangeDisplay2Value(__plug_in_arrow, _arrow_dark);
+        } else if (_everyPageRollChange == 15) {
+            ChangeDisplay2Value(__plug_in_arrow, _arrow_light);
+        }
+
+        _everyPageRollChange > 30 ? _everyPageRollChange = 0 : _everyPageRollChange++;
+    }
+    break;
+    case _LCM_PRE_CHARGE:
+    case _LCM_CHARGING:
+    case _LCM_COMPLETE: {
+        if (_currentPage == _LCM_PRE_CHARGE) {
+            if (_everyPageRollChange == 0 || _everyPageRollChange == 22) {
+                ChangeDisplay2Value(__conn_line, _conn_map1);
+            } else if (_everyPageRollChange == 11 || _everyPageRollChange == 33) {
+                ChangeDisplay2Value(__conn_line, _conn_map2);
+            }
+        } else if (_currentPage == _LCM_CHARGING) {
+            if (_everyPageRollChange == 0 || _everyPageRollChange == 22) {
+                ChangeDisplay2Value(__conn_line_chag, _charging_map1);
+            } else if (_everyPageRollChange == 11 || _everyPageRollChange == 33) {
+                ChangeDisplay2Value(__conn_line_chag, _charging_map2);
+            }
+        } else if (_currentPage == _LCM_COMPLETE) {
+            if (_everyPageRollChange == 0) {
+                ChangeDisplay2Value(__conn_line_comp, _complete_map);
+            }
+        }
+
+        _everyPageRollChange >= 45 ? _everyPageRollChange = 0 : _everyPageRollChange++;
+    }
+    break;
+    }
+}
+
+void RefreshConnStatus()
+{
+    // Wifi priority is higher than Ethernet
+#if defined DD360 ||defined DD360Audi || defined DD360ComBox
+    uint8_t i = 0;
+    unsigned char flag[4] = {0};
+
+    for (i = 0; i < ShmSysConfigAndInfo->SysWarningInfo.WarningCount; i++) {
+        //printf("status code = %s\r\n", &ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i][0]);
+        if (memcmp(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i][0], "012304", 6) == 0) {
+            flag[0] = 1;
+            continue;
+        }
+
+        if (memcmp(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i][0], "043625", 6) == 0) {
+            //disconnected from AP through WiFi
+            flag[1] = 1;
+            continue;
+        }
+
+        if (memcmp(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i][0], "043627", 6) == 0) { //wifi disabled
+            flag[1] = 2;
+            continue;
+        }
+
+        if ((memcmp(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i][0], "033900", 6) == 0) ||
+                (memcmp(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i][0], "033901", 6) == 0) ||
+                (memcmp(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i][0], "033902", 6) == 0)) {
+            flag[2] = 1;
+            continue;
+        }
+
+        if (memcmp(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i][0], "043626", 6) == 0) {
+            //disconnected from APN through 3G/4G
+            flag[3] = 1;
+            continue;
+        }
+
+        if (memcmp(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i][0], "043628", 6) == 0) { //4g disabled
+            flag[3] = 2;
+            continue;
+        }
+    }
+
+    if (flag[0] == 1) {
+        ChangeDisplay2Value(__ethernet_status, _eth_disconnect);
+    } else {
+        ChangeDisplay2Value(__ethernet_status, _eth_connect);
+    }
+
+    //ChangeDisplay2Value(__wifi_status, _disappear);
+    //ChangeDisplay2Value(__conn_status, _disappear);
+    //ChangeDisplay2Value(__3G4G_status, _disappear);
+
+    if (flag[1] == 1) {
+        ChangeDisplay2Value(__3G4G_move_status, _disappear);
+        ChangeDisplay2Value(__wifi_status, _wifi_disconnect);
+    } else if (flag[1] == 2) {
+        ChangeDisplay2Value(__wifi_status, _disappear);
+    } else {
+        ChangeDisplay2Value(__3G4G_move_status, _disappear);
+        ChangeDisplay2Value(__wifi_status, _wifi_connect);
+    }
+
+    if (flag[2] == 1) {
+        ChangeDisplay2Value(__conn_status, _disconnect);
+    } else {
+        ChangeDisplay2Value(__conn_status, _connect);
+    }
+
+    if (flag[1] == 2) {
+        ChangeDisplay2Value(__3G4G_status, _disappear);
+        if (flag[3] == 1) {
+            ChangeDisplay2Value(__3G4G_move_status, _3G4G_disconnect);
+        } else if (flag[3] == 2) {
+            ChangeDisplay2Value(__3G4G_move_status, _disappear);
+        } else {
+            ChangeDisplay2Value(__3G4G_move_status, __3G4G_connect);
+        }
+    } else {
+        if (flag[3] == 1) {
+            ChangeDisplay2Value(__3G4G_status, _3G4G_disconnect);
+        } else if (flag[3] == 2) {
+            ChangeDisplay2Value(__3G4G_status, _disappear);
+        } else {
+            ChangeDisplay2Value(__3G4G_status, __3G4G_connect);
+        }
+    }
+#else
+    if (ShmSysConfigAndInfo->SysConfig.AthInterface.WifiNetworkConn == YES ||
+            ShmSysConfigAndInfo->SysConfig.AthInterface.WifiMode == _SYS_WIFI_MODE_AP) {
+        _wifi_conn_status = true;
+        ChangeDisplay2Value(__wifi_status, _wifi_connect);
+        ChangeDisplay2Value(__ethernet_status, _disappear);
+    } else {
+        _wifi_conn_status = false;
+        ChangeDisplay2Value(__wifi_status, _disappear);
+    }
+
+    if (!_wifi_conn_status) {
+        if (ShmSysConfigAndInfo->SysConfig.TelecomInterface.TelcomNetworkConn == YES ||
+                ShmSysConfigAndInfo->SysInfo.InternetConn == YES) {
+            ChangeDisplay2Value(__ethernet_status, _ethernet_connect);
+        } else {
+            ChangeDisplay2Value(__ethernet_status, _ethernet_disconnect);
+        }
+    }
+
+    // 連線到後台
+    if (ShmSysConfigAndInfo->SysInfo.OcppConnStatus == YES) {
+        ChangeDisplay2Value(__conn_status, _connect);
+    } else {
+        ChangeDisplay2Value(__conn_status, _disconnect);
+    }
+#endif //defined DD360 || defined DD360Audi
+}
+
+byte FirstPageChanged()
+{
+    byte result = NO;
+
+    if (_currentPage != _oldPage) {
+        result = YES;
+        _oldPage = _currentPage;
+    }
+
+    return result;
+}
+
+bool IsPageReloadChk()
+{
+    bool result = false;
+
+    if (ShmSysConfigAndInfo->SysInfo.CurGunSelectedByAc == NO_DEFINE) {
+        if (_curPage_index != ShmSysConfigAndInfo->SysInfo.CurGunSelected) {
+            _curPage_index = ShmSysConfigAndInfo->SysInfo.CurGunSelected;
+            result = true;
+        }
+    } else {
+        if (_curPage_index != ShmSysConfigAndInfo->SysInfo.CurGunSelectedByAc) {
+            _curPage_index = ShmSysConfigAndInfo->SysInfo.CurGunSelectedByAc;
+            result = true;
+        }
+    }
+
+    return result;
+}
+
+void ProcessPageInfo()
+{
+    _page_reload = IsPageReloadChk();
+
+    switch (_currentPage) {
+#if defined DD360Audi
+    case _LCM_SELECT_GUN: ////For Audi
+        if (ShmSysConfigAndInfo->SysInfo.CurGunSelected == 0) {
+            ChangeDisplay2Value(__left_gun_map, _left_gun_enable_map);
+            ChangeDisplay2Value(__right_gun_map, _right_gun_disable_map);
+        } else if (ShmSysConfigAndInfo->SysInfo.CurGunSelected == 1) {
+            ChangeDisplay2Value(__left_gun_map, _left_gun_disable_map);
+            ChangeDisplay2Value(__right_gun_map, _right_gun_enable_map);
+        }
+        ChangeDisplay2Value(__add_chk_btn, _select_gun_btn);
+        break;
+#endif //defined DD360Audi
+
+    case _LCM_IDLE: {
+        if (ShmSysConfigAndInfo->SysConfig.isRFID) {
+            ChangeDisplay2Value(__main_rfid, _main_rfid);
+        } else {
+            ChangeDisplay2Value(__main_rfid, _main_none_rfid);
+        }
+
+        if (ShmSysConfigAndInfo->SysConfig.isQRCode) {
+            ChangeDisplay2Value(__main_qr, _main_qr);
+        } else {
+            ChangeDisplay2Value(__qr_code, _disappear);
+            ChangeDisplay2Value(__main_qr, _main_none_qr);
+            needReloadQr = true;
+        }
+
+        if (ShmSysConfigAndInfo->SysConfig.isAPP) {
+            ChangeDisplay2Value(__main_app, _main_app);
+        } else {
+            ChangeDisplay2Value(__main_app, _main_none_app);
+        }
+
+        //if (FirstPageChanged() == YES || needReloadQr || _page_reload) {
+        if (ShmSysConfigAndInfo->SysConfig.isQRCode) {
+            needReloadQr = false;
+            ChangeQrCode_Idle((char *)ShmSysConfigAndInfo->SysConfig.SystemId);
+        }
+        //}
+    }
+    break;
+    case _LCM_AUTHORIZING:
+    case _LCM_AUTHORIZ_COMP:
+    case _LCM_AUTHORIZ_FAIL:
+    case _LCM_WAIT_FOR_PLUG: {
+        FirstPageChanged();
+#if defined DD360Audi
+        if (_currentPage == _LCM_AUTHORIZ_COMP) { ////For Audi
+            ChangeBalanceValue(__balance, ShmSysConfigAndInfo->SysInfo.CurGunSelected);
+        }
+#endif //defined DD360Audi
+    }
+    break;
+    case _LCM_PRE_CHARGE:
+    case _LCM_CHARGING:
+    case _LCM_COMPLETE: {
+
+        bool isShowAc = false;
+        if (acgunCount > 0) {
+            if (ShmSysConfigAndInfo->SysInfo.CurGunSelectedByAc != NO_DEFINE) {
+                isShowAc = true;
+                ChangeDisplay2Value(__gun_type_index + (2 * 2), _actype_light);
+
+                if (_currentPage == _LCM_CHARGING) {
+                    ChangeAcBattMapAndValue(_LCM_CHARGING);
+                    if (ac_chargingInfo[0]->PresentChargedDuration >= 0 &&
+                            ac_chargingInfo[0]->PresentChargedDuration <= TIME_MAX_SEC) {
+                        ChangeRemainTime(ac_chargingInfo[0]->PresentChargedDuration);
+                    } else {
+                        ChangeRemainTime(0);
+                    }
+
+                    if (ac_chargingInfo[0]->PresentChargingPower >= 0.1 &&
+                            ac_chargingInfo[0]->PresentChargingPower <= POWER_MAX_KW) {
+                        ChangeChargingPowerValue(ac_chargingInfo[0]->PresentChargingPower);
+                    } else {
+                        ChangeChargingPowerValue(0);
+                    }
+
+                    if (ac_chargingInfo[0]->PresentChargedEnergy >= 0.1 &&
+                            ac_chargingInfo[0]->PresentChargedEnergy <= ENERGY_MAX_KWH) {
+                        ChangeChargingEnergyValue(ac_chargingInfo[0]->PresentChargedEnergy);
+                    } else {
+                        ChangeChargingEnergyValue(0);
+                    }
+
+                    if (strcmp((char *)ac_chargingInfo[0]->StartUserId, "") == 0) {
+                        ChangeDisplay2Value(__stop_method_btn, _stop_charging_btn);
+                    } else {
+                        ChangeDisplay2Value(__stop_method_btn, _stop_charging_btn_scan);
+                    }
+                } else if (_currentPage == _LCM_COMPLETE) {
+                    ChangeAcBattMapAndValue(_LCM_COMPLETE);
+                    if (ac_chargingInfo[0]->PresentChargedDuration >= 0 &&
+                            ac_chargingInfo[0]->PresentChargedDuration <= TIME_MAX_SEC) {
+                        ChangeRemainTime(ac_chargingInfo[0]->PresentChargedDuration);
+                    } else {
+                        ChangeRemainTime(0);
+                    }
+
+                    if (ac_chargingInfo[0]->PresentChargingPower >= 0.1 &&
+                            ac_chargingInfo[0]->PresentChargingPower <= POWER_MAX_KW) {
+                        ChangeChargingPowerValue(ac_chargingInfo[0]->PresentChargingPower);
+                    } else {
+                        ChangeChargingPowerValue(0);
+                    }
+
+                    if (ac_chargingInfo[0]->PresentChargedEnergy >= 0.1 &&
+                            ac_chargingInfo[0]->PresentChargedEnergy <= ENERGY_MAX_KWH) {
+                        ChangeChargingEnergyValue(ac_chargingInfo[0]->PresentChargedEnergy);
+
+                        if (ShmSysConfigAndInfo->SysConfig.BillingData.isBilling &&
+                                ac_chargingInfo[0]->ChargingFee >= 0) {
+                            ChangeChargingFeeValue(ac_chargingInfo[0]->ChargingFee);
+                        }
+                    } else {
+                        ChangeChargingEnergyValue(0);
+                        if (ShmSysConfigAndInfo->SysConfig.BillingData.isBilling) {
+                            ChangeChargingFeeValue(0);
+                        }
+                    }
+
+                    if (!ShmSysConfigAndInfo->SysConfig.BillingData.isBilling) {
+                        ChangeDisplay2Value(__charging_fee_map, _disappear);
+                        ChangeDisplay2Value(__charging_fee_tx, _disappear);
+                    } else {
+                        ChangeDisplay2Value(__charging_fee_map, _money_map);
+                    }
+                }
+            } else {
+                ChangeDisplay2Value(__gun_type_index + (2 * 2), _actype_dark);
+            }
+        } else {
+            ChangeDisplay2Value(__gun_type_index + (2 * 2), _disappear);
+        }
+
+        for (byte i = 0; i < _totalCount; i++) {
+            switch (_chargingInfoData[i]->Type) {
+            case _Type_Chademo: {
+                if (ShmSysConfigAndInfo->SysInfo.CurGunSelected == i && !isShowAc) {
+                    if (_currentPage == _LCM_COMPLETE) {
+                        ChangeDisplay2Value(__cmp_gun_type_index + (i * 2), _chademo_light_cmp);
+                    } else {
+                        ChangeDisplay2Value(__gun_type_index + (i * 2), _chademo_light);
+                    }
+                } else {
+                    if (_currentPage == _LCM_COMPLETE) {
+                        ChangeDisplay2Value(__cmp_gun_type_index + (i * 2), _chademo_dark_cmp);
+                    } else {
+                        ChangeDisplay2Value(__gun_type_index + (i * 2), _chademo_dark);
+                    }
+                }
+            }
+            break;
+            case _Type_GB: {
+                if (ShmSysConfigAndInfo->SysInfo.CurGunSelected == i && !isShowAc) {
+                    if (_currentPage == _LCM_COMPLETE) {
+                        ChangeDisplay2Value(__cmp_gun_type_index + (i * 2), _gbt_light_cmp);
+                    } else {
+                        ChangeDisplay2Value(__gun_type_index + (i * 2), _gbt_light);
+                    }
+                } else {
+                    if (_currentPage == _LCM_COMPLETE) {
+                        ChangeDisplay2Value(__cmp_gun_type_index + (i * 2), _gbt_dark_cmp);
+                    } else {
+                        ChangeDisplay2Value(__gun_type_index + (i * 2), _gbt_dark);
+                    }
+                }
+            }
+            break;
+            case _Type_CCS_2: {
+                if (ShmSysConfigAndInfo->SysInfo.CurGunSelected == i && !isShowAc) {
+                    if (_currentPage == _LCM_COMPLETE) {
+                        ChangeDisplay2Value(__cmp_gun_type_index + (i * 2), _ccs_light_cmp);
+                    } else {
+                        ChangeDisplay2Value(__gun_type_index + (i * 2), _ccs_light);
+                    }
+                } else {
+                    if (_currentPage == _LCM_COMPLETE) {
+                        ChangeDisplay2Value(__cmp_gun_type_index + (i * 2), _ccs_dark_cmp);
+                    } else {
+                        ChangeDisplay2Value(__gun_type_index + (i * 2), _ccs_dark);
+                    }
+                }
+            }
+            break;
+            }
+
+            if (_currentPage == _LCM_PRE_CHARGE && !isShowAc) {
+                if (ShmSysConfigAndInfo->SysInfo.CurGunSelected == i) {
+                    ChangeBattMapAndValue(_currentPage, _chargingInfoData[i]->EvBatterySoc);
+                }
+            } else if (_currentPage == _LCM_CHARGING && !isShowAc) {
+                if (ShmSysConfigAndInfo->SysInfo.CurGunSelected == i) {
+                    ChangeBattMapAndValue(_LCM_CHARGING, _chargingInfoData[i]->EvBatterySoc);
+                    if (_chargingInfoData[i]->PresentChargedDuration >= 0 &&
+                            _chargingInfoData[i]->PresentChargedDuration <= TIME_MAX_SEC) {
+                        ChangeRemainTime(_chargingInfoData[i]->PresentChargedDuration);
+                    } else {
+                        ChangeRemainTime(0);
+                    }
+
+                    if (_chargingInfoData[i]->PresentChargingPower >= 0 &&
+                            _chargingInfoData[i]->PresentChargingPower <= POWER_MAX_KW) {
+                        ChangeChargingPowerValue(_chargingInfoData[i]->PresentChargingPower);
+                    } else {
+                        ChangeChargingPowerValue(0);
+                    }
+
+                    if (_chargingInfoData[i]->PresentChargedEnergy >= 0.1 &&
+                            _chargingInfoData[i]->PresentChargedEnergy <= ENERGY_MAX_KWH) {
+                        ChangeChargingEnergyValue(_chargingInfoData[i]->PresentChargedEnergy);
+                    } else {
+                        ChangeChargingEnergyValue(0);
+                    }
+
+                    if (strcmp((char *)_chargingInfoData[i]->StartUserId, "") == 0) {
+                        ChangeDisplay2Value(__stop_method_btn, _stop_charging_btn);
+                    } else {
+                        ChangeDisplay2Value(__stop_method_btn, _stop_charging_btn_scan);
+                    }
+                }
+            } else if (_currentPage == _LCM_COMPLETE && !isShowAc) {
+                if (ShmSysConfigAndInfo->SysInfo.CurGunSelected == i) {
+                    ChangeBattMapAndValue(_LCM_COMPLETE, _chargingInfoData[i]->EvBatterySoc);
+                    if (_chargingInfoData[i]->PresentChargedDuration >= 0 &&
+                            _chargingInfoData[i]->PresentChargedDuration <= TIME_MAX_SEC) {
+                        ChangeRemainTime(_chargingInfoData[i]->PresentChargedDuration);
+                    } else {
+                        ChangeRemainTime(0);
+                    }
+
+                    if (_chargingInfoData[i]->PresentChargingPower >= 0 &&
+                            _chargingInfoData[i]->PresentChargingPower <= POWER_MAX_KW) {
+                        ChangeChargingPowerValue(_chargingInfoData[i]->PresentChargingPower);
+                    } else {
+                        ChangeChargingPowerValue(0);
+                    }
+#if 1
+                    if (_chargingInfoData[i]->PresentChargedEnergy >= 0.1 &&
+                            _chargingInfoData[i]->PresentChargedEnergy <= ENERGY_MAX_KWH) {
+                        ChangeChargingEnergyValue(_chargingInfoData[i]->PresentChargedEnergy);
+
+                        if (ShmSysConfigAndInfo->SysConfig.BillingData.isBilling &&
+                                _chargingInfoData[i]->ChargingFee >= 0) {
+                            ChangeChargingFeeValue(_chargingInfoData[i]->ChargingFee);
+                            ChangeBalanceValue(__remain_balance, i);
+                        }
+                    } else {
+                        ChangeChargingEnergyValue(0);
+                        if (ShmSysConfigAndInfo->SysConfig.BillingData.isBilling) {
+                            ChangeChargingFeeValue(0);
+                            ChangeBalanceValue(__remain_balance, i);
+                        }
+                    }
+#else
+                    ChangeChargingEnergyValue(_chargingInfoData[i]->PresentChargedEnergy);
+
+                    if (ShmSysConfigAndInfo->SysConfig.BillingData.isBilling &&
+                            _chargingInfoData[i]->ChargingFee >= 0) {
+                        ChangeChargingFeeValue(_chargingInfoData[i]->ChargingFee);
+                        ChangeBalanceValue(__remain_balance, i);
+                    }
+#endif // 0
+                    if (!ShmSysConfigAndInfo->SysConfig.BillingData.isBilling) {
+                        ChangeDisplay2Value(__charging_fee_map, _disappear);
+                        ChangeDisplay2Value(__charging_fee_tx, _disappear);
+                    } else {
+                        ChangeDisplay2Value(__charging_fee_map, _money_map);
+                    }
+                }
+            }
+        }
+
+        // gun btn and QR code
+        if (_totalCount + acgunCount >= 2 && _currentPage) {
+            byte index = 0;
+            for (index = 0; index < _totalCount; index++) {
+                if (ShmSysConfigAndInfo->SysInfo.CurGunSelected != index) {
+                    break;
+                }
+            }
+
+            if (_chargingInfoData[index]->SystemStatus == S_IDLE ||
+                    _chargingInfoData[index]->SystemStatus == S_RESERVATION ||
+                    _chargingInfoData[index]->SystemStatus == S_BOOTING) {
+                if (FirstPageChanged() == YES || needReloadQr || _page_reload) {
+                    if (ShmSysConfigAndInfo->SysConfig.isQRCode) {
+                        needReloadQr = false;
+                        ChangeQrCode_Charge((char *)ShmSysConfigAndInfo->SysConfig.SystemId);
+                    }
+                }
+            }
+        }
+    }
+    break;
+
+    case _LCM_FIX:
+        if (ShmPrimaryMcuData->InputDet.bits.EmergencyButton == 1) {
+            ChangeDisplay2Value(_emergency_map, _emergency_disable_map);
+        } else {
+            ChangeDisplay2Value(_emergency_map, _disappear);
+        }
+        break;
+    }
+}
+
+void ChangeDisplayMoneyInfo()
+{
+    uint8_t curGun = ShmSysConfigAndInfo->SysInfo.CurGunSelected;
+
+    if (ShmSysConfigAndInfo->SysConfig.BillingData.isBilling) {
+        struct timeb csuTime;
+        struct tm *tmCSU;
+
+        ftime(&csuTime);
+        tmCSU = localtime(&csuTime.time);
+
+        ChangeDisplay2Value(__money_rate_map, _charging_money);
+        if (gAudiCustInfo->PricesInfo[curGun].UserPrices != 0.00) { //Jerry add
+            DisplayMoneyRate(gAudiCustInfo->PricesInfo[curGun].UserPrices);
+        } else {
+            if (tmCSU->tm_hour <= 23) {
+                ShmSysConfigAndInfo->SysConfig.BillingData.Cur_fee = ShmSysConfigAndInfo->SysConfig.BillingData.Fee[tmCSU->tm_hour];
+                DisplayMoneyRate(ShmSysConfigAndInfo->SysConfig.BillingData.Cur_fee);
+            }
+
+            if (ShmSysConfigAndInfo->SysConfig.BillingData.Currency <= 53) {
+                DisplayMoneyCur((byte *)Currency[ShmSysConfigAndInfo->SysConfig.BillingData.Currency]);
+            }
+        }
+    } else {
+        ChangeDisplay2Value(__money_rate_map, _disappear);
+        ChangeDisplay2Value(__money_by_rate, _disappear);
+        ChangeDisplay2Value(__money_rate, _disappear);
+    }
+}
+
+void Initialization()
+{
+    bool isPass = false;
+    byte count = 5;
+    while (!isPass && count > 0) {
+        isPass = true;
+        for (byte _index = 0; _index < _totalCount; _index++) {
+            if (!FindChargingInfoData(_index, &_chargingInfoData[0])) {
+                DEBUG_ERROR("LcmComm (main) : FindChargingInfoData false \n");
+                isPass = false;
+                count--;
+                break;
+            }
+        }
+
+        sleep(1);
+    }
+
+    isPass = false;
+
+    if (acgunCount > 0) {
+        while (!isPass) {
+            isPass = true;
+            for (byte _index = 0; _index < acgunCount; _index++) {
+                if (!FindAcChargingInfoData(_index, &ac_chargingInfo[0])) {
+                    DEBUG_ERROR("LcmComm : FindAcChargingInfoData false \n");
+                    isPass = false;
+                    break;
+                }
+            }
+
+            sleep(1);
+        }
+    }
+
+    if (count == 0) {
+        PRINTF_FUNC("LCM Initialization Gun Fail.............\n");
+    }
+}
+
+int main(void)
+{
+    if (InitShareMemory() == FAIL) {
+#ifdef SystemLogMessage
+        DEBUG_ERROR("InitShareMemory NG\n");
+#endif
+        if (ShmStatusCodeData != NULL) {
+            ShmStatusCodeData->AlarmCode.AlarmEvents.bits.FailToCreateShareMemory = 1;
+        }
+        sleep(5);
+        return 0;
+    }
+
+    _port = CreateCommunicationLcmPort();
+    byte changeWarningPriority = 0;
+    byte curWarningCount = 255;
+    ChangeBackLight(true);
+    _totalCount = ShmSysConfigAndInfo->SysConfig.TotalConnectorCount;
+    acgunCount = ShmSysConfigAndInfo->SysConfig.AcConnectorCount;
+    Initialization();
+
+    //ChangeToOtherPage(_LCM_COMPLETE);
+    //return 0;
+
+    for (byte i = 0; i < 3; i++) {
+        ChangeDisplay2Value(__gun_type_index + (i * 2), _disappear);
+    }
+
+    while (_port != -1) {
+        if (strcmp((char *)ShmSysConfigAndInfo->SysInfo.LcmHwRev, moduleName) != 0x00) {
+            GetCurrentPage();
+            sleep(1);
+        } else {
+            //DemoFunction();
+
+            // Warning 處理
+            if (curWarningCount != ShmSysConfigAndInfo->SysWarningInfo.WarningCount) {
+                changeWarningPriority = 0;
+                ShmSysConfigAndInfo->SysWarningInfo.PageIndex = 0;
+                curWarningCount = ShmSysConfigAndInfo->SysWarningInfo.WarningCount;
+                ChangeWarningFunc();
+            } else if (ShmSysConfigAndInfo->SysWarningInfo.WarningCount > 5 && changeWarningPriority == 0) {
+                // 當有兩頁 Warning 則每隔三秒改變一次
+                if (ShmSysConfigAndInfo->SysWarningInfo.PageIndex == 0) {
+                    ShmSysConfigAndInfo->SysWarningInfo.PageIndex = 1;
+                } else {
+                    ShmSysConfigAndInfo->SysWarningInfo.PageIndex = 0;
+                }
+
+                ChangeWarningFunc();
+            }
+
+            // 頁面資訊處理
+            ProcessPageInfo();
+
+            // 網路 - wifi - 連線訊號處理
+            RefreshConnStatus();
+
+            // 換頁處理
+            ChangeCurPage();
+
+            RefreshPageAnimation(_everyPageRollChange);
+
+            //if (changeWarningPriority == 0) { ////For Audi
+            ChangeDisplayMoneyInfo();
+            //}
+
+            changeWarningPriority >= 15 ? (_battery_display_ani = true) : (_battery_display_ani = false);
+            changeWarningPriority >= 30 ? changeWarningPriority = 0 : changeWarningPriority++;
+            usleep(100000);
+        }
+    }
+
+    CloseCommunicationLcmPort();
+
+    return FAIL;
+}

EVSE/Projects/DD360ComBox/Apps/Module_PrimaryComm.c

@@ -0,0 +1,517 @@
+#include    <sys/time.h>
+#include    <sys/timeb.h>
+#include    <sys/types.h>
+#include    <sys/stat.h>
+#include    <sys/types.h>
+#include    <sys/ioctl.h>
+#include    <sys/socket.h>
+#include    <sys/ipc.h>
+#include    <sys/shm.h>
+#include    <sys/shm.h>
+#include    <sys/mman.h>
+#include    <linux/wireless.h>
+#include    <arpa/inet.h>
+#include    <netinet/in.h>
+
+#include    <unistd.h>
+#include    <stdarg.h>
+#include    <stdio.h>      /*標準輸入輸出定義*/
+#include    <stdlib.h>     /*標準函數庫定義*/
+#include    <unistd.h>     /*Unix 標準函數定義*/
+#include    <fcntl.h>      /*檔控制定義*/
+#include    <termios.h>    /*PPSIX 終端控制定義*/
+#include    <errno.h>      /*錯誤號定義*/
+#include    <errno.h>
+#include    <string.h>
+#include    <time.h>
+#include    <ctype.h>
+#include    <ifaddrs.h>
+#include    <math.h>
+#include    "../../define.h"
+#include    "PrimaryComm.h"
+#include    <stdbool.h>
+
+#define ARRAY_SIZE(A)       (sizeof(A) / sizeof(A[0]))
+#define PASS                1
+#define FAIL                -1
+#define YES                 1
+#define NO                  0
+
+typedef unsigned char       byte;
+
+struct SysConfigAndInfo         *ShmSysConfigAndInfo;
+struct StatusCodeData           *ShmStatusCodeData;
+struct PrimaryMcuData           *ShmPrimaryMcuData;
+
+void trim(char *s);
+int mystrcmp(char *p1, char *p2);
+void substr(char *dest, const char *src, unsigned int start, unsigned int cnt);
+void split(char **arr, char *str, const char *del);
+
+int Uart1Fd;
+char *priPortName = "/dev/ttyS1";
+Ver ver;
+Gpio_in gpio_in;
+Rtc rtc;
+
+struct timeval _flash_time;
+byte flash = NO;
+struct ChargingInfoData *ChargingData[CHAdeMO_QUANTITY + CCS_QUANTITY + GB_QUANTITY];
+unsigned char ChillerSwitch;
+unsigned int ChillerOnTime;
+
+void PRINTF_FUNC(char *string, ...);
+
+int StoreLogMsg(const char *fmt, ...);
+#define DEBUG_INFO(format, args...) StoreLogMsg("[%s:%d][%s][Info] "format, __FILE__, __LINE__, __FUNCTION__, ##args)
+#define DEBUG_WARN(format, args...) StoreLogMsg("[%s:%d][%s][Warn] "format, __FILE__, __LINE__, __FUNCTION__, ##args)
+#define DEBUG_ERROR(format, args...) StoreLogMsg("[%s:%d][%s][Error] "format, __FILE__, __LINE__, __FUNCTION__, ##args)
+
+int StoreLogMsg(const char *fmt, ...)
+{
+    char Buf[4096 + 256];
+    char buffer[4096];
+    va_list args;
+    struct timeb  SeqEndTime;
+    struct tm *tm;
+
+    va_start(args, fmt);
+    int rc = vsnprintf(buffer, sizeof(buffer), fmt, args);
+    va_end(args);
+
+    memset(Buf, 0, sizeof(Buf));
+    ftime(&SeqEndTime);
+    SeqEndTime.time = time(NULL);
+    tm = localtime(&SeqEndTime.time);
+
+    if (ShmSysConfigAndInfo->SysConfig.SwitchDebugFlag == YES) {
+        sprintf(Buf, "%02d:%02d:%02d:%03d - %s",
+                tm->tm_hour, tm->tm_min, tm->tm_sec, SeqEndTime.millitm, buffer);
+        printf("%s \n", Buf);
+    } else {
+        sprintf(Buf, "echo \"%04d-%02d-%02d %02d:%02d:%02d:%03d - %s\" >> /Storage/SystemLog/[%04d.%02d]SystemLog",
+                tm->tm_year + 1900, tm->tm_mon + 1, tm->tm_mday, tm->tm_hour, tm->tm_min, tm->tm_sec, SeqEndTime.millitm,
+                buffer,
+                tm->tm_year + 1900, tm->tm_mon + 1);
+        system(Buf);
+    }
+
+    return rc;
+}
+
+int DiffTimeb(struct timeb ST, struct timeb ET)
+{
+    //return milli-second
+    unsigned int StartTime, StopTime;
+
+    StartTime = (unsigned int)ST.time;
+    StopTime = (unsigned int)ET.time;
+    return (StopTime - StartTime) * 1000 + ET.millitm - ST.millitm;
+}
+
+void PRINTF_FUNC(char *string, ...)
+{
+    va_list args;
+    char buffer[4096];
+    va_start(args, string);
+    vsnprintf(buffer, sizeof(buffer), string, args);
+    va_end(args);
+
+    DEBUG_INFO("%s \n", buffer);
+}
+//=================================
+// Common routine
+//=================================
+char *getTimeString(void)
+{
+    char *result = malloc(21);
+    time_t timep;
+    struct tm *p;
+    time(&timep);
+    p = gmtime(&timep);
+
+    sprintf(result, "[%04d-%02d-%02d %02d:%02d:%02d]", (1900 + p->tm_year), (1 + p->tm_mon), p->tm_mday, p->tm_hour, p->tm_hour, p->tm_sec);
+
+    return result;
+}
+
+void trim(char *s)
+{
+    int i = 0, j, k, l = 0;
+
+    while ((s[i] == ' ') || (s[i] == '\t') || (s[i] == '\n')) {
+        i++;
+    }
+
+    j = strlen(s) - 1;
+    while ((s[j] == ' ') || (s[j] == '\t') || (s[j] == '\n')) {
+        j--;
+    }
+
+    if (i == 0 && j == strlen(s) - 1) { }
+    else if (i == 0) { s[j + 1] = '\0'; }
+    else {
+        for (k = i; k <= j; k++) { s[l++] = s[k]; }
+        s[l] = '\0';
+    }
+}
+
+int mystrcmp(char *p1, char *p2)
+{
+    while (*p1 == *p2) {
+        if (*p1 == '\0' || *p2 == '\0') {
+            break;
+        }
+        p1++;
+        p2++;
+    }
+    if (*p1 == '\0' && *p2 == '\0') {
+        return (PASS);
+    } else {
+        return (FAIL);
+    }
+}
+
+void substr(char *dest, const char *src, unsigned int start, unsigned int cnt)
+{
+    strncpy(dest, src + start, cnt);
+    dest[cnt] = 0;
+}
+
+void split(char **arr, char *str, const char *del)
+{
+    char *s = strtok(str, del);
+
+    while (s != NULL) {
+        *arr++ = s;
+        s = strtok(NULL, del);
+    }
+}
+
+//==========================================
+// Init all share memory
+//==========================================
+int InitShareMemory()
+{
+    int result = PASS;
+    int MeterSMId;
+
+    //creat ShmSysConfigAndInfo
+    if ((MeterSMId = shmget(ShmSysConfigAndInfoKey, sizeof(struct SysConfigAndInfo),  0777)) < 0) {
+#ifdef SystemLogMessage
+        DEBUG_ERROR("shmget ShmSysConfigAndInfo NG\n");
+#endif
+        result = FAIL;
+    } else if ((ShmSysConfigAndInfo = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+#ifdef SystemLogMessage
+        DEBUG_ERROR("shmat ShmSysConfigAndInfo NG\n");
+#endif
+        result = FAIL;
+    }
+
+    //creat ShmStatusCodeData
+    if ((MeterSMId = shmget(ShmStatusCodeKey, sizeof(struct StatusCodeData),  0777)) < 0) {
+#ifdef SystemLogMessage
+        DEBUG_ERROR("shmget ShmStatusCodeData NG\n");
+#endif
+        result = FAIL;
+    } else if ((ShmStatusCodeData = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+#ifdef SystemLogMessage
+        DEBUG_ERROR("shmat ShmStatusCodeData NG\n");
+#endif
+        result = FAIL;
+    }
+
+    //creat ShmStatusCodeData
+    if ((MeterSMId = shmget(ShmPrimaryMcuKey, sizeof(struct PrimaryMcuData), 0777)) < 0) {
+#ifdef SystemLogMessage
+        DEBUG_ERROR("shmget ShmPrimaryMcuData NG\n");
+#endif
+        result = FAIL;
+    } else if ((ShmPrimaryMcuData = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+#ifdef ShmPrimaryMcuData
+        DEBUG_ERROR("shmat ShmPrimaryMcuData NG\n");
+#endif
+        result = FAIL;
+    }
+
+    return result;
+}
+
+//================================================
+// Function
+//================================================
+void GetFwAndHwVersion()
+{
+    if (Query_FW_Ver(Uart1Fd, Addr.IoExtend, &ver) == PASS) {
+        //PRINTF_FUNC("Primary FW Rev = %s \n", ver.Version_FW);
+        strcpy((char *)ShmPrimaryMcuData->version, ver.Version_FW);
+        strcpy((char *) ShmSysConfigAndInfo->SysInfo.CsuPrimFwRev, ver.Version_FW);
+    }
+
+    if (Query_HW_Ver(Uart1Fd, Addr.IoExtend, &ver) == PASS)
+        ;//PRINTF_FUNC("Primary HW Rev  = %s \n", ver.Version_HW);
+}
+
+void GetInputGpioStatus()
+{
+    //PRINTF_FUNC("GetInputGpioStatus \n");
+    if (Query_Gpio_Input(Uart1Fd, Addr.IoExtend, &gpio_in) == PASS) {
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
+        ShmSysConfigAndInfo->SysInfo.AcContactorStatus = ShmPrimaryMcuData->InputDet.bits.AcContactorDetec = gpio_in.AC_Connector;
+        ShmPrimaryMcuData->InputDet.bits.AcMainBreakerDetec = gpio_in.AC_MainBreaker;
+#else
+        ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CcsLiquidChillerWaterLevelWarning = ~gpio_in.AC_Connector;
+        ShmStatusCodeData->FaultCode.FaultEvents.bits.CcsLiquidChillerWaterLevelFault = ~gpio_in.AC_MainBreaker;
+#endif //!defined DD360 && !defined DD360Audi
+
+        ShmPrimaryMcuData->InputDet.bits.SpdDetec = gpio_in.SPD;
+        ShmPrimaryMcuData->InputDet.bits.DoorOpen = ~gpio_in.Door_Open;
+
+        ShmPrimaryMcuData->InputDet.bits.Button1 = gpio_in.Button[0];
+        ShmPrimaryMcuData->InputDet.bits.Button2 = gpio_in.Button[1];
+        ShmPrimaryMcuData->InputDet.bits.EmergencyButton = gpio_in.Emergency_Btn;
+        ShmPrimaryMcuData->InputDet.bits.Key0 = ~gpio_in.Key[0] & 0x01;
+        ShmPrimaryMcuData->InputDet.bits.Key1 = ~gpio_in.Key[1] & 0x01;
+        ShmPrimaryMcuData->InputDet.bits.Key2 = ~gpio_in.Key[2] & 0x01;
+        ShmPrimaryMcuData->InputDet.bits.Key3 = ~gpio_in.Key[3] & 0x01;
+        /*printf(" gpio_in.Key[0]~ gpio_in.Key[3]=%d, %d, %d, %d\n",
+        ShmPrimaryMcuData->InputDet.bits.Key0 , ShmPrimaryMcuData->InputDet.bits.Key1,
+        ShmPrimaryMcuData->InputDet.bits.Key2,ShmPrimaryMcuData->InputDet.bits.Key3);
+        printf("ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CcsLiquidChillerWaterLevelWarning=%d\n", ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CcsLiquidChillerWaterLevelWarning);
+        printf("ShmStatusCodeData->FaultCode.FaultEvents.bits.CcsLiquidChillerWaterLevelFault=%d\n", ShmStatusCodeData->FaultCode.FaultEvents.bits.CcsLiquidChillerWaterLevelFault);
+        */
+        //PRINTF_FUNC("left = %d \n", ShmPrimaryMcuData->InputDet.bits.Button1);
+        //PRINTF_FUNC("right = %d \n", ShmPrimaryMcuData->InputDet.bits.Button2);
+        //PRINTF_FUNC("ShmSysConfigAndInfo->SysInfo.AcContactorStatus = %d \n", ShmSysConfigAndInfo->SysInfo.AcContactorStatus);
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
+        if (ShmPrimaryMcuData->InputDet.bits.AcMainBreakerDetec == YES) {
+            DEBUG_ERROR("AC Mainbreaker occur. \n");
+        }
+#endif //!defined DD360 && !defined DD360Audi
+    }
+}
+
+void SetOutputGpio(byte flash)
+{
+    Gpio_out gpio;
+    gpio.Button_LED[0] = flash;
+    gpio.Button_LED[1] = flash;
+
+    gpio.System_LED[0] = 0x00;
+    gpio.System_LED[1] = 0x00;
+    gpio.System_LED[2] = 0x00;
+    gpio.System_LED[3] = 0x00;
+
+#if defined DD360 ||defined DD360Audi || defined DD360ComBox
+    if ((ChargingData[0]->PresentChargingCurrent) >= 150) {
+        ChillerSwitch = 1;
+        ChillerOnTime = time((time_t *)NULL);
+    } else {
+        if (ChillerSwitch == 1) {
+            if ((ChargingData[0]->PresentChargingCurrent) >= 100) {
+                ChillerSwitch = 1;
+                ChillerOnTime = time((time_t *)NULL);
+            } else {
+                if ((time((time_t *)NULL) - ChillerOnTime) >= 600) {
+                    ChillerSwitch = 0;
+                } else {
+                    ChillerSwitch = 1;
+                }
+            }
+        } else {
+            ChillerSwitch = 0;
+        }
+    }
+    gpio.AC_Connector = ChillerSwitch;//Chiller ON/OFF Control, "0: Chiller disable, 1: Chiller enable"
+
+    //printf("ChargingData[0]->PresentChargingCurrent=%f,ChargingData[1]->PresentChargingCurrent=%f,ChillerSwitch=%d\n",ChargingData[0]->PresentChargingCurrent,ChargingData[1]->PresentChargingCurrent,ChillerSwitch);
+#else
+    gpio.AC_Connector = 0x00;
+#endif //defined DD360 || DD360Audi
+
+    gpio.AC_Breaker = 0x00;
+
+    if (Config_Gpio_Output(Uart1Fd, Addr.IoExtend, &gpio) == PASS) {
+        //PRINTF_FUNC("SetOutputGpio sucessfully. %d \n", flash);
+    } else {
+        //PRINTF_FUNC("SetOutputGpio fail. \n");
+    }
+}
+
+void SetRtcData()
+{
+    struct timeb csuTime;
+    struct tm *tmCSU;
+
+    ftime(&csuTime);
+    tmCSU = localtime(&csuTime.time);
+//  PRINTF_FUNC("Time : %04d-%02d-%02d %02d:%02d:%02d \n", tmCSU->tm_year + 1900,
+//          tmCSU->tm_mon + 1, tmCSU->tm_mday, tmCSU->tm_hour, tmCSU->tm_min,
+//          tmCSU->tm_sec);
+
+    rtc.RtcData[0] = '0' + (tmCSU->tm_year + 1900) / 1000 % 10;
+    rtc.RtcData[1] = '0' + (tmCSU->tm_year + 1900) / 100 % 10;
+    rtc.RtcData[2] = '0' + (tmCSU->tm_year + 1900) / 10 % 10;
+    rtc.RtcData[3] = '0' + (tmCSU->tm_year + 1900) / 1 % 10;
+
+    rtc.RtcData[4] = '0' + (tmCSU->tm_mon + 1) / 10 % 10;
+    rtc.RtcData[5] = '0' + (tmCSU->tm_mon + 1) / 1 % 10;
+
+    rtc.RtcData[6] = '0' + (tmCSU->tm_mday) / 10 % 10;
+    rtc.RtcData[7] = '0' + (tmCSU->tm_mday) / 1 % 10;
+
+    rtc.RtcData[8] = '0' + (tmCSU->tm_hour) / 10 % 10;
+    rtc.RtcData[9] = '0' + (tmCSU->tm_hour) / 1 % 10;
+
+    rtc.RtcData[10] = '0' + (tmCSU->tm_min) / 10 % 10;
+    rtc.RtcData[11] = '0' + (tmCSU->tm_min) / 1 % 10;
+
+    rtc.RtcData[12] = '0' + (tmCSU->tm_sec) / 10 % 10;
+    rtc.RtcData[13] = '0' + (tmCSU->tm_sec) / 1 % 10;
+
+    if (Config_Rtc_Data(Uart1Fd, Addr.IoExtend, &rtc) == PASS) {
+        //PRINTF_FUNC("SetRtc sucessfully. \n");
+    } else {
+        //PRINTF_FUNC("SetRtc fail. \n");
+    }
+}
+
+//================================================
+// Main process
+//================================================
+int InitComPort()
+{
+    int fd;
+    struct termios tios;
+
+    fd = open(priPortName, O_RDWR);
+    if (fd <= 0) {
+#ifdef SystemLogMessage
+        DEBUG_ERROR("open 407 Communication port NG \n");
+#endif
+        return -1;
+    }
+    ioctl (fd, TCGETS, &tios);
+    tios.c_cflag = B115200 | CS8 | CLOCAL | CREAD;
+    tios.c_lflag = 0;
+    tios.c_iflag = 0;
+    tios.c_oflag = 0;
+    tios.c_cc[VMIN] = 0;
+    tios.c_cc[VTIME] = (unsigned char)1;
+    tios.c_lflag = 0;
+    tcflush(fd, TCIFLUSH);
+    ioctl (fd, TCSETS, &tios);
+
+    return fd;
+}
+
+unsigned long GetTimeoutValue(struct timeval _sour_time)
+{
+    struct timeval _end_time;
+    gettimeofday(&_end_time, NULL);
+
+    return 1000000 * (_end_time.tv_sec - _sour_time.tv_sec) + _end_time.tv_usec - _sour_time.tv_usec;
+}
+
+int FindChargingInfoData(byte target, struct ChargingInfoData **chargingData)
+{
+    for (byte index = 0; index < CHAdeMO_QUANTITY; index++) {
+        if (ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].Index == target) {
+            chargingData[target] = &ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index];
+            return 1;
+        }
+    }
+
+    for (byte index = 0; index < CCS_QUANTITY; index++) {
+        if (ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].Index == target) {
+            chargingData[target] = &ShmSysConfigAndInfo->SysInfo.CcsChargingData[index];
+            return 1;
+        }
+    }
+
+    for (byte index = 0; index < GB_QUANTITY; index++) {
+        if (ShmSysConfigAndInfo->SysInfo.GbChargingData[index].Index == target) {
+            chargingData[target] = &ShmSysConfigAndInfo->SysInfo.GbChargingData[index];
+            return 1;
+        }
+    }
+
+    return 0;
+}
+
+int main(void)
+{
+    if (InitShareMemory() == FAIL) {
+#ifdef SystemLogMessage
+        DEBUG_ERROR("InitShareMemory NG\n");
+#endif
+        if (ShmStatusCodeData != NULL) {
+            ShmStatusCodeData->AlarmCode.AlarmEvents.bits.FailToCreateShareMemory = 1;
+        }
+        sleep(5);
+        return 0;
+    }
+
+    for (byte _index = 0; _index < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; _index++) {
+        if (!FindChargingInfoData(_index, &ChargingData[0])) {
+            DEBUG_ERROR("FindChargingInfoData false \n");
+            break;
+        }
+    }
+    ChillerSwitch = 0;
+    Uart1Fd = InitComPort();
+    //PRINTF_FUNC("407 Port id = %d \n", Uart1Fd);
+
+    if (Uart1Fd < 0) {
+#ifdef SystemLogMessage
+        DEBUG_ERROR("InitComPort (Uart1 : AM3352 - STM32) NG");
+#endif
+
+        if (ShmStatusCodeData != NULL) {
+            ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CsuInitFailed = 1;
+        }
+        sleep(5);
+        return 0;
+    }
+
+    SetRtcData();
+    gettimeofday(&_flash_time, NULL);
+    for (;;) {
+        if (strcmp((char *)ShmSysConfigAndInfo->SysInfo.LcmHwRev, " ") == 0x00) {
+            if ((GetTimeoutValue(_flash_time) / 1000) > 1000) {
+                if (flash == NO) {
+                    flash = YES;
+                } else {
+                    flash = NO;
+                }
+                SetOutputGpio(flash);
+                gettimeofday(&_flash_time, NULL);
+            }
+        } else {
+            if ((GetTimeoutValue(_flash_time) / 1000) > 5000) {
+                if (flash == NO) {
+                    flash = YES;
+                }
+
+                SetOutputGpio(flash);
+                gettimeofday(&_flash_time, NULL);
+            }
+        }
+
+        // 程序開始之前~ 必須先確定 FW 版本與硬體版本，確認後!!~ 該模組才算是真正的 Initial Comp.
+        // 模組更新 FW 後，需重新做
+        if (ShmPrimaryMcuData->SelfTest_Comp != PASS) {
+            //PRINTF_FUNC("(407) Get Fw and Hw Ver. \n");
+            GetFwAndHwVersion();
+            sleep(1);
+            ShmPrimaryMcuData->SelfTest_Comp = PASS;
+        } else {
+            GetInputGpioStatus();
+        }
+
+        usleep(100000);
+    }
+
+    return FAIL;
+}

EVSE/Projects/DD360ComBox/Apps/Module_PsuComm.c

@@ -0,0 +1,2115 @@
+
+#include 	"Module_PsuComm.h"
+
+#define ARRAY_SIZE(A)		(sizeof(A) / sizeof(A[0]))
+#define PASS				1
+#define FAIL				-1
+#define YES					1
+#define NO					0
+#define DERATING_COUNT		30
+#define DERATING_GAP		30
+#define ELEMENT_NOT_FIND	255
+#define CHK_VOL_RANGE		50
+#define CHK_CUR_RANGE		10
+#define DERATING_RANGE		100
+#define ZERO_CURRENT		10			// 該值須保持最小為 1A
+#define ZERO_VOLTAGE		50
+#define STOP_CURRENT		30
+#define PSU_MIN_CUR			1000
+#define PSU_MIN_VOL			1500
+#define PRE_CHARG_STEP_CUR	30
+#define PRE_CHARG_RANGE		50
+#define EQUAL				0
+
+struct SysConfigAndInfo			*ShmSysConfigAndInfo;
+struct StatusCodeData 			*ShmStatusCodeData;
+struct PsuData 					*ShmPsuData;
+
+bool libInitialize = false;
+byte getAvailableCapOffset = 5;
+byte deratingKeepCount = 0;
+
+float evseOutVol = 0;
+float evseOutCur = 0;
+
+void PRINTF_FUNC(char *string, ...);
+
+int StoreLogMsg(const char *fmt, ...);
+#define DEBUG_INFO(format, args...) StoreLogMsg("[%s:%d][%s][Info] "format, __FILE__, __LINE__, __FUNCTION__, ##args)
+#define DEBUG_WARN(format, args...) StoreLogMsg("[%s:%d][%s][Warn] "format, __FILE__, __LINE__, __FUNCTION__, ##args)
+#define DEBUG_ERROR(format, args...) StoreLogMsg("[%s:%d][%s][Error] "format, __FILE__, __LINE__, __FUNCTION__, ##args)
+
+unsigned long GetTimeoutValue(struct timeval _sour_time);
+
+unsigned long GetTimeoutValue(struct timeval _sour_time)
+{
+	struct timeval _end_time;
+	gettimeofday(&_end_time, NULL);
+
+	return 1000000 * (_end_time.tv_sec - _sour_time.tv_sec) + _end_time.tv_usec - _sour_time.tv_usec;
+}
+
+int StoreLogMsg(const char *fmt, ...)
+{
+	char Buf[4096+256];
+	char buffer[4096];
+	va_list args;
+	struct timeb  SeqEndTime;
+	struct tm *tm;
+
+	va_start(args, fmt);
+	int rc = vsnprintf(buffer, sizeof(buffer), fmt, args);
+	va_end(args);
+
+	memset(Buf,0,sizeof(Buf));
+	ftime(&SeqEndTime);
+	SeqEndTime.time = time(NULL);
+	tm=localtime(&SeqEndTime.time);
+
+	if (ShmSysConfigAndInfo->SysConfig.SwitchDebugFlag == YES)
+	{
+		sprintf(Buf,"%02d:%02d:%02d:%03d - %s",
+			tm->tm_hour,tm->tm_min,tm->tm_sec,SeqEndTime.millitm, buffer);
+		printf("%s \n", Buf);
+	}
+	else
+	{
+		sprintf(Buf,"echo \"%04d-%02d-%02d %02d:%02d:%02d:%03d - %s\" >> /Storage/SystemLog/[%04d.%02d]SystemLog",
+			tm->tm_year+1900,tm->tm_mon+1,tm->tm_mday,tm->tm_hour,tm->tm_min,tm->tm_sec,SeqEndTime.millitm,
+			buffer,
+			tm->tm_year+1900,tm->tm_mon+1);
+		system(Buf);
+	}
+
+	return rc;
+}
+
+void PRINTF_FUNC(char *string, ...)
+{
+	va_list args;
+	char buffer[4096];
+	va_start(args, string);
+	vsnprintf(buffer, sizeof(buffer), string, args);
+	va_end(args);
+
+	DEBUG_INFO("%s \n", buffer);
+}
+//=================================
+// Common routine
+//=================================
+size_t FindIndex(const int a[], size_t size, int value, byte group)
+{
+    size_t index = 0;
+
+    while ( index < size && a[index] != value ) ++index;
+    return (index == size ? ELEMENT_NOT_FIND : group);
+}
+
+byte FindTargetGroup(byte address)
+{
+	byte _group = ELEMENT_NOT_FIND;
+
+	if (ShmPsuData->GroupCount == 1)
+		_group = 0;
+	else
+	{
+		_group = FindIndex(connector_1, ShmPsuData->PsuGroup[0].GroupPresentPsuQuantity, address, 0);
+
+		if (_group == ELEMENT_NOT_FIND)
+			_group = FindIndex(connector_2, ShmPsuData->PsuGroup[1].GroupPresentPsuQuantity, address, 1);
+	}
+
+	return _group;
+}
+
+bool IsOverModuleCount(byte count)
+{
+	bool result = false;
+
+	if (count >= ShmPsuData->SystemPresentPsuQuantity)
+		result = true;
+
+	return result;
+}
+//=================================
+// Save data to share memory Function
+//=================================
+bool FindChargingInfoData(byte target, struct ChargingInfoData **chargingData)
+{
+	for (byte index = 0; index < CHAdeMO_QUANTITY; index++)
+	{
+		if (ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].Index == target)
+		{
+			chargingData[target] = &ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index];
+			return true;
+		}
+	}
+
+	for (byte index = 0; index < CCS_QUANTITY; index++)
+	{
+		if (ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].Index == target)
+		{
+			chargingData[target] = &ShmSysConfigAndInfo->SysInfo.CcsChargingData[index];
+			return true;
+		}
+	}
+
+	for (byte index = 0; index < GB_QUANTITY; index++)
+	{
+		if (ShmSysConfigAndInfo->SysInfo.GbChargingData[index].Index == target)
+		{
+			chargingData[target] = &ShmSysConfigAndInfo->SysInfo.GbChargingData[index];
+			return true;
+		}
+	}
+
+	return false;
+}
+
+//=================================
+// Alarm code mapping to share memory Function
+//=================================
+// 檢查 Byte 中某個 Bit 的值
+// _byte : 欲改變的 byte
+// _bit : 該 byte 的第幾個 bit
+unsigned char mask_table[] = { 0x01, 0x02, 0x04, 0x08, 0x10, 0x20, 0x40, 0x80 };
+unsigned char DetectBitValue(unsigned char _byte, unsigned char _bit)
+{
+	return ( _byte & mask_table[_bit] ) != 0x00;
+}
+
+void AbnormalStopAnalysis(byte gun_index, int errCode)
+{
+	for (char i = 0; i < 3; i++)
+	{
+		unsigned char byteIndex = (errCode >> (8 * i)) & 0xff;
+
+		for (char bitIndex = 0; bitIndex < 8; bitIndex++)
+		{
+			if(DetectBitValue(byteIndex , bitIndex) == 1)
+			{
+				switch(byteIndex)
+				{
+					case 0:
+					{
+						if (bitIndex == 0)
+							ShmStatusCodeData->AlarmCode.AlarmEvents.bits.PsuOutputShortCircuit = YES;
+						else if (bitIndex == 5)
+							ShmStatusCodeData->AlarmCode.AlarmEvents.bits.PsuDcSideShutDown = YES;
+					}
+						break;
+				case 1:
+					{
+						if (bitIndex == 1)
+							ShmStatusCodeData->AlarmCode.AlarmEvents.bits.PsuFailureAlarm = YES;
+						else if (bitIndex == 2)
+							ShmStatusCodeData->AlarmCode.AlarmEvents.bits.PsuProtectionAlarm = YES;
+						else if (bitIndex == 3)
+							ShmStatusCodeData->AlarmCode.AlarmEvents.bits.PsuFanFailureAlarm = YES;
+						else if (bitIndex == 4)
+							ShmStatusCodeData->AlarmCode.AlarmEvents.bits.PsuCriticalPointOTP = YES;
+						else if (bitIndex == 5)
+							ShmStatusCodeData->AlarmCode.AlarmEvents.bits.PsuDcSideShutDown = YES;
+					}
+					break;
+				case 2:
+					{
+						if (bitIndex == 0)
+							ShmStatusCodeData->AlarmCode.AlarmEvents.bits.PsuPowerLimitedState = YES;
+						else if (bitIndex == 1)
+							ShmStatusCodeData->AlarmCode.AlarmEvents.bits.PsuDuplicateID = YES;
+						else if (bitIndex == 2)
+							ShmStatusCodeData->AlarmCode.AlarmEvents.bits.PsuThreePhaseOnputImbalance = YES;
+						else if (bitIndex == 3)
+							ShmStatusCodeData->AlarmCode.AlarmEvents.bits.PsuThreePhaseInputInadequate = YES;
+						else if (bitIndex == 4)
+							ShmStatusCodeData->AlarmCode.AlarmEvents.bits.PsuThreePhaseInputInadequate = YES;
+						else if (bitIndex == 5)
+							ShmStatusCodeData->AlarmCode.AlarmEvents.bits.PsuInputUVP = YES;
+						else if (bitIndex == 6)
+							ShmStatusCodeData->AlarmCode.AlarmEvents.bits.PsuInputOVP = YES;
+					}
+					break;
+				}
+			}
+//			else
+//			{
+//				switch (byteIndex) {
+//				case 0: {
+//					if (bitIndex == 0)
+//						ShmStatusCodeData->AlarmCode.AlarmEvents.bits.PsuOutputShortCircuit = NO;
+//					else if (bitIndex == 5)
+//						ShmStatusCodeData->AlarmCode.AlarmEvents.bits.PsuDcSideShutDown = NO;
+//				}
+//					break;
+//				case 1: {
+//					if (bitIndex == 1)
+//						ShmStatusCodeData->AlarmCode.AlarmEvents.bits.PsuFailureAlarm = NO;
+//					else if (bitIndex == 2)
+//						ShmStatusCodeData->AlarmCode.AlarmEvents.bits.PsuProtectionAlarm = NO;
+//					else if (bitIndex == 3)
+//						ShmStatusCodeData->AlarmCode.AlarmEvents.bits.PsuFanFailureAlarm = NO;
+//					else if (bitIndex == 4)
+//						ShmStatusCodeData->AlarmCode.AlarmEvents.bits.PsuCriticalPointOTP = NO;
+//					else if (bitIndex == 5)
+//						ShmStatusCodeData->AlarmCode.AlarmEvents.bits.PsuDcSideShutDown = NO;
+//				}
+//					break;
+//				case 2: {
+//					if (bitIndex == 1)
+//						ShmStatusCodeData->AlarmCode.AlarmEvents.bits.PsuDuplicateID = NO;
+//					if (bitIndex == 2)
+//						ShmStatusCodeData->AlarmCode.AlarmEvents.bits.PsuThreePhaseOnputImbalance = NO;
+//					else if (bitIndex == 3)
+//						ShmStatusCodeData->AlarmCode.AlarmEvents.bits.PsuThreePhaseInputInadequate = NO;
+//					else if (bitIndex == 4)
+//						ShmStatusCodeData->AlarmCode.AlarmEvents.bits.PsuThreePhaseInputInadequate = NO;
+//					else if (bitIndex == 5)
+//						ShmStatusCodeData->AlarmCode.AlarmEvents.bits.PsuInputUVP = NO;
+//					else if (bitIndex == 6)
+//						ShmStatusCodeData->AlarmCode.AlarmEvents.bits.PsuInputOVP = NO;
+//				}
+//					break;
+//				}
+//			}
+		}
+	}
+}
+
+//=================================
+// Callback Function
+//=================================
+// no using -- GetOutputAndTempCallback
+void GetStatusCallback(byte group, byte address, byte temp, int alarm)
+{
+//	if (ShmPsuData->Work_Step == INITIAL_START)
+//		return;
+//
+//	if (IsOverModuleCount(address))
+//		return;
+//
+//	byte group1 = FindTargetGroup(address);
+//
+//	if (group1 == 1)
+//		address -= ShmPsuData->PsuGroup[group1 - 1].GroupPresentPsuQuantity;
+//
+//	ShmPsuData->PsuGroup[group1].PsuModule[address].CriticalTemp1 = temp;
+//	ShmPsuData->PsuGroup[group1].PsuModule[address].CriticalTemp2 = temp;
+//	ShmPsuData->PsuGroup[group1].PsuModule[address].CriticalTemp3 = temp;
+//	ShmPsuData->PsuGroup[group1].PsuModule[address].ExletTemp = temp;
+//	ShmPsuData->PsuGroup[group1].PsuModule[address].AlarmCode = alarm;
+//	AbnormalStopAnalysis(group1, alarm);
+
+//	PRINTF_FUNC("***Status*** address = %d, temp = %d, err1 = %d, err2 = %d, err3 = %d, err4 = %d \n",
+//			address, temp,
+//			(alarm >> 24) & 0xFF,
+//			(alarm >> 16) & 0xFF,
+//			(alarm >> 8) & 0xFF,
+//			alarm & 0xFF);
+}
+// no using -- GetOutputAndTempCallback End
+
+void GetModuleCountCallback(byte group, byte count)
+{
+	if (group == SYSTEM_CMD)
+		ShmPsuData->SystemPresentPsuQuantity = count;
+	else
+	{
+		ShmPsuData->PsuGroup[group].GroupPresentPsuQuantity = count;
+	}
+}
+
+void GetMaxPowerAndCur(unsigned char mode, int ratingCur, int *pow, int *cur)
+{
+	if (ShmPsuData->Work_Step < GET_SYS_CAP)
+		return;
+
+	unsigned short maxCurrent = ShmSysConfigAndInfo->SysConfig.MaxChargingCurrent * 10;
+	unsigned short maxPower = ShmSysConfigAndInfo->SysConfig.MaxChargingPower * 10;
+
+	if (mode == _MAIN_CHARGING_MODE_AVER)
+	{
+		maxCurrent /= 2;
+		maxPower /= 2;
+	}
+
+	if (maxPower != 0 && maxPower <= *pow)
+		*pow = maxPower;
+
+	if (maxCurrent != 0 && maxCurrent <= *cur)
+		*cur = maxCurrent;
+
+	if (ratingCur != 0 && ratingCur <= *cur)
+		*cur = ratingCur;
+}
+
+void GetAvailableCapCallback(byte address, short maxVol, short minVol, short maxCur, short totalPow)
+{
+	if (ShmPsuData->Work_Step < GET_SYS_CAP)
+		return;
+
+	int _groupPower = 0, _groupCurrent = 0;
+	byte group = FindTargetGroup(address);
+	float _chargingVol = 0, _targetVol = 0;
+
+	if (group == 1)
+		address -= ShmPsuData->PsuGroup[group - 1].GroupPresentPsuQuantity;
+
+	if (ShmSysConfigAndInfo->SysInfo.MainChargingMode == _MAIN_CHARGING_MODE_MAX)
+	{
+		for (byte groupIndex = 0; groupIndex < _gunCount; groupIndex++)
+		{
+			if (chargingInfo[groupIndex]->EvBatteryMaxVoltage > 0)
+			{
+				_chargingVol = chargingInfo[groupIndex]->EvBatteryMaxVoltage;
+				_targetVol = chargingInfo[groupIndex]->EvBatterytargetVoltage;
+				break;
+			}
+		}
+	}
+
+//	PRINTF_FUNC("group = %d, DeratingChargingCurrent = %f, RealRatingPower = %d \n",
+//					group, chargingInfo[group]->DeratingChargingCurrent, chargingInfo[group]->RealRatingPower);
+
+	if (chargingInfo[group]->DeratingChargingCurrent == 0)
+	{
+		// 在還沒取得真正可輸出的電流前，依照 GFD 階段得到的真正 POWER / 模塊個數 / 車子電池最大電壓
+		if (ShmPsuData->PsuGroup[group].GroupRealOutputPower > 0 && _chargingVol > 0)
+		{
+//			printf("GroupRealOutputPower = %d, GroupPresentPsuQuantity = %d\n",
+//					ShmPsuData->PsuGroup[group].GroupRealOutputPower,
+//					ShmPsuData->PsuGroup[group].GroupPresentPsuQuantity);
+
+			ShmPsuData->PsuGroup[group].PsuModule[address].AvailableCurrent =
+					((ShmPsuData->PsuGroup[group].GroupRealOutputPower / ShmPsuData->PsuGroup[group].GroupPresentPsuQuantity) * 1000 / (int)_chargingVol) * 10;
+
+//			PRINTF_FUNC(" *1* AvailableCurrent = %d \n",
+//				ShmPsuData->PsuGroup[group].PsuModule[address].AvailableCurrent);
+		}
+		else
+		{
+			// 注一 : 獲取模塊最大輸出能力 (忽視 Derating 狀態)，所以這邊需要限制實際可輸出的電流
+			if (ShmPsuData->PsuGroup[group].PsuModule[address].AvailableCurrent <= 0)
+				ShmPsuData->PsuGroup[group].PsuModule[address].AvailableCurrent = PSU_MIN_CUR;
+
+//			PRINTF_FUNC(" *2* group = %d, AvailableCurrent = %d \n",
+//				group, ShmPsuData->PsuGroup[group].PsuModule[address].AvailableCurrent);
+		}
+//		PRINTF_FUNC("group = %d, address = %d, AvailableCurrent = %d \n",
+//				group, address, ShmPsuData->PsuGroup[group].PsuModule[address].AvailableCurrent);
+	}
+	else
+	{
+		ShmPsuData->PsuGroup[group].PsuModule[address].AvailableCurrent = maxCur;
+	}
+
+	ShmPsuData->PsuGroup[group].PsuModule[address].AvailablePower = totalPow;
+	// 總和該 Group 的可輸出電流
+	for (byte index = 0; index < ShmPsuData->PsuGroup[group].GroupPresentPsuQuantity; index++)
+	{
+		_groupCurrent += ShmPsuData->PsuGroup[group].PsuModule[index].AvailableCurrent;
+		_groupPower += ShmPsuData->PsuGroup[group].PsuModule[index].AvailablePower;
+	}
+
+	// 各群得到最大輸出能力 (電流、Power)
+	ShmPsuData->PsuGroup[group].GroupAvailableCurrent = _groupCurrent;
+	ShmPsuData->PsuGroup[group].GroupAvailablePower = _groupPower;
+
+	chargingInfo[group]->MaximumChargingVoltage = maxVol;
+
+	int _power = 0, _current = 0, _ratingcurrent = 0, _sysRealPower = 0;
+	bool isGetAllDeratingCurrent = true;
+
+	for (byte index = 0; index < ShmPsuData->GroupCount; index++)
+	{
+		_power += ShmPsuData->PsuGroup[index].GroupAvailablePower;
+		_current += ShmPsuData->PsuGroup[index].GroupAvailableCurrent;
+		_ratingcurrent += chargingInfo[index]->DeratingChargingCurrent;
+		_sysRealPower += ShmPsuData->PsuGroup[index].GroupRealOutputPower;
+		if (ShmPsuData->PsuGroup[index].GroupPresentOutputVoltage >= PSU_MIN_VOL &&
+				chargingInfo[index]->DeratingChargingCurrent == 0)
+			isGetAllDeratingCurrent = false;
+	}
+
+	// 如果不是所有群都得到 Derating current，則先不採樣該次的 ratingCurrent
+	if (!isGetAllDeratingCurrent) _ratingcurrent = 0;
+	// 因應注一，為避免一值改變通知車子電樁最大可輸出電流所做的限制
+	// 而因為 rating value 一般都會小於模塊的最大可輸出電流
+	// 所以如果該值大於在注一所限制的輸出電流，則以此值為主
+	if (_ratingcurrent != 0) _current = _ratingcurrent;
+
+	//printf("=============== _current ==================== %d \n", _current);
+	//printf("=============== _ratingcurrent ==================== %d \n", _ratingcurrent);
+	ShmPsuData->SystemAvailableCurrent = _current;
+	ShmPsuData->SystemAvailablePower = _power;
+
+	if (ShmSysConfigAndInfo->SysInfo.MainChargingMode == _MAIN_CHARGING_MODE_AVER ||
+			(ShmSysConfigAndInfo->SysInfo.ReAssignedFlag >= _REASSIGNED_GET_NEW_CAP &&
+			 ShmSysConfigAndInfo->SysInfo.ReAssignedFlag <= _REASSIGNED_RELAY_M_TO_A))
+	{
+		int halfPow = ShmPsuData->PsuGroup[group].GroupAvailablePower;
+		int halfCur = ShmPsuData->PsuGroup[group].GroupAvailableCurrent;
+		int ratingCur = chargingInfo[group]->DeratingChargingCurrent;
+		int gpRealPow = ShmPsuData->PsuGroup[group].GroupRealOutputPower;
+
+		if ((ShmSysConfigAndInfo->SysInfo.ReAssignedFlag >= _REASSIGNED_GET_NEW_CAP &&
+				ShmSysConfigAndInfo->SysInfo.ReAssignedFlag <= _REASSIGNED_RELAY_M_TO_A))
+		{
+			if (chargingInfo[group]->DividChargingCurrent == 0)
+				return;
+			else
+			{
+				halfCur = chargingInfo[group]->DividChargingCurrent;
+				ratingCur = 0;
+			}
+		}
+
+		GetMaxPowerAndCur(_MAIN_CHARGING_MODE_AVER, ratingCur, &halfPow, &halfCur);
+
+//		if ((ShmSysConfigAndInfo->SysInfo.ReAssignedFlag >= _REASSIGNED_GET_NEW_CAP &&
+//				 ShmSysConfigAndInfo->SysInfo.ReAssignedFlag <= _REASSIGNED_RELAY_M_TO_A))
+//		{
+//			chargingInfo[group]->AvailableChargingCurrent =	DERATING_RANGE;
+//			chargingInfo[group]->AvailableChargingPower = ShmPsuData->PsuGroup[group].GroupAvailablePower;
+//		}
+//		else
+		{
+			// 以下狀況 -> 槍資訊中的最大輸出能力，為該群的輸出能力
+			// 1. 如不是最大充
+			// 2. 智能切換成均充過程
+			chargingInfo[group]->AvailableChargingCurrent =	halfCur;
+			chargingInfo[group]->AvailableChargingPower = halfPow;
+			chargingInfo[group]->RealRatingPower = gpRealPow;
+
+			if(chargingInfo[group]->DeratingChargingCurrent > 0)
+			{
+				unsigned short _powBuf = 0;
+				_powBuf = ((chargingInfo[group]->DeratingChargingCurrent / 10) * ShmPsuData->PsuGroup[group].GroupPresentOutputVoltage / 10) / 1000; // 單位是 KW
+
+				if (_powBuf > ShmPsuData->PsuGroup[group].GroupRealOutputPower ||
+						chargingInfo[group]->EvBatterytargetVoltage > 0)
+				{
+					ShmPsuData->PsuGroup[group].GroupRealOutputPower = _powBuf;
+//					PRINTF_FUNC("group = %d, DeratingChargingCurrent = %f, RealRatingPower = %d \n",
+//								group, chargingInfo[group]->DeratingChargingCurrent, chargingInfo[group]->RealRatingPower);
+				}
+			}
+			//printf("(Aver.) RealRatingPower = %d \n", chargingInfo[group]->RealRatingPower);
+		}
+	}
+	else if (ShmSysConfigAndInfo->SysInfo.MainChargingMode == _MAIN_CHARGING_MODE_MAX)
+	{
+		//PRINTF_FUNC("group = %d, Final = %d \n", group, _current);
+		GetMaxPowerAndCur(_MAIN_CHARGING_MODE_MAX, _ratingcurrent, &_power, &_current);
+
+		if (ShmSysConfigAndInfo->SysInfo.IsAlternatvieConf == YES)
+		{
+			for (byte count = 0; count < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; count++)
+			{
+				chargingInfo[count]->MaximumChargingVoltage = maxVol;
+				chargingInfo[count]->AvailableChargingCurrent =	_current;
+				chargingInfo[count]->AvailableChargingPower = _power;
+				chargingInfo[count]->RealRatingPower = _sysRealPower;
+			}
+		}
+		else
+		{
+			// 如果是最大充，該槍資訊中的輸出能力為各群輸出能力的和
+			chargingInfo[group]->AvailableChargingCurrent =	_current;
+			chargingInfo[group]->AvailableChargingPower = _power;
+			chargingInfo[group]->RealRatingPower = _sysRealPower;
+		}
+
+		if(chargingInfo[group]->DeratingChargingCurrent > 0)
+		{
+			unsigned short _powBuf = 0;
+			_powBuf = ((chargingInfo[group]->DeratingChargingCurrent / 10) * ShmPsuData->PsuGroup[group].GroupPresentOutputVoltage / 10) / 1000; // 單位是 KW
+
+			if (_powBuf > ShmPsuData->PsuGroup[group].GroupRealOutputPower ||
+					chargingInfo[group]->EvBatterytargetVoltage > 0 ||
+					_targetVol > 0)
+			{
+				ShmPsuData->PsuGroup[group].GroupRealOutputPower = _powBuf;
+			}
+		}
+	}
+}
+
+void GetFwCallback(byte address, short dcSwVer, short pfcSwVer, short hwVer)
+{
+	if (ShmPsuData->Work_Step < GET_SYS_CAP)
+		return;
+
+	if (IsOverModuleCount(address))
+		return;
+
+	byte group = FindTargetGroup(address);
+
+	sprintf((char *)ShmPsuData->PsuVersion[address].FwPrimaryVersion, "DC %d.%02d", (dcSwVer & 0xFF00) >> 8, dcSwVer & 0xFF);
+	sprintf((char *)ShmPsuData->PsuVersion[address].FwSecondVersion, "PFC %d.%02d", (pfcSwVer & 0xFF00) >> 8, pfcSwVer & 0xFF);
+	if (group == 1)
+		address -= ShmPsuData->PsuGroup[group - 1].GroupPresentPsuQuantity;
+	sprintf((char *)ShmPsuData->PsuGroup[group].PsuModule[address].FwVersion, "DC %d.%02d", (dcSwVer & 0xFF00) >> 8, dcSwVer & 0xFF);
+	//DEBUG_INFO("fw Ver. = %s \n", ShmPsuData->PsuGroup[group].PsuModule[address].FwVersion);
+}
+
+// no using -- GetInputVoltageCallback
+void GetInputVoltageCallback(byte address, unsigned short vol1, unsigned short vol2, unsigned short vol3)
+{
+//	if (ShmPsuData->Work_Step < GET_SYS_CAP)
+//		return;
+//
+//	if (IsOverModuleCount(address))
+//		return;
+//
+//	byte group = FindTargetGroup(address);
+//
+//	if (group == 1)
+//		address -= ShmPsuData->PsuGroup[group - 1].GroupPresentPsuQuantity;
+//
+//	ShmPsuData->PsuGroup[group].PsuModule[address].InputVoltageL1 = vol1;
+//	ShmPsuData->PsuGroup[group].PsuModule[address].InputVoltageL2 = vol2;
+//	ShmPsuData->PsuGroup[group].PsuModule[address].InputVoltageL3 = vol3;
+//
+//	PRINTF_FUNC("***Input*** address = %d, R = %d, S = %d, T = %d, gp = %d \n",
+//				address, vol1, vol2, vol3, group);
+}
+// no using -- GetInputVoltageCallback End
+
+// no using -- GetOutputAndTempCallback
+void GetPresentOutputCallback(byte group, unsigned short outVol, unsigned short outCur)
+{
+//	if (ShmPsuData->Work_Step < GET_SYS_CAP)
+//		return;
+
+	//if (outCur != ShmPsuData->PsuGroup[group].GroupPresentOutputCurrent)
+	//{
+	//	PRINTF_FUNC("Gp_%d, gp output cur = %d \n", group, outCur);
+	//}
+
+//	// PSU Group - 電壓
+//	ShmPsuData->PsuGroup[group].GroupPresentOutputVoltage = outVol;
+//	// PSU Group - 電流
+//	ShmPsuData->PsuGroup[group].GroupPresentOutputCurrent = outCur;
+//
+//	if (ShmSysConfigAndInfo->SysInfo.MainChargingMode == _MAIN_CHARGING_MODE_MAX ||
+//			(ShmSysConfigAndInfo->SysInfo.MainChargingMode == _MAIN_CHARGING_MODE_AVER &&
+//			(ShmSysConfigAndInfo->SysInfo.ReAssignedFlag >= _REASSIGNED_WAITING &&
+//			ShmSysConfigAndInfo->SysInfo.ReAssignedFlag <= _REASSIGNED_COMP))
+//		)
+//	{
+//		unsigned short outputVol = 0;
+//		unsigned short outputCur = 0;
+//
+//		for (byte index = 0; index < ShmPsuData->GroupCount; index++)
+//		{
+//			bool needtoAdd = true;
+//
+//			if (ShmPsuData->PsuGroup[index].GroupPresentOutputVoltage > outputVol)
+//				outputVol = ShmPsuData->PsuGroup[index].GroupPresentOutputVoltage;
+//
+//			if (ShmSysConfigAndInfo->SysInfo.ReAssignedFlag >= _REASSIGNED_ADJUST_M_TO_A &&
+//					ShmSysConfigAndInfo->SysInfo.ReAssignedFlag <= _REASSIGNED_RELAY_M_TO_A)
+//			{
+////				PRINTF_FUNC("Gp_%d, DividChargingCurrent = %d \n", index,
+////						chargingInfo[index]->DividChargingCurrent);
+//				if (chargingInfo[index]->DividChargingCurrent == 0)
+//					needtoAdd = false;
+//			}
+//
+//			if (needtoAdd)
+//				outputCur += ShmPsuData->PsuGroup[index].GroupPresentOutputCurrent;
+//		}
+//
+//		// 黑白機
+//		if (ShmSysConfigAndInfo->SysInfo.IsAlternatvieConf == YES)
+//		{
+//			for (byte count = 0; count < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; count++)
+//			{
+//				float _vol_buf = outputVol;
+//				float _cur_buf = outputCur;
+//
+//				// EVSE - 電壓
+//				_vol_buf /= 10;
+//				chargingInfo[count]->PresentChargingVoltage = _vol_buf;
+//				// EVSE - 電流
+//				_cur_buf /= 10;
+//				chargingInfo[count]->PresentChargingCurrent = _cur_buf;
+//			}
+//		}
+//
+//		if ((chargingInfo[group]->SystemStatus >= S_PREPARING_FOR_EVSE && chargingInfo[group]->SystemStatus <= S_COMPLETE) ||
+//			(chargingInfo[group]->SystemStatus >= S_CCS_PRECHARGE_ST0 && chargingInfo[group]->SystemStatus <= S_CCS_PRECHARGE_ST1))
+//		{
+//			float _vol_buf = outputVol;
+//			float _cur_buf = outputCur;
+//
+//			// EVSE - 電壓
+//			_vol_buf /= 10;
+//			chargingInfo[group]->PresentChargingVoltage = _vol_buf;
+//			// EVSE - 電流
+//			_cur_buf /= 10;
+//			chargingInfo[group]->PresentChargingCurrent = _cur_buf;
+//		}
+//	}
+//	else
+//	{
+//		float _vol_buf = ShmPsuData->PsuGroup[group].GroupPresentOutputVoltage;
+//		float _cur_buf = ShmPsuData->PsuGroup[group].GroupPresentOutputCurrent;
+//
+//		// EVSE - 電壓
+//		_vol_buf /= 10;
+//		chargingInfo[group]->PresentChargingVoltage = _vol_buf;
+//		// EVSE - 電流
+//		_cur_buf /= 10;
+//		chargingInfo[group]->PresentChargingCurrent = _cur_buf;
+//	}
+//
+//	PRINTF_FUNC("Gun_%d, PresentChargingVoltage = %f, PresentChargingCurrent = %f \n", group,
+//			chargingInfo[group]->PresentChargingVoltage,
+//			chargingInfo[group]->PresentChargingCurrent);
+}
+// no using -- GetOutputAndTempCallback End
+
+void GetFanSpeedCallback(byte address, unsigned int fanSpeed)
+{
+	if (ShmPsuData->Work_Step < GET_SYS_CAP)
+		return;
+
+	if (IsOverModuleCount(address))
+		return;
+
+	byte group = FindTargetGroup(address);
+
+	if (group == 1)
+		address -= ShmPsuData->PsuGroup[group - 1].GroupPresentPsuQuantity;
+
+	ShmPsuData->PsuGroup[group].PsuModule[address].FanSpeed_1 = fanSpeed;
+	ShmPsuData->PsuGroup[group].PsuModule[address].FanSpeed_2 = fanSpeed;
+	ShmPsuData->PsuGroup[group].PsuModule[address].FanSpeed_3 = fanSpeed;
+	ShmPsuData->PsuGroup[group].PsuModule[address].FanSpeed_4 = fanSpeed;
+}
+
+void GetIavailableCallback(byte address, unsigned short Iavail, unsigned short Vext)
+{
+	if (ShmPsuData->Work_Step < GET_SYS_CAP)
+		return;
+
+	if (IsOverModuleCount(address))
+		return;
+
+	//PRINTF_FUNC("address = %d, Iavail = %d \n", address, Iavail);
+	byte group = FindTargetGroup(address);
+
+	if (group == 1)
+		address -= ShmPsuData->PsuGroup[group - 1].GroupPresentPsuQuantity;
+
+	//PRINTF_FUNC("group = %d, address_%d, Iavail = %d \n", group, address, Iavail);
+	ShmPsuData->PsuGroup[group].PsuModule[address].IAvailableCurrent = Iavail;
+
+	bool isPass = true;
+	int totalCur = 0;
+	byte sampleCount = 8;
+
+	if (Iavail == 0)
+	{
+		for (byte count = 0; count < sampleCount; count++)
+		{
+			chargingInfo[group]->SampleChargingCur[count] = Iavail;
+		}
+	}
+	else
+	{
+		// 該群的可輸出電流
+		for (byte index = 0; index < ShmPsuData->PsuGroup[group].GroupPresentPsuQuantity; index++)
+		{
+			totalCur += ShmPsuData->PsuGroup[group].PsuModule[index].IAvailableCurrent;
+		}
+
+		for (byte count = 0; count < sampleCount; count++)
+		{
+			if (chargingInfo[group]->SampleChargingCur[count] == 0)
+			{
+				chargingInfo[group]->SampleChargingCur[count] = totalCur;
+				return;
+			}
+			else
+			{
+				if (chargingInfo[group]->SampleChargingCur[count] != totalCur)
+				{
+					chargingInfo[group]->SampleChargingCur[count] = totalCur;
+					isPass = false;
+					break;
+				}
+			}
+		}
+	}
+
+	if (isPass)
+	{
+//		if (totalCur != 0)
+//				PRINTF_FUNC("group = %d, rating pass value = %d \n", group, totalCur);
+
+		chargingInfo[group]->DeratingChargingCurrent = totalCur;
+	}
+}
+
+void GetPresentOutputFCallback(byte group, float outVol, float outCur)
+{
+	// isinf : -1 = 負無窮，1 = 正無窮，0 = 其他
+	if (isinf(outVol) == 0)
+		ShmPsuData->PsuGroup[group].GroupPresentOutputVoltage = (unsigned short)(outVol * 10);
+	else
+		ShmPsuData->PsuGroup[group].GroupPresentOutputVoltage = 0;
+
+	if (isinf(outCur) == 0)
+		ShmPsuData->PsuGroup[group].GroupPresentOutputCurrent = (unsigned short)(outCur * 10);
+	else
+		ShmPsuData->PsuGroup[group].GroupPresentOutputCurrent = 0;
+
+	if (ShmSysConfigAndInfo->SysInfo.MainChargingMode == _MAIN_CHARGING_MODE_MAX ||
+				(ShmSysConfigAndInfo->SysInfo.MainChargingMode == _MAIN_CHARGING_MODE_AVER &&
+				(ShmSysConfigAndInfo->SysInfo.ReAssignedFlag >= _REASSIGNED_WAITING &&
+				ShmSysConfigAndInfo->SysInfo.ReAssignedFlag <= _REASSIGNED_COMP))
+			)
+		{
+			unsigned short outputVol = 0;
+			unsigned short outputCur = 0;
+			unsigned char _maxTOaver = 0;
+
+			for (byte index = 0; index < ShmPsuData->GroupCount; index++)
+			{
+				bool needtoAdd = true;
+
+				if (ShmPsuData->PsuGroup[index].GroupPresentOutputVoltage > outputVol)
+					outputVol = ShmPsuData->PsuGroup[index].GroupPresentOutputVoltage;
+
+				if (ShmSysConfigAndInfo->SysInfo.ReAssignedFlag >= _REASSIGNED_ADJUST_M_TO_A &&
+						ShmSysConfigAndInfo->SysInfo.ReAssignedFlag <= _REASSIGNED_RELAY_M_TO_A)
+				{
+					if (chargingInfo[index]->DividChargingCurrent == 0)
+						needtoAdd = false;
+					else
+						_maxTOaver = index;
+				}
+
+				if (needtoAdd)
+					outputCur += ShmPsuData->PsuGroup[index].GroupPresentOutputCurrent;
+			}
+
+			if (ShmSysConfigAndInfo->SysInfo.ReAssignedFlag >= _REASSIGNED_ADJUST_M_TO_A &&
+					ShmSysConfigAndInfo->SysInfo.ReAssignedFlag <= _REASSIGNED_RELAY_M_TO_A)
+			{
+				if (chargingInfo[_maxTOaver]->DividChargingCurrent != 0)
+				{
+					float _cur_buf = outputCur;
+					_cur_buf /= 10;
+					chargingInfo[_maxTOaver]->PresentChargingCurrent = _cur_buf;
+				}
+			}
+
+			// 黑白機
+			if (ShmSysConfigAndInfo->SysInfo.IsAlternatvieConf == YES)
+			{
+				for (byte count = 0; count < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; count++)
+				{
+					float _vol_buf = outputVol;
+					float _cur_buf = outputCur;
+
+					// EVSE - 電壓
+					_vol_buf /= 10;
+					chargingInfo[count]->PresentChargingVoltage = _vol_buf;
+
+					_cur_buf /= 10;
+					chargingInfo[count]->PresentChargingCurrent = _cur_buf;
+				}
+			}
+
+			if ((chargingInfo[group]->SystemStatus >= S_PREPARING_FOR_EVSE && chargingInfo[group]->SystemStatus <= S_COMPLETE) ||
+				(chargingInfo[group]->SystemStatus >= S_CCS_PRECHARGE_ST0 && chargingInfo[group]->SystemStatus <= S_CCS_PRECHARGE_ST1))
+			{
+				float _vol_buf = outputVol;
+				float _cur_buf = outputCur;
+
+				// EVSE - 電壓
+				_vol_buf /= 10;
+				chargingInfo[group]->PresentChargingVoltage = _vol_buf;
+
+				_cur_buf /= 10;
+				chargingInfo[group]->PresentChargingCurrent = _cur_buf;
+			}
+		}
+		else
+		{
+			float _vol_buf = ShmPsuData->PsuGroup[group].GroupPresentOutputVoltage;
+			float _cur_buf = ShmPsuData->PsuGroup[group].GroupPresentOutputCurrent;
+
+			// EVSE - 電壓
+			_vol_buf /= 10;
+			chargingInfo[group]->PresentChargingVoltage = _vol_buf;
+
+			_cur_buf /= 10;
+			chargingInfo[group]->PresentChargingCurrent = _cur_buf;
+		}
+}
+
+//==========================================
+// 特規用指令
+//==========================================
+void GetOutputAndTempCallback(byte address, unsigned short outputVol_s,
+		unsigned short outputCur_s, unsigned short outputPower, unsigned char Temperature)
+{
+	if (ShmPsuData->Work_Step < GET_SYS_CAP)
+		return;
+
+	//unsigned short outVol = outputVol_s;
+	//unsigned short outCur = outputCur_s;
+
+	if (IsOverModuleCount(address))
+		return;
+
+	byte group = FindTargetGroup(address);
+
+	if (group == 1)
+		address -= ShmPsuData->PsuGroup[group - 1].GroupPresentPsuQuantity;
+
+//	// PSU Group - 電壓
+//	ShmPsuData->PsuGroup[group].GroupPresentOutputVoltage = outVol;
+//	// PSU Group - 電流
+//	ShmPsuData->PsuGroup[group].GroupPresentOutputCurrent = outCur;
+//	// PSU Group - 能量
+//	ShmPsuData->PsuGroup[group].GroupPresentOutputPower = outVol * outCur;
+//
+//	if (ShmSysConfigAndInfo->SysInfo.MainChargingMode == _MAIN_CHARGING_MODE_MAX ||
+//				(ShmSysConfigAndInfo->SysInfo.MainChargingMode == _MAIN_CHARGING_MODE_AVER &&
+//				(ShmSysConfigAndInfo->SysInfo.ReAssignedFlag >= _REASSIGNED_WAITING &&
+//				ShmSysConfigAndInfo->SysInfo.ReAssignedFlag <= _REASSIGNED_COMP))
+//			)
+//	{
+//		unsigned short outputVol = 0;
+//		unsigned short outputCur = 0;
+//		unsigned char _maxTOaver = 0;
+//
+//		for (byte index = 0; index < ShmPsuData->GroupCount; index++)
+//		{
+//			bool needtoAdd = true;
+//
+//			if (ShmPsuData->PsuGroup[index].GroupPresentOutputVoltage > outputVol)
+//				outputVol = ShmPsuData->PsuGroup[index].GroupPresentOutputVoltage;
+//
+////			if (ShmSysConfigAndInfo->SysInfo.ReAssignedFlag >= _REASSIGNED_ADJUST_M_TO_A &&
+////					ShmSysConfigAndInfo->SysInfo.ReAssignedFlag <= _REASSIGNED_RELAY_M_TO_A)
+////			{
+////				if (chargingInfo[index]->DividChargingCurrent == 0)
+////					needtoAdd = false;
+////				else
+////					_maxTOaver = index;
+////			}
+//
+//			if (needtoAdd)
+//				outputCur += ShmPsuData->PsuGroup[index].GroupPresentOutputCurrent;
+//		}
+//
+//		if (ShmSysConfigAndInfo->SysInfo.ReAssignedFlag >= _REASSIGNED_ADJUST_M_TO_A &&
+//				ShmSysConfigAndInfo->SysInfo.ReAssignedFlag <= _REASSIGNED_RELAY_M_TO_A)
+//		{
+//			if (chargingInfo[_maxTOaver]->DividChargingCurrent != 0)
+//			{
+//				float _cur_buf = outputCur;
+//				_cur_buf /= 10;
+//				chargingInfo[_maxTOaver]->PresentChargingCurrent = _cur_buf;
+//			}
+//		}
+//
+//		// 黑白機
+//		if (ShmSysConfigAndInfo->SysInfo.IsAlternatvieConf == YES)
+//		{
+//			for (byte count = 0; count < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; count++)
+//			{
+//				float _vol_buf = outputVol;
+//				float _cur_buf = outputCur;
+//
+//				// EVSE - 電壓
+//				_vol_buf /= 10;
+//				chargingInfo[count]->PresentChargingVoltage = _vol_buf;
+//
+//				_cur_buf /= 10;
+//				chargingInfo[count]->PresentChargingCurrent = _cur_buf;
+//			}
+//		}
+//
+//		if ((chargingInfo[group]->SystemStatus >= S_PREPARING_FOR_EVSE && chargingInfo[group]->SystemStatus <= S_COMPLETE) ||
+//			(chargingInfo[group]->SystemStatus >= S_CCS_PRECHARGE_ST0 && chargingInfo[group]->SystemStatus <= S_CCS_PRECHARGE_ST1))
+//		{
+//			float _vol_buf = outputVol;
+//			float _cur_buf = outputCur;
+//
+//			// EVSE - 電壓
+//			_vol_buf /= 10;
+//			chargingInfo[group]->PresentChargingVoltage = _vol_buf;
+//
+//			_cur_buf /= 10;
+//			chargingInfo[group]->PresentChargingCurrent = _cur_buf;
+//		}
+//	}
+//	else
+//	{
+//		float _vol_buf = ShmPsuData->PsuGroup[group].GroupPresentOutputVoltage;
+//		float _cur_buf = ShmPsuData->PsuGroup[group].GroupPresentOutputCurrent;
+//
+//		// EVSE - 電壓
+//		_vol_buf /= 10;
+//		chargingInfo[group]->PresentChargingVoltage = _vol_buf;
+//
+//		_cur_buf /= 10;
+//		chargingInfo[group]->PresentChargingCurrent = _cur_buf;
+//	}
+
+	ShmPsuData->PsuGroup[group].PsuModule[address].CriticalTemp1 = Temperature;
+	ShmPsuData->PsuGroup[group].PsuModule[address].CriticalTemp2 = Temperature;
+	ShmPsuData->PsuGroup[group].PsuModule[address].CriticalTemp3 = Temperature;
+	ShmPsuData->PsuGroup[group].PsuModule[address].ExletTemp = Temperature;
+
+//	PRINTF_FUNC("***Output Value and Temp*** group = %d, Vol = %d, Cur = %d \n",
+//			group, outputVol_s, outputCur_s);
+}
+
+void GetModuleStatusCallback(byte address, unsigned char isErr, unsigned char status,
+		unsigned char err1, unsigned char err2, unsigned char err3, unsigned char err4)
+{
+	if (ShmPsuData->Work_Step < GET_SYS_CAP)
+		return;
+
+	if (IsOverModuleCount(address))
+		return;
+
+	byte group1 = FindTargetGroup(address);
+
+	if (group1 == 1)
+		address -= ShmPsuData->PsuGroup[group1 - 1].GroupPresentPsuQuantity;
+
+	int alarm = (err2 << 24) | (err3 << 16) | (err4 << 8);
+
+//	ShmPsuData->PsuGroup[group1].PsuModule[address].CriticalTemp1 = temp;
+//	ShmPsuData->PsuGroup[group1].PsuModule[address].CriticalTemp2 = temp;
+//	ShmPsuData->PsuGroup[group1].PsuModule[address].CriticalTemp3 = temp;
+//	ShmPsuData->PsuGroup[group1].PsuModule[address].ExletTemp = temp;
+	ShmPsuData->PsuGroup[group1].PsuModule[address].AlarmCode = alarm;
+	AbnormalStopAnalysis(group1, alarm);
+
+	// err2 == state 2
+	// err3 == state 1
+	// err4 == state 0
+	//PRINTF_FUNC("***Status*** address = %d, alarm = %d \n", address, alarm);
+}
+
+void GetModuleInputCallback(byte address, unsigned short inputR,
+		unsigned short inputS, unsigned short inputT)
+{
+	if (ShmPsuData->Work_Step < GET_SYS_CAP)
+		return;
+
+	if (IsOverModuleCount(address))
+		return;
+
+	byte group = FindTargetGroup(address);
+
+	if (group == 1)
+		address -= ShmPsuData->PsuGroup[group - 1].GroupPresentPsuQuantity;
+
+	ShmPsuData->PsuGroup[group].PsuModule[address].InputVoltageL1 = inputR;
+	ShmPsuData->PsuGroup[group].PsuModule[address].InputVoltageL2 = inputS;
+	ShmPsuData->PsuGroup[group].PsuModule[address].InputVoltageL3 = inputT;
+
+	//PRINTF_FUNC("***Input*** address = %d, R = %d, S = %d, T = %d \n",
+	//		address, inputR, inputS, inputT);
+}
+//==========================================
+// Init all share memory
+//==========================================
+int InitShareMemory()
+{
+	int result = PASS;
+	int MeterSMId;
+
+	//creat ShmSysConfigAndInfo
+	if ((MeterSMId = shmget(ShmSysConfigAndInfoKey, sizeof(struct SysConfigAndInfo),  0777)) < 0)
+    {
+		#ifdef SystemLogMessage
+		DEBUG_ERROR("shmget ShmSysConfigAndInfo NG %d \n");
+		#endif
+		result = FAIL;
+	}
+    else if ((ShmSysConfigAndInfo = shmat(MeterSMId, NULL, 0)) == (void *) -1)
+    {
+    	#ifdef SystemLogMessage
+    	DEBUG_ERROR("shmat ShmSysConfigAndInfo NG \n");
+		#endif
+    	result = FAIL;
+   	 }
+    else
+    {}
+
+   	//creat ShmStatusCodeData
+   	if ((MeterSMId = shmget(ShmStatusCodeKey, sizeof(struct StatusCodeData),  0777)) < 0)
+    {
+		#ifdef SystemLogMessage
+   		DEBUG_ERROR("shmget ShmStatusCodeData NG \n");
+		#endif
+   		result = FAIL;
+	}
+    else if ((ShmStatusCodeData = shmat(MeterSMId, NULL, 0)) == (void *) -1)
+    {
+    	#ifdef SystemLogMessage
+    	DEBUG_ERROR("shmat ShmStatusCodeData NG \n");
+		#endif
+    	result = FAIL;
+   	}
+    else
+    {}
+
+   	//creat ShmPsuData
+	if ((MeterSMId = shmget(ShmPsuKey, sizeof(struct PsuData),  0777)) < 0)
+	{
+		#ifdef SystemLogMessage
+		DEBUG_ERROR("shmget ShmPsuData NG \n");
+		#endif
+		result = FAIL;
+	}
+	else if ((ShmPsuData = shmat(MeterSMId, NULL, 0)) == (void *) -1)
+	{
+		#ifdef SystemLogMessage
+		DEBUG_ERROR("shmat ShmPsuData NG \n");
+		#endif
+		result = FAIL;
+	 }
+	memset(ShmPsuData,0,sizeof(struct PsuData));
+
+    return result;
+}
+
+//================================================
+// Main process
+//================================================
+void InitialPsuData()
+{
+	ShmPsuData->SystemPresentPsuQuantity = 0;
+	ShmPsuData->SystemAvailablePower = 0;
+
+	PRINTF_FUNC("************ psu Group = %d \n", ShmPsuData->GroupCount);
+	for (byte _groupCount = 0; _groupCount < ShmPsuData->GroupCount; _groupCount++)
+	{
+		ShmPsuData->PsuGroup[_groupCount].GroupPresentPsuQuantity = 0;
+		ShmPsuData->PsuGroup[_groupCount].GroupAvailablePower = 0;
+		ShmPsuData->PsuGroup[_groupCount].GroupAvailableCurrent = 0;
+	}
+}
+
+void Initialization()
+{
+	bool isPass = false;
+	while(!isPass)
+	{
+		isPass = true;
+		for (byte _index = 0; _index < _gunCount; _index++)
+		{
+			if (!FindChargingInfoData(_index, &chargingInfo[0]))
+			{
+				DEBUG_ERROR("Module_PsuComm : FindChargingInfoData false \n");
+				isPass = false;
+				break;
+			}
+		}
+		sleep(1);
+	}
+
+	if (ShmSysConfigAndInfo->SysInfo.IsAlternatvieConf == YES)
+		ShmPsuData->GroupCount = 1;
+	else
+		ShmPsuData->GroupCount = _gunCount;
+
+	char EvsePower[2];
+
+	EvsePower[2] = '\0';
+	char count = 0;
+	byte psuTarIndex = 0;
+	// 解析 ModelName 取得各槍各有幾個 PSU 及編號
+	if (strlen((char *) ShmSysConfigAndInfo->SysConfig.ModelName) >= 6)
+	{
+		strncpy(EvsePower, (char *)(ShmSysConfigAndInfo->SysConfig.ModelName + 4), 2);
+		if (strcmp(EvsePower, "15") == EQUAL)
+			count = 5;
+		else if (strcmp(EvsePower, "30") == EQUAL)
+			count = 1;
+		else if (strcmp(EvsePower, "60") == EQUAL)
+			count = 2;
+		else if (strcmp(EvsePower, "12") == EQUAL)
+			count = 4;
+		else if (strcmp(EvsePower, "18") == EQUAL)
+			count = 6;
+		else if (strcmp(EvsePower, "36") == EQUAL)
+			count = 12;
+
+		if (count > 0)
+		{
+			if (ShmPsuData->GroupCount == 1)
+				conn_1_count = count;
+			else if (ShmPsuData->GroupCount == 2)
+			{
+				if(count % 2 > 0)
+					conn_1_count = (count / 2) + 1;
+				else
+					conn_1_count = (count / 2);
+
+				conn_2_count = count - conn_1_count;
+			}
+
+			for(byte psuIndex = 0; psuIndex < conn_1_count; psuIndex++)
+			{
+				connector_1[psuIndex] = psuTarIndex;
+				psuTarIndex++;
+			}
+
+			for(byte psuIndex = 0; psuIndex < conn_2_count; psuIndex++)
+			{
+				connector_2[psuIndex] = psuTarIndex;
+				psuTarIndex++;
+			}
+
+			for(byte psuIndex = 0; psuIndex < conn_1_count; psuIndex++)
+				PRINTF_FUNC("Connector 1 - Number = %d \n", connector_1[psuIndex]);
+
+			for(byte psuIndex = 0; psuIndex < conn_2_count; psuIndex++)
+				PRINTF_FUNC("Connector 2 - Number = %d \n", connector_2[psuIndex]);
+		}
+		else
+			DEBUG_ERROR("Module_PsuComm : Can't parsing model name. \n");
+	}
+}
+
+void CheckSmartChargingStep(bool isWaitingAver, bool isCharging, bool canAverageCharging)
+{
+	if (ShmSysConfigAndInfo->SysInfo.ReAssignedFlag == _REASSIGNED_PREPARE_M_TO_A)
+	{
+		if (isWaitingAver)
+		{
+			if (ShmSysConfigAndInfo->SysInfo.MainChargingMode == _MAIN_CHARGING_MODE_MAX)
+			{
+				ShmSysConfigAndInfo->SysInfo.CanAverageCharging = canAverageCharging;
+
+				if (canAverageCharging)
+				{
+					PRINTF_FUNC("=============Smart Charging : _REASSIGNED_GET_NEW_CAP============= Step 2 \n");
+					ShmSysConfigAndInfo->SysInfo.ReAssignedFlag = _REASSIGNED_GET_NEW_CAP;
+				}
+				else
+				{
+					PRINTF_FUNC("=============Smart Charging : _REASSIGNED_NONE============= Step 0 \n");
+					ShmSysConfigAndInfo->SysInfo.ReAssignedFlag = _REASSIGNED_NONE;
+				}
+			}
+			else
+			{
+				PRINTF_FUNC("=============Smart Charging : _REASSIGNED_NONE============= Step 0 \n");
+				ShmSysConfigAndInfo->SysInfo.ReAssignedFlag = _REASSIGNED_NONE;
+			}
+		}
+	}
+	else  if (ShmSysConfigAndInfo->SysInfo.ReAssignedFlag ==  _REASSIGNED_PREPARE_A_TO_M)
+	{
+		if (isCharging)
+		{
+			if (ShmSysConfigAndInfo->SysInfo.MainChargingMode == _MAIN_CHARGING_MODE_AVER)
+			{
+				PRINTF_FUNC("=============Smart Charging : _REASSIGNED_ADJUST_A_TO_M============= Step 12 \n");
+				preChargingCur = preChargingTarget = 0;
+				gettimeofday(&_max_time, NULL);
+				ShmSysConfigAndInfo->SysInfo.ReAssignedFlag = _REASSIGNED_ADJUST_A_TO_M;
+			}
+			else
+			{
+				PRINTF_FUNC("=============Smart Charging_1  : _REASSIGNED_COMP============= Step 15 \n");
+				ShmSysConfigAndInfo->SysInfo.ReAssignedFlag = _REASSIGNED_COMP;
+			}
+		}
+		else
+		{
+			PRINTF_FUNC("=============Smart Charging_2 : _REASSIGNED_COMP============= Step 15 \n");
+			ShmSysConfigAndInfo->SysInfo.ReAssignedFlag = _REASSIGNED_COMP;
+		}
+	}
+}
+
+int main(void)
+{
+	if(InitShareMemory() == FAIL)
+	{
+		#ifdef SystemLogMessage
+		DEBUG_ERROR("InitShareMemory NG\n");
+		#endif
+		if(ShmStatusCodeData != NULL)
+		{
+			ShmStatusCodeData->AlarmCode.AlarmEvents.bits.FailToCreateShareMemory = 1;
+		}
+		sleep(5);
+		return 0;
+	}
+
+	PRINTF_FUNC("InitShareMemory OK\n");
+
+	// register callback function
+	RefreshStatus(&GetStatusCallback);
+	RefreshModuleCount(&GetModuleCountCallback);
+	RefreshAvailableCap(&GetAvailableCapCallback);
+	RefreshFwVersion(&GetFwCallback);
+	RefreshInputVol(&GetInputVoltageCallback);
+	RefreshGetOutput(&GetPresentOutputCallback);
+	RefreshFanInfo(&GetFanSpeedCallback);
+	RefreshIavailable(&GetIavailableCallback);
+	RefreshGetOutputF(&GetPresentOutputFCallback);
+
+	// GetPresentOutputCallback & GetStatusCallback
+	AutoMode_RefreshOutputAndTemp(&GetOutputAndTempCallback);
+	// GetStatusCallback
+	AutoMode_RefreshModuleStatus(&GetModuleStatusCallback);
+	// GetInputVoltageCallback
+	AutoMode_RefreshModuleInput(&GetModuleInputCallback);
+
+	sleep(2);
+	_gunCount = ShmSysConfigAndInfo->SysConfig.TotalConnectorCount;
+	// initial object
+	InitialPsuData();
+	Initialization();
+	libInitialize = InitialCommunication();
+    byte isInitialComp = NO;
+    PRINTF_FUNC("ALTERNATIVE_CONG = %d \n", ShmSysConfigAndInfo->SysInfo.IsAlternatvieConf);
+	//main loop
+	while (libInitialize)
+	{
+		// 斷電狀態
+		if (ShmSysConfigAndInfo->SysInfo.AcContactorStatus == NO)
+		{
+			//一但 AC Off PSU 斷電全部的 PSU Group ID 會全部清 0
+			if (!isInitialComp)
+			{
+				ShmPsuData->Work_Step = INITIAL_START;
+				sleep(2);
+				InitialPsuData();
+				isInitialComp = YES;
+			}
+			sleep(1);
+			continue;
+		}
+		else
+			isInitialComp = NO;
+
+		// 自檢失敗
+		if (ShmPsuData->Work_Step == _NO_WORKING)
+		{
+			PRINTF_FUNC("== PSU == self test fail. \n");
+			sleep(5);
+		}
+
+		switch(ShmPsuData->Work_Step)
+		{
+			case INITIAL_START:
+			{
+				PRINTF_FUNC("== PSU == INITIAL_START \n");
+				gettimeofday(&_cmdSubPriority_time, NULL);
+				sleep(5);
+				SwitchPower(SYSTEM_CMD, PSU_POWER_OFF);
+				SetWalkInConfig(SYSTEM_CMD, NO, 0);
+				for (byte index = 0; index < ShmPsuData->GroupCount; index++)
+					isStartOutputSwitch[index] = false;
+				ShmPsuData->Work_Step = GET_PSU_COUNT;
+			}
+				break;
+			case GET_PSU_COUNT:
+			{
+				int time = GetTimeoutValue(_cmdSubPriority_time) / 1000;
+				byte moduleCount = 0;
+
+				if (time > 2000)
+				{
+//					if (ShmPsuData->GroupCount == 0)
+//						ShmPsuData->GroupCount = ShmSysConfigAndInfo->SysConfig.TotalConnectorCount;
+					// 分別取各群模組數量
+					for (byte index = 0; index < ShmPsuData->GroupCount; index++)
+					{
+						// 總和各群模組數量
+						moduleCount += ShmPsuData->PsuGroup[index].GroupPresentPsuQuantity;
+
+						// 取各群模組數量
+						GetModuleCount(index);
+					}
+					PRINTF_FUNC("== PSU == indexCount = %d, moduleCount = %d, sysCount = %d\n",
+							ShmPsuData->GroupCount, moduleCount, ShmPsuData->SystemPresentPsuQuantity);
+
+					// 發送取得目前全部模組數量
+					GetModuleCount(SYSTEM_CMD);
+
+					// 判斷系統數量與各群數量一致
+					if(moduleCount == ShmPsuData->SystemPresentPsuQuantity && moduleCount > 0)
+					{
+						PRINTF_FUNC("Psu Count = %d \n", moduleCount);
+						if (ShmSysConfigAndInfo->SysInfo.BootingStatus == BOOTTING)
+						{
+							// 電樁在 Booting 的狀態 - 自檢
+							PRINTF_FUNC("== PSU == GET_SYS_CAP \n");
+							ShmPsuData->Work_Step = GET_SYS_CAP;
+						}
+						else
+						{
+							PRINTF_FUNC("== PSU == _WORK_CHARGING \n");
+							ShmPsuData->Work_Step = _WORK_CHARGING;
+
+							//sdlu test
+							gettimeofday(&_test_time, NULL);
+						}
+					}
+
+					gettimeofday(&_cmdSubPriority_time, NULL);
+				}
+			}
+				break;
+			case GET_SYS_CAP:
+			{
+				int time = GetTimeoutValue(_cmdSubPriority_time) / 1000;
+
+				if (time > 1000)
+				{
+					bool isFinish = true;
+					for (byte psuCount = 0; psuCount < ShmPsuData->SystemPresentPsuQuantity; psuCount++)
+					{
+						if (strcmp((char *)ShmPsuData->PsuVersion[psuCount].FwPrimaryVersion, "") == EQUAL ||
+								ShmPsuData->SystemAvailablePower <= 0 || ShmPsuData->SystemAvailableCurrent <= 0)
+						{
+							isFinish = false;
+							break;
+						}
+					}
+
+					if (!isFinish)
+					{
+						for (byte index = 0; index < ShmPsuData->GroupCount; index++)
+						{
+							// Pooling Status
+							//GetStatus(index);
+
+							// 取系統總輸出能力
+							GetModuleCap(index);
+
+							// 取版號
+							GetModuleVer(index);
+						}
+					}
+					else
+					{
+						// 判斷系統輸出額定功率與電流
+						PRINTF_FUNC("SystemAvailableCurrent = %d, SystemAvailablePower = %d \n",
+							ShmPsuData->SystemAvailableCurrent, ShmPsuData->SystemAvailablePower);
+
+						PRINTF_FUNC("== PSU == BOOTING_COMPLETE \n");
+						ShmPsuData->Work_Step = BOOTING_COMPLETE;
+					}
+
+					gettimeofday(&_cmdSubPriority_time, NULL);
+				}
+			}
+				break;
+			case BOOTING_COMPLETE:
+			{
+				bool isSelfTestPass = true;
+				for (byte groupIndex = 0; groupIndex < _gunCount; groupIndex++)
+				{
+					if (chargingInfo[groupIndex]->SystemStatus == S_BOOTING)
+					{
+						isSelfTestPass = false;
+					}
+				}
+
+				if (isSelfTestPass)
+					ShmPsuData->Work_Step = _WORK_CHARGING;
+				sleep(1);
+			}
+				break;
+			case _WORK_CHARGING:
+			{
+				int time = GetTimeoutValue(_cmdSubPriority_time) / 1000;
+
+				// 低 Priority 的指令
+				if (time > 1500)
+				{
+					isCharging = false;
+					isWaitingAver = false;
+					isReadToCharging = false;
+					CanAverageCharging = true;
+
+					for (byte index = 0; index < ShmPsuData->GroupCount; index++)
+					{
+						// Pooling Status
+						//GetStatus(index);
+
+						// 取得模塊輸出額定電流能力
+						//GetModuleIavailable(index);
+
+						if (chargingInfo[index]->SystemStatus == S_CHARGING)
+						{
+							isCharging = true;
+							if (ShmSysConfigAndInfo->SysInfo.ReAssignedFlag == _REASSIGNED_PREPARE_M_TO_A)
+							{
+								if (toAverVolPoint > 0 &&
+										toAverVolPoint == (chargingInfo[index]->EvBatterytargetCurrent * 10))
+								{
+									// 欲最大充 -> 均充需要等待充電中的輸出電流拉高到目標電流
+									if ((chargingInfo[index]->PresentChargingCurrent * 10) >=
+											(chargingInfo[index]->EvBatterytargetCurrent * 10) - CHK_CUR_RANGE)
+									{
+										if (toAverVolCount == 0)
+											isWaitingAver = true;
+										else
+											toAverVolCount--;
+									}
+								}
+								else
+								{
+									toAverVolPoint = (chargingInfo[index]->EvBatterytargetCurrent * 10);
+									toAverVolCount = 3;
+								}
+							}
+							else
+							{
+								toAverVolPoint = 0;
+								toAverVolCount = 3;
+							}
+						}
+
+						if ((chargingInfo[index]->SystemStatus >= S_PREPARING_FOR_EVSE && chargingInfo[index]->SystemStatus <= S_CHARGING) ||
+								(chargingInfo[index]->SystemStatus >= S_CCS_PRECHARGE_ST0 && chargingInfo[index]->SystemStatus <= S_CCS_PRECHARGE_ST1))
+						{
+							isReadToCharging = true;
+						}
+
+						if (chargingInfo[index]->DeratingChargingCurrent < STOP_CURRENT)
+						{
+							CanAverageCharging = false;
+						}
+					}
+
+					gettimeofday(&_cmdSubPriority_time, NULL);
+					CheckSmartChargingStep(isWaitingAver, isCharging, CanAverageCharging);
+				}
+
+				for (byte groupIndex = 0; groupIndex < _gunCount; groupIndex++)
+				{
+					// 取系統總輸出能力
+					GetModuleCap(groupIndex);
+
+					// 取各群輸出電壓電流 (float)
+					GetModuleOutputF(groupIndex);
+
+					// 取得模塊輸出額定電流能力
+					GetModuleIavailable(groupIndex);
+
+					// 針對各槍當前狀態，傳送需要回傳的資料指令
+					if (((chargingInfo[groupIndex]->SystemStatus >= S_PREPARING_FOR_EVSE && chargingInfo[groupIndex]->SystemStatus <= S_CHARGING) && chargingInfo[groupIndex]->RelayK1K2Status) ||
+							(chargingInfo[groupIndex]->SystemStatus >= S_PREPARING_FOR_EVSE && chargingInfo[groupIndex]->SystemStatus <= S_CHARGING && chargingInfo[groupIndex]->Type == _Type_GB) ||
+							(chargingInfo[groupIndex]->SystemStatus >= S_CCS_PRECHARGE_ST0 && chargingInfo[groupIndex]->SystemStatus <= S_CCS_PRECHARGE_ST1))
+					{
+						//if (time > 1000)
+						{
+							if (chargingInfo[groupIndex]->FireChargingVoltage > 0 &&
+								evseOutVol != (chargingInfo[groupIndex]->FireChargingVoltage / 10))
+							{
+								evseOutVol = (chargingInfo[groupIndex]->FireChargingVoltage / 10);
+								PRINTF_FUNC("groupIndex = %d, ev need vol = %f, evse output vol = %f \n", groupIndex,
+									(chargingInfo[groupIndex]->EvBatterytargetVoltage * 10),
+									chargingInfo[groupIndex]->FireChargingVoltage);
+							}
+
+							if ((chargingInfo[groupIndex]->PresentChargingCurrent * 10) > 0 &&
+								evseOutCur != (chargingInfo[groupIndex]->PresentChargingCurrent * 10))
+							{
+								evseOutCur = (chargingInfo[groupIndex]->PresentChargingCurrent * 10);
+								PRINTF_FUNC("groupIndex = %d, ev need cur = %f, evse output cur = %f \n", groupIndex,
+									(chargingInfo[groupIndex]->EvBatterytargetCurrent * 10),
+									(chargingInfo[groupIndex]->PresentChargingCurrent * 10));
+							}
+						}
+
+						if (ShmSysConfigAndInfo->SysInfo.MainChargingMode == _MAIN_CHARGING_MODE_MAX)
+						{
+//							PRINTF_FUNC("index = %d, SystemStatus = %d, Ev = %f, curCur = %f \n", groupIndex,
+//									chargingInfo[groupIndex]->SystemStatus, chargingInfo[groupIndex]->EvBatterytargetCurrent,
+//									(chargingInfo[groupIndex]->PresentChargingCurrent * 10));
+							// 智能判斷 Start -----------------------------------------------------------
+							if (ShmSysConfigAndInfo->SysInfo.ReAssignedFlag >= _REASSIGNED_GET_NEW_CAP &&
+									ShmSysConfigAndInfo->SysInfo.ReAssignedFlag <= _REASSIGNED_RELAY_M_TO_A)
+							{
+								if (ShmSysConfigAndInfo->SysInfo.ReAssignedFlag == _REASSIGNED_GET_NEW_CAP)
+								{
+									//PRINTF_FUNC("group = %d, GroupPresentOutputCurrent = %d \n",
+									//		groupIndex, ShmPsuData->PsuGroup[groupIndex].GroupPresentOutputCurrent);
+
+									if (chargingInfo[groupIndex]->DividChargingCurrent == 0)
+									{
+										chargingInfo[groupIndex]->DividChargingCurrent = ShmPsuData->PsuGroup[groupIndex].GroupPresentOutputCurrent;
+									}
+								}
+								PRINTF_FUNC("Index = %d, DividChargingCurrent = %f \n", groupIndex, chargingInfo[groupIndex]->DividChargingCurrent);
+							}
+							else
+							{
+								chargingInfo[groupIndex]->DividChargingCurrent = 0;
+								chargingInfo[groupIndex]->MaxChargingToAverPassFlag = 0;
+							}
+
+							if (ShmSysConfigAndInfo->SysInfo.ReAssignedFlag == _REASSIGNED_GET_NEW_CAP)
+							{
+								if (ShmPsuData->SystemAvailableCurrent != chargingInfo[groupIndex]->AvailableChargingCurrent)
+								{
+									// 車端要求電流為該充電槍的額定輸出電流的範圍內
+									if ((chargingInfo[groupIndex]->EvBatterytargetCurrent * 10) <= ShmPsuData->PsuGroup[groupIndex].GroupPresentOutputCurrent + DERATING_GAP ||
+										deratingKeepCount >= DERATING_COUNT)
+									{
+										// 車端降載完成
+										PRINTF_FUNC("Index = %d, newEvCurrent = %f \n", groupIndex, (chargingInfo[groupIndex]->EvBatterytargetCurrent * 10));
+										PRINTF_FUNC("=============Smart Charging : _REASSIGNED_ADJUST_M_TO_A============= Step 3 \n");
+										ShmSysConfigAndInfo->SysInfo.ReAssignedFlag = _REASSIGNED_ADJUST_M_TO_A;
+										gettimeofday(&_derating_time, NULL);
+										deratingKeepCount = 0;
+									}
+									else
+									{
+										deratingKeepCount++;
+										PRINTF_FUNC("** Step 2 ** : Index = %d, EvBatterytargetCurrent = %f, TargetCurrent = %d, Count = %d \n",
+												groupIndex,
+												(chargingInfo[groupIndex]->EvBatterytargetCurrent * 10),
+												(ShmPsuData->PsuGroup[groupIndex].GroupPresentOutputCurrent + DERATING_GAP),
+												deratingKeepCount);
+									}
+								}
+
+							}
+							else if (ShmSysConfigAndInfo->SysInfo.ReAssignedFlag == _REASSIGNED_ADJUST_M_TO_A)
+							{
+								bool isChanged = false;
+
+								if (chargingInfo[groupIndex]->AvailableChargingCurrent <= (chargingInfo[groupIndex]->EvBatterytargetCurrent * 10))
+								{
+									PRINTF_FUNC("** _REASSIGNED_ADJUST_M_TO_A ** Gun_%d, PresentChargingCurrent = %f, AvailableChargingCurrent = %f, EvBatterytargetCurrent = %f \n", groupIndex,
+											(chargingInfo[groupIndex]->PresentChargingCurrent * 10),
+											chargingInfo[groupIndex]->AvailableChargingCurrent,
+											(chargingInfo[groupIndex]->EvBatterytargetCurrent * 10));
+
+									for (byte subIndex = 0; subIndex < ShmPsuData->GroupCount; subIndex++)
+									{
+										if (chargingInfo[subIndex]->SystemStatus == S_REASSIGN)
+										{
+											// 當 B 模塊輸出電流小於 5A 及退開 relay
+											if ((ShmPsuData->PsuGroup[subIndex].GroupPresentOutputCurrent) <= 50)
+												isChanged = true;
+											break;
+										}
+									}
+								}
+								else if (((chargingInfo[groupIndex]->PresentChargingCurrent * 10) >= ShmPsuData->PsuGroup[groupIndex].GroupPresentOutputCurrent - CHK_CUR_RANGE) &&
+										((chargingInfo[groupIndex]->PresentChargingCurrent * 10) <= ShmPsuData->PsuGroup[groupIndex].GroupPresentOutputCurrent + CHK_CUR_RANGE))
+								{
+									for (byte subIndex = 0; subIndex < ShmPsuData->GroupCount; subIndex++)
+									{
+										if (chargingInfo[subIndex]->SystemStatus == S_REASSIGN)
+										{
+											if ((ShmPsuData->PsuGroup[subIndex].GroupPresentOutputCurrent) <= CHK_CUR_RANGE)
+												isChanged = true;
+											break;
+										}
+									}
+								}
+
+								if (isChanged)
+								{
+									PRINTF_FUNC("** _REASSIGNED_ADJUST_M_TO_A To 4** Gun_%d, PresentChargingCurrent = %f, GroupPresentOutputCurrent = %d \n", groupIndex,
+										(chargingInfo[groupIndex]->PresentChargingCurrent * 10),
+										ShmPsuData->PsuGroup[groupIndex].GroupPresentOutputCurrent);
+
+									// 輸出端與車端要求電流接近
+									PRINTF_FUNC("=============Smart Charging : _REASSIGNED_RELAY_M_TO_A============= Step 4 \n");
+									ShmSysConfigAndInfo->SysInfo.ReAssignedFlag = _REASSIGNED_RELAY_M_TO_A;
+								}
+								else
+								{
+									if ((GetTimeoutValue(_derating_time) / 1000) > 1000)
+									{
+										gettimeofday(&_derating_time, NULL);
+									}
+								}
+							}
+
+							//if (ShmPsuData->SystemAvailablePower > 0)
+							{
+								// 調整輸出電流 : 漸進調整方式
+								if (ShmSysConfigAndInfo->SysInfo.ReAssignedFlag >= _REASSIGNED_GET_NEW_CAP &&
+										ShmSysConfigAndInfo->SysInfo.ReAssignedFlag < _REASSIGNED_RELAY_M_TO_A)
+								{
+									if (ShmSysConfigAndInfo->SysInfo.ReAssignedFlag >= _REASSIGNED_ADJUST_M_TO_A)
+									{
+										// 當前充電中的目標電壓
+										float targetVol = (chargingInfo[groupIndex]->EvBatterytargetVoltage * 10);
+										byte reassignIndex = ELEMENT_NOT_FIND;
+
+										// 找到等待分配的槍
+										for (byte subIndex = 0; subIndex < ShmPsuData->GroupCount; subIndex++)
+										{
+											if (chargingInfo[subIndex]->SystemStatus == S_REASSIGN)
+											{
+												reassignIndex = subIndex;
+												break;
+											}
+										}
+
+										if (reassignIndex != ELEMENT_NOT_FIND)
+										{
+											if ((GetTimeoutValue(_derating_time) / 1000) <= 50 ||
+													chargingInfo[groupIndex]->MaxChargingToAverPassFlag == 0)
+											{
+												chargingInfo[groupIndex]->MaxChargingToAverPassFlag = 1;
+												// A 模塊維持當前電壓電流
+												//PRINTF_FUNC("A : index = %d, cur = %d \n", groupIndex, ShmPsuData->PsuGroup[groupIndex].GroupPresentOutputCurrent);
+												//PresentOutputVol(groupIndex, targetVol, ShmPsuData->PsuGroup[groupIndex].GroupPresentOutputCurrent);
+												//PRINTF_FUNC("set out (%d) value = %f******** 1 \n", groupIndex, chargingInfo[groupIndex]->EvBatterytargetCurrent);
+												PresentOutputVol(groupIndex, targetVol, (chargingInfo[groupIndex]->EvBatterytargetCurrent * 10));
+//											}
+//
+//											if ((GetTimeoutValue(_derating_time) / 1000) <= 50)
+//											{
+												// 直接拉掉 B 模塊的電流
+												//PRINTF_FUNC("B : index = %d, cur = %d \n", reassignIndex, CHK_CUR_RANGE);
+												//PRINTF_FUNC("set out (%d) value = %d******** 2 \n", reassignIndex, CHK_CUR_RANGE);
+												PresentOutputVol(reassignIndex, targetVol, CHK_CUR_RANGE);
+											}
+										}
+									}
+
+									if ((chargingInfo[groupIndex]->EvBatterytargetVoltage * 10) == 0)
+									{
+										//PRINTF_FUNC("sys ******** 1 \n");
+										bool isNeedToClosePower = false;
+										for (byte index = 0; index < ShmPsuData->GroupCount; index++)
+										{
+											if (isStartOutputSwitch[index])
+											{
+												isNeedToClosePower = true;
+											}
+											isStartOutputSwitch[index] = false;
+										}
+
+										if (isNeedToClosePower)
+										{
+											SwitchPower(SYSTEM_CMD, PSU_POWER_OFF);
+											FlashLed(SYSTEM_CMD, PSU_FLASH_NORMAL);
+										}
+									}
+								}
+								else if (ShmSysConfigAndInfo->SysInfo.ReAssignedFlag >= _REASSIGNED_RELAY_M_TO_A)
+								{
+									//PRINTF_FUNC("set out (%d) value = %f******** 3 \n", groupIndex, chargingInfo[groupIndex]->EvBatterytargetCurrent);
+									PresentOutputVol(groupIndex,
+											(chargingInfo[groupIndex]->EvBatterytargetVoltage * 10),
+											(chargingInfo[groupIndex]->EvBatterytargetCurrent * 10));
+								}
+								else if (ShmSysConfigAndInfo->SysInfo.MainChargingMode == _MAIN_CHARGING_MODE_MAX)
+								{
+//									PRINTF_FUNC("set out (sys) value = %f, smart step = %d******** 4 \n",
+//										chargingInfo[groupIndex]->EvBatterytargetCurrent, ShmSysConfigAndInfo->SysInfo.ReAssignedFlag);
+									// 該充電槍的目標電壓與目標電流
+									PresentOutputVol(SYSTEM_CMD,
+										(chargingInfo[groupIndex]->EvBatterytargetVoltage * 10),
+										(chargingInfo[groupIndex]->EvBatterytargetCurrent * 10));
+
+									if ((chargingInfo[groupIndex]->EvBatterytargetVoltage * 10) == 0)
+									{
+										//PRINTF_FUNC("sys ******** 2 \n");
+										bool isNeedToClosePower = false;
+										for (byte index = 0; index < ShmPsuData->GroupCount; index++)
+										{
+											if (isStartOutputSwitch[index])
+											{
+												isNeedToClosePower = true;
+											}
+											isStartOutputSwitch[index] = false;
+										}
+
+										if (isNeedToClosePower)
+										{
+											SwitchPower(SYSTEM_CMD, PSU_POWER_OFF);
+											FlashLed(SYSTEM_CMD, PSU_FLASH_NORMAL);
+										}
+									}
+									else
+									{
+										bool isNeedToOpenPower = false;
+										for (byte index = 0; index < ShmPsuData->GroupCount; index++)
+										{
+											if (!isStartOutputSwitch[index])
+											{
+												isNeedToOpenPower = true;
+											}
+											isStartOutputSwitch[index] = true;
+										}
+
+										if (isNeedToOpenPower)
+										{
+											SwitchPower(SYSTEM_CMD, PSU_POWER_ON);
+											FlashLed(SYSTEM_CMD, PSU_FLASH_ON);
+										}
+									}
+								}
+							}
+						}
+						else if (ShmSysConfigAndInfo->SysInfo.MainChargingMode == _MAIN_CHARGING_MODE_AVER)
+						{
+							// 智能判斷 Start -----------------------------------------------------------
+							if (ShmSysConfigAndInfo->SysInfo.ReAssignedFlag == _REASSIGNED_ADJUST_A_TO_M)
+							{
+								bool balanceVol = true;
+
+								for (byte subIndex = 0; subIndex < ShmPsuData->GroupCount; subIndex++)
+								{
+									if (chargingInfo[subIndex]->SystemStatus == S_IDLE ||
+											chargingInfo[subIndex]->SystemStatus == S_RESERVATION)
+									{
+										// 各群電壓接近平衡
+										if (((chargingInfo[subIndex]->PresentChargingVoltage * 10) < (chargingInfo[groupIndex]->PresentChargingVoltage * 10) - ZERO_VOLTAGE) ||
+											((chargingInfo[subIndex]->PresentChargingVoltage * 10) < (chargingInfo[groupIndex]->EvBatterytargetVoltage * 10) - CHK_VOL_RANGE))
+										{
+											PRINTF_FUNC("** _REASSIGNED_ADJUST_A_TO_M ** Gun_%d, PresentChargingVoltage = %f, PresentChargingVoltage_V = %f, EvBatterytargetVoltage = %f \n", subIndex,
+												(chargingInfo[subIndex]->PresentChargingVoltage * 10),
+												((chargingInfo[groupIndex]->PresentChargingVoltage * 10) - ZERO_VOLTAGE),
+												((chargingInfo[groupIndex]->EvBatterytargetVoltage * 10) - CHK_VOL_RANGE));
+											balanceVol = false;
+										}
+										break;
+									}
+								}
+
+								if (balanceVol)
+								{
+									// 閒置端與車端要求電壓接近
+									PRINTF_FUNC("=============Smart Charging : _REASSIGNED_RELAY_A_TO_M============= Step 13 \n");
+									ShmSysConfigAndInfo->SysInfo.ReAssignedFlag = _REASSIGNED_RELAY_A_TO_M;
+								}
+								else
+								{
+									if ((GetTimeoutValue(_max_time) / 1000) > 500)
+									{
+										gettimeofday(&_max_time, NULL);
+									}
+								}
+							}
+							else if(ShmSysConfigAndInfo->SysInfo.ReAssignedFlag == _REASSIGNED_WAITING)
+							{
+								int idleCurrent = 0;
+								int chargingCurrent = 0;
+
+								for (byte subIndex = 0; subIndex < ShmPsuData->GroupCount; subIndex++)
+								{
+									if (chargingInfo[subIndex]->SystemStatus == S_IDLE ||
+											chargingInfo[subIndex]->SystemStatus == S_RESERVATION ||
+											chargingInfo[subIndex]->SystemStatus == S_REASSIGN_CHECK)
+										idleCurrent = ShmPsuData->PsuGroup[subIndex].GroupPresentOutputCurrent;
+									else
+										chargingCurrent = ShmPsuData->PsuGroup[subIndex].GroupPresentOutputCurrent;
+								}
+
+								if (idleCurrent >= chargingCurrent - PRE_CHARG_RANGE)
+								{
+									PRINTF_FUNC("=============Smart Charging_0 : _REASSIGNED_COMP============= Step 15 \n");
+									ShmSysConfigAndInfo->SysInfo.ReAssignedFlag = _REASSIGNED_COMP;
+								}
+								else
+								{
+									if ((GetTimeoutValue(_max_time) / 1000) > 500)
+									{
+										gettimeofday(&_max_time, NULL);
+									}
+								}
+							}
+
+							if (chargingInfo[groupIndex]->AvailableChargingCurrent > 0)
+							{
+								if (ShmSysConfigAndInfo->SysInfo.ReAssignedFlag >= _REASSIGNED_ADJUST_A_TO_M)
+								{
+									byte reassignIndex = ELEMENT_NOT_FIND;
+
+									for (byte subIndex = 0; subIndex < ShmPsuData->GroupCount; subIndex++)
+									{
+										if (chargingInfo[subIndex]->SystemStatus == S_IDLE ||
+												chargingInfo[subIndex]->SystemStatus == S_RESERVATION ||
+												chargingInfo[subIndex]->SystemStatus == S_REASSIGN_CHECK)
+										{
+											reassignIndex = subIndex;
+//											if ((GetTimeoutValue(_max_time) / 1000) <= 50)
+//											{
+//												// 閒置模塊升壓，另對剛分配近來的模塊，預上升電流值 (preChargingCur)
+//												PresentOutputVol(subIndex,
+//														chargingInfo[groupIndex]->EvBatterytargetVoltage,
+//														ZERO_CURRENT + preChargingTarget);
+//											}
+											//PRINTF_FUNC("preChargingCur = %d \n", preChargingCur);
+											if (ShmSysConfigAndInfo->SysInfo.ReAssignedFlag >= _REASSIGNED_WAITING)
+											{
+												preChargingCur = ShmPsuData->PsuGroup[subIndex].GroupPresentOutputCurrent;
+											}
+											else
+												preChargingCur = 0;
+										}
+										else
+										{
+											//PRINTF_FUNC("CurOutputCurrent = %d \n", ShmPsuData->PsuGroup[subIndex].GroupPresentOutputCurrent - preChargingCur);
+											// 充電中的模塊維持輸出
+//											if ((GetTimeoutValue(_max_time) / 1000) <= 50)
+//											{
+//												PresentOutputVol(subIndex,
+//													chargingInfo[subIndex]->EvBatterytargetVoltage,
+//													chargingInfo[subIndex]->EvBatterytargetCurrent - preChargingCur);
+//											}
+
+											if ((ShmSysConfigAndInfo->SysInfo.ReAssignedFlag >= _REASSIGNED_WAITING) &&
+													(preChargingCur >= preChargingTarget - ZERO_CURRENT))
+												preChargingTarget += PRE_CHARG_STEP_CUR;
+
+											if (preChargingTarget >= (chargingInfo[subIndex]->EvBatterytargetCurrent * 10) / 2)
+												preChargingTarget = (chargingInfo[subIndex]->EvBatterytargetCurrent * 10) / 2;
+										}
+									}
+
+									if (reassignIndex != ELEMENT_NOT_FIND)
+									{
+										if ((GetTimeoutValue(_max_time) / 1000) <= 50)
+										{
+											//PRINTF_FUNC("set out (%d) value = %d******** 5 \n", reassignIndex, ZERO_CURRENT + preChargingTarget);
+											// 閒置模塊升壓，另對剛分配近來的模塊，預上升電流值 (preChargingCur)
+											PresentOutputVol(reassignIndex,
+												(chargingInfo[groupIndex]->EvBatterytargetVoltage * 10),
+												ZERO_CURRENT + preChargingTarget);
+
+											byte _ovCahrgingCur = 0;
+											if (preChargingCur > PRE_CHARG_STEP_CUR)
+												_ovCahrgingCur = PRE_CHARG_STEP_CUR;
+
+											//PRINTF_FUNC("set out (%d) value = %f******** 6 \n", groupIndex, chargingInfo[groupIndex]->EvBatterytargetCurrent - preChargingCur - _ovCahrgingCur);
+											PresentOutputVol(groupIndex,
+												(chargingInfo[groupIndex]->EvBatterytargetVoltage * 10),
+												(chargingInfo[groupIndex]->EvBatterytargetCurrent * 10) - preChargingCur - _ovCahrgingCur);
+										}
+									}
+
+									if ((chargingInfo[groupIndex]->EvBatterytargetVoltage * 10) == 0)
+									{
+										//PRINTF_FUNC("sys ******** 3 \n");
+										bool isNeedToClosePower = false;
+										for (byte index = 0; index < ShmPsuData->GroupCount; index++)
+										{
+											if (isStartOutputSwitch[index])
+											{
+												isNeedToClosePower = true;
+											}
+											isStartOutputSwitch[index] = false;
+										}
+
+										if (isNeedToClosePower)
+										{
+											SwitchPower(SYSTEM_CMD, PSU_POWER_OFF);
+											FlashLed(SYSTEM_CMD, PSU_FLASH_NORMAL);
+										}
+									}
+									else
+									{
+										bool isNeedToOpenPower = false;
+										for (byte index = 0; index < ShmPsuData->GroupCount; index++)
+										{
+											if (!isStartOutputSwitch[index])
+											{
+												isNeedToOpenPower = true;
+											}
+											isStartOutputSwitch[index] = true;
+										}
+
+										if (isNeedToOpenPower)
+										{
+											SwitchPower(SYSTEM_CMD, PSU_POWER_ON);
+											FlashLed(SYSTEM_CMD, PSU_FLASH_ON);
+										}
+									}
+								}
+								else
+								{
+									//PRINTF_FUNC("set out (%d) value = %f******** 7 \n", groupIndex, chargingInfo[groupIndex]->EvBatterytargetCurrent);
+									PresentOutputVol(groupIndex,
+										(chargingInfo[groupIndex]->EvBatterytargetVoltage * 10),
+										(chargingInfo[groupIndex]->EvBatterytargetCurrent * 10));
+
+									if ((chargingInfo[groupIndex]->EvBatterytargetVoltage * 10) == 0)
+									{
+										//PRINTF_FUNC("%d ******** 4 \n", groupIndex);
+										if (isStartOutputSwitch[groupIndex])
+										{
+											isStartOutputSwitch[groupIndex] = false;
+											SwitchPower(groupIndex, PSU_POWER_OFF);
+											FlashLed(groupIndex, PSU_FLASH_NORMAL);
+										}
+									}
+									else
+									{
+										if (!isStartOutputSwitch[groupIndex])
+										{
+											isStartOutputSwitch[groupIndex] = true;
+											SwitchPower(groupIndex, PSU_POWER_ON);
+											FlashLed(groupIndex, PSU_FLASH_ON);
+										}
+									}
+								}
+							}
+						}
+					}
+					else if (chargingInfo[groupIndex]->SystemStatus >= S_TERMINATING &&
+								chargingInfo[groupIndex]->SystemStatus <= S_COMPLETE)
+					{
+						if (ShmSysConfigAndInfo->SysInfo.MainChargingMode == _MAIN_CHARGING_MODE_MAX)
+						{
+							if (!isCharging)
+							{
+								//PRINTF_FUNC("sys ******** 5 \n");
+								bool isNeedToClosePower = false;
+								for (byte index = 0; index < ShmPsuData->GroupCount; index++)
+								{
+									if (isStartOutputSwitch[index])
+									{
+										isNeedToClosePower = true;
+									}
+									isStartOutputSwitch[index] = false;
+								}
+
+								if (isNeedToClosePower)
+								{
+									SwitchPower(SYSTEM_CMD, PSU_POWER_OFF);
+									FlashLed(SYSTEM_CMD, PSU_FLASH_NORMAL);
+								}
+
+								if (chargingInfo[groupIndex]->SystemStatus == S_COMPLETE)
+								{
+									if (ShmSysConfigAndInfo->SysInfo.ReAssignedFlag >= _REASSIGNED_PREPARE_M_TO_A &&
+											ShmSysConfigAndInfo->SysInfo.ReAssignedFlag <= _REASSIGNED_RELAY_M_TO_A)
+									{
+										// 代表在切換的過程中，停止充電了
+										if ((chargingInfo[groupIndex]->PresentChargingCurrent * 10) <= STOP_CURRENT)
+											ShmSysConfigAndInfo->SysInfo.ReAssignedFlag = _REASSIGNED_RELAY_M_TO_A;
+									}
+								}
+							}
+							else if (chargingInfo[groupIndex]->SystemStatus == S_COMPLETE)
+							{
+								// 代表充電的槍依舊在充電，欲進入充電的槍取消充電了
+								if (ShmSysConfigAndInfo->SysInfo.ReAssignedFlag >= _REASSIGNED_PREPARE_M_TO_A &&
+										ShmSysConfigAndInfo->SysInfo.ReAssignedFlag <= _REASSIGNED_RELAY_M_TO_A)
+								{
+									ShmSysConfigAndInfo->SysInfo.ReAssignedFlag = _REASSIGNED_NONE;
+								}
+							}
+						}
+						else if (ShmSysConfigAndInfo->SysInfo.MainChargingMode == _MAIN_CHARGING_MODE_AVER)
+						{
+							if (!isReadToCharging)
+							{
+								bool isNeedToClosePower = false;
+								for (byte index = 0; index < ShmPsuData->GroupCount; index++)
+								{
+									if (isStartOutputSwitch[index])
+									{
+										isNeedToClosePower = true;
+									}
+									isStartOutputSwitch[index] = false;
+								}
+
+								if (isNeedToClosePower)
+								{
+									SwitchPower(SYSTEM_CMD, PSU_POWER_OFF);
+									FlashLed(SYSTEM_CMD, PSU_FLASH_NORMAL);
+								}
+							}
+							else
+							{
+								if (isStartOutputSwitch[groupIndex])
+								{
+									isStartOutputSwitch[groupIndex] = false;
+									SwitchPower(groupIndex, PSU_POWER_OFF);
+									FlashLed(groupIndex, PSU_FLASH_NORMAL);
+								}
+							}
+
+							if (ShmSysConfigAndInfo->SysInfo.ReAssignedFlag >= _REASSIGNED_WAITING)
+								ShmSysConfigAndInfo->SysInfo.ReAssignedFlag = _REASSIGNED_COMP;
+							else
+								ShmSysConfigAndInfo->SysInfo.ReAssignedFlag = _REASSIGNED_NONE;
+						}
+					}
+					else if ((chargingInfo[groupIndex]->SystemStatus >= S_PREPARNING && chargingInfo[groupIndex]->SystemStatus <= S_PREPARING_FOR_EV) &&
+							ShmSysConfigAndInfo->SysInfo.MainChargingMode == _MAIN_CHARGING_MODE_AVER)
+					{
+						//PRINTF_FUNC("%d ******** 7 \n", groupIndex);
+						if (isStartOutputSwitch[groupIndex])
+						{
+							isStartOutputSwitch[groupIndex] = false;
+							SwitchPower(groupIndex, PSU_POWER_OFF);
+							FlashLed(groupIndex, PSU_FLASH_NORMAL);
+						}
+					}
+				}
+					break;
+			}
+			case _TEST_MODE:
+			{
+				// 在測試模式中，保持與模塊的通訊
+				int time = GetTimeoutValue(_cmdSubPriority_time) / 1000;
+
+				if (time > 1500)
+				{
+					for (byte index = 0; index < ShmPsuData->GroupCount; index++)
+					{
+						// 取系統總輸出能力
+						GetModuleCap(index);
+
+						// 取各群輸出電壓電流 (float)
+						GetModuleOutputF(index);
+					}
+
+					gettimeofday(&_cmdSubPriority_time, NULL);
+				}
+
+				byte _switch = 0x00;
+				if ((chargingInfo[0]->EvBatterytargetVoltage * 10) > 0 && (chargingInfo[0]->EvBatterytargetCurrent * 10) > 0)
+					_switch = 0x01;
+
+				for (byte _groupCount_1 = 0; _groupCount_1 < conn_1_count; _groupCount_1++)
+				{
+					SetDirModulePresentOutput(connector_1[_groupCount_1],
+						(chargingInfo[0]->EvBatterytargetVoltage * 10),
+						(chargingInfo[0]->EvBatterytargetCurrent * 10),
+						_switch, _switch);
+				}
+
+				for (byte _groupCount_2 = 0; _groupCount_2 < conn_2_count; _groupCount_2++)
+				{
+					SetDirModulePresentOutput(connector_2[_groupCount_2],
+						(chargingInfo[0]->EvBatterytargetVoltage * 10),
+						(chargingInfo[0]->EvBatterytargetCurrent * 10),
+						_switch, _switch);
+				}
+			}
+				break;
+		}
+		usleep(20000);
+	}
+	return FAIL;
+}

EVSE/Projects/DD360ComBox/Apps/Module_PsuComm.h

@@ -0,0 +1,62 @@
+#include 	<sys/time.h>
+#include 	<sys/timeb.h>
+#include    <sys/types.h>
+#include    <sys/stat.h>
+#include 	<sys/types.h>
+#include 	<sys/ioctl.h>
+#include 	<sys/socket.h>
+#include 	<sys/ipc.h>
+#include 	<sys/shm.h>
+#include 	<sys/shm.h>
+#include 	<sys/mman.h>
+#include 	<linux/wireless.h>
+#include 	<linux/can.h>
+#include 	<linux/can/raw.h>
+#include 	<arpa/inet.h>
+#include 	<netinet/in.h>
+
+#include 	<unistd.h>
+#include 	<stdarg.h>
+#include   <stdio.h>      /*標準輸入輸出定義*/
+#include   <stdlib.h>     /*標準函數庫定義*/
+#include   <unistd.h>     /*Unix 標準函數定義*/
+#include   <fcntl.h>      /*檔控制定義*/
+#include   <termios.h>    /*PPSIX 終端控制定義*/
+#include   <errno.h>      /*錯誤號定義*/
+#include 	<errno.h>
+#include 	<string.h>
+#include	<time.h>
+#include	<ctype.h>
+#include 	<ifaddrs.h>
+#include	<math.h>
+#include	"../../define.h"
+#include 	<stdbool.h>
+
+typedef unsigned char 		byte;
+typedef unsigned short 	word;
+typedef unsigned int 		unit;
+
+unsigned char _gunCount;
+struct ChargingInfoData *chargingInfo[CHAdeMO_QUANTITY + CCS_QUANTITY + GB_QUANTITY];
+bool isStartOutputSwitch[CHAdeMO_QUANTITY + CCS_QUANTITY + GB_QUANTITY];
+
+struct timeval _cmdSubPriority_time;
+struct timeval _derating_time;
+struct timeval _max_time;
+
+struct timeval _test_time;
+
+bool isCharging = false;
+bool isWaitingAver = false;
+bool isReadToCharging = false;
+bool CanAverageCharging = false;
+int preChargingTarget;
+int preChargingCur;
+
+float toAverVolPoint;
+byte toAverVolCount;
+
+int connector_1[12];
+int connector_2[12];
+byte conn_1_count = 0;
+byte conn_2_count = 0;

EVSE/Projects/DD360ComBox/Apps/OutputTask.c

@@ -0,0 +1,373 @@
+/*
+ * OutputTask.c
+ *
+ *  Created on: 2020年2月25日
+ *      Author: 7564
+ */
+
+#include 	"OutputTask.h"
+
+bool isOpen;
+
+int InitComPort()
+{
+	int fd;
+	struct termios tios;
+
+	fd = open(priPortName, O_RDWR);
+	if(fd<=0)
+	{
+		#ifdef SystemLogMessage
+		DEBUG_ERROR("open 407 Communication port NG \n");
+		#endif
+		return -1;
+	}
+	ioctl (fd, TCGETS, &tios);
+	tios.c_cflag = B115200| CS8 | CLOCAL | CREAD;
+	tios.c_lflag = 0;
+	tios.c_iflag = 0;
+	tios.c_oflag = 0;
+	tios.c_cc[VMIN]=0;
+	tios.c_cc[VTIME]=(unsigned char)1;
+	tios.c_lflag=0;
+	tcflush(fd, TCIFLUSH);
+	ioctl (fd, TCSETS, &tios);
+
+	return fd;
+}
+
+unsigned long GetTimeoutValue(struct timeval _sour_time)
+{
+	struct timeval _end_time;
+	gettimeofday(&_end_time, NULL);
+
+	return 1000000 * (_end_time.tv_sec - _sour_time.tv_sec) + _end_time.tv_usec - _sour_time.tv_usec;
+}
+
+void ShowMainMsg()
+{
+	printf("Max Vol : %f, Max Cur : %d, POW : %d \n", UnSafeDataInfo->PSU_VOLTAGE,
+			UnSafeDataInfo->PSU_CURRENT, UnSafeDataInfo->PSU_POWER);
+	printf("=> ");
+}
+
+void ChkButtonStatus()
+{
+	if (Button1 == PRESS && !leftBtnPush)
+	{
+		if(!leftBtnPush)
+		{
+			leftBtnPush = true;
+			if (_charging_mode == CHARGING_MODE_STOP)
+			{
+				_charging_mode = CHARGING_MODE_START;
+				printf("****************** Switch to Charging Mode ******************\n");
+			}
+		}
+		else if (Button1 == RELEASE)
+		{
+			if(leftBtnPush)
+			{
+				leftBtnPush = false;
+			}
+		}
+	}
+
+	if (Button2 == PRESS && !rightBtnPush)
+	{
+		if(!rightBtnPush)
+		{
+			rightBtnPush = true;
+			if (_charging_mode == CHARGING_MODE_START)
+			{
+				_charging_mode = CHARGING_MODE_TERMINATING;
+				printf("****************** Switch to Stop Mode ******************\n");
+			}
+		}
+		else if (Button2 == RELEASE)
+		{
+			if(rightBtnPush)
+			{
+				rightBtnPush = false;
+			}
+		}
+	}
+}
+
+void GetModuleCountCallback(byte group, byte count)
+{
+	printf("group = %d, count = %d \n", group, count);
+	if (group == SYSTEM_CMD)
+		UnSafeDataInfo->PSU_COUNT = count;
+}
+
+void GetAvailableCapCallback(byte address, short maxVol, short minVol, short maxCur, short totalPow)
+{
+	int _groupPower = 0, _groupCurrent = 0;
+
+	UnSafeDataInfo->PsuModule[address].PSU_VOLTAGE_INFO = maxVol;
+	UnSafeDataInfo->PsuModule[address].PSU_CURRENT_INFO = maxCur;
+	UnSafeDataInfo->PsuModule[address].PSU_POWER_INFO = totalPow;
+
+	for (byte index = 0; index < UnSafeDataInfo->PSU_COUNT; index++)
+	{
+		_groupCurrent += UnSafeDataInfo->PsuModule[address].PSU_CURRENT_INFO;
+		_groupPower += UnSafeDataInfo->PsuModule[address].PSU_POWER_INFO;
+	}
+
+	UnSafeDataInfo->PSU_VOLTAGE = maxVol;
+	UnSafeDataInfo->PSU_CURRENT = _groupCurrent;
+	UnSafeDataInfo->PSU_POWER = _groupPower;
+}
+
+void GetStatusCallback(byte group, byte address, byte temp, int alarm)
+{
+	printf("alarm = %d \n", alarm);
+}
+
+void GetInputVoltageCallback(byte address, unsigned short vol1, unsigned short vol2, unsigned short vol3)
+{
+	printf("vol1 = %d, vol2 = %d, vol3 = %d \n", vol1, vol2, vol3);
+}
+
+int CreateShareMemory()
+{
+	int MeterSMId;
+
+	if ((MeterSMId = shmget(ShmTestKey,	sizeof(struct UnSafeData), IPC_CREAT | 0777)) < 0)
+	{
+		return 0;
+	}
+	else if ((UnSafeDataInfo = shmat(MeterSMId, NULL, 0))	== (void *) -1)
+	{
+		return 0;
+	}
+	memset(UnSafeDataInfo, 0, sizeof(struct UnSafeData));
+
+	return 1;
+}
+
+static void get_char(char *word)
+{
+    fd_set rfds;
+    struct timeval tv;
+
+    FD_ZERO(&rfds);
+    FD_SET(0, &rfds);
+    tv.tv_sec = 0;
+    tv.tv_usec = 10; //wait input timout time
+
+    //if input
+    if (select(1, &rfds, NULL, NULL, &tv) > 0)
+    {
+    	fgets(word, 128, stdin);
+    }
+}
+
+void GetInputString()
+{
+	char word[128];
+	char newString[7][10];
+	int i, j, ctr;
+
+	get_char(word);
+
+	if (strlen(word) == 0)
+	    return;
+	//fgets(word, sizeof(word), stdin);
+
+	j = 0;
+	ctr = 0;
+	for (i = 0; i <= (strlen(word)); i++) {
+		if (word[i] == ' ' || word[i] == '\0' || word[i] == 10) {
+			newString[ctr][j] = '\0';
+			ctr++;
+			j = 0;
+		} else {
+			newString[ctr][j] = word[i];
+			j++;
+		}
+	}
+
+	VOLTAGE = atof(newString[0]);
+	CURRENT = atof(newString[1]);
+	if (VOLTAGE <= UnSafeDataInfo->PSU_VOLTAGE && CURRENT <= UnSafeDataInfo->PSU_CURRENT)
+	{
+		//printf("OutputVol = %f, OutputCur = %f \n", VOLTAGE, CURRENT);
+	}
+	else
+	{
+		ShowMainMsg();
+	}
+}
+
+void GetIavailableCallback(byte address, unsigned short Iavail, unsigned short Vext)
+{
+	//printf("address = %d, Iavail = %d, Vext = %d \n", address, Iavail, Vext);
+}
+
+void GetOutputAndTempCallback(byte address, unsigned short outputVol,
+		unsigned short outputCur, unsigned short outputPower, unsigned char Temperature)
+{
+	//printf("***Output Value and Temp*** address = %d, Vol = %d, Cur = %d, Pow = %d, Temp = %d \n",
+	//		address, outputVol, outputCur, outputPower, Temperature);
+}
+
+void GetModuleStatusCallback(byte address, unsigned char isErr, unsigned char status,
+		unsigned char err1, unsigned char err2, unsigned char err3, unsigned char err4)
+{
+	//int alarm = (err2 << 24) | (err3 << 16) | (err4 << 8);
+
+	// err2 == state 2
+	// err3 == state 1
+	// err4 == state 0
+	//printf("***Status*** address = %d, alarm = %d \n", address, alarm);
+//	printf("***Status*** address = %d, err1 = %d, err2 = %d, err3 = %d, err4 = %d \n",
+//			address, err1,err2,err3,err4);
+}
+
+void GetModuleInputCallback(byte address, unsigned short inputR,
+		unsigned short inputS, unsigned short inputT)
+{
+
+}
+
+int main(void)
+{
+	isOpen =false;
+
+	if(CreateShareMemory() == 0)
+	{
+		printf("CreateShareMemory fail. \n");
+		return 0;
+	}
+	RefreshModuleCount(&GetModuleCountCallback);
+	RefreshAvailableCap(&GetAvailableCapCallback);
+
+	RefreshStatus(&GetStatusCallback);
+	RefreshInputVol(&GetInputVoltageCallback);
+
+	RefreshIavailable(&GetIavailableCallback);
+
+	AutoMode_RefreshOutputAndTemp(&GetOutputAndTempCallback);
+	AutoMode_RefreshModuleStatus(&GetModuleStatusCallback);
+	AutoMode_RefreshModuleInput(&GetModuleInputCallback);
+
+	Uart1Fd = InitComPort();
+	libInitialize = InitialCommunication();
+
+	if (Uart1Fd < 0 || !libInitialize)
+	{
+		printf("Initial port fail. \n");
+		return 0;
+	}
+
+	sleep(5);
+	gettimeofday(&_cmdSubPriority_time, NULL);
+	VOLTAGE = 0.0;
+	CURRENT = 0.0;
+
+	SwitchPower(SYSTEM_CMD, PSU_POWER_OFF);
+//	while (1)
+//	{
+//		printf("++++++++++++++2++++++++++++++++++++++++++++++++++++++\n");
+//		SetWalkInConfig(0, YES, 0);
+//		SetWalkInConfig(1, NO, 0);
+//		printf("++++++++++++++++++++++++++++++++++++++++++++++++++++\n");
+//		sleep(1);
+//	}
+//
+//	sleep(1);
+//		printf("++++++++++++++2++++++++++++++++++++++++++++++++++++++\n");
+//		SetWalkInConfig(SYSTEM_CMD, NO, 0);
+//		printf("++++++++++++++++++++++++++++++++++++++++++++++++++++\n");
+//	return 0;
+	while (1)
+	{
+		GetInputGpioStatus();
+		//ChkButtonStatus();
+		// 切換 Walk-in mode (default 5s -> 2s)
+		SetWalkInConfig(SYSTEM_CMD, NO, 0);
+
+		int time = GetTimeoutValue(_cmdSubPriority_time) / 1000;
+		while(isGetCount == YES)
+		{
+			if (_charging_mode == CHARGING_MODE_START)
+			{
+				// 取得模塊輸出額定電流能力
+				GetModuleIavailable(0);
+			}
+
+			GetInputString();
+			if (VOLTAGE > 150 && CURRENT >= 0)
+				_charging_mode = CHARGING_MODE_START;
+			else
+				_charging_mode = CHARGING_MODE_TERMINATING;
+			//printf("_charging_mode = %d \n", _charging_mode);
+			switch(_charging_mode)
+			{
+				case CHARGING_MODE_START:
+				{
+					//if (!isOpen)
+					{
+						//SwitchPower(SYSTEM_CMD, PSU_POWER_ON);
+						//FlashLed(SYSTEM_CMD, PSU_FLASH_ON);
+						SetDirModulePresentOutput(0,
+												VOLTAGE * 10,
+												CURRENT * 10,
+												0x01,
+												0x01);
+					}
+					//PresentOutputVol(SYSTEM_CMD, VOLTAGE * 10, CURRENT * 10);
+				}
+					break;
+				case CHARGING_MODE_TERMINATING:
+				{
+					//if (isOpen)
+					{
+						SetDirModulePresentOutput(0,
+							VOLTAGE * 10,
+							CURRENT * 10,
+							0x00,
+							0x01);
+						//SwitchPower(SYSTEM_CMD, PSU_POWER_OFF);
+						//FlashLed(SYSTEM_CMD, PSU_FLASH_NORMAL);
+					}
+				}
+					break;
+			}
+			//GetStatus(0);
+			//GetModuleInput(0);
+			sleep(1);
+		}
+
+		if (UnSafeDataInfo->PSU_COUNT <= 0)
+		{
+			if (time > 1000)
+			{
+				printf("Step 1 : GetModuleCount...... \n");
+				GetModuleCount(SYSTEM_CMD);
+				gettimeofday(&_cmdSubPriority_time, NULL);
+			}
+		}
+		else if (time < 5000)
+		{
+			printf("Step 2 : GetModuleCap...... \n");
+			GetModuleCap(0);
+
+			SwitchPower(SYSTEM_CMD, PSU_POWER_OFF);
+			FlashLed(SYSTEM_CMD, PSU_FLASH_NORMAL);
+		}
+		else
+		{
+			ShowMainMsg();
+			isGetCount = YES;
+		}
+
+		sleep(1);
+	}
+
+	return 0;
+}
+
+

EVSE/Projects/DD360ComBox/Apps/OutputTask.h

@@ -0,0 +1,174 @@
+/*
+ * OutputTask.h
+ *
+ *  Created on: 2020¦~2¤ë25¤é
+ *      Author: 7564
+ */
+
+#ifndef OUTPUTTASK_H_
+#define OUTPUTTASK_H_
+
+
+#include 	<sys/time.h>
+#include 	<sys/timeb.h>
+#include    <sys/types.h>
+#include    <sys/stat.h>
+#include 	<sys/types.h>
+#include 	<sys/ioctl.h>
+#include 	<sys/socket.h>
+#include 	<sys/ipc.h>
+#include 	<sys/shm.h>
+#include 	<sys/shm.h>
+#include 	<sys/mman.h>
+#include 	<linux/wireless.h>
+#include 	<linux/can.h>
+#include 	<linux/can/raw.h>
+#include 	<arpa/inet.h>
+#include 	<netinet/in.h>
+
+#include 	<unistd.h>
+#include 	<stdarg.h>
+#include    <stdio.h>
+#include    <stdlib.h>
+#include    <unistd.h>
+#include    <fcntl.h>
+#include    <termios.h>
+#include    <errno.h>
+#include 	<errno.h>
+#include 	<string.h>
+#include	<time.h>
+#include	<ctype.h>
+#include 	<ifaddrs.h>
+#include 	<stdbool.h>
+
+#define ShmTestKey	2001
+
+#define ARRAY_SIZE(A)		(sizeof(A) / sizeof(A[0]))
+#define PASS				1
+#define FAIL				-1
+#define YES					1
+#define NO					0
+#define PRESS				1
+#define RELEASE				0
+#define MAX_PSU_QUANTITY        62
+
+int Uart1Fd = -1;
+char *priPortName = "/dev/ttyS1";
+
+bool libInitialize = false;
+struct timeval _cmdSubPriority_time;
+
+unsigned char Button1 = RELEASE;
+unsigned char Button2 = RELEASE;
+bool leftBtnPush = false;
+bool rightBtnPush = false;
+
+unsigned char _psuCount = 0;
+unsigned char isGetCount = NO;
+
+float VOLTAGE;
+float CURRENT;
+
+struct PsuModuleInfo
+{
+	unsigned int 	PSU_POWER_INFO;
+	float			PSU_VOLTAGE_INFO;
+	unsigned short	PSU_CURRENT_INFO;
+};
+
+struct UnSafeData
+{
+	unsigned char 			PSU_COUNT;
+	struct PsuModuleInfo 	PsuModule[MAX_PSU_QUANTITY];
+	unsigned int 			PSU_POWER;
+	float					PSU_VOLTAGE;
+	unsigned short			PSU_CURRENT;
+};
+
+struct UnSafeData			*UnSafeDataInfo;
+
+typedef struct GPIO_IN
+{
+	unsigned char AC_Connector;
+	unsigned char AC_MainBreaker;
+	unsigned char SPD;
+	unsigned char Door_Open;
+	unsigned char GFD[2];
+	unsigned char AC_Drop;
+	unsigned char Emergency_IO;
+
+	unsigned char Emergency_Btn;
+	unsigned char Button[2];
+	unsigned char Key[4];
+}Gpio_in;
+
+Gpio_in gpio_in;
+
+enum CHARGING_MODE
+{
+	CHARGING_MODE_STOP = 			0x00,
+	CHARGING_MODE_START = 			0x01,
+	CHARGING_MODE_TERMINATING = 	0x10,
+};
+
+unsigned char _charging_mode = CHARGING_MODE_STOP;
+
+int tranceive(int fd, unsigned char* cmd, unsigned char cmd_len, unsigned char* rx)
+{
+	int len;
+	tcflush(fd,TCIOFLUSH);
+	if(write(fd, cmd, cmd_len) >= cmd_len)
+	{
+		usleep(50000);
+		len = read(fd, rx, 512);
+	}
+	else
+	{
+		#ifdef SystemLogMessage
+		DEBUG_ERROR("Serial command %s response fail.\n", cmd);
+		#endif
+	}
+
+	return len;
+}
+
+unsigned char Query_Gpio_Input(unsigned char fd, unsigned char targetAddr, Gpio_in *Ret_Buf)
+{
+	unsigned char result = FAIL;
+	unsigned char tx[7] = {0xaa, 0x00, targetAddr, 0x0a, 0x00, 0x00, 0x00};
+	unsigned char rx[512];
+	unsigned char chksum = 0x00;
+	unsigned char len = tranceive(fd, tx, sizeof(tx), rx);
+
+	if(len > 0)
+	{
+		for (int idx = 0; idx < (rx[4] | rx[5] << 8); idx++)
+		{
+			chksum ^= rx[6+idx];
+		}
+
+		if((chksum == rx[6+(rx[4] | rx[5]<<8)]) &&
+		   (rx[2] == tx[1]) &&
+		   (rx[1] == tx[2]) &&
+		   (rx[3] == tx[3]))
+		{
+			Ret_Buf->Button[0] 			= (rx[7] >> 1) & 0x01;
+			Ret_Buf->Button[1] 			= (rx[7] >> 2) & 0x01;
+
+			result = PASS;
+		}
+	}
+
+	return result;
+}
+
+void GetInputGpioStatus()
+{
+	if (Query_Gpio_Input(Uart1Fd, 0x04, &gpio_in) == PASS)
+	{
+		Button1 = gpio_in.Button[0];
+		Button2 = gpio_in.Button[1];
+	}
+}
+
+#endif /* OUTPUTTASK_H_ */

EVSE/Projects/DD360ComBox/Apps/PrimaryComm.c

@@ -0,0 +1,381 @@
+#include    <sys/time.h>
+#include    <sys/timeb.h>
+#include    <sys/types.h>
+#include    <sys/stat.h>
+#include    <sys/types.h>
+#include    <sys/ioctl.h>
+#include    <sys/socket.h>
+#include    <sys/ipc.h>
+#include    <sys/shm.h>
+#include    <sys/shm.h>
+#include    <sys/mman.h>
+#include    <linux/wireless.h>
+#include    <arpa/inet.h>
+#include    <netinet/in.h>
+
+#include    <unistd.h>
+#include    <stdarg.h>
+#include    <stdio.h>      /*標準輸入輸出定義*/
+#include    <stdlib.h>     /*標準函數庫定義*/
+#include    <unistd.h>     /*Unix 標準函數定義*/
+#include    <fcntl.h>      /*檔控制定義*/
+#include    <termios.h>    /*PPSIX 終端控制定義*/
+#include    <errno.h>      /*錯誤號定義*/
+#include    <errno.h>
+#include    <string.h>
+#include    <time.h>
+#include    <ctype.h>
+#include    <ifaddrs.h>
+#include    <math.h>
+#include    "PrimaryComm.h"
+
+#define PASS                1
+#define FAIL                -1
+
+struct Address Addr = {0x01, 0x02, 0x03, 0x04, 0xFF};
+struct Command Cmd = {0x01, 0x02, 0x0a, 0x2C, 0x83, 0x86, 0x87, 0xe0, 0xe1, 0xe2, 0xe3};
+
+int tranceive(int fd, unsigned char *cmd, unsigned char cmd_len, unsigned char *rx)
+{
+    int len;
+    //sleep(2); //required to make flush work, for some reason
+    tcflush(fd, TCIOFLUSH);
+    if (write(fd, cmd, cmd_len) >= cmd_len) {
+        usleep(50000);
+        len = read(fd, rx, 512);
+    } else {
+#ifdef SystemLogMessage
+        DEBUG_ERROR("Serial command %s response fail.\n", cmd);
+#endif
+    }
+
+    return len;
+}
+
+unsigned char Query_FW_Ver(unsigned char fd, unsigned char targetAddr, Ver *Ret_Buf)
+{
+    unsigned char result = FAIL;
+    unsigned char tx[7] = {0xaa, 0x00, targetAddr, Cmd.query_FW_Ver, 0x00, 0x00, 0x00};
+    unsigned char rx[512];
+    unsigned char chksum = 0x00;
+    unsigned char len = tranceive(fd, tx, sizeof(tx), rx);
+
+    if (len > 0) {
+        for (int idx = 0; idx < (rx[4] | rx[5] << 8); idx++) {
+            chksum ^= rx[6 + idx];
+        }
+
+        if ((chksum == rx[6 + (rx[4] | rx[5] << 8)]) &&
+                (rx[2] == tx[1]) &&
+                (rx[1] == tx[2]) &&
+                (rx[3] == tx[3])) {
+            memcpy(Ret_Buf->Version_FW, (char *)rx + 6, (rx[4] | rx[5] << 8));
+            *(Ret_Buf->Version_FW + 8) = 0x00;
+            result = PASS;
+        }
+    }
+
+    return result;
+}
+
+unsigned char Query_HW_Ver(unsigned char fd, unsigned char targetAddr, Ver *Ret_Buf)
+{
+    unsigned char result = FAIL;
+    unsigned char tx[7] = {0xaa, 0x00, targetAddr, Cmd.query_HW_Ver, 0x00, 0x00, 0x00};
+    unsigned char rx[512];
+    unsigned char chksum = 0x00;
+
+    if (tranceive(fd, tx, sizeof(tx), rx) > 0) {
+        for (int idx = 0; idx < (rx[4] | rx[5] << 8); idx++) {
+            chksum ^= rx[6 + idx];
+        }
+
+        if ((chksum == rx[6 + (rx[4] | rx[5] << 8)]) &&
+                (rx[2] == tx[1]) &&
+                (rx[1] == tx[2]) &&
+                (rx[3] == tx[3])) {
+            memcpy(Ret_Buf->Version_HW, (char *)rx + 6, (rx[4] | rx[5] << 8));
+            //*(Ret_Buf->Version_HW + 8) = 0x00;
+            result = PASS;
+        }
+    }
+
+    return result;
+}
+
+unsigned char Query_Gpio_Input(unsigned char fd, unsigned char targetAddr, Gpio_in *Ret_Buf)
+{
+    unsigned char result = FAIL;
+    unsigned char tx[7] = {0xaa, 0x00, targetAddr, Cmd.query_Gpio_In, 0x00, 0x00, 0x00};
+    unsigned char rx[512];
+    unsigned char chksum = 0x00;
+    unsigned char len = tranceive(fd, tx, sizeof(tx), rx);
+
+    if (len > 0) {
+        for (int idx = 0; idx < (rx[4] | rx[5] << 8); idx++) {
+            chksum ^= rx[6 + idx];
+        }
+
+        if ((chksum == rx[6 + (rx[4] | rx[5] << 8)]) &&
+                (rx[2] == tx[1]) &&
+                (rx[1] == tx[2]) &&
+                (rx[3] == tx[3])) {
+            Ret_Buf->AC_Connector       = (rx[6] >> 0) & 0x01;
+            Ret_Buf->AC_MainBreaker     = (rx[6] >> 1) & 0x01;
+            Ret_Buf->SPD                = (rx[6] >> 2) & 0x01;
+            Ret_Buf->Door_Open          = (rx[6] >> 3) & 0x01;
+            Ret_Buf->GFD[0]             = (rx[6] >> 4) & 0x01;
+            Ret_Buf->GFD[1]             = (rx[6] >> 5) & 0x01;
+            Ret_Buf->AC_Drop            = (rx[6] >> 6) & 0x01;
+            Ret_Buf->Emergency_IO       = (rx[6] >> 7) & 0x01;
+
+            Ret_Buf->Emergency_Btn      = (rx[7] >> 0) & 0x01;
+            Ret_Buf->Button[0]          = (rx[7] >> 1) & 0x01;
+            Ret_Buf->Button[1]          = (rx[7] >> 2) & 0x01;
+            Ret_Buf->Key[0]             = (rx[7] >> 3) & 0x01;
+            Ret_Buf->Key[1]             = (rx[7] >> 4) & 0x01;
+            Ret_Buf->Key[2]             = (rx[7] >> 5) & 0x01;
+            Ret_Buf->Key[3]             = (rx[7] >> 6) & 0x01;
+            result = PASS;
+        }
+    }
+
+    return result;
+}
+
+unsigned char Config_Gpio_Output(unsigned char fd, unsigned char targetAddr, Gpio_out *Set_Buf)
+{
+    unsigned char result = FAIL;
+    unsigned char tx[9] = {0xaa, 0x00, targetAddr, Cmd.config_Gpio_Output, 0x01, 0x00, 0x00, 0x00};
+    unsigned char rx[512];
+    unsigned char chksum = 0x00;
+
+    for (int idx = 0; idx < 2; idx++) {
+        tx[6] |= (Set_Buf->Button_LED[idx] ? 0x01 : 0x00) << (0 + idx);
+    }
+
+    for (int idx = 0; idx < 4; idx++) {
+        tx[6] |= (Set_Buf->System_LED[idx] ? 0x01 : 0x00) << (2 + idx);
+    }
+
+    tx[6] |= (Set_Buf->AC_Connector ? 0x01 : 0x00) << 6;
+    tx[6] |= (Set_Buf->AC_Breaker ? 0x01 : 0x00) << 7;
+
+    for (int idx = 0; idx < (tx[4] | tx[5] << 8); idx++) {
+        chksum ^= tx[6 + idx];
+    }
+    tx[7] = chksum;
+
+    if (tranceive(fd, tx, sizeof(tx), rx) > 0) {
+        chksum = 0x00;
+        for (int idx = 0; idx < (rx[4] | rx[5] << 8); idx++) {
+            chksum ^= rx[6 + idx];
+        }
+
+        if ((chksum == rx[6 + (rx[4] | rx[5] << 8)]) &&
+                (rx[2] == tx[1]) &&
+                (rx[1] == tx[2]) &&
+                (rx[3] == tx[3]) &&
+                (rx[6] == tx[6])) {
+            result = PASS;
+        }
+    }
+
+    return result;
+}
+
+unsigned char Config_Rtc_Data(unsigned char fd, unsigned char targetAddr, Rtc *Set_Buf)
+{
+    unsigned char result = FAIL;
+    unsigned char tx[21] = { 0xaa, 0x00, targetAddr, Cmd.config_Rtc_Data, 0x0E, 0x00, Set_Buf->RtcData[0], Set_Buf->RtcData[1],
+                             Set_Buf->RtcData[2], Set_Buf->RtcData[3], Set_Buf->RtcData[4], Set_Buf->RtcData[5], Set_Buf->RtcData[6], Set_Buf->RtcData[7],
+                             Set_Buf->RtcData[8], Set_Buf->RtcData[9], Set_Buf->RtcData[10], Set_Buf->RtcData[11], Set_Buf->RtcData[12], Set_Buf->RtcData[13]
+                           };
+    unsigned char rx[512];
+    unsigned char chksum = 0x00;
+
+    for (int idx = 0; idx < (tx[4] | tx[5] << 8); idx++) {
+        chksum ^= tx[6 + idx];
+    }
+    tx[20] = chksum;
+
+    if (tranceive(fd, tx, sizeof(tx), rx) > 0) {
+        chksum = 0x00;
+        for (int idx = 0; idx < (rx[4] | rx[5] << 8); idx++) {
+            chksum ^= rx[6 + idx];
+        }
+
+        if ((chksum == rx[6 + (rx[4] | rx[5] << 8)]) &&
+                (rx[2] == tx[1]) &&
+                (rx[1] == tx[2]) &&
+                (rx[3] == tx[3]) &&
+                (rx[6] == tx[6])) {
+            result = PASS;
+        }
+    }
+
+    return result;
+}
+
+unsigned char Config_Model_Name(unsigned char fd, unsigned char targetAddr, unsigned char *modelname)
+{
+    unsigned char result = FAIL;
+    unsigned char tx[21] = {0xaa, 0x00, targetAddr, Cmd.config_Model_Name, 0x0E, 0x00,
+                            0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00
+                           };
+    unsigned char rx[512];
+    unsigned char chksum = 0x00;
+
+    memcpy(tx + 6, modelname, 14);
+
+    for (int idx = 0; idx < (tx[4] | tx[5] << 8); idx++) {
+        chksum ^= tx[6 + idx];
+    }
+    tx[20] = chksum;
+
+//  for(int i = 0; i < 21; i++)
+//              printf ("tx = %x \n", tx[i]);
+    unsigned char len = tranceive(fd, tx, sizeof(tx), rx);
+//  for(int i = 0; i < len; i++)
+//                  printf ("rx = %x \n", rx[i]);
+    if (len > 6) {
+        if (len < 6 + (rx[4] | rx[5] << 8)) {
+            return result;
+        }
+
+        chksum = 0x00;
+        for (int idx = 0; idx < (rx[4] | rx[5] << 8); idx++) {
+            chksum ^= rx[6 + idx];
+        }
+
+        if ((chksum == rx[6 + (rx[4] | rx[5] << 8)]) &&
+                (rx[2] == tx[1]) &&
+                (rx[1] == tx[2]) &&
+                (rx[3] == tx[3]) &&
+                rx[6] == PASS) {
+            result = PASS;
+        }
+    }
+
+    return result;
+}
+unsigned char Update_Start(unsigned char fd, unsigned char targetAddr, unsigned int crc32)
+{
+    unsigned char result = FAIL;
+    unsigned char tx[11] = {0xaa, 0x00, targetAddr, Cmd.update_Start, 0x04, 0x00, (crc32 >> 0) & 0xff, (crc32 >> 8) & 0xff, (crc32 >> 16) & 0xff, (crc32 >> 24) & 0xff, 0x00};
+    unsigned char rx[512];
+    unsigned char chksum = 0x00;
+
+    for (int idx = 0; idx < (tx[4] | tx[5] << 8); idx++) {
+        chksum ^= tx[6 + idx];
+    }
+    tx[10] = chksum;
+
+
+    if (tranceive(fd, tx, sizeof(tx), rx) > 0) {
+        chksum = 0x00;
+        for (int idx = 0; idx < (rx[4] | rx[5] << 8); idx++) {
+            chksum ^= rx[6 + idx];
+        }
+
+        if ((chksum == rx[6 + (rx[4] | rx[5] << 8)]) &&
+                (rx[2] == tx[1]) &&
+                (rx[1] == tx[2]) &&
+                (rx[3] == tx[3]) &&
+                (rx[6] == 0x00)) {
+            result = PASS;
+        }
+    }
+
+    return result;
+}
+
+unsigned char Update_Abord(unsigned char fd, unsigned char targetAddr)
+{
+    unsigned char result = FAIL;
+    unsigned char tx[7] = {0xaa, 0x00, targetAddr, Cmd.update_Start, 0x04, 0x00, 0x00};
+    unsigned char rx[512];
+    unsigned char chksum = 0x00;
+
+    if (tranceive(fd, tx, sizeof(tx), rx) > 0) {
+        for (int idx = 0; idx < (rx[4] | rx[5] << 8); idx++) {
+            chksum ^= rx[6 + idx];
+        }
+
+        if ((chksum == rx[6 + (rx[4] | rx[5] << 8)]) &&
+                (rx[2] == tx[1]) &&
+                (rx[1] == tx[2]) &&
+                (rx[3] == tx[3]) &&
+                (rx[6] == 0x00)) {
+            result = PASS;
+        }
+    }
+
+    return result;
+}
+
+unsigned char Update_Transfer(unsigned char fd, unsigned char targetAddr, unsigned int startAddr, unsigned char *data, unsigned short int length)
+{
+    unsigned char result = FAIL;
+    unsigned char tx[11 + length];
+    unsigned char rx[512];
+    unsigned char chksum = 0x00;
+
+    tx[0] = 0xaa;
+    tx[1] = 0x00;
+    tx[2] = targetAddr;
+    tx[3] = Cmd.update_Transfer;
+    tx[4] = (4 + length) & 0xff;
+    tx[5] = ((4 + length) >> 8) & 0xff;
+    tx[6] = (startAddr >> 0) & 0xff;
+    tx[7] = (startAddr >> 8) & 0xff;
+    tx[8] = (startAddr >> 16) & 0xff;
+    tx[9] = (startAddr >> 24) & 0xff;
+    memcpy(tx + 10, data, length);
+
+    for (int idx = 0; idx < (tx[4] | tx[5] << 8); idx++) {
+        chksum ^= tx[6 + idx];
+    }
+    tx[sizeof(tx) - 1] = chksum;
+
+    if (tranceive(fd, tx, sizeof(tx), rx) > 0) {
+        for (int idx = 0; idx < (rx[4] | rx[5] << 8); idx++) {
+            chksum ^= rx[6 + idx];
+        }
+
+        if ((chksum == rx[6 + (rx[4] | rx[5] << 8)]) &&
+                (rx[2] == tx[1]) &&
+                (rx[1] == tx[2]) &&
+                (rx[3] == tx[3]) &&
+                (rx[6] == 0x00)) {
+            result = PASS;
+        }
+    }
+
+    return result;
+}
+
+unsigned char Update_Finish(unsigned char fd, unsigned char targetAddr)
+{
+    unsigned char result = FAIL;
+    unsigned char tx[7] = {0xaa, 0x00, targetAddr, Cmd.update_Finish, 0x04, 0x00, 0x00};
+    unsigned char rx[512];
+    unsigned char chksum = 0x00;
+
+    if (tranceive(fd, tx, sizeof(tx), rx) > 0) {
+        for (int idx = 0; idx < (rx[4] | rx[5] << 8); idx++) {
+            chksum ^= rx[6 + idx];
+        }
+
+        if ((chksum == rx[6 + (rx[4] | rx[5] << 8)]) &&
+                (rx[2] == tx[1]) &&
+                (rx[1] == tx[2]) &&
+                (rx[3] == tx[3]) &&
+                (rx[6] == 0x00)) {
+            result = PASS;
+        }
+    }
+
+    return result;
+}
+

EVSE/Projects/DD360ComBox/Apps/PrimaryComm.h

@@ -0,0 +1,76 @@
+#ifndef PRIMARYCOMM_H_
+#define PRIMARYCOMM_H_
+
+extern struct Address {
+    unsigned char Aux;
+    unsigned char Fan;
+    unsigned char Relay;
+    unsigned char IoExtend;
+    unsigned char Broadcast;
+} Addr;
+
+extern struct Command {
+    unsigned char query_FW_Ver;         //0x01
+    unsigned char query_HW_Ver;     //0x02
+    unsigned char query_Gpio_In;        //0x0a
+    unsigned char query_charging_power; // 0x2C
+
+    unsigned char config_Model_Name;            //0x83
+    unsigned char config_Gpio_Output;   //0x86
+    unsigned char config_Rtc_Data;      //0x87
+
+    unsigned char update_Start;     //0xe0
+    unsigned char update_Abort;     //0xe1
+    unsigned char update_Transfer;      //0xe2
+    unsigned char update_Finish;        //0xe3
+
+} Cmd;
+
+typedef struct Verion {
+    char Version_FW[16];
+    char Version_HW[16];
+} Ver;
+
+typedef struct GPIO_IN {
+    unsigned char AC_Connector;
+    unsigned char AC_MainBreaker;
+    unsigned char SPD;
+    unsigned char Door_Open;
+    unsigned char GFD[2];
+    unsigned char AC_Drop;
+    unsigned char Emergency_IO;
+
+    unsigned char Emergency_Btn;
+    unsigned char Button[2];
+    unsigned char Key[4];
+} Gpio_in;
+
+typedef struct GPIO_OUT {
+    unsigned char Button_LED[2];
+    unsigned char System_LED[4];
+    unsigned char AC_Connector;
+    unsigned char AC_Breaker;
+} Gpio_out;
+
+typedef struct RTC {
+    unsigned char RtcData[14];
+} Rtc;
+
+extern unsigned char Query_FW_Ver(unsigned char fd, unsigned char targetAddr, Ver *Ret_Buf);
+extern unsigned char Query_HW_Ver(unsigned char fd, unsigned char targetAddr, Ver *Ret_Buf);
+extern unsigned char Query_Gpio_Input(unsigned char fd, unsigned char targetAddr, Gpio_in *Ret_Buf);
+
+extern unsigned char Config_Gpio_Output(unsigned char fd, unsigned char targetAddr, Gpio_out *Set_Buf);
+extern unsigned char Config_Rtc_Data(unsigned char fd, unsigned char targetAddr, Rtc *Set_Buf);
+unsigned char Config_Model_Name(unsigned char fd, unsigned char targetAddr, unsigned char *modelname);
+// 13 bytes
+// year : 4, month : 2, day : 2, hour : 2, min : 2, sec : 2
+//extern unsigned char Config_RTC();
+
+extern unsigned char Update_Start(unsigned char fd, unsigned char targetAddr, unsigned int crc32);
+extern unsigned char Update_Abord(unsigned char fd, unsigned char targetAddr);
+extern unsigned char Update_Transfer(unsigned char fd, unsigned char targetAddr, unsigned int startAddr, unsigned char *data, unsigned short int length);
+extern unsigned char Update_Finish(unsigned char fd, unsigned char targetAddr);
+
+
+#endif /* PRIMARYCOMM_H_ */

EVSE/Projects/DD360ComBox/Apps/ReDoComm.c

@@ -0,0 +1,2210 @@
+#include <stdio.h>
+#include <stdlib.h>
+#include <stdint.h>
+#include <stdarg.h>
+#include <string.h>
+#include <stdbool.h>
+
+#include <sys/time.h>
+#include <sys/timeb.h>
+#include <sys/socket.h>
+#include <sys/types.h>
+#include <sys/ipc.h>
+#include <sys/shm.h>
+
+#include <arpa/inet.h>
+#include <netinet/in.h>
+
+#include <assert.h>
+#include <time.h>
+#include <errno.h>
+#include <unistd.h>
+#include <signal.h>
+
+#include "../../define.h"
+#include "Config.h"
+#include "ReDoComm.h"
+#include "AudiCust.h"
+#include "timeout.h"
+
+//------------------------------------------------------------------------------
+#define DEBUG_INFO(format, args...) StoreLogMsg("[%s:%d][%s][Info] "format, __FILE__, __LINE__, __FUNCTION__, ##args)
+#define DEBUG_WARN(format, args...) StoreLogMsg("[%s:%d][%s][Warn] "format, __FILE__, __LINE__, __FUNCTION__, ##args)
+#define DEBUG_ERROR(format, args...) StoreLogMsg("[%s:%d][%s][Error] "format, __FILE__, __LINE__, __FUNCTION__, ##args)
+
+//------------------------------------------------------------------------------
+//static int TcpSock = 0;
+//static uint8_t PacketSe;
+static DoCommGblData gDoCommGblData = {0};
+
+static struct SysConfigAndInfo  *ShmSysConfigAndInfo;
+static struct StatusCodeData    *ShmStatusCodeData;
+static struct PsuData           *ShmPsuData;
+static struct OCPP16Data        *ShmOCPP16Data;
+static struct PrimaryMcuData    *ShmPrimaryMcuData;
+static struct ChargingInfoData  *ChargingData[CHAdeMO_QUANTITY + CCS_QUANTITY + GB_QUANTITY];
+static struct timeb             gRegTimeUp[2][MAX_REGISTER_NUM] = {0};
+static struct WARNING_CODE_INFO gPreSysWarningInfo = {0};
+static AudiCustInfo             *gAudiCustInfo = NULL;
+
+//------------------------------------------------------------------------------
+static void removeFaultCodeToBuf(uint8_t *Code);
+static void addFaultCodeToBuf(uint8_t *Code);
+static int readMiscCommand(int fd, uint8_t id);
+static int writeCsuModuleVersion(int fd);
+
+//------------------------------------------------------------------------------
+//--- Common function ---
+//------------------------------------------------------------------------------
+static int StoreLogMsg(const char *fmt, ...)
+{
+    char Buf[4096 + 256];
+    char buffer[4096];
+    va_list args;
+    struct timeb  SeqEndTime;
+    struct tm *tm;
+
+    va_start(args, fmt);
+    int rc = vsnprintf(buffer, sizeof(buffer), fmt, args);
+    va_end(args);
+
+    memset(Buf, 0, sizeof(Buf));
+    ftime(&SeqEndTime);
+    SeqEndTime.time = time(NULL);
+    tm = localtime(&SeqEndTime.time);
+
+    if (ShmSysConfigAndInfo->SysConfig.SwitchDebugFlag == 1) {
+        sprintf(Buf, "%02d:%02d:%02d:%03d - %s",
+                tm->tm_hour, tm->tm_min, tm->tm_sec, SeqEndTime.millitm, buffer);
+        printf("%s \n", Buf);
+    } else {
+        sprintf(Buf, "echo \"%04d-%02d-%02d %02d:%02d:%02d:%03d - %s\" >> /Storage/SystemLog/[%04d.%02d]SystemLog",
+                tm->tm_year + 1900, tm->tm_mon + 1, tm->tm_mday, tm->tm_hour, tm->tm_min, tm->tm_sec, SeqEndTime.millitm,
+                buffer,
+                tm->tm_year + 1900, tm->tm_mon + 1);
+        system(Buf);
+    }
+
+    return rc;
+}
+
+static int DiffTimeb(struct timeb ST, struct timeb ET)
+{
+    //return milli-second
+    unsigned int StartTime, StopTime;
+
+    StartTime = (unsigned int)ST.time;
+    StopTime = (unsigned int)ET.time;
+
+    return (StopTime - StartTime) * 1000 + ET.millitm - ST.millitm;
+}
+
+/**
+ * [hexdump : check data]
+ * @Author   Jerry
+ * @DateTime 2018-12-21
+ * @param    p          [description]
+ * @param    size       [description]
+ */
+static void Hexdump(const void *p, size_t size)
+{
+    const uint8_t *c = p;
+    char message[10240] = {0};
+    uint32_t i = 0;
+    uint32_t message_len = 0;
+
+    assert(p);
+
+    //printf("Dumping %u bytes from %p:\r\n", size, p);
+    message_len += sprintf(&message[message_len], "\r\nDumping %u bytes from %p:\r\n",  (unsigned int)size, p);
+
+    while (size > 0) {
+        for (i = 0; i < 16; i++) {
+            if (i < size) {
+                //printf("%02x ", c[i]);
+                message_len += sprintf(&message[message_len], "%02x ", c[i]);
+            } else {
+                //printf("   ");
+                message_len += sprintf(&message[message_len], "   ");
+            }
+        }
+
+        for (i = 0; i < 16; i++) {
+            if (i < size) {
+                //printf("%c", c[i] >= 32 && c[i] < 127 ? c[i] : '.');
+                message_len += sprintf(&message[message_len], "%c", c[i] >= 32 && c[i] < 127 ? c[i] : '.');
+            } else {
+                //printf(" ");
+                message_len += sprintf(&message[message_len], " ");
+            }
+        }
+
+        //printf("\n");
+        message_len += sprintf(&message[message_len], "\r\n");
+        c += 16;
+
+        if (size <= 16) {
+            break;
+        }
+
+        size -= 16;
+    }
+
+    message_len += sprintf(&message[message_len], "\r\n");
+
+    DEBUG_INFO("%s", message);
+}
+
+static int string2ByteArray(char *input, byte *output)
+{
+    int loop = 0;
+    int i = 0;
+
+    while (input[loop] != '\0') {
+        output[i++] = input[loop++];
+    }
+    output[loop] = '\0';
+
+    return loop + 1;
+}
+
+static void unixSocketSigPipeHandle(int sig)
+{
+    DEBUG_ERROR("socket packet error %x\r\n", sig);
+}
+
+static void InitSocketSigPipe(void)
+{
+    struct sigaction action;
+
+    action.sa_handler = unixSocketSigPipeHandle;
+    sigemptyset(&action.sa_mask);
+    action.sa_flags = 0;
+    sigaction(SIGPIPE, &action, NULL);
+}
+
+//------------------------------------------------------------------------------
+static void setTcpStatus(uint8_t setValue)
+{
+    ShmStatusCodeData->AlarmCode.AlarmEvents.bits.DisconnectedFromDo = setValue;
+}
+
+//------------------------------------------------------------------------------
+//--- TCP socket function ---
+//------------------------------------------------------------------------------
+static int sendTcpSocket(int fd, uint8_t *data, uint16_t dataLen)
+{
+    int size = -1;
+
+    size = send(fd, data, dataLen , 0);
+    if ((size < 0) || (errno == EAGAIN)) {
+        if (size < 0) {
+            DEBUG_ERROR("Size = %d, EAGAIN error %d:%s\r\n", size, errno, strerror(errno));
+        }
+    }
+
+    return size;
+}
+
+static int recvTcpSocket(int fd, uint8_t *data, uint16_t dataLen)
+{
+    int size = -1;
+    uint8_t *pdata = (uint8_t *)data;
+
+    size = recv(fd, pdata, dataLen, MSG_WAITALL);
+    if ((errno == EAGAIN) || (size < 0)) {
+        DEBUG_ERROR("Size = %d, EAGAIN error %d:%s\r\n", size, errno, strerror(errno));
+    }
+
+    return size;
+}
+
+static int getSO_ERROR(int fd)
+{
+    int err = 1;
+    socklen_t len = sizeof err;
+
+    if (-1 == getsockopt(fd, SOL_SOCKET, SO_ERROR, (char *)&err, &len)) {
+        DEBUG_ERROR("getSO_ERROR\r\n");
+    }
+
+    if (err) {
+        errno = err;        // set errno to the socket SO_ERROR
+    }
+
+    return err;
+}
+
+static void closeSocket(int fd)        // *not* the Windows closesocket()
+{
+    if (fd < 0) {
+        return;
+    }
+
+    getSO_ERROR(fd); // first clear any errors, which can cause close to fail
+    if (shutdown(fd, SHUT_RDWR) < 0) { // secondly, terminate the 'reliable' delivery
+        if (errno != ENOTCONN && errno != EINVAL) { // SGI causes EINVAL
+            DEBUG_INFO("shutdown\r\n");
+        }
+    }
+
+    if (close(fd) < 0) { // finally call close()
+        DEBUG_INFO("client socket close\r\n");
+    }
+}
+
+static int doCommConnToServer(void)
+{
+    struct sockaddr_in dest;
+    struct timeval tv;
+    int flag;
+    int TcpSock = 0;
+
+    //if (TcpSock > 0) {
+    //    close(TcpSock);
+    //}
+
+    if ((TcpSock = socket(AF_INET, SOCK_STREAM, 0)) < 0) {
+        DEBUG_ERROR("Open TCP socket NG");
+        return -1;
+    }
+
+    //flag = fcntl (TcpSock, F_GETFL, 0);
+    //if (flag >= 0) {
+    //    flag |= O_NONBLOCK;
+    //    fcntl(TcpSock, F_SETFL, flag );
+    //}
+
+    tv.tv_sec = 0;
+    tv.tv_usec = 100000;
+    setsockopt(TcpSock, SOL_SOCKET,  SO_RCVTIMEO, &tv, sizeof(struct timeval));
+    setsockopt(TcpSock, SOL_SOCKET, SO_SNDTIMEO, &tv, sizeof(struct timeval));
+    flag = 1;
+    setsockopt(TcpSock, SOL_SOCKET, MSG_NOSIGNAL, &flag, sizeof(flag));
+
+    memset(&dest, 0, sizeof(dest));
+    dest.sin_family = AF_INET;
+    dest.sin_port = htons(DoTcpPort);
+    inet_aton(DoIPAddress, (struct in_addr *) &dest.sin_addr.s_addr);
+
+    if (connect(TcpSock, (struct sockaddr *) &dest, sizeof(dest)) != 0) {
+        close(TcpSock);
+        return -1;
+    }
+
+    return TcpSock;
+}
+
+//------------------------------------------------------------------------------
+//--- Audi select gun ---
+//------------------------------------------------------------------------------
+static void clearPricesInfo(uint8_t id)
+{
+    memset(&gAudiCustInfo->PricesInfo[id], 0, sizeof(PricesInfo));
+    gAudiCustInfo->PricesInfo[id].Balance = FAIL_BALANCE_PRICES;
+}
+
+static void ClearAuthorizedFlag(void)
+{
+    ShmOCPP16Data->SpMsg.bits.AuthorizeConf = NO;
+    ShmSysConfigAndInfo->SysInfo.AuthorizeFlag = NO;
+}
+
+static void ClearDetectPluginFlag(void)
+{
+    ShmSysConfigAndInfo->SysInfo.WaitForPlugit = NO;
+}
+
+static bool isDetectPlugin(void)
+{
+    if (ShmSysConfigAndInfo->SysInfo.WaitForPlugit == YES) {
+        return YES;
+    }
+
+    return NO;
+}
+
+static void destroySelectGun(uint8_t curGun)
+{
+    uint8_t i = 0;
+    uint8_t totalGun = ShmSysConfigAndInfo->SysConfig.TotalConnectorCount;
+
+    if (curGun == DESTROY_ALL_SEL) {
+        gAudiCustInfo->SelGunInfo.RightGun = SEL_GUN_RELEASE;
+        gAudiCustInfo->SelGunInfo.LeftGun = SEL_GUN_RELEASE;
+
+        for (i = 0; i < totalGun; i++) {
+            ChargingData[i]->TimeoutFlag = Timeout_None;
+            clearPricesInfo(i);
+        }
+        ShmSysConfigAndInfo->SysInfo.CurGunSelected = 0;
+        strcpy((char *)ShmSysConfigAndInfo->SysConfig.UserId, "");
+    }
+
+    //for charging timeout or complete
+    if ((curGun == LEFT_GUN_NUM) && (gAudiCustInfo->SelGunInfo.LeftGun != SEL_GUN_RELEASE)) {
+        gAudiCustInfo->SelGunInfo.LeftGun = SEL_GUN_RELEASE;
+        if (ShmOCPP16Data->SpMsg.bits.AuthorizeConf != NO) {
+            ClearAuthorizedFlag();
+        }
+        clearPricesInfo(curGun);
+    }
+
+    if ((curGun == RIGHT_GUN_NUM) && (gAudiCustInfo->SelGunInfo.RightGun != SEL_GUN_RELEASE)) {
+        if (ShmOCPP16Data->SpMsg.bits.AuthorizeConf != NO) {
+            ClearAuthorizedFlag();
+        }
+
+        clearPricesInfo(curGun);
+    }
+}
+
+static int getConfirmSelectedGun(uint8_t curSel)
+{
+    if (((curSel == LEFT_GUN_NUM) && (gAudiCustInfo->SelGunInfo.LeftGun >= SEL_GUN_CONFIRM)) ||
+            ((curSel == RIGHT_GUN_NUM) && (gAudiCustInfo->SelGunInfo.RightGun >= SEL_GUN_CONFIRM))) {
+        return PASS;
+    }
+
+    return FAIL;
+}
+
+static int getSelGunWaitToAuthor(uint8_t curGun)
+{
+    if (curGun == LEFT_GUN_NUM && gAudiCustInfo->SelGunInfo.LeftGun == SEL_GUN_ATHOR) {
+        return FAIL;
+    }
+
+    if (curGun == RIGHT_GUN_NUM && gAudiCustInfo->SelGunInfo.RightGun == SEL_GUN_ATHOR) {
+        return FAIL;
+    }
+
+    return PASS;
+}
+
+static void setConfirmSelGun(uint8_t selGun)
+{
+    if (selGun == LEFT_GUN_NUM && gAudiCustInfo->SelGunInfo.LeftGun == SEL_GUN_RELEASE) {
+        gAudiCustInfo->SelGunInfo.LeftGun = SEL_GUN_CONFIRM;
+        //printf("confirmSelGun left\r\n");
+    } else if (selGun == RIGHT_GUN_NUM && gAudiCustInfo->SelGunInfo.RightGun == SEL_GUN_RELEASE) {
+        gAudiCustInfo->SelGunInfo.RightGun = SEL_GUN_CONFIRM;
+        //printf("confirmSelGun right\r\n");
+    }
+}
+
+//------------------------------------------------------------------------------
+//--- DoComm function ---
+//------------------------------------------------------------------------------
+static int compareOpcode(uint8_t opCode)
+{
+    if (opCode != OP_WAIT_RESPONSE) {
+        //DEBUG_ERROR("response operative code fail\r\n");
+        return FAIL;
+    }
+
+    return PASS;
+}
+
+static int compareResult(uint8_t result)
+{
+    if (result != COMMAND_RESULT_OK) {
+        //DEBUG_ERROR("response result fail\r\n");
+        return FAIL;
+    }
+
+    return PASS;
+}
+
+static int compareRegister(uint8_t srcReg, uint8_t destReg)
+{
+    if (srcReg != destReg) {
+        //DEBUG_ERROR("response register fail\r\n");
+        return FAIL;
+    }
+
+    return PASS;
+}
+
+static float transPricesUnit(int prices)
+{
+    //printf("prices = %.2f\r\n", prices * PRICES_UNIT);
+    return (prices * PRICES_UNIT);
+}
+
+static void clearMiscCommand(void)
+{
+    gDoCommGblData.MiscCmd = 0;
+}
+
+static int qrCodeUrlInfoHandle(uint8_t *data)
+{
+    int len = 0;
+    //char cmdBuf[128] = {0};
+    char localTime[128] = {0};
+    uint16_t timeLen = 0;
+    struct timeb SeqEndTime;
+    struct tm *tm;
+
+    if ((char *)&data[0] == '\0') {
+        DEBUG_ERROR("QR code date error\r\n");
+        return FAIL;
+    }
+
+    //get local system time
+    ftime(&SeqEndTime);
+    SeqEndTime.time = time(NULL);
+    tm = localtime(&SeqEndTime.time);
+    timeLen = sprintf(localTime, "%04d-%02d-%02d %02d:%02d",
+                      tm->tm_year + 1900,
+                      tm->tm_mon + 1,
+                      tm->tm_mday,
+                      tm->tm_hour,
+                      tm->tm_min);
+
+    //copy QR code string
+    if (strncmp((char *)localTime, (char *)&data[0], timeLen - 2) != 0) {
+        memset(ShmSysConfigAndInfo->SysConfig.SystemId, '\0', sizeof(ShmSysConfigAndInfo->SysConfig.SystemId));
+        //printf("data =  %s\r\n", data);
+        len = string2ByteArray((char *)data, (uint8_t *)ShmSysConfigAndInfo->SysConfig.SystemId);
+        //printf("SystemId =  %s\r\n", ShmSysConfigAndInfo->SysConfig.SystemId);
+    }
+
+    //if ((char *)&data[len] == '\0') {
+    //    DEBUG_ERROR("power cabinet system date error\r\n");
+    //    return FAIL;
+    //}
+
+    //set system date
+    //if (strncmp((char *)localTime, (char *)&data[len], timeLen) != 0) {
+    //    sprintf(cmdBuf, "date -s \"%s\" >> /dev/null", (char *)&data[len]);
+    //    system(cmdBuf);
+    //    DEBUG_INFO("local time = %s, data time = %s\r\n", localTime, (char *)&data[len]);
+    //    ShmOCPP16Data->MsMsg.bits.ResetReq = YES;
+    //    strcpy((char *)ShmOCPP16Data->Reset.Type, "Soft");
+    //    sleep(3);
+    //    //gDoCommGblData.DisConnCount = CHECK_NETWORK_FAIL_COUNT;
+    //}
+
+    return PASS;
+}
+
+static int updateFirmwareHandle(uint8_t *imgName)
+{
+    int ret = PASS;
+    char cmdBuf[1024] = {0};
+
+    sprintf(cmdBuf, "/mnt/%s", imgName);
+    DEBUG_INFO("Program ready to check file %s\n", cmdBuf);
+    if ( access(cmdBuf, F_OK) != -1) {
+        DEBUG_INFO("File '%s' exist.\n", cmdBuf);
+        ShmSysConfigAndInfo->SysInfo.FirmwareUpdate = YES;
+    } else {
+        DEBUG_INFO("File '%s' doesn't exist.\n", cmdBuf);
+        ret = FAIL;
+    }
+
+#if 0
+    char cmdBuf[1024] = {0};
+    int status = 0;
+
+    system("touch ./tftpUpdate.sh"); //創建shell
+    sprintf(cmdBuf, "echo tftp -gr %s -l %s/%s %s; > ./tftpUpdate.sh",
+            imgName,
+            IMAGE_FILE_PATH,
+            imgName,
+            DoIPAddress);
+    system("chmod +x ./tftpUpdate.sh"); //修改權限
+
+    status = system("sh tftpUpdate.sh"); //執行shell
+    if (-1 == status) {
+        printf("system error!");
+    } else {
+        printf("exit status value = [0x%x]\n", status);
+
+        if (WIFEXITED(status)) {
+            if (0 == WEXITSTATUS(status)) {
+                printf("run shell script successfully.\n");
+                ShmSysConfigAndInfo->SysInfo.FirmwareUpdate = YES;
+            } else {
+                printf("run shell script fail, script exit code: %d\n", WEXITSTATUS(status));
+            }
+        } else {
+            printf("exit status = [%d]\n", WEXITSTATUS(status));
+        }
+    }
+
+    system("rm -rf ./tftpUpdate.sh"); //刪除shell
+#endif //0
+
+    return ret;
+}
+
+static int miscCommandHandle(uint8_t dataLen, uint8_t plugNum, uint8_t *data)
+{
+    int ret = PASS;
+    uint8_t i = 0, j = 0;
+    uint8_t cmdCount = (dataLen / 6);
+    uint16_t cmd = 0;
+    uint32_t value = 0;
+    float prices = 0;
+    MiscCommand *pMiscCmd = NULL;
+
+    if (cmdCount < 1) {
+        gDoCommGblData.MiscCmd = 0;
+        //printf("cmdCount fail = %d, data len = %d\r\n", cmdCount, dataLen);
+        return FAIL;
+    }
+
+    for (i = 0; i < cmdCount; i++) {
+        pMiscCmd = (MiscCommand *)data + i;
+        cmd = ntohs(pMiscCmd->CMD);
+        value = ntohl(*((uint32_t *)&pMiscCmd->Value[0]));
+        //DEBUG_INFO("misc command = %x, value = %d\r\n", cmd, value);
+
+        switch (cmd) {
+        //--- Execute parameter ---
+        case MISC_CMD_CONNECOTOR_TIMEOUT:
+            gAudiCustInfo->RemoteSetup.ConnectionTimeout = value;
+            DEBUG_INFO("connection timeout = %d\r\n", gAudiCustInfo->RemoteSetup.ConnectionTimeout);
+            clearMiscCommand();
+            break;
+
+        case MISC_CMD_OPERATIVE_STATE:
+            if ((value > YES) || (value < NO)) {
+                if (plugNum == 1) {
+                    clearMiscCommand();
+                }
+                break;
+            }
+
+            DEBUG_INFO("change availability plugNum = %d, value = %d\r\n", plugNum, value);
+            ShmOCPP16Data->CsMsg.bits[plugNum].ChangeAvailabilityReq = YES;
+            if (value == YES) {
+                strcpy((char *)ShmOCPP16Data->ChangeAvailability[plugNum].Type, "Operative");
+            } else if (value == NO) {
+                strcpy((char *)ShmOCPP16Data->ChangeAvailability[plugNum].Type, "Inoperative");
+            }
+
+            if (plugNum == 1) {
+                clearMiscCommand();
+            }
+            break;
+
+        case MISC_CMD_DEFAULT_PRICES:
+            prices = transPricesUnit((int)value);
+            DEBUG_INFO("default prices = %.2f\r\n", prices);
+
+            ShmSysConfigAndInfo->SysConfig.BillingData.isBilling = YES;
+            for (j = 0; j < 24; j++) {
+                ShmSysConfigAndInfo->SysConfig.BillingData.Fee[j] = prices;
+            }
+
+            clearMiscCommand();
+            break;
+
+        case MISC_CMD_DEFAULT_CURRENCY:
+            if (value < 0) {
+                clearMiscCommand();
+                return FAIL;
+            }
+
+            DEBUG_INFO("default currency = %s%c\r\n", (uint8_t *)Currency[value]);
+            ShmSysConfigAndInfo->SysConfig.BillingData.Currency = value;
+            clearMiscCommand();
+            break;
+
+        case MISC_CMD_ACCOUNT_BALANCE:
+            if (ShmSysConfigAndInfo->SysInfo.CurGunSelected != (plugNum)) {
+                clearMiscCommand();
+                break;
+            }
+
+#if defined DD360Audi
+            if (getConfirmSelectedGun(plugNum) == FAIL) {
+                DEBUG_INFO("Remote start not select gun\r\n");
+                break;
+            }
+#endif //DD360Audi
+
+            gAudiCustInfo->PricesInfo[plugNum].Balance = transPricesUnit((int)value);
+            DEBUG_INFO("%d misc balance = %.2f\r\n", plugNum, gAudiCustInfo->PricesInfo[plugNum].Balance);
+            clearMiscCommand();
+            break;
+
+        case MISC_CMD_BACKEND_STATUS :
+            gAudiCustInfo->EthDevStatus.Backend = value;
+            break;
+
+        case MISC_CMD_ETHERNET_STATUS :
+            gAudiCustInfo->EthDevStatus.Ethernet = value;
+            break;
+
+        case MISC_CMD_WIFI_STATUS :
+            gAudiCustInfo->EthDevStatus.Wifi = value;
+            break;
+
+        case MISC_CMD_4G_STATUS :
+            gAudiCustInfo->EthDevStatus.FourG = value;
+            break;
+
+        //--- Control Dispenser ---
+        case MISC_CMD_HARDWARE_REBOOT:
+            if (value != YES) {
+                clearMiscCommand();
+                break;
+            }
+
+            DEBUG_INFO("Hardware reboot\r\n");
+            ShmOCPP16Data->MsMsg.bits.ResetReq = YES;
+            strcpy((char *)ShmOCPP16Data->Reset.Type, "Hard");
+            clearMiscCommand();
+            break;
+
+        case MISC_CMD_SOFTWARE_RESTART:
+            if (value != YES) {
+                clearMiscCommand();
+                break;
+            }
+
+            clearMiscCommand();
+            DEBUG_INFO("Software reboot\r\n");
+            ShmOCPP16Data->MsMsg.bits.ResetReq = YES;
+            strcpy((char *)ShmOCPP16Data->Reset.Type, "Soft");
+            break;
+
+        case MISC_CMD_REMOTE_START_CHARGING:
+            if (value != YES) {
+                if (plugNum == 1) {
+                    clearMiscCommand();
+                }
+                break;
+            }
+            DEBUG_INFO("Remote start charging plugNum = %d\r\n", plugNum);
+
+#if defined DD360Audi
+            if (getSelGunWaitToAuthor(plugNum) == FAIL) {
+                DEBUG_ERROR("Remote start gun already charging\r\n");
+                break;
+            }
+
+            if (ShmSysConfigAndInfo->SysInfo.CurGunSelected != (plugNum)) {
+                if (plugNum == LEFT_GUN_NUM &&
+                        (gAudiCustInfo->SelGunInfo.LeftGun == SEL_GUN_CONFIRM ||
+                         gAudiCustInfo->SelGunInfo.LeftGun == SEL_GUN_ATHOR)) {
+                    gAudiCustInfo->SelGunInfo.LeftGun = SEL_GUN_RELEASE;
+                    strcpy((char *)ShmSysConfigAndInfo->SysConfig.UserId, "");
+                    ShmSysConfigAndInfo->SysInfo.WaitForPlugit = NO;
+                    sleep(1); //Jerry add
+                    ShmSysConfigAndInfo->SysInfo.SystemPage = _LCM_SELECT_GUN;
+                    gettimeofday(&ShmSysConfigAndInfo->SysInfo.SystemTimeoutTimer, NULL);
+                    ShmSysConfigAndInfo->SysInfo.SystemTimeoutFlag = Timeout_None;
+                }
+
+                if (plugNum == RIGHT_GUN_NUM &&
+                        (gAudiCustInfo->SelGunInfo.RightGun == SEL_GUN_CONFIRM ||
+                         gAudiCustInfo->SelGunInfo.RightGun == SEL_GUN_ATHOR)) {
+                    gAudiCustInfo->SelGunInfo.RightGun = SEL_GUN_RELEASE;
+                    strcpy((char *)ShmSysConfigAndInfo->SysConfig.UserId, "");
+                    ShmSysConfigAndInfo->SysInfo.WaitForPlugit = NO;
+                    sleep(1); //Jerry add
+                    ShmSysConfigAndInfo->SysInfo.SystemPage = _LCM_SELECT_GUN;
+                    gettimeofday(&ShmSysConfigAndInfo->SysInfo.SystemTimeoutTimer, NULL);
+                    ShmSysConfigAndInfo->SysInfo.SystemTimeoutFlag = Timeout_None;
+                }
+
+                ShmSysConfigAndInfo->SysInfo.CurGunSelected = (plugNum);
+                ShmSysConfigAndInfo->SysInfo.CurGunSelectedByAc = NO_DEFINE;
+            }
+#else
+            ShmSysConfigAndInfo->SysInfo.CurGunSelected = (plugNum);
+            ShmSysConfigAndInfo->SysInfo.CurGunSelectedByAc = NO_DEFINE;
+#endif //DD360Audi
+            setConfirmSelGun(ShmSysConfigAndInfo->SysInfo.CurGunSelected);
+
+            ShmOCPP16Data->CsMsg.bits[plugNum].RemoteStartTransactionReq = YES;
+            gAudiCustInfo->PricesInfo[plugNum].Balance = 0.00;
+            clearMiscCommand();
+            break;
+
+        case MISC_CMD_REMOTE_STOP_CHARGING:
+            if (value != YES) {
+                if (plugNum == 1) {
+                    clearMiscCommand();
+                }
+                break;
+            }
+
+            strcpy((char *)ShmSysConfigAndInfo->SysConfig.UserId, "");
+            ShmSysConfigAndInfo->SysInfo.WaitForPlugit = NO;
+            ShmSysConfigAndInfo->SysInfo.SystemPage = _LCM_SELECT_GUN;
+            gettimeofday(&ShmSysConfigAndInfo->SysInfo.SystemTimeoutTimer, NULL);
+            ShmSysConfigAndInfo->SysInfo.SystemTimeoutFlag = Timeout_None;
+            destroySelectGun(plugNum);
+
+            clearMiscCommand();
+            break;
+
+        case MISC_CMD_REMOTE_UNLOCK:
+            if (value != YES) {
+                if (plugNum == 1) {
+                    clearMiscCommand();
+                }
+                break;
+            }
+
+            if (isDetectPlugin() == YES) {
+                ClearDetectPluginFlag();
+                strcpy((char *)ShmSysConfigAndInfo->SysConfig.UserId, "");
+                ShmSysConfigAndInfo->SysInfo.WaitForPlugit = NO;
+                ShmSysConfigAndInfo->SysInfo.SystemPage = _LCM_SELECT_GUN;
+                gettimeofday(&ShmSysConfigAndInfo->SysInfo.SystemTimeoutTimer, NULL);
+                ShmSysConfigAndInfo->SysInfo.SystemTimeoutFlag = Timeout_None;
+                destroySelectGun(plugNum);
+            } else {
+                ChargingData[plugNum]->StopChargeFlag = POWER_CABINET_STOP_CHARGING;
+            }
+            break;
+
+        default:
+            clearMiscCommand();
+            break;
+        }
+        usleep(128);
+    }
+
+    return ret;
+}
+
+static int chargingcapabilityHandle(uint8_t *data, uint8_t plugNum)
+{
+    uint8_t addr = 0;
+    float MaxVolt, MaxCurrent, MaxPower;
+    static PricesInfo pricesInfo[2] = {0};
+    CapabilityInfo *pCapabilityInfo = NULL;
+    AccountInfo *pAccountInfo = NULL;
+
+    //--- charging capability information --------------------------------------
+    pCapabilityInfo = (CapabilityInfo *)&data[0];
+
+    MaxVolt = (float)(ntohs(pCapabilityInfo->OutputVoltage));
+    if (MaxVolt >= 0) {
+        if (MaxVolt > MAX_VOLTAGE) {
+            MaxVolt = MAX_VOLTAGE;
+        }
+        ChargingData[plugNum]->MaximumChargingVoltage = MaxVolt;
+    }
+
+    MaxCurrent = (float)(ntohs(pCapabilityInfo->OutputCurrent));
+    if (MaxCurrent >= 0) {
+        if (MaxCurrent > MAX_CURRENCY) {
+            MaxCurrent = MAX_CURRENCY;
+        }
+        ChargingData[plugNum]->AvailableChargingCurrent = MaxCurrent;
+    }
+
+    MaxPower = (float)(ntohs(pCapabilityInfo->OutputPower));
+    if (MaxPower >= 0) {
+        if (MaxPower > MAX_POWER) {
+            MaxPower = MAX_POWER;
+        }
+        ChargingData[plugNum]->AvailableChargingPower = MaxPower;
+    }
+    //MaxVolt = (float)(data[0] << 8 |data[1]);
+    //MaxCurrent = (float)(data[2] << 8 | data[3]);
+    //MaxPower = (float)(data[4] << 8 | data[5]);
+    //printf("MaxVolt=%f, MaxCurrent=%f, MaxPower=%f,\n", MaxVolt, MaxCurrent, MaxPower);
+
+    //--- user prices information ----------------------------------------------
+    addr = (sizeof(CapabilityInfo) - 2); //2 byte reserved
+    pAccountInfo = (AccountInfo *)&data[addr];
+
+    ShmSysConfigAndInfo->SysConfig.BillingData.Currency = pAccountInfo->Currency;
+    gAudiCustInfo->PricesInfo[plugNum].UserPrices         = transPricesUnit(ntohl(pAccountInfo->UserPrices));
+    ChargingData[plugNum]->ChargingFee                    = transPricesUnit(ntohl(pAccountInfo->TotalCost));
+    gAudiCustInfo->PricesInfo[plugNum].Balance            = transPricesUnit(ntohl(pAccountInfo->Balance));
+
+    if ((pricesInfo[plugNum].UserPrices != gAudiCustInfo->PricesInfo[plugNum].UserPrices) ||
+            (pricesInfo[plugNum].Balance != gAudiCustInfo->PricesInfo[plugNum].Balance)) {
+        pricesInfo[plugNum].UserPrices = gAudiCustInfo->PricesInfo[plugNum].UserPrices;
+        pricesInfo[plugNum].Balance = gAudiCustInfo->PricesInfo[plugNum].Balance;
+
+        DEBUG_INFO("id = %d, user prices = %.2f, Total cost = %.2f, Account balances = %.2f, currency = %s\r\n",
+                   plugNum,
+                   gAudiCustInfo->PricesInfo[plugNum].UserPrices,
+                   ChargingData[plugNum]->ChargingFee,
+                   gAudiCustInfo->PricesInfo[plugNum].Balance,
+                   (uint8_t *)Currency[ShmSysConfigAndInfo->SysConfig.BillingData.Currency]);
+    }
+
+    return PASS;
+}
+
+static void addFaultCodeToBuf(uint8_t *Code)
+{
+    uint8_t warningCount = ShmSysConfigAndInfo->SysWarningInfo.WarningCount;
+
+    if (warningCount < 10) {
+        memcpy(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[warningCount][0],
+               Code,
+               strlen((char *)Code));
+        ShmSysConfigAndInfo->SysWarningInfo.WarningCount++;
+    }
+}
+
+static void removeFaultCodeToBuf(uint8_t *Code)
+{
+    uint8_t find = 0x01;
+    uint8_t i = 0;
+    char _code[7] = {0};
+
+    sprintf(_code, "%s", Code);
+
+    // 把相關的錯誤碼一次移除，避免重複顯示
+    while (find) {
+        usleep(128);
+        find = 0x00;
+        for (i = 0; i < ShmSysConfigAndInfo->SysWarningInfo.WarningCount; i++) {
+            usleep(128);
+            if (find == 0x00) {
+                if (memcmp(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i][0], _code, 7) == 0) {
+                    find = 0x01;
+                }
+            } else {
+                memcpy(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i - 1][0],
+                       &ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i][0], 7);
+            }
+        }
+
+        if (find) {
+            ShmSysConfigAndInfo->SysWarningInfo.WarningCount--;
+        }
+    }
+}
+
+bool CompareArrayIsZero(uint8_t *array, unsigned int array_size)
+{
+    uint8_t i;
+
+    if (array != NULL) {
+        for (i = 0; i < array_size; i++) {
+            if (array[i] != 0) {
+                return false;
+            }
+        }
+    }
+
+    return true;
+}
+static int powerCabinetStatusProcess(uint8_t dataLen, uint8_t *data)
+{
+    uint8_t ret = 0;
+    uint8_t i = 0;
+    uint8_t count = 0;
+    uint8_t EventCodeTmp[7] = {0};
+    uint8_t StatusArray[MAX_REGISTER_NUM][WARNING_CODE_SIZE] = {0};
+    uint8_t remaindLen = 0;
+    uint8_t statusCodeError = 0;
+
+    //if (dataLen <= 0) {
+    //    return FAIL;
+    //}
+
+    if (dataLen > 0) {
+        remaindLen = dataLen % WARNING_CODE_SIZE;
+
+        if (remaindLen != 0) {
+            dataLen -= remaindLen;
+        }
+
+        if (dataLen < WARNING_CODE_SIZE) {
+            DEBUG_ERROR("fail status code length = %d\r\n", dataLen);
+            Hexdump(data, dataLen);
+            if (ShmSysConfigAndInfo->SysWarningInfo.WarningCount > 0) {
+                for (i = 0; i < ShmSysConfigAndInfo->SysWarningInfo.WarningCount; i++) {
+                    usleep(128);
+                    if (ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i][1] >= '3' ||  //from backend or power cabinet
+                            (ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i][0] >= 'B' &&
+                             ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i][1] >= '4')) {
+                        memset(EventCodeTmp, 0, sizeof(EventCodeTmp));
+                        memcpy(EventCodeTmp,
+                               ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i],
+                               sizeof(EventCodeTmp));
+                        removeFaultCodeToBuf(EventCodeTmp);
+                    }
+                }
+            }
+            return FAIL;
+        }
+
+        for (count = 0; count < dataLen; count += WARNING_CODE_SIZE) {
+            usleep(128);
+            // misc command status code handle
+            if (strncmp((char *)&data[count], MISC_ST_MISC_CMD, WARNING_CODE_SIZE) == 0) {
+                //if (gDoCommGblData.MiscCmd != REG_MISC_CONTROL) {
+                gDoCommGblData.MiscCmd = REG_MISC_CONTROL;
+                //}
+                memset((char *)&data[count], 0, WARNING_CODE_SIZE);
+                continue;
+            } else if (strncmp((char *)&data[count], MISC_ST_VERSION, WARNING_CODE_SIZE) == 0) {
+                //if (gDoCommGblData.MiscCmd != REG_REPORT_CSU_VERSION) {
+                gDoCommGblData.MiscCmd = REG_REPORT_CSU_VERSION;
+                //}
+                memset((char *)&data[count], 0, WARNING_CODE_SIZE);
+                continue;
+            }
+
+            if (CompareArrayIsZero((uint8_t *)&data[count], WARNING_CODE_SIZE) == true) {
+                memset(EventCodeTmp, 0, sizeof(EventCodeTmp));
+                memcpy(EventCodeTmp, (char *)&data[count], sizeof(EventCodeTmp));
+                DEBUG_ERROR("error status = %s\r\n", EventCodeTmp);
+                continue;
+            }
+
+            strncpy((char *)&StatusArray[count / WARNING_CODE_SIZE], (char *)&data[count], WARNING_CODE_SIZE);
+
+            ret = 0;
+            for (i = 0; i < ShmSysConfigAndInfo->SysWarningInfo.WarningCount; i++) {
+                usleep(128);
+                if (memcmp(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i][0],
+                           StatusArray[count / WARNING_CODE_SIZE],
+                           WARNING_CODE_SIZE) == 0) {
+                    ret = 1;
+                    break;
+                }
+            }
+
+            if (ret == 0) {
+                addFaultCodeToBuf(StatusArray[count / WARNING_CODE_SIZE]);
+            }
+            //Rtn=StatusCodeProcessing(StatusArray[count/6]);
+        }
+    }
+
+    for (i = 0; i < ShmSysConfigAndInfo->SysWarningInfo.WarningCount; i++) {
+        usleep(128);
+        //if (ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i][0] >= 'B' &&
+        //        ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i][1] >= '4') {
+        //    memset(EventCodeTmp, 0, sizeof(EventCodeTmp));
+        //    memcpy(EventCodeTmp,
+        //           ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i],
+        //           sizeof(EventCodeTmp));
+        //    removeFaultCodeToBuf(EventCodeTmp);
+        //}
+
+        if (ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i][1] >= '3' || //from backend or power cabinet 0x33
+                (ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i][0] >= 'B' &&
+                 ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i][1] >= '4')) {
+            ret = 0;
+
+            for (count = 0; count < (dataLen / WARNING_CODE_SIZE); count++) {
+                usleep(128);
+                if (memcmp(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i][0],
+                           StatusArray[count],
+                           WARNING_CODE_SIZE) == 0) {
+                    ret = 1;
+                    break;
+                }
+            }
+
+            if (ret == 0) {
+                memset(EventCodeTmp, 0, sizeof(EventCodeTmp));
+                memcpy(EventCodeTmp,
+                       ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i],
+                       sizeof(EventCodeTmp));
+                removeFaultCodeToBuf(EventCodeTmp);
+            }
+        }
+    }
+
+    return PASS;
+}
+
+static int responsePackeHandle(int fd, uint8_t *pResult, uint8_t plugNum, uint8_t reg)
+{
+    int ret = PASS;
+    uint8_t rawDataLen = 0;
+    CsuResultPkt *pCsuResult = (CsuResultPkt *)pResult;
+    SoftwareUpdInfo *pSoftwareUpd = NULL;
+
+    //Hexdump((uint8_t *)pCsuResult, sizeof(CmdHead) + pCsuResult->Head.DataLen);
+    if (compareOpcode(pCsuResult->Head.OP) == FAIL ||
+            compareResult(pCsuResult->Data.Result) == FAIL ||
+            compareRegister(pCsuResult->Data.Register, reg) == FAIL) {
+        if (reg != REG_CHARGING_PERMISSION) {
+            return FAIL;
+        }
+    }
+
+    rawDataLen = (pCsuResult->Head.DataLen - 2); //2 byte = register and result byte
+
+    switch (pCsuResult->Data.Register) {
+    case REG_MODEL_NAME:
+        break;
+
+    case REG_CONNECTOR_ID:
+        gDoCommGblData.ConnectorID[0] = pCsuResult->Data.Data[0];
+        gDoCommGblData.ConnectorID[1] = pCsuResult->Data.Data[1];
+        DEBUG_INFO("OK (Left connector ID = %d, Right connector ID = %d)\n",
+                   pCsuResult->Data.Data[0],
+                   pCsuResult->Data.Data[1]);
+        break;
+
+    case REG_POWER_CABINET_STATUS:
+        ret = powerCabinetStatusProcess(rawDataLen, pCsuResult->Data.Data);
+        break;
+
+    case REG_DISPENSER_STATUS:
+        memset(&gPreSysWarningInfo, 0, sizeof(struct WARNING_CODE_INFO));
+        memcpy((uint8_t *)&gPreSysWarningInfo,
+               &(ShmSysConfigAndInfo->SysWarningInfo),
+               sizeof(struct WARNING_CODE_INFO));
+        break;
+
+    case REG_CHARGING_CAP:
+        chargingcapabilityHandle(pCsuResult->Data.Data, plugNum);
+        break;
+
+    case REG_CHARGING_TARGET:
+        break;
+
+    case REG_SOFTWARE_UPDATE:
+        pSoftwareUpd = (SoftwareUpdInfo *)&pCsuResult->Data.Data[0];
+
+        if ((strcmp((char *)pSoftwareUpd->ImgName, "") == 0) ||
+                (rawDataLen == 0) ||
+                pSoftwareUpd->UpdateState != 1) {
+            ret = FAIL;
+            break;
+        }
+
+        ret = FAIL;
+        ret = updateFirmwareHandle(pSoftwareUpd->ImgName);
+        break;
+
+    case REG_PLUG_IN_STATE:
+        break;
+
+    case REG_CONNECTOR_STATE:
+        break;
+
+    case REG_USER_ID:
+        //DEBUG_INFO("%s\n", pCsuResult->Data.Data[0] == 1 ? "Accept" : "Reject" );
+        //if (pCsuResult->Data.Data[0] <= 0) {
+        //    return FAIL;
+        //}
+        if (pCsuResult->Data.Result == COMMAND_RESULT_NG) {
+            return COMMAND_RESULT_NG;
+        }
+        return pCsuResult->Data.Data[0];
+        break;
+
+    case REG_CHARGING_PERMISSION:
+        //DEBUG_INFO("id = %d, result = %s, action = %s\r\n",
+        //           pCsuResult->Head.ID,
+        //           pCsuResult->Data.Result == 1 ? "OK" : "NG",
+        //           pCsuResult->Data.Data[0] == 1 ? "Permitted" : "NOT permitted");
+        if (pCsuResult->Data.Result == COMMAND_RESULT_NG) {
+            return COMMAND_RESULT_NG;
+        }
+        return pCsuResult->Data.Data[0];
+        break;
+
+    case REG_MISC_CONTROL:
+        miscCommandHandle(rawDataLen, plugNum, pCsuResult->Data.Data);
+        break;
+
+    case REG_REPORT_CSU_VERSION:
+    case REG_REPORT_OTHER_VERSION:
+        break;
+
+    case REG_PRESENT_CHARGING_INFO:
+        break;
+
+    case REG_QRCODE_URL_INFO:
+        ret = qrCodeUrlInfoHandle(pCsuResult->Data.Data);
+        break;
+
+    case REG_WAIT_PLUG_IT_STATE:
+        break;
+
+    default:
+        break;
+    }
+
+    return ret;
+}
+
+static int composeSocketData(int fd,
+                             uint8_t id,
+                             uint8_t opCode,
+                             uint8_t reg,
+                             uint8_t dataLen,
+                             uint8_t *data)
+{
+    int ret = PASS;
+    int size = 0;
+    int sendPktLen = 0;
+    uint8_t i = 0;
+    uint8_t plugNum = 0;
+    CsuCmdPkt csuCmdPkt = {0};
+    CsuResultPkt csuResult = {0};
+
+    csuCmdPkt.Head.SeqNum = gDoCommGblData.SeqNum++;
+    csuCmdPkt.Head.ID = id;
+    csuCmdPkt.Head.OP = opCode;
+    csuCmdPkt.Head.DataLen = dataLen + 1; //+1 for register byte
+
+    csuCmdPkt.Data.Register = reg;
+    if ((data != NULL) && (dataLen > 0)) {
+        memcpy(csuCmdPkt.Data.Data, data, dataLen);
+    }
+
+    sendPktLen = csuCmdPkt.Head.DataLen + sizeof(csuCmdPkt.Head);
+
+    //Hexdump((uint8_t *)&csuCmdPkt, sendPktLen);
+
+    //send command packet
+    if ((size = sendTcpSocket(fd, (uint8_t *)&csuCmdPkt, sendPktLen)) < 0) {
+        DEBUG_ERROR("TCP socket send packet fail = %d\r\n", size);
+        gDoCommGblData.DisConnCount++;
+        return FAIL;
+    }
+
+    //receive result head
+    if ((size = recvTcpSocket(fd, (uint8_t *)&csuResult.Head, sizeof(csuResult.Head))) < 0) {
+        DEBUG_ERROR("TCP socket RX head fail = %d\r\n", size);
+        gDoCommGblData.DisConnCount++;
+        return FAIL;
+    }
+
+    //receive result raw data
+    if ((size = recvTcpSocket(fd, (uint8_t *)&csuResult.Data, csuResult.Head.DataLen)) < 0) {
+        DEBUG_ERROR("TCP socket RX data fail = %d\r\n", size);
+        gDoCommGblData.DisConnCount++;
+        return FAIL;
+    }
+
+    for (i = 0; i < sizeof(gDoCommGblData.ConnectorID); i++) {
+        if (id == gDoCommGblData.ConnectorID[i]) {
+            plugNum = i;
+            break;
+        }
+    }
+
+    ret = responsePackeHandle(fd, (uint8_t *)&csuResult, plugNum, csuCmdPkt.Data.Register);
+
+    return ret;
+}
+
+static int writeWaitPlugItState(int fd, uint8_t id)
+{
+    int ret = PASS;
+    uint8_t data[2] = {ShmSysConfigAndInfo->SysInfo.WaitForPlugit, 0};
+
+    //printf("WaitForPlugit = %d\r\n", ShmSysConfigAndInfo->SysInfo.WaitForPlugit);
+
+    if ((ret = composeSocketData(fd,
+                                 id,
+                                 OP_WRITE_DATA,
+                                 REG_WAIT_PLUG_IT_STATE,
+                                 1,
+                                 &data[0])) == FAIL) {
+        return ret;
+    }
+
+    return ret;
+}
+
+static int readQRcodeURLAndSystemDate(int fd)
+{
+    int ret = PASS;
+
+    ret = composeSocketData(fd,
+                            ID_REGISTER,
+                            OP_READ_DATA,
+                            REG_QRCODE_URL_INFO,
+                            0,
+                            NULL);
+    return ret;
+}
+
+static int writePresentChargingInfo(int fd, uint8_t plugNum, uint8_t id)
+{
+    int ret = PASS;
+    uint8_t dataBuf[16] = {0};
+    PreChargingInfo *pPreChargingInfo = (PreChargingInfo *)dataBuf;
+
+    pPreChargingInfo->PresentChargingVoltage = htons((uint16_t)ChargingData[plugNum]->PresentChargingVoltage * 10);
+    pPreChargingInfo->PresentChargingCurrent = htons((uint16_t)ChargingData[plugNum]->PresentChargingCurrent * 10);
+    pPreChargingInfo->RemainChargingDuration = htonl(ChargingData[plugNum]->RemainChargingDuration);
+    pPreChargingInfo->EvBatterySoc = ChargingData[plugNum]->EvBatterySoc;
+
+    ret = composeSocketData(fd,
+                            id,
+                            OP_WRITE_DATA,
+                            REG_PRESENT_CHARGING_INFO,
+                            sizeof(PreChargingInfo),
+                            (uint8_t *)pPreChargingInfo);
+    return ret;
+}
+
+static int writeOtherModuleVersion(int fd)
+{
+    int ret = PASS;
+    uint8_t data[255] = {0};
+    uint8_t dataLen = 0;
+
+    //report other module version message
+    memcpy(&data[dataLen], ShmSysConfigAndInfo->SysInfo.FanModuleFwRev, VERSION_BUF_SIZE);
+    dataLen += VERSION_BUF_SIZE;
+    memcpy(&data[dataLen], ShmSysConfigAndInfo->SysInfo.RelayModuleFwRev, VERSION_BUF_SIZE);
+    dataLen += VERSION_BUF_SIZE;
+    memcpy(&data[dataLen], ShmSysConfigAndInfo->SysInfo.Connector1FwRev, VERSION_BUF_SIZE);
+    dataLen += VERSION_BUF_SIZE;
+    memcpy(&data[dataLen], ShmSysConfigAndInfo->SysInfo.Connector2FwRev, VERSION_BUF_SIZE);
+    dataLen += VERSION_BUF_SIZE;
+    memcpy(&data[dataLen], ShmSysConfigAndInfo->SysInfo.LedModuleFwRev, VERSION_BUF_SIZE);
+    dataLen += VERSION_BUF_SIZE;
+
+    ret = composeSocketData(fd,
+                            ID_REGISTER,
+                            OP_WRITE_DATA,
+                            REG_REPORT_OTHER_VERSION,
+                            dataLen,
+                            &data[0]);
+
+    return ret;
+}
+
+static int writeCsuModuleVersion(int fd)
+{
+    int ret = PASS;
+    uint8_t data[255] = {0};
+    uint8_t dataLen = 0;
+
+    //report CSU platform version message
+    memcpy(&data[dataLen], ShmSysConfigAndInfo->SysInfo.CsuBootLoadFwRev, VERSION_BUF_SIZE);
+    dataLen += VERSION_BUF_SIZE;
+    memcpy(&data[dataLen], ShmSysConfigAndInfo->SysInfo.CsuKernelFwRev, VERSION_BUF_SIZE);
+    dataLen += VERSION_BUF_SIZE;
+    memcpy(&data[dataLen], ShmSysConfigAndInfo->SysInfo.CsuRootFsFwRev, VERSION_BUF_SIZE);
+    dataLen += VERSION_BUF_SIZE;
+    memcpy(&data[dataLen], ShmSysConfigAndInfo->SysInfo.CsuPrimFwRev, VERSION_BUF_SIZE);
+    dataLen += VERSION_BUF_SIZE;
+
+    ret = composeSocketData(fd,
+                            ID_REGISTER,
+                            OP_WRITE_DATA,
+                            REG_REPORT_CSU_VERSION,
+                            dataLen,
+                            &data[0]);
+
+    return ret;
+}
+
+static int readMiscCommand(int fd, uint8_t id)
+{
+    int ret = PASS;
+
+    ret = composeSocketData(fd,
+                            id,
+                            OP_READ_DATA,
+                            REG_MISC_CONTROL,
+                            0,
+                            NULL);
+
+    return ret;
+}
+
+static int readChargePermission(int fd, uint8_t id)
+{
+    //int ret = PASS;
+
+    //if ((ret = composeSocketData(fd,
+    //                             id,
+    //                             OP_READ_DATA,
+    //                             REG_CHARGING_PERMISSION,
+    //                             0,
+    //                             NULL)) == FAIL) {
+    //    return ret;
+    //}
+
+    return composeSocketData(fd,
+                             id,
+                             OP_READ_DATA,
+                             REG_CHARGING_PERMISSION,
+                             0,
+                             NULL);
+}
+
+static int writeUserID(int fd, uint8_t id, uint8_t *pUserID)
+{
+    if ((strlen((char *)pUserID) <= 0) || (pUserID == NULL)) {
+        return FAIL;
+    }
+
+    return composeSocketData(fd,
+                             id,
+                             OP_WRITE_DATA,
+                             REG_USER_ID,
+                             strlen((char *)pUserID),
+                             pUserID);
+}
+
+static int writeConnectorState(int fd, uint8_t plugNum, uint8_t id)
+{
+    uint8_t dataBuf[8] = {'\0'};
+    ConnectorState *pConnState = (ConnectorState *)dataBuf;
+    static char vendorErrorCodeTmp[2][WARNING_CODE_SIZE] = {0};
+    int ret = PASS;
+
+    if (ChargingData[plugNum]->SystemStatus <= S_AUTHORIZING) {
+        pConnState->State = CONN_ST_IDLE;    //idle
+        strcpy((char *)ShmOCPP16Data->StatusNotification[plugNum].VendorErrorCode, "");
+        //strcpy(&vendorErrorCodeTmp[plugNum][0], "");
+    } else if ((ChargingData[plugNum]->SystemStatus <= S_PREPARING_FOR_EVSE) ||
+               (ChargingData[plugNum]->SystemStatus == S_CCS_PRECHARGE_ST0) ||
+               (ChargingData[plugNum]->SystemStatus == S_CCS_PRECHARGE_ST1)) {
+        pConnState->State = CONN_ST_PREPARING;    //preparing
+    } else if (ChargingData[plugNum]->SystemStatus == S_CHARGING) {
+        pConnState->State = CONN_ST_CHARGING;    //charging
+    } else if (ChargingData[plugNum]->SystemStatus == S_TERMINATING) {
+        pConnState->State = CONN_ST_TERMINATING;    //terminating
+    } else if ((ChargingData[plugNum]->SystemStatus == S_ALARM) ||
+               (ChargingData[plugNum]->SystemStatus == S_FAULT)) {
+        pConnState->State = CONN_ST_ALARM;
+        strncpy((char *)pConnState->WarningCode, (char *)ShmOCPP16Data->StatusNotification[plugNum].VendorErrorCode, WARNING_CODE_SIZE);
+
+        if (strcmp(&vendorErrorCodeTmp[plugNum][0], "") == 0) {
+            strncpy(&vendorErrorCodeTmp[plugNum][0], (char *)ShmOCPP16Data->StatusNotification[plugNum].VendorErrorCode, WARNING_CODE_SIZE);
+            vendorErrorCodeTmp[plugNum][6] = '\0';
+            DEBUG_INFO("1 ID = %d, VendorErrorCode = %s\r\n", plugNum, (char *)ShmOCPP16Data->StatusNotification[plugNum].VendorErrorCode);
+        } else {
+            if (strncmp(&vendorErrorCodeTmp[plugNum][0], (char *)ShmOCPP16Data->StatusNotification[plugNum].VendorErrorCode, WARNING_CODE_SIZE) != 0) {
+                strncpy(&vendorErrorCodeTmp[plugNum][0], (char *)ShmOCPP16Data->StatusNotification[plugNum].VendorErrorCode, WARNING_CODE_SIZE);
+                vendorErrorCodeTmp[plugNum][6] = '\0';
+                DEBUG_INFO("2 ID = %d, VendorErrorCode = %s\r\n", plugNum, (char *)ShmOCPP16Data->StatusNotification[plugNum].VendorErrorCode);
+            }
+        }
+    }
+
+    ret = composeSocketData(fd,
+                            id,
+                            OP_WRITE_DATA,
+                            REG_CONNECTOR_STATE,
+                            sizeof(dataBuf) - 1,
+                            &dataBuf[0]);
+    return ret;
+}
+
+static int writePlugInStatus(int fd, uint8_t plugNum, uint8_t id)
+{
+    int ret = PASS;
+    uint8_t dataBuf[2] = {ChargingData[plugNum]->ConnectorPlugIn, 0};
+
+    ret = composeSocketData(fd,
+                            id,
+                            OP_WRITE_DATA,
+                            REG_PLUG_IN_STATE,
+                            1,
+                            &dataBuf[0]);
+    return ret;
+}
+
+static int readSoftwareUpdate(int fd, uint8_t gunID)
+{
+    int ret = PASS;
+    uint8_t dataBuf[2] = {ShmSysConfigAndInfo->SysInfo.FirmwareUpdate, 0};
+
+    ret = composeSocketData(fd,
+                            gunID,
+                            OP_READ_DATA,
+                            REG_SOFTWARE_UPDATE,
+                            1,
+                            &dataBuf[0]);
+
+    return ret;
+}
+
+static int writeChargingTarget(int fd, uint8_t plugNum, uint8_t id)
+{
+    int ret = PASS;
+    float ChargingVolt, ChargingAmp;
+    uint8_t dataBuf[4] = {0};
+
+    ChargingVolt = ChargingData[plugNum]->EvBatterytargetVoltage;
+    ChargingAmp = ChargingData[plugNum]->EvBatterytargetCurrent;
+    ChargingVolt *= 10;
+    ChargingAmp *= 10;
+
+    dataBuf[0] = ((uint16_t)ChargingVolt >> 8) & 0xFF;
+    dataBuf[1] = ((uint16_t)ChargingVolt) & 0xFF;
+    dataBuf[2] = ((uint16_t)ChargingAmp >> 8) & 0xFF;
+    dataBuf[3] = ((uint16_t)ChargingAmp) & 0xFF;
+
+    ret = composeSocketData(fd,
+                            id,
+                            OP_WRITE_DATA,
+                            REG_CHARGING_TARGET,
+                            sizeof(dataBuf),
+                            &dataBuf[0]);
+
+    return ret;
+}
+
+static int readChargingCapability(int fd, uint8_t id)
+{
+    int ret = PASS;
+
+    ret = composeSocketData(fd,
+                            id,
+                            OP_READ_DATA,
+                            REG_CHARGING_CAP,
+                            0,
+                            NULL);
+
+    return ret;
+}
+
+static int writeDispenserStatus(int fd, uint8_t gunID)
+{
+    uint8_t warningCount = 0;
+    uint8_t count = 0;
+    uint8_t CurWarnCodeTmp[10][6] = {0};
+    uint8_t PreWarnCodeTmp[10][6] = {0};
+    int ret = PASS;
+
+    if ((ShmSysConfigAndInfo->SysWarningInfo.WarningCount <= 0) &&
+            (gPreSysWarningInfo.WarningCount <= 0)) {
+        return FAIL;
+    }
+
+    warningCount = ShmSysConfigAndInfo->SysWarningInfo.WarningCount;
+    for (count = 0; count < warningCount; count++) {
+        memcpy(CurWarnCodeTmp[count], ShmSysConfigAndInfo->SysWarningInfo.WarningCode[count], WARNING_CODE_SIZE);
+    }
+
+    warningCount = gPreSysWarningInfo.WarningCount;
+    for (count = 0; count < warningCount; count++) {
+        memcpy(PreWarnCodeTmp[count], gPreSysWarningInfo.WarningCode[count], WARNING_CODE_SIZE);
+    }
+
+    if (strcmp((char *)&CurWarnCodeTmp[0], (char *)&PreWarnCodeTmp[0]) == 0) {
+        return FAIL;
+    }
+
+    ret = composeSocketData(fd,
+                            gunID,
+                            OP_WRITE_DATA,
+                            REG_DISPENSER_STATUS,
+                            strlen((char *)CurWarnCodeTmp),
+                            &CurWarnCodeTmp[0][0]);
+
+    return ret;
+}
+
+static int readPowerCabinetStatus(int fd, uint8_t gunID)
+{
+    int ret = PASS;
+
+    ret = composeSocketData(fd,
+                            gunID,
+                            OP_READ_DATA,
+                            REG_POWER_CABINET_STATUS,
+                            0,
+                            NULL);
+
+    return ret;
+}
+
+static int readConnectorID(int fd)
+{
+    int ret = PASS;
+
+    ret = composeSocketData(fd,
+                            ID_REGISTER,
+                            OP_READ_DATA,
+                            REG_CONNECTOR_ID,
+                            0,
+                            NULL);
+
+    return ret;
+}
+
+static int WriteModelName(int fd)
+{
+    int ret = PASS;
+    uint8_t Tmp = 0;
+    uint8_t TmpBuf[255] = {0};
+
+    memcpy(TmpBuf,
+           ShmSysConfigAndInfo->SysConfig.ModelName,
+           strlen((char *)ShmSysConfigAndInfo->SysConfig.ModelName));
+
+    Tmp = (uint8_t)(ShmPrimaryMcuData->InputDet.bits.Key2 << 2 |
+                    ShmPrimaryMcuData->InputDet.bits.Key1 << 1 |
+                    ShmPrimaryMcuData->InputDet.bits.Key0);
+
+    TmpBuf[strlen((char *)ShmSysConfigAndInfo->SysConfig.ModelName)] = Tmp; //Dispenser switch value
+
+    ret = composeSocketData(fd,
+                            ID_REGISTER,
+                            OP_WRITE_DATA,
+                            REG_MODEL_NAME,
+                            strlen((char *)ShmSysConfigAndInfo->SysConfig.ModelName) + 1,
+                            &TmpBuf[0]);
+
+    return ret;
+}
+
+static void calDisconnectCount(uint8_t *pValue, uint8_t maxCount)
+{
+    sleep(3); //wait 1 second
+
+    if ((*pValue) >= maxCount) {
+        setTcpStatus(ABNORMAL);
+    } else {
+        (*pValue)++;
+    }
+}
+
+static int CheckNetworkStatus(void)
+{
+    char *ipAddr = (char *)&ShmSysConfigAndInfo->SysConfig.Eth0Interface.EthIpAddress;
+
+    //printf("Check network IP Header = %s\n", ipAddr);
+    if (strstr(ipAddr, CMP_ETH_IP_HEAD) != NULL) {
+        return 1;
+    }
+
+    return 0;
+}
+
+static int FindChargingInfoData(byte target, struct ChargingInfoData **chargingData)
+{
+    uint8_t index = 0;
+
+    for (index = 0; index < CHAdeMO_QUANTITY; index++) {
+        if (ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].Index == target) {
+            chargingData[target] = &ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index];
+            return 1;
+        }
+    }
+
+    for (index = 0; index < CCS_QUANTITY; index++) {
+        if (ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].Index == target) {
+            chargingData[target] = &ShmSysConfigAndInfo->SysInfo.CcsChargingData[index];
+            return 1;
+        }
+    }
+
+    for (index = 0; index < GB_QUANTITY; index++) {
+        if (ShmSysConfigAndInfo->SysInfo.GbChargingData[index].Index == target) {
+            chargingData[target] = &ShmSysConfigAndInfo->SysInfo.GbChargingData[index];
+            return 1;
+        }
+    }
+
+    return 0;
+}
+
+static int InitShareMemory(void)
+{
+    int result = 1;
+    int MeterSMId = 0;
+
+    if ((MeterSMId = shmget(ShmSysConfigAndInfoKey, sizeof(struct SysConfigAndInfo),  0777)) < 0) {
+        DEBUG_ERROR("shmget ShmSysConfigAndInfo NG\n");
+        result = 0;
+    } else if ((ShmSysConfigAndInfo = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+        DEBUG_ERROR("[shmat ShmSysConfigAndInfo NG\n");
+        result = 0;
+    }
+
+    if ((MeterSMId = shmget(ShmStatusCodeKey, sizeof(struct StatusCodeData),  0777)) < 0) {
+        DEBUG_ERROR("shmget ShmStatusCodeData NG\n");
+        result = 0;
+    } else if ((ShmStatusCodeData = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+        DEBUG_ERROR("shmat ShmStatusCodeData NG\n");
+        result = 0;
+    }
+
+    //creat ShmPsuData
+    if ((MeterSMId = shmget(ShmPsuKey, sizeof(struct PsuData),  0777)) < 0) {
+        DEBUG_ERROR("shmget ShmPsuData NG \n");
+        result = 0;
+    } else if ((ShmPsuData = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+        DEBUG_ERROR("shmat ShmPsuData NG \n");
+        result = 0;
+    }
+
+    //creat ShmOCPP16Data
+    if ((MeterSMId = shmget(ShmOcppModuleKey, sizeof(struct OCPP16Data),  0777)) < 0) {
+        DEBUG_ERROR("shmget ShmOCPP16Data NG \n");
+        result = 0;
+    } else if ((ShmOCPP16Data = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+        DEBUG_ERROR("shmat ShmOCPP16Data NG \n");
+        result = 0;
+    }
+
+    if ((MeterSMId = shmget(ShmPrimaryMcuKey, sizeof(struct PrimaryMcuData), 0777)) < 0) {
+        DEBUG_ERROR("shmget ShmPrimaryMcuData NG\n");
+        result = 0;
+    } else if ((ShmPrimaryMcuData = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+        DEBUG_ERROR("shmat ShmPrimaryMcuData NG\n");
+        result = 0;
+    }
+
+    //creat Audi customization info
+    if ((MeterSMId = shmget(ShmAudiCustInfoKey, sizeof(AudiCustInfo), IPC_CREAT | 0777)) < 0) {
+        DEBUG_ERROR("[main]CreatShareMemory:shmget select gun info NG \n");
+        return 0;
+    } else if ((gAudiCustInfo = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+        DEBUG_ERROR("[main]CreatShareMemory:shmat shmget select gun info \n");
+        return 0;
+    }
+
+    return result;
+}
+
+static void updateFirmwareProcess(int fd, uint8_t gunID, uint8_t totalConnCount)
+{
+    bool canUpdateFirmware = true;
+    uint8_t plugNum = 0;
+    uint8_t ackCount = 5;
+    struct timeb updateTime;
+
+    if (ShmSysConfigAndInfo->SysWarningInfo.Level != 2) {
+        for (plugNum = 0; plugNum < totalConnCount; plugNum++) {
+            if (ChargingData[plugNum]->SystemStatus != S_IDLE &&
+                    ChargingData[plugNum]->SystemStatus != S_RESERVATION &&
+                    ChargingData[plugNum]->SystemStatus != S_MAINTAIN) {
+                canUpdateFirmware = false;
+            }
+        }
+    }
+
+    if (canUpdateFirmware) {
+        ftime(&updateTime);
+        if (DiffTimeb(gRegTimeUp[0][REG_SOFTWARE_UPDATE], updateTime) > LOOP_RETRY_TIME * 5) {
+            readSoftwareUpdate(fd, gunID);
+            ftime(&gRegTimeUp[0][REG_SOFTWARE_UPDATE]);
+        }
+
+        if (ShmSysConfigAndInfo->SysInfo.FirmwareUpdate == YES) {
+            while (ackCount != 0) {
+                ftime(&updateTime);
+                if (DiffTimeb(gRegTimeUp[0][REG_SOFTWARE_UPDATE], updateTime) > LOOP_RETRY_TIME / 2) {
+                    readSoftwareUpdate(fd, gunID);
+                    ftime(&gRegTimeUp[0][REG_SOFTWARE_UPDATE]);
+                    if (ShmSysConfigAndInfo->SysInfo.FirmwareUpdate == NO) {
+                        ackCount--;
+                    }
+                }
+                usleep(128);
+            }
+        }
+    }
+}
+
+static void checkAuthorProcess(int fd, uint8_t plugNum)
+{
+    int ret = 0;
+    uint8_t gunID = 0;
+    struct timeb AuthNowTime;
+
+#if defined DD360Audi
+    gunID = gDoCommGblData.ConnectorID[ShmSysConfigAndInfo->SysInfo.CurGunSelected];
+    //gunID = gDoCommGblData.ConnectorID[plugNum];
+#else
+    gunID = ID_REGISTER;
+#endif // DD360Audi
+
+    if ((ShmOCPP16Data->SpMsg.bits.AuthorizeReq == YES) || (ShmSysConfigAndInfo->SysInfo.AuthorizeFlag == YES)) {
+        ftime(&AuthNowTime);
+
+        if (DiffTimeb(gRegTimeUp[plugNum][REG_USER_ID], AuthNowTime) > LOOP_RETRY_TIME) {
+            ret = writeUserID(fd,
+                              gunID,
+                              ShmSysConfigAndInfo->SysConfig.UserId);
+            if (ret >= 0) {
+                memset(ShmOCPP16Data->Authorize.ResponseIdTagInfo.Status,
+                       0,
+                       sizeof(ShmOCPP16Data->Authorize.ResponseIdTagInfo.Status));
+                if (ret == 0) {
+                    strcpy((char *)ShmOCPP16Data->Authorize.ResponseIdTagInfo.Status, "Invalid");
+                } else {
+                    strcpy((char *)ShmOCPP16Data->Authorize.ResponseIdTagInfo.Status, "Accepted");
+                }
+
+                //printf("gAudiCustInfo->PricesInfo[plugNum].Balance = %.2f, %.2f\r\n",
+                //       gAudiCustInfo->PricesInfo[plugNum].Balance,
+                //       FAIL_BALANCE_PRICES);
+#if defined DD360Audi
+                if (gAudiCustInfo->PricesInfo[plugNum].Balance != FAIL_BALANCE_PRICES)
+#else
+                if (gAudiCustInfo->PricesInfo[plugNum].Balance == FAIL_BALANCE_PRICES) {
+                    gAudiCustInfo->PricesInfo[plugNum].Balance = 0;
+                }
+#endif //
+                {
+                    ShmOCPP16Data->SpMsg.bits.AuthorizeConf    = 1; //isAuthorizedComplete
+                    ShmOCPP16Data->SpMsg.bits.AuthorizeReq     = 0;
+                    ShmSysConfigAndInfo->SysInfo.AuthorizeFlag = 0;
+                    ShmPsuData->SystemAvailablePower           = 0;
+                    ShmPsuData->SystemPresentPsuQuantity       = 0;
+                }
+            }
+            ftime(&gRegTimeUp[plugNum][REG_USER_ID]);
+        }
+    }
+}
+
+static int messageTrigger(int fd, uint8_t plugNum, uint8_t gunID, uint8_t curReg)
+{
+    int ret = DISPENSER_INIT_SUCC;
+    int isContinue = 1;
+    struct timeb NowTime;
+
+    while (isContinue) {
+        usleep(128);
+        ftime(&NowTime);
+
+        switch (curReg) {
+        case REG_MODEL_NAME:
+            if (WriteModelName(fd) == PASS) {
+                gDoCommGblData.DisConnCount = 0;
+                curReg = REG_CONNECTOR_ID;
+            } else {
+                sleep(1);
+            }
+            break;
+
+        case REG_CONNECTOR_ID:
+            if (readConnectorID(fd) == PASS) {
+                gDoCommGblData.DisConnCount = 0;
+                curReg = REG_REPORT_CSU_VERSION;
+            } else {
+                sleep(1);
+            }
+            break;
+
+        case REG_POWER_CABINET_STATUS:
+            if (DiffTimeb(gRegTimeUp[plugNum][curReg], NowTime) > LOOP_RETRY_TIME) {
+                readPowerCabinetStatus(fd, gunID);
+                ftime(&gRegTimeUp[plugNum][curReg]);
+            }
+            curReg = REG_DISPENSER_STATUS;
+            break;
+
+        case REG_DISPENSER_STATUS:
+            if (DiffTimeb(gRegTimeUp[plugNum][curReg], NowTime) > LOOP_RETRY_TIME) {
+                writeDispenserStatus(fd, gunID);
+                ftime(&gRegTimeUp[plugNum][curReg]);
+            }
+            curReg = REG_PLUG_IN_STATE;
+            break;
+
+        //case REG_CHARGING_CAP:
+        //    readChargingCapability(fd, plugNum, gunID);
+        //    break;
+
+        //case REG_CHARGING_TARGET:
+        //    writeChargingTarget(fd, plugNum, gunID);
+        //    break;
+
+        //case REG_SOFTWARE_UPDATE:
+        //    if (ChargingData[plugNum]->SystemStatus == S_IDLE) {
+        //        if (DiffTimeb(gRegTimeUp[plugNum][curReg], NowTime) > LOOP_RETRY_TIME * 10) {
+        //            readSoftwareUpdate(fd);
+        //            ftime(&gRegTimeUp[plugNum][curReg]);
+        //        }
+        //        while (ShmSysConfigAndInfo->SysInfo.FirmwareUpdate == YES) {
+        //            ftime(&NowTime);
+        //            if (DiffTimeb(gRegTimeUp[plugNum][curReg], NowTime) > LOOP_RETRY_TIME) {
+        //                readSoftwareUpdate(fd);
+        //            }
+        //            usleep(128);
+        //        }
+        //    }
+        //    isContinue = 0;
+        //    break;
+
+        case REG_PLUG_IN_STATE:
+            if (DiffTimeb(gRegTimeUp[plugNum][curReg], NowTime) > LOOP_RETRY_TIME) {
+                writePlugInStatus(fd, plugNum, gunID);
+                ftime(&gRegTimeUp[plugNum][curReg]);
+            }
+            curReg = REG_CONNECTOR_STATE;
+            break;
+
+        case REG_CONNECTOR_STATE:
+            if (DiffTimeb(gRegTimeUp[plugNum][curReg], NowTime) > LOOP_RETRY_TIME) {
+                writeConnectorState(fd, plugNum, gunID);
+                ftime(&gRegTimeUp[plugNum][curReg]);
+            }
+
+            //check misc command from power cabinet
+            if (gDoCommGblData.MiscCmd != 0) {
+                curReg = gDoCommGblData.MiscCmd;
+            } else {
+                curReg = REG_QRCODE_URL_INFO;
+            }
+            break;
+
+        //case REG_USER_ID:
+        //    writeUserID(fd, gunID, uint8_t *pUserID);
+        //    break;
+
+        //case REG_CHARGING_PERMISSION:
+        //    readChargePermission(fd, gunID);
+        //    break;
+
+        case REG_MISC_CONTROL:
+            readMiscCommand(fd, gunID);
+            isContinue = 0;
+            break;
+
+        case REG_REPORT_CSU_VERSION:
+        case REG_REPORT_OTHER_VERSION:
+            if (gDoCommGblData.MiscCmd != 0) {
+                writeCsuModuleVersion(fd);
+                writeOtherModuleVersion(fd);
+                clearMiscCommand();
+                isContinue = 0;
+            } else {
+                //power up write dispenser version and get power cabinet system ID
+                if ((writeCsuModuleVersion(fd) == PASS) &&
+                        (writeOtherModuleVersion(fd) == PASS) &&
+                        (readQRcodeURLAndSystemDate(fd) == PASS)) {
+                    //gDoCommGblData.DisConnCount = 0;
+                    isContinue = 0;
+                }
+            }
+            break;
+
+        //case REG_PRESENT_CHARGING_INFO:
+        //    break;
+
+        case REG_QRCODE_URL_INFO:
+            if (gunID == 1) {
+                if (DiffTimeb(gRegTimeUp[plugNum][curReg], NowTime) > (LOOP_RETRY_TIME * 10)) {
+                    readQRcodeURLAndSystemDate(fd);
+                    ftime(&gRegTimeUp[plugNum][curReg]);
+                }
+            }
+            isContinue = 0;
+            //curReg = REG_SOFTWARE_UPDATE;
+            break;
+
+        //case REG_WAIT_PLUG_IT_STATE:
+        //    if (DiffTimeb(gRegTimeUp[plugNum][curReg], NowTime) > (LOOP_RETRY_TIME / 10)) {
+        //        writeWaitPlugItState(fd, gunID);
+        //        ftime(&gRegTimeUp[plugNum][curReg]);
+        //    }
+        //    isContinue = 0;
+        //    break;
+
+        default:
+            DEBUG_ERROR("error curReg = %x\r\n", curReg);
+            gDoCommGblData.MiscCmd = 0;
+            gDoCommGblData.DisConnCount = CHECK_NETWORK_FAIL_COUNT;
+            isContinue = 0;
+            break;
+        }
+
+        if (gDoCommGblData.DisConnCount >= CHECK_NETWORK_FAIL_COUNT) {
+            return DISPENSER_SOCKET_RECONN;
+        }
+    }//for
+
+    return ret;
+}
+
+//static bool isDetectPlugin()
+//{
+//    if (ShmSysConfigAndInfo->SysInfo.WaitForPlugit == YES) {
+//        return YES;
+//    }
+//
+//    return NO;
+//}
+
+static void systemStatusProcess(int fd, uint8_t totalGun, uint8_t plugNum, uint8_t gunID)
+{
+    uint8_t i = 0;
+    struct timeb AuthNowTime = {0};
+
+    switch (ChargingData[plugNum]->SystemStatus) {
+    case S_IDLE:
+    case S_RESERVATION:
+    case S_MAINTAIN:
+    case S_ALARM:
+    case S_AUTHORIZING:
+        checkAuthorProcess(fd, plugNum);
+
+        //authorization complete, write wait plug it state
+        if (gAudiCustInfo->PricesInfo[plugNum].Balance != FAIL_BALANCE_PRICES) {
+            ftime(&AuthNowTime);
+            if (DiffTimeb(gRegTimeUp[plugNum][REG_WAIT_PLUG_IT_STATE], AuthNowTime) > (LOOP_RETRY_TIME / 10)) {
+                writeWaitPlugItState(fd, gunID);
+                ftime(&gRegTimeUp[plugNum][REG_WAIT_PLUG_IT_STATE]);
+            }
+
+            ftime(&AuthNowTime);
+            if (DiffTimeb(gRegTimeUp[plugNum][REG_CHARGING_CAP], AuthNowTime) > LOOP_RETRY_TIME) {
+                readChargingCapability(fd, gunID);
+                ftime(&gRegTimeUp[plugNum][REG_CHARGING_CAP]);
+            }
+        }
+        break;
+
+    case S_PREPARNING: //get permission
+        ftime(&AuthNowTime);
+        if (DiffTimeb(gRegTimeUp[plugNum][REG_CONNECTOR_STATE], AuthNowTime) > LOOP_RETRY_TIME) {
+            writeConnectorState(fd, plugNum, gunID);
+            ftime(&gRegTimeUp[plugNum][REG_CONNECTOR_STATE]);
+        }
+
+        ftime(&AuthNowTime);
+        if (DiffTimeb(gRegTimeUp[plugNum][REG_CHARGING_PERMISSION], AuthNowTime) > LOOP_RETRY_TIME) {
+            if (readChargePermission(fd, gunID) && readChargingCapability(fd, gunID)) {
+                for (i = 0; i < totalGun; i++) {
+                    ShmPsuData->SystemAvailablePower += ChargingData[i]->AvailableChargingPower;
+                }
+                ShmPsuData->SystemPresentPsuQuantity = (ShmPsuData->SystemAvailablePower / 30);
+            }
+            ftime(&gRegTimeUp[plugNum][REG_CHARGING_PERMISSION]);
+        }
+
+        ftime(&AuthNowTime);
+        if (DiffTimeb(gRegTimeUp[plugNum][REG_PRESENT_CHARGING_INFO], AuthNowTime) > LOOP_RETRY_TIME) {
+            writePresentChargingInfo(fd, plugNum, gunID);
+            ftime(&gRegTimeUp[plugNum][REG_PRESENT_CHARGING_INFO]);
+        }
+        break;
+
+    case S_PREPARING_FOR_EV://wait connector lock
+        ftime(&AuthNowTime);
+        if (DiffTimeb(gRegTimeUp[plugNum][REG_CHARGING_CAP], AuthNowTime) > LOOP_RETRY_TIME) {
+            readChargingCapability(fd, gunID);
+            ftime(&gRegTimeUp[plugNum][REG_CHARGING_CAP]);
+        }
+
+        ftime(&AuthNowTime);
+        if (DiffTimeb(gRegTimeUp[plugNum][REG_CHARGING_PERMISSION], AuthNowTime) > LOOP_RETRY_TIME) {
+            if (readChargePermission(fd, gunID) == 0) {
+                DEBUG_INFO("S_PREPARING_FOR_EV Stop charging by power cabinet's permission = %d, %d\r\n",
+                           plugNum,
+                           REG_CHARGING_PERMISSION);
+                ChargingData[plugNum]->StopChargeFlag = POWER_CABINET_STOP_CHARGING;
+            }
+            ftime(&gRegTimeUp[plugNum][REG_CHARGING_PERMISSION]);
+        }
+
+        ftime(&AuthNowTime);
+        if (DiffTimeb(gRegTimeUp[plugNum][REG_PRESENT_CHARGING_INFO], AuthNowTime) > LOOP_RETRY_TIME) {
+            writePresentChargingInfo(fd, plugNum, gunID);
+            ftime(&gRegTimeUp[plugNum][REG_PRESENT_CHARGING_INFO]);
+        }
+        break;
+
+    case S_PREPARING_FOR_EVSE: //insaulation test
+    case S_CCS_PRECHARGE_ST0:
+    case S_CCS_PRECHARGE_ST1:
+        writeChargingTarget(fd, plugNum, gunID);
+
+        ftime(&AuthNowTime);
+        if (DiffTimeb(gRegTimeUp[plugNum][REG_CHARGING_CAP], AuthNowTime) > LOOP_RETRY_TIME) {
+            readChargingCapability(fd, gunID);
+            ftime(&gRegTimeUp[plugNum][REG_CHARGING_CAP]);
+        }
+
+        ftime(&AuthNowTime);
+        if (DiffTimeb(gRegTimeUp[plugNum][REG_CHARGING_PERMISSION], AuthNowTime) > LOOP_RETRY_TIME) {
+            if (readChargePermission(fd, gunID) == 0) {
+                DEBUG_INFO("S_PREPARING_FOR_EVSE Stop charging by power cabinet's permission = %d, %d\r\n",
+                           plugNum,
+                           REG_CHARGING_PERMISSION);
+                ChargingData[plugNum]->StopChargeFlag = POWER_CABINET_STOP_CHARGING;
+            }
+            ftime(&gRegTimeUp[plugNum][REG_CHARGING_PERMISSION]);
+        }
+
+        ftime(&AuthNowTime);
+        if (DiffTimeb(gRegTimeUp[plugNum][REG_PRESENT_CHARGING_INFO], AuthNowTime) > LOOP_RETRY_TIME) {
+            writePresentChargingInfo(fd, plugNum, gunID);
+            ftime(&gRegTimeUp[plugNum][REG_PRESENT_CHARGING_INFO]);
+        }
+        break;
+
+    case S_CHARGING: //charging
+    case S_TERMINATING:
+        ftime(&AuthNowTime);
+        if (DiffTimeb(gRegTimeUp[plugNum][REG_CHARGING_CAP], AuthNowTime) > LOOP_RETRY_TIME) {
+            readChargingCapability(fd, gunID);
+            ftime(&gRegTimeUp[plugNum][REG_CHARGING_CAP]);
+        }
+
+        ftime(&AuthNowTime);
+        if (DiffTimeb(gRegTimeUp[plugNum][REG_CHARGING_PERMISSION], AuthNowTime) > LOOP_RETRY_TIME) {
+            if (readChargePermission(fd, gunID) == 0) {
+                DEBUG_INFO("Stop charging by power cabinet's permission = %d, %d\r\n",
+                           plugNum,
+                           REG_CHARGING_PERMISSION);
+                ChargingData[plugNum]->StopChargeFlag = POWER_CABINET_STOP_CHARGING;
+                //printf("%d StopChargeFlag = %d\r\n", plugNum, ChargingData[plugNum]->StopChargeFlag);
+            }
+            ftime(&gRegTimeUp[plugNum][REG_CHARGING_PERMISSION]);
+        }
+        writeChargingTarget(fd, plugNum, gunID);
+
+        ftime(&AuthNowTime);
+        if (DiffTimeb(gRegTimeUp[plugNum][REG_PRESENT_CHARGING_INFO], AuthNowTime) > LOOP_RETRY_TIME) {
+            writePresentChargingInfo(fd, plugNum, gunID);
+            ftime(&gRegTimeUp[plugNum][REG_PRESENT_CHARGING_INFO]);
+        }
+        break;
+
+    case S_COMPLETE:
+        ftime(&AuthNowTime);
+        if (DiffTimeb(gRegTimeUp[plugNum][REG_CHARGING_CAP], AuthNowTime) > LOOP_RETRY_TIME) {
+            readChargingCapability(fd, gunID);
+            ftime(&gRegTimeUp[plugNum][REG_CHARGING_CAP]);
+        }
+        break;
+
+    default:
+        break;
+    }
+}
+
+static int networkCreatePorcess(void)
+{
+    int fd = 0;
+
+    /**************** Check Network **********/
+    DEBUG_INFO("Check Dispenser Network Information");
+    while (!CheckNetworkStatus()) {
+        calDisconnectCount(&gDoCommGblData.DisConnCount, CHECK_NETWORK_FAIL_COUNT);
+        DEBUG_ERROR("disconnect count = % d\r\n", gDoCommGblData.DisConnCount);
+    }
+    DEBUG_INFO("Dispenser Network Information checked: IP = % s Netmask = % s, Gateway = % s",
+               ShmSysConfigAndInfo->SysConfig.Eth0Interface.EthIpAddress,
+               ShmSysConfigAndInfo->SysConfig.Eth0Interface.EthSubmaskAddress,
+               ShmSysConfigAndInfo->SysConfig.Eth0Interface.EthGatewayAddress);
+
+    gDoCommGblData.DisConnCount = 0;
+
+    /**************** Power cabinet connection **********/
+    DEBUG_INFO("Connect to Power Cabinet");
+    while ((fd = doCommConnToServer()) <= 0) {
+        calDisconnectCount(&gDoCommGblData.DisConnCount, CONNECT_SERVER_FAIL_COUNT);
+        DEBUG_ERROR("disconnect count = %d, fd = %d\r\n", gDoCommGblData.DisConnCount, fd);
+    }
+    DEBUG_INFO("Power cabinet connected(fd = % d): IP = % s Netmask = % s, Gateway = % s",
+               fd,
+               ShmSysConfigAndInfo->SysConfig.Eth0Interface.EthIpAddress,
+               ShmSysConfigAndInfo->SysConfig.Eth0Interface.EthSubmaskAddress,
+               ShmSysConfigAndInfo->SysConfig.Eth0Interface.EthGatewayAddress);
+
+    gDoCommGblData.DisConnCount = 0;
+    destroySelectGun(DESTROY_ALL_SEL);
+
+    sleep(3);
+
+    setTcpStatus(NORMAL);
+
+    return fd;
+}
+
+int main(int argc, char *argv[])
+{
+    uint8_t plugNum = 0, gunID = 0;
+    uint8_t index = 0;
+    uint8_t totalConnCount = 0;
+    uint8_t initDone = DISPENER_INIT_FAIL;
+    int fd = 0;
+    int isContinue = 1;
+
+    InitSocketSigPipe();
+
+    /**************** Initialization **********/
+    if (InitShareMemory() == 0) {
+        if (ShmStatusCodeData != NULL) {
+            ShmStatusCodeData->AlarmCode.AlarmEvents.bits.FailToCreateShareMemory = YES;
+        }
+
+        DEBUG_ERROR("DoComm Initial share memory fail\r\n");
+        sleep(5);
+
+        return 0;
+    }
+
+    totalConnCount = ShmSysConfigAndInfo->SysConfig.TotalConnectorCount;
+
+    for (index = 0; index < totalConnCount; index++) {
+        if (!FindChargingInfoData(index, &ChargingData[0])) {
+            DEBUG_ERROR("FindChargingInfoData false \n");
+            break;
+        }
+        clearPricesInfo(index);
+    }
+
+    //initial trigger message timer
+    for (index = 0; index < MAX_REGISTER_NUM; index++) {
+        ftime(&gRegTimeUp[0][index]);
+        ftime(&gRegTimeUp[1][index]);
+        usleep(50000);
+    }
+
+    setTcpStatus(NORMAL);
+
+    while (isContinue) {
+        if (initDone == DISPENER_INIT_FAIL) {
+            fd = networkCreatePorcess();
+
+            initDone = messageTrigger(fd, 0, 0, REG_MODEL_NAME); //first trigger model name and connector id
+        } else {
+            plugNum = 0;
+            gunID = 0;
+            for (plugNum = 0; plugNum < totalConnCount; plugNum++) {
+                checkAuthorProcess(fd, plugNum);
+                //plugNum = setup chargingData value for bottom layer
+                //gunID = (plugNum  + 1); //connector Id, 1 = left gun, 2 = right gun
+                gunID = gDoCommGblData.ConnectorID[plugNum];
+                systemStatusProcess(fd, totalConnCount, plugNum, gunID);
+
+                initDone = messageTrigger(fd,
+                                          plugNum,
+                                          gunID,
+                                          REG_POWER_CABINET_STATUS);
+
+                if (initDone == DISPENSER_SOCKET_RECONN) {
+                    break;
+                }
+            }
+        }
+
+        if (initDone == DISPENSER_SOCKET_RECONN) {
+            DEBUG_INFO("Disconnected from power cabinet...re-connecting");
+            setTcpStatus(ABNORMAL);
+
+            gDoCommGblData.DisConnCount = 0;
+            gDoCommGblData.SeqNum = 0;
+
+            closeSocket(fd);
+            fd = 0;
+
+            initDone = DISPENER_INIT_FAIL;
+        }
+
+        //update dispenser firmware
+        if (initDone != DISPENER_INIT_FAIL) {
+            updateFirmwareProcess(fd, gDoCommGblData.ConnectorID[0], totalConnCount);
+        }
+
+        usleep(1000);
+    }
+}

EVSE/Projects/DD360ComBox/Apps/ReDoComm.h

@@ -0,0 +1,235 @@
+#ifndef _DO_COMM_H_
+#define _DO_COMM_H_
+
+//------------------------------------------------------------------------------
+//--- common define ---
+//------------------------------------------------------------------------------
+#define CMP_ETH_IP_HEAD                         "192.168.100"
+
+#define DoIPAddress                             "192.168.100.1"
+#define DoTcpPort                               36000
+
+#define IMAGE_FILE_PATH                         "../mnt"
+#define TFTP_PULL_CMD                           "tftp"
+#define SIGTERM_MSG                             "SegmentFault.~~~~\n"
+
+#define MAX_REGISTER_NUM                        30
+
+#define CHECK_NETWORK_FAIL_COUNT                3//10
+#define CONNECT_SERVER_FAIL_COUNT               3//5
+#define WARNING_CODE_SIZE                       6
+
+#define MAX_VOLTAGE                             10000
+#define MAX_CURRENCY                            5000
+#define MAX_POWER                               3600
+
+#define DISPENSER_INIT_SUCC                     0x01
+#define DISPENER_INIT_FAIL                      0x02
+#define DISPENSER_SOCKET_RECONN                 0x03
+
+#define VERSION_BUF_SIZE                        32
+
+#define PRICES_UNIT                             0.01
+
+#define PASS                                    (1)
+#define FAIL                                    (-1)
+
+#define YES                                     (1)
+#define NO                                      (0)
+
+#define NO_DEFINE                               255
+
+#define LOOP_RETRY_TIME                         1000 //1 second
+
+#define NORMAL                                  0
+#define ABNORMAL                                1
+
+//------------------------------------------------------------------------------
+//--- dispenser ID ---
+//------------------------------------------------------------------------------
+#define ID_RESERVER                             0x00
+#define ID_OF_DISPENSER                         0x01
+#define ID_REGISTER                             0xFF
+
+//------------------------------------------------------------------------------
+//--- dispenser operation ---
+//------------------------------------------------------------------------------
+#define OP_READ_DATA                            0x01
+#define OP_WRITE_DATA                           0x02
+#define OP_WAIT_RESPONSE                        0x03
+
+//------------------------------------------------------------------------------
+//--- connector status ---
+//------------------------------------------------------------------------------
+#define CONN_ST_IDLE                            0x00
+#define CONN_ST_PREPARING                       0x01
+#define CONN_ST_CHARGING                        0x02
+#define CONN_ST_TERMINATING                     0x03
+#define CONN_ST_ALARM                           0x04
+
+//------------------------------------------------------------------------------
+//--- dispenser register ---
+//------------------------------------------------------------------------------
+#define REG_MODEL_NAME                          0x01
+#define REG_CONNECTOR_ID                        0x02
+#define REG_POWER_CABINET_STATUS                0x03
+#define REG_DISPENSER_STATUS                    0x04
+#define REG_CHARGING_CAP                        0x05
+#define REG_CHARGING_TARGET                     0x06
+#define REG_SOFTWARE_UPDATE                     0x07
+#define REG_PLUG_IN_STATE                       0x08
+#define REG_CONNECTOR_STATE                     0x09
+#define REG_USER_ID                             0x0A
+#define REG_CHARGING_PERMISSION                 0x0B
+#define REG_MISC_CONTROL                        0X0C
+#define REG_REPORT_CSU_VERSION                  0X0D
+#define REG_REPORT_OTHER_VERSION                0X0E
+#define REG_PRESENT_CHARGING_INFO               0X0F
+#define REG_QRCODE_URL_INFO                     0X10
+#define REG_WAIT_PLUG_IT_STATE                  0x11
+
+//------------------------------------------------------------------------------
+//--- dispenser result ---
+//------------------------------------------------------------------------------
+#define COMMAND_RESULT_OK                       0x01
+#define COMMAND_RESULT_NG                       0x02 //wait state
+
+//------------------------------------------------------------------------------
+//--- power cabinet misc status code ---
+//------------------------------------------------------------------------------
+#define MISC_ST_MISC_CMD                        "B40001"
+
+#define MISC_ST_VERSION                         "B40999"
+
+//------------------------------------------------------------------------------
+//--- power cabinet misc command ---
+//------------------------------------------------------------------------------
+#define MISC_CMD_CONNECOTOR_TIMEOUT             0X0001
+#define MISC_CMD_OPERATIVE_STATE                0X0002
+#define MISC_CMD_DEFAULT_PRICES                 0x0003
+#define MISC_CMD_DEFAULT_CURRENCY               0x0004
+#define MISC_CMD_ACCOUNT_BALANCE                0x0005
+
+#define MISC_CMD_BACKEND_STATUS                 0x0006
+#define MISC_CMD_ETHERNET_STATUS                0x0007
+#define MISC_CMD_WIFI_STATUS                    0x0008
+#define MISC_CMD_4G_STATUS                      0x0009
+
+#define MISC_CMD_HARDWARE_REBOOT                0x0101
+#define MISC_CMD_SOFTWARE_RESTART               0x0102
+#define MISC_CMD_REMOTE_START_CHARGING          0x0103
+#define MISC_CMD_REMOTE_STOP_CHARGING           0x0104
+#define MISC_CMD_REMOTE_UNLOCK                  0x0105
+
+#define ST_UPDATE_FIRMWARE                      0x01
+#define ST_NO_UPDATE_FIRMWARE                   0x02
+
+//------------------------------------------------------------------------------
+#pragma pack(push)
+#pragma pack(1)
+
+typedef struct StConnectorState {
+    uint8_t State;
+    uint8_t WarningCode[6];
+    uint8_t Reserved;
+} ConnectorState;
+
+typedef struct StConnectorIDTable {
+    uint8_t DcConnID1;
+    uint8_t DcConnID2;
+    uint8_t AcConnID;
+} ConnectorIDTable;
+
+typedef struct StDoCommGlobalVar {
+    uint8_t SeqNum;
+    uint8_t DisConnCount;
+    uint8_t ConnectorID[3]; //keep from power cabinet
+    uint8_t MiscCmd;
+    uint8_t Reserved[2];
+} DoCommGblData;
+
+typedef struct StCommnadHead {
+    uint8_t SeqNum;     //sequence number 0 ~ 255
+    uint8_t ID;         //0: Reserved, 0x01 ~ 0xFE: connector ID, 0xFF: exists in register 1 and register 2
+    uint8_t OP;         //0x01: read, 0x02: write, 0x03: response from power cabinet
+    uint8_t DataLen;    //raw data Length
+} CmdHead;
+
+typedef struct StCommandData {
+    uint8_t Register;   /*  0x01: dispenser model name (maximum 32 bytes) and the value of dispenser switch
+                            0x02: The ID to connector equipped at dispenser
+                            0x03: Power cabinet status
+                            0x04: Dispenser status
+                            0x05: The charging capacity of each connector
+                            0x06: The required voltage and current during charging
+                            0x07: The indicator of software update to dispenser
+                            0x08: Indicate whether the connector is plug-in or not
+                            0x09: Indicate the connector state
+                            0x0A: The user ID can be RFID card number, EVCCID, etc.
+                            0x0B: Charging permission from power cabinet to dispenser
+                        */
+    uint8_t Data[250];
+} CmdData;
+
+typedef struct StResultData {
+    uint8_t Register;   /*  0x01: dispenser model name (maximum 32 bytes) and the value of dispenser switch
+                            0x02: The ID to connector equipped at dispenser
+                            0x03: Power cabinet status
+                            0x04: Dispenser status
+                            0x05: The charging capacity of each connector
+                            0x06: The required voltage and current during charging
+                            0x07: The indicator of software update to dispenser
+                            0x08: Indicate whether the connector is plug-in or not
+                            0x09: Indicate the connector state
+                            0x0A: The user ID can be RFID card number, EVCCID, etc.
+                            0x0B: Charging permission from power cabinet to dispenser
+                        */
+    uint8_t Result;
+    uint8_t Data[249];
+} ResultData;
+
+typedef struct StCsuCmdPkt {
+    CmdHead Head;
+    CmdData Data;
+} CsuCmdPkt;
+
+typedef struct StCsuResultPkt {
+    CmdHead Head;
+    ResultData Data;
+} CsuResultPkt;
+
+typedef struct StMiscCommand {
+    uint16_t CMD;
+    uint8_t Value[4];
+} MiscCommand;
+
+typedef struct StPresentChargingInfo {
+    uint16_t PresentChargingVoltage;   //0~6553.5 volt
+    uint16_t PresentChargingCurrent;   //0~6553.5 amp
+    int RemainChargingDuration;     // second
+    uint8_t EvBatterySoc;               // 0~100%
+} PreChargingInfo;
+
+typedef struct StSoftwareUpdInfo {
+    uint8_t UpdateState;         //1:update , 2: not update
+    uint8_t ImgName[248];
+} SoftwareUpdInfo;
+
+typedef struct StCapabilityInfo {
+    uint16_t OutputVoltage;
+    uint16_t OutputCurrent;
+    uint16_t OutputPower;
+    uint8_t Reserved[2];
+} CapabilityInfo;
+
+typedef struct StAccountInfo {
+    uint8_t Currency;
+    int UserPrices;
+    int TotalCost;
+    int Balance;
+    uint8_t Reserved[3];
+} AccountInfo;
+
+#pragma pack(pop)
+
+#endif /* _DO_COMM_H_ */

EVSE/Projects/DD360ComBox/Apps/ReMain.c

@@ -0,0 +1,6653 @@
+#include <sys/types.h>
+#include <sys/stat.h>
+#include <sys/time.h>
+#include <sys/timeb.h>
+#include <sys/types.h>
+#include <sys/ioctl.h>
+#include <sys/socket.h>
+#include <sys/ipc.h>
+#include <sys/shm.h>
+#include <sys/mman.h>
+#include <linux/wireless.h>
+#include <arpa/inet.h>
+#include <netinet/in.h>
+
+#include <unistd.h>
+#include <stdarg.h>
+#include <stdio.h>      /*標準輸入輸出定義*/
+#include <stdlib.h>     /*標準函數庫定義*/
+#include <unistd.h>     /*Unix 標準函數定義*/
+#include <fcntl.h>      /*檔控制定義*/
+#include <termios.h>    /*PPSIX 終端控制定義*/
+#include <errno.h>      /*錯誤號定義*/
+#include <errno.h>
+#include <string.h>
+#include <stdint.h>
+#include <time.h>
+#include <ctype.h>
+#include <ifaddrs.h>
+#include <math.h>
+#include "../../define.h"
+#include "Config.h"
+#include <stdbool.h>
+#include <dirent.h>
+#include "timeout.h"
+
+#if defined DD360 ||defined DD360Audi || defined DD360ComBox
+#include "AudiCust.h"
+#endif //defined DD360Audi
+
+#define ARRAY_SIZE(A)                           (sizeof(A) / sizeof(A[0]))
+#define PASS                                    1
+#define FAIL                                    -1
+#define MODELNAME_FAIL                          0
+#define BUFFER_SIZE                             128
+#define YES                                     1
+#define NO                                      0
+#define NORMAL                                  0
+#define ABNORMAL                                1
+#define EQUAL                                   0
+#define BTN_RELEASE                             0
+#define BTN_PRESS                               1
+#define MAX_BUF                                 64
+#define MtdBlockSize                            0x600000
+#define SYSFS_GPIO_DIR                          "/sys/class/gpio"
+#define UPGRADE_FAN                             0x02
+#if defined DD360 ||defined DD360Audi || defined DD360ComBox
+#define UPGRADE_RB                              0x09 //0x09 for DD360 dispenser
+#else
+#define UPGRADE_RB                              0x03 //other module use
+#endif //defined DD360 || defined DD360Audi
+#define UPGRADE_PRI                             0x04
+#define UPGRADE_AC                              0x05
+#define UPGRADE_LED                             0x06
+#define SYSTEM_MIN_VOL                          80 //150
+#define MIN_OUTPUT_CUR                          0
+#define AC_OUTPUT_VOL                           220
+
+#define NO_DEFINE                               255
+#define DEFAULT_AC_INDEX                        2
+#define PSU_MIN_CUR                             100
+
+#define DB_FILE                                 "/Storage/ChargeLog/localCgargingRecord.db"
+
+#define uSEC_VAL                                1000000
+#define SELFTEST_TIMEOUT                        60//45
+#define AUTHORIZE_TIMEOUT                       15//30
+#define AUTHORIZE_COMP_TIMEOUT                  3
+#define AUTHORIZE_FAIL_TIMEOUT                  3
+#define AUTHORIZE_STOP_TIMEOUT                  30
+#define RETURN_TO_CHARGING_PAGE                 30
+#define GUN_PREPARE_TIMEOUT                     30
+#define GUN_EV_WAIT_TIMEOUT                     120
+#define GUN_EVSE_WAIT_TIMEOUT                   60
+#define GUN_COMP_WAIT_TIMEOUT                   10
+#define GUN_PRECHARGING_TIMEOUT                 60
+
+typedef struct StLedConfig {
+    //OutputDrvValue[0]
+    uint8_t LeftButtonLed: 1;                   //bit 0,    H: ON,      L:OFF
+    uint8_t RightButtonLed: 1;                  //bit 1,    H: ON,      L:OFF
+    uint8_t GreenLED: 1;                        //bit 2,    H: ON,      L:OFF
+    uint8_t YellowLED: 1;                       //bit 3,    H: ON,      L:OFF
+    uint8_t RedLED: 1;                          //bit 4,    H: ON,      L:OFF
+    uint8_t SystemLed4: 1;                      //bit 5,    H: ON,      L:OFF
+    uint8_t AcContactor: 1;                     //bit 6,    H: ON,      L:OFF
+    uint8_t Reserved: 1;                        //bit 7 reserved
+} LedConfig;
+
+char *valid_Internet[2] = {"8.8.8.8", "180.76.76.76"};
+unsigned char mask_table[] = { 0x01, 0x02, 0x04, 0x08, 0x10, 0x20, 0x40, 0x80 };
+int whileLoopTime = 10000; // 10 ms
+int wtdFd = -1;
+byte _authorizeIndex = NO_DEFINE;
+
+#if defined METER_ENABLE
+bool relayWeldingCheck = false;
+bool relayDrivingCheck = false;
+#endif //defined METER_ENABLE
+
+bool IsAuthorizingMode();
+void ClearAuthorizedFlag();
+bool isDetectPlugin();
+void ClearDetectPluginFlag();
+int mystrcmp(unsigned char *p1, unsigned char *p2);
+
+long long DiffTimebWithNow(struct timeb ST);
+unsigned char DetectBitValue(unsigned char _byte, unsigned char _bit);
+void SetBitValue(unsigned char *_byte, unsigned char _bit, unsigned char value);
+void ChargingTerminalProcess(byte gunIndex);
+void ChkPrimaryStatus();
+void StartSystemTimeoutDet(unsigned char flag);
+void StopSystemTimeoutDet();
+void StartGunInfoTimeoutDet(unsigned char gunIndex, unsigned char flag);
+void StopGunInfoTimeoutDet(unsigned char gunIndex);
+int StoreLogMsg_1(const char *fmt, ...);
+unsigned long GetTimeoutValue(struct timeval _sour_time);
+void gpio_set_value(unsigned int gpio, unsigned int value);
+void PRINTF_FUNC(char *string, ...);
+void ChangeGunSelectByIndex(byte sel);
+void InformOcppErrOccur(byte codeType);
+
+void RecordAlarmCode(byte gunIndex, char *code);
+void RecordWarningCode(byte gunIndex, char *code);
+void ReleaseWarningCodeByString(byte gunIndex, char *code);
+void ReleaseAlarmCode(byte gunIndex);
+
+int DB_Open(sqlite3 *db);
+int DB_Insert_Record(sqlite3 *db, int gun_index);
+int DB_Update_Operactive(sqlite3 *db, uint8_t gun_index, uint8_t IsAvailable);
+int DB_Get_Operactive(sqlite3 *db, uint8_t gun_index);
+
+#define log_info(format, args...) StoreLogMsg_1("[%s:%d][%s][Info] "format, __FILE__, __LINE__, __FUNCTION__, ##args)
+#define log_warn(format, args...) StoreLogMsg_1("[%s:%d][%s][Warn] "format, __FILE__, __LINE__, __FUNCTION__, ##args)
+#define log_error(format, args...) StoreLogMsg_1("[%s:%d][%s][Error] "format, __FILE__, __LINE__, __FUNCTION__, ##args)
+
+struct SysConfigAndInfo         *ShmSysConfigAndInfo;
+struct StatusCodeData           *ShmStatusCodeData;
+struct PsuData                  *ShmPsuData;
+struct CHAdeMOData              *ShmCHAdeMOData;
+struct GBTData                  *ShmGBTData;
+struct CcsData                  *ShmCcsData;
+struct PrimaryMcuData           *ShmPrimaryMcuData;
+struct FanModuleData            *ShmFanModuleData;
+struct RelayModuleData          *ShmRelayModuleData;
+struct LedModuleData            *ShmLedModuleData;
+struct OCPP16Data               *ShmOCPP16Data;
+
+struct ChargingInfoData         *chargingInfo[CHAdeMO_QUANTITY + CCS_QUANTITY + GB_QUANTITY];
+struct ChargingInfoData         *ac_chargingInfo[AC_QUANTITY];
+struct timeb                    startChargingTime[CHAdeMO_QUANTITY + CCS_QUANTITY + GB_QUANTITY];
+struct timeb                    endChargingTime[CHAdeMO_QUANTITY + CCS_QUANTITY + GB_QUANTITY];
+
+#if defined METER_ENABLE
+struct MeterInformation         *ShmCsuMeterData;
+struct DcCommonInformation      *ShmDcCommonData;
+#endif //defined METER_ENABLE
+
+#if defined DD360 ||defined DD360Audi || defined DD360ComBox
+static AudiCustInfo             *gAudiCustInfo = NULL; //Jerry add
+#endif //defined DD360Audi
+
+// for initial index to check EV board type is correct
+byte _gunIndex = 0;
+byte _acgunIndex = 0;
+byte _chademoIndex = 0;
+byte _ccsIndex = 0;
+byte _gb_Index = 0;
+byte _ac_Index = 0;
+byte bd0_1_status = 0;
+byte bd0_2_status = 0;
+byte bd1_1_status = 0;
+byte bd1_2_status = 0;
+
+static uint8_t restartFlag = 0;
+
+bool isCardScan = false;
+bool isModelNameMatch = true;
+
+int rfidFd = -1;
+char *rfidPortName = "/dev/ttyS2";
+char *fwVersion = "V1.07.00.0000.00"; // "V0.16.00.0000.00";
+
+sqlite3 *localDb;
+bool isDb_ready;
+
+#if defined DD360Audi
+//------------------------------------------------------------------------------
+//--- share memory value ---
+//------------------------------------------------------------------------------
+static void changeLcmPage(uint8_t index)
+{
+    ShmSysConfigAndInfo->SysInfo.SystemPage = index;
+}
+
+static uint8_t getCurLcmPage(void)
+{
+    return ShmSysConfigAndInfo->SysInfo.SystemPage;
+}
+
+//------------------------------------------------------------------------------
+static void destroySelGun(uint8_t curGun)
+{
+    uint8_t i = 0;
+    uint8_t totalGun = ShmSysConfigAndInfo->SysConfig.TotalConnectorCount;
+
+    //for status timeout
+    if (curGun == DESTROY_ALL_SEL) {
+        gAudiCustInfo->SelGunInfo.RightGun = SEL_GUN_RELEASE;
+        gAudiCustInfo->SelGunInfo.LeftGun = SEL_GUN_RELEASE;
+        log_info("destroy all gun = %d, %d\r\n",
+                 gAudiCustInfo->SelGunInfo.LeftGun,
+                 gAudiCustInfo->SelGunInfo.RightGun);
+        for (i = 0; i < totalGun; i++) {
+            StopGunInfoTimeoutDet(i);
+            memset(&gAudiCustInfo->PricesInfo[i], 0, sizeof(PricesInfo));
+        }
+        ShmSysConfigAndInfo->SysInfo.CurGunSelected = 0;
+        strcpy((char *)ShmSysConfigAndInfo->SysConfig.UserId, "");
+        //changeLcmPage(_LCM_SELECT_GUN);
+        return;
+    }
+
+    //for charging timeout or complete
+    if ((curGun == LEFT_GUN_NUM) && (gAudiCustInfo->SelGunInfo.LeftGun != SEL_GUN_RELEASE)) {
+        if (gAudiCustInfo->SelGunInfo.LeftGun == SEL_GUN_CONFIRM ||
+                gAudiCustInfo->SelGunInfo.LeftGun == SEL_GUN_ATHOR) {
+            changeLcmPage(_LCM_SELECT_GUN);
+        }
+        gAudiCustInfo->SelGunInfo.LeftGun = SEL_GUN_RELEASE;
+        StopGunInfoTimeoutDet(LEFT_GUN_NUM);
+        if (ShmOCPP16Data->SpMsg.bits.AuthorizeConf != NO) {
+            ClearAuthorizedFlag();
+        }
+
+        log_info("destroy left gun, cur page = %d\r\n", getCurLcmPage());
+        if (getCurLcmPage() == ShmSysConfigAndInfo->SysInfo.SystemPage) {
+            log_info("clear left balance\r\n");
+            memset(&gAudiCustInfo->PricesInfo[curGun], 0, sizeof(PricesInfo));
+            gAudiCustInfo->PricesInfo[curGun].Balance = FAIL_BALANCE_PRICES;
+        }
+    }
+
+    if ((curGun == RIGHT_GUN_NUM) && (gAudiCustInfo->SelGunInfo.RightGun != SEL_GUN_RELEASE)) {
+        if (gAudiCustInfo->SelGunInfo.RightGun == SEL_GUN_CONFIRM ||
+                gAudiCustInfo->SelGunInfo.RightGun == SEL_GUN_ATHOR) {
+            changeLcmPage(_LCM_SELECT_GUN);
+        }
+        gAudiCustInfo->SelGunInfo.RightGun = SEL_GUN_RELEASE;
+        StopGunInfoTimeoutDet(RIGHT_GUN_NUM);
+        if (ShmOCPP16Data->SpMsg.bits.AuthorizeConf != NO) {
+            ClearAuthorizedFlag();
+        }
+
+        log_info("destroy right gun, cur page = %d\r\n", getCurLcmPage());
+        if (getCurLcmPage() == ShmSysConfigAndInfo->SysInfo.SystemPage) {
+            log_info("clear right balance\r\n");
+            memset(&gAudiCustInfo->PricesInfo[curGun], 0, sizeof(PricesInfo));
+            gAudiCustInfo->PricesInfo[curGun].Balance = FAIL_BALANCE_PRICES;
+        }
+    }
+}
+
+static int waitRightGunPlugIt(uint8_t curGun)
+{
+    if ((curGun == RIGHT_GUN_NUM) && (gAudiCustInfo->SelGunInfo.RightGun == SEL_GUN_ATHOR)) {
+        return PASS;
+    }
+
+    return FAIL;
+}
+
+static int waitLeftGunPlugIt(uint8_t curGun)
+{
+    if ((curGun == LEFT_GUN_NUM) && (gAudiCustInfo->SelGunInfo.LeftGun == SEL_GUN_ATHOR)) {
+        return PASS;
+    }
+
+    return FAIL;
+}
+
+static void setSelGunWaitToAuthor(uint8_t curSel)
+{
+    if (curSel == LEFT_GUN_NUM && gAudiCustInfo->SelGunInfo.LeftGun == SEL_GUN_CONFIRM) {
+        gAudiCustInfo->SelGunInfo.LeftGun = SEL_GUN_ATHOR;
+        //printf("setSelGunWaitToAuthor left\r\n");
+        StopGunInfoTimeoutDet(curSel);
+    } else if (curSel == RIGHT_GUN_NUM && gAudiCustInfo->SelGunInfo.RightGun == SEL_GUN_CONFIRM) {
+        gAudiCustInfo->SelGunInfo.RightGun = SEL_GUN_ATHOR;
+        //printf("setSelGunWaitToAuthor right\r\n");
+        StopGunInfoTimeoutDet(curSel);
+    }
+}
+
+static int getConfirmSelectedGun(uint8_t curSel)
+{
+    if (((curSel == LEFT_GUN_NUM) && (gAudiCustInfo->SelGunInfo.LeftGun >= SEL_GUN_CONFIRM)) ||
+            ((curSel == RIGHT_GUN_NUM) && (gAudiCustInfo->SelGunInfo.RightGun >= SEL_GUN_CONFIRM))) {
+        return PASS;
+    }
+
+    return FAIL;
+}
+
+static void confirmSelGun(uint8_t selGun)
+{
+    if (selGun == LEFT_GUN_NUM) {
+        gAudiCustInfo->SelGunInfo.LeftGun = SEL_GUN_CONFIRM;
+        StopGunInfoTimeoutDet(selGun);
+        //printf("confirmSelGun left\r\n");
+    } else if (selGun == RIGHT_GUN_NUM) {
+        gAudiCustInfo->SelGunInfo.RightGun = SEL_GUN_CONFIRM;
+        StopGunInfoTimeoutDet(selGun);
+        //printf("confirmSelGun right\r\n");
+    }
+
+    changeLcmPage(_LCM_IDLE);
+
+    StartGunInfoTimeoutDet(selGun, Timeout_SelectGun);
+}
+#endif // defined DD360Audi
+
+static void startPrimaryLedIndicatorCtrlFork(void)
+{
+    pid_t pid = fork();
+    if (pid == 0) {
+        uint8_t totalGun = ShmSysConfigAndInfo->SysConfig.TotalConnectorCount;
+        uint8_t gunIndex = 0;
+        int isContinue = 1;
+        LedConfig *pLedConfig = (LedConfig *)&ShmPrimaryMcuData->OutputDrv.OutputDrvValue[0];
+
+        while (isContinue) {
+            for (gunIndex = 0; gunIndex < totalGun; gunIndex++) {
+                //printf("led indicator status = %d\r\n", chargingInfo[gunIndex]->SystemStatus);
+                //printf("level = %d\r\n", ShmSysConfigAndInfo->SysWarningInfo.Level);
+                switch (chargingInfo[gunIndex]->SystemStatus) {
+                case S_BOOTING:
+                    pLedConfig->RedLED = YES;
+                    pLedConfig->YellowLED = YES;
+                    pLedConfig->GreenLED = YES;
+                    break;
+
+                case S_IDLE:
+                case S_RESERVATION:
+                case S_AUTHORIZING:
+                case S_REASSIGN_CHECK:
+                case S_REASSIGN:
+                case S_PREPARNING:
+                case S_PREPARING_FOR_EV:
+                case S_PREPARING_FOR_EVSE:
+                case S_CCS_PRECHARGE_ST0:
+                case S_CCS_PRECHARGE_ST1:
+                    pLedConfig->RedLED = NO;
+                    pLedConfig->YellowLED = NO;
+
+                    if (pLedConfig->GreenLED == YES) {
+                        pLedConfig->GreenLED = NO;
+                    } else {
+                        pLedConfig->GreenLED = YES;
+                    }
+                    break;
+
+                case S_CHARGING:
+                    pLedConfig->RedLED = NO;
+                    if (pLedConfig->YellowLED == YES) {
+                        pLedConfig->YellowLED = NO;
+                    } else {
+                        pLedConfig->YellowLED = YES;
+                    }
+                    pLedConfig->GreenLED = NO;
+                    break;
+
+                case S_ALARM:
+                case S_TERMINATING:
+                case S_COMPLETE:
+                    if (ShmSysConfigAndInfo->SysWarningInfo.Level == 2) {
+                        pLedConfig->YellowLED = NO;
+                        pLedConfig->GreenLED = NO;
+                        if (pLedConfig->RedLED == YES) {
+                            pLedConfig->RedLED = NO;
+                        } else {
+                            pLedConfig->RedLED = YES;
+                        }
+                    } else {
+                        pLedConfig->RedLED = NO;
+                        pLedConfig->YellowLED = NO;
+                        pLedConfig->GreenLED = YES;
+                    }
+                    break;
+
+                case S_MAINTAIN:
+                case S_FAULT:
+                    pLedConfig->YellowLED = NO;
+                    pLedConfig->GreenLED = NO;
+                    if (ShmSysConfigAndInfo->SysWarningInfo.Level == 2) {
+                        if (pLedConfig->RedLED == YES) {
+                            pLedConfig->RedLED = NO;
+                        } else {
+                            pLedConfig->RedLED = YES;
+                        }
+                    }
+                    break;
+
+                case S_BOOKING:
+                case S_DEBUG:
+                case S_UPDATE:
+                case S_NONE:
+                    break;
+                }
+
+                usleep(500000);
+            }//switch
+        }//for
+    }//while
+}
+
+//================================================
+// initial can-bus
+//================================================
+int InitCanBus()
+{
+    int                     s0, nbytes;
+    struct timeval          tv;
+    struct ifreq            ifr0;
+    struct sockaddr_can     addr0;
+
+    system("/sbin/ip link set can0 down");
+    system("/sbin/ip link set can0 type can bitrate 500000 restart-ms 100");
+    system("/sbin/ip link set can0 up");
+
+    s0 = socket(PF_CAN, SOCK_RAW, CAN_RAW);
+
+    tv.tv_sec = 0;
+    tv.tv_usec = 10000;
+    if (setsockopt(s0, SOL_SOCKET, SO_RCVTIMEO, (char *)&tv, sizeof(struct  timeval)) < 0) {
+#ifdef SystemLogMessage
+        log_error("Set SO_RCVTIMEO NG");
+#endif
+    }
+    nbytes = 40960;
+    if (setsockopt(s0, SOL_SOCKET,  SO_RCVBUF, &nbytes, sizeof(int)) < 0) {
+#ifdef SystemLogMessage
+        log_error("Set SO_RCVBUF NG");
+#endif
+    }
+    nbytes = 40960;
+    if (setsockopt(s0, SOL_SOCKET, SO_SNDBUF, &nbytes, sizeof(int)) < 0) {
+#ifdef SystemLogMessage
+        log_error("Set SO_SNDBUF NG");
+#endif
+    }
+
+    strcpy(ifr0.ifr_name, "can0" );
+    ioctl(s0, SIOCGIFINDEX, &ifr0); /* ifr.ifr_ifindex gets filled with that device's index */
+    addr0.can_family = AF_CAN;
+    addr0.can_ifindex = ifr0.ifr_ifindex;
+    bind(s0, (struct sockaddr *)&addr0, sizeof(addr0));
+    return s0;
+}
+
+//================================================
+// initial uart port
+//================================================
+char *_priPortName = "/dev/ttyS1";
+char *_485PortName = "/dev/ttyS5";
+
+int InitComPort(byte target)
+{
+    int fd;
+    struct termios tios;
+
+    if (target == UPGRADE_PRI) {
+        fd = open(_priPortName, O_RDWR);
+    } else if (target == UPGRADE_FAN ||  target == UPGRADE_RB || target == UPGRADE_AC || target == UPGRADE_LED) {
+        fd = open(_485PortName, O_RDWR);
+    }
+
+    if (fd <= 0) {
+#ifdef SystemLogMessage
+        log_error("open 407 Communication port NG \n");
+#endif
+        return -1;
+    }
+    ioctl (fd, TCGETS, &tios);
+    tios.c_cflag = B115200 | CS8 | CLOCAL | CREAD;
+    tios.c_lflag = 0;
+    tios.c_iflag = 0;
+    tios.c_oflag = 0;
+    tios.c_cc[VMIN] = 0;
+    tios.c_cc[VTIME] = (unsigned char)1;
+    tios.c_lflag = 0;
+    tcflush(fd, TCIFLUSH);
+    ioctl (fd, TCSETS, &tios);
+
+    return fd;
+}
+
+//=================================
+// Common routine
+//=================================
+void substr(char *dest, const char *src, unsigned int start, unsigned int cnt)
+{
+    strncpy(dest, src + start, cnt);
+    dest[cnt] = 0;
+}
+
+int InitWatchDog()
+{
+    int fd;
+    system("/usr/bin/fuser -k /dev/watchdog");
+    sleep(1);
+    system("echo V > /dev/watchdog");
+    sleep(1);
+    fd = open("/dev/watchdog", O_RDWR);
+
+    if (fd <= 0) {
+        log_error("System watch dog initial fail.\r\n");
+    }
+    return fd;
+}
+
+int StoreLogMsg_1(const char *fmt, ...)
+{
+    char Buf[4096 + 256];
+    char buffer[4096];
+    va_list args;
+    struct timeb  SeqEndTime;
+    struct tm *tm;
+
+    va_start(args, fmt);
+    int rc = vsnprintf(buffer, sizeof(buffer), fmt, args);
+    va_end(args);
+
+    memset(Buf, 0, sizeof(Buf));
+    ftime(&SeqEndTime);
+    SeqEndTime.time = time(NULL);
+    tm = localtime(&SeqEndTime.time);
+
+    if (ShmSysConfigAndInfo->SysConfig.SwitchDebugFlag == YES) {
+        sprintf(Buf, "%02d:%02d:%02d:%03d - %s",
+                tm->tm_hour, tm->tm_min, tm->tm_sec, SeqEndTime.millitm, buffer);
+        printf("%s \n", Buf);
+    } else {
+        sprintf(Buf, "echo \"%04d-%02d-%02d %02d:%02d:%02d:%03d - %s\" >> /Storage/SystemLog/[%04d.%02d]SystemLog",
+                tm->tm_year + 1900, tm->tm_mon + 1, tm->tm_mday, tm->tm_hour, tm->tm_min, tm->tm_sec, SeqEndTime.millitm,
+                buffer,
+                tm->tm_year + 1900, tm->tm_mon + 1);
+        system(Buf);
+    }
+
+    return rc;
+}
+
+unsigned long GetTimeoutValue(struct timeval _sour_time)
+{
+    struct timeval _end_time;
+    gettimeofday(&_end_time, NULL);
+
+    return 1000000 * (_end_time.tv_sec - _sour_time.tv_sec) + _end_time.tv_usec - _sour_time.tv_usec;
+}
+
+int mystrcmp(unsigned char *p1, unsigned char *p2)
+{
+    while (*p1 == *p2) {
+        if (*p1 == '\0' || *p2 == '\0') {
+            break;
+        }
+        p1++;
+        p2++;
+    }
+    if (*p1 == '\0' && *p2 == '\0') {
+        return (PASS);
+    } else {
+        return (FAIL);
+    }
+}
+
+int DiffTimeb(struct timeb ST, struct timeb ET)
+{
+    //return milli-second
+    unsigned int StartTime, StopTime;
+
+    StartTime = (unsigned int)ST.time;
+    StopTime = (unsigned int)ET.time;
+    //return (StopTime-StartTime)*1000+ET.millitm-ST.millitm;
+    return (StopTime - StartTime);
+}
+
+bool CheckTimeOut(struct timeb ST)
+{
+    struct timeb ET;
+    unsigned int StartTime, StopTime;
+
+    ftime(&ET);
+    StartTime = (unsigned int) ST.time;
+    StopTime = (unsigned int) ET.time;
+    return (StopTime > StartTime) ? YES : NO;
+}
+
+void setChargerMode(byte gun_index, byte mode)
+{
+    chargingInfo[gun_index]->SystemStatus = mode;
+}
+
+void PRINTF_FUNC(char *string, ...)
+{
+    va_list args;
+    char buffer[4096];
+    va_start(args, string);
+    vsnprintf(buffer, sizeof(buffer), string, args);
+    va_end(args);
+
+    log_info("%s \n", buffer);
+}
+
+long long DiffTimebWithNow(struct timeb ST)
+{
+    //return milli-second
+    struct timeb ET;
+    long long StartTime, StopTime;
+
+    ftime(&ET);
+    StartTime = (long long)ST.time;
+    StopTime = (long long)ET.time;
+    return ((StopTime - StartTime) * 1000) + (ET.millitm - ST.millitm);
+}
+
+//==========================================
+// Log
+//==========================================
+void CheckFwSlotStatusLog()
+{
+    if (bd0_1_status == 0 && bd0_2_status == 1) {
+        PRINTF_FUNC("Connector 1 : Chademo");
+    } else if (bd0_1_status == 1 && bd0_2_status == 0) {
+        PRINTF_FUNC("Connector 1 : CCS");
+    } else if (bd0_1_status == 1 && bd0_2_status == 1) {
+        PRINTF_FUNC("Connector 1 : GB");
+    }
+
+    if (bd1_1_status == 0 && bd1_2_status == 1) {
+        PRINTF_FUNC("Connector 2 : Chademo");
+    } else if (bd1_1_status == 1 && bd1_2_status == 0) {
+        PRINTF_FUNC("Connector 2 : CCS");
+    } else if (bd1_1_status == 1 && bd1_2_status == 1) {
+        PRINTF_FUNC("Connector 2 : GB");
+    }
+}
+
+void CheckHwSlotStatusLog(byte index)
+{
+    if (chargingInfo[index]->Type == _Type_Chademo) {
+        PRINTF_FUNC("Hw check : Connector %d, Type : Chademo, Evboard_id = %d \n",
+                    index, chargingInfo[index]->Evboard_id);
+    } else if (chargingInfo[index]->Type == _Type_CCS_2) {
+        PRINTF_FUNC("Hw check : Connector %d, Type : CCS, Evboard_id = %d \n",
+                    index, chargingInfo[index]->Evboard_id);
+    } else if (chargingInfo[index]->Type == _Type_GB) {
+        PRINTF_FUNC("Hw check : Connector %d, Type : GB, Evboard_id = %d \n",
+                    index, chargingInfo[index]->Evboard_id);
+    }
+}
+
+//==========================================
+// Check interface status
+//==========================================
+int isInterfaceUp(const char *interface)
+{
+    int result = FAIL;
+
+    FILE *fp;
+    char cmd[256];
+    char buf[512];
+
+    strcpy(cmd, "ifconfig");
+    fp = popen(cmd, "r");
+    if (fp != NULL) {
+        while (fgets(buf, sizeof(buf), fp) != NULL) {
+            if (strstr(buf, interface) > 0) {
+                result = PASS;
+            }
+        }
+    }
+    pclose(fp);
+
+    return result;
+}
+
+//=================================
+// Create all share memory
+//=================================
+int CreateShareMemory()
+{
+    int MeterSMId = FAIL;
+
+    if ((MeterSMId = shmget(ShmSysConfigAndInfoKey, sizeof(struct SysConfigAndInfo), IPC_CREAT | 0777)) < 0) {
+        return FAIL;
+    } else if ((ShmSysConfigAndInfo = shmat(MeterSMId, NULL, 0))  == (void *) - 1) {
+        return FAIL;
+    }
+    memset(ShmSysConfigAndInfo, 0, sizeof(struct SysConfigAndInfo));
+
+    if ((MeterSMId = shmget(ShmStatusCodeKey, sizeof(struct StatusCodeData), IPC_CREAT | 0777)) < 0) {
+        return FAIL;
+    } else if ((ShmStatusCodeData = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+        return FAIL;
+    }
+
+    memset(ShmStatusCodeData, 0, sizeof(struct StatusCodeData));
+
+    //creat ShmPsuData
+    if ((MeterSMId = shmget(ShmPsuKey, sizeof(struct PsuData), IPC_CREAT | 0777)) < 0) {
+        return FAIL;
+    } else if ((ShmPsuData = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+        return FAIL;
+    }
+    memset(ShmPsuData, 0, sizeof(struct PsuData));
+
+    if (CHAdeMO_QUANTITY > 0) {
+        if ((MeterSMId = shmget(ShmCHAdeMOCommKey, sizeof(struct CHAdeMOData),  IPC_CREAT | 0777)) < 0) {
+            return FAIL;
+        } else if ((ShmCHAdeMOData = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+            return FAIL;
+        }
+        memset(ShmCHAdeMOData, 0, sizeof(struct CHAdeMOData));
+    }
+
+    if (GB_QUANTITY > 0) {
+        if ((MeterSMId = shmget(ShmGBTCommKey, sizeof(struct GBTData),  IPC_CREAT | 0777)) < 0) {
+            return FAIL;
+        } else if ((ShmGBTData = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+            return FAIL;
+        }
+        memset(ShmGBTData, 0, sizeof(struct GBTData));
+    }
+
+    //creat ShmCcsData
+    if (CCS_QUANTITY > 0) {
+        if ((MeterSMId = shmget(ShmCcsCommKey, sizeof(struct CcsData),  IPC_CREAT | 0777)) < 0) {
+            return FAIL;
+        } else if ((ShmCcsData = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+            return FAIL;
+        }
+        memset(ShmCcsData, 0, sizeof(struct CcsData));
+    }
+
+    //creat ShmPrimaryMcuData
+    if ((MeterSMId = shmget(ShmPrimaryMcuKey, sizeof(struct PrimaryMcuData), IPC_CREAT | 0777)) < 0) {
+        return FAIL;
+    } else if ((ShmPrimaryMcuData = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+        return FAIL;
+    }
+    memset(ShmPrimaryMcuData, 0, sizeof(struct PrimaryMcuData));
+
+    //creat ShmFanModuleData
+    if ((MeterSMId = shmget(ShmFanBdKey, sizeof(struct FanModuleData),  IPC_CREAT | 0777)) < 0) {
+        return FAIL;
+    } else if ((ShmFanModuleData = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+        return FAIL;
+    }
+    memset(ShmFanModuleData, 0, sizeof(struct FanModuleData));
+
+    //creat ShmRelayModuleData
+    if ((MeterSMId = shmget(ShmRelayBdKey, sizeof(struct RelayModuleData),  IPC_CREAT | 0777)) < 0) {
+        return FAIL;
+    } else if ((ShmRelayModuleData = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+        return FAIL;
+    }
+    memset(ShmRelayModuleData, 0, sizeof(struct RelayModuleData));
+
+    if ((MeterSMId = shmget(ShmLedBdKey, sizeof(struct LedModuleData), IPC_CREAT | 0777)) < 0) {
+        return FAIL;
+    } else if ((ShmLedModuleData = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+        return FAIL;
+    }
+    memset(ShmLedModuleData, 0, sizeof(struct LedModuleData));
+
+    //creat ShmOCPP16Data
+    if ((MeterSMId = shmget(ShmOcppModuleKey, sizeof(struct OCPP16Data), IPC_CREAT | 0777)) < 0) {
+        return FAIL;
+    } else if ((ShmOCPP16Data = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+        return FAIL;
+    }
+    // memset(ShmOCPP16Data,0,sizeof(struct OCPP16Data));
+
+#if defined METER_ENABLE
+    if ((MeterSMId = shmget(ShmCsuMeterKey, sizeof(struct MeterInformation), IPC_CREAT | 0777)) < 0) {
+        return FAIL;
+    } else if ((ShmCsuMeterData = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+        return FAIL;
+    }
+    memset(ShmCsuMeterData, 0, sizeof(struct MeterInformation));
+
+    if ((MeterSMId = shmget(ShmCommonKey, sizeof(struct DcCommonInformation), IPC_CREAT | 0777)) < 0) {
+        return FAIL;
+    } else if ((ShmDcCommonData = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+        return FAIL;
+    }
+    memset(ShmDcCommonData, 0, sizeof(struct DcCommonInformation));
+#endif //defined METER_ENABLE
+
+#if defined DD360 ||defined DD360Audi || defined DD360ComBox
+    //creat Audi customization info
+    if ((MeterSMId = shmget(ShmAudiCustInfoKey, sizeof(AudiCustInfo), IPC_CREAT | 0777)) < 0) {
+        return FAIL;
+    } else if ((gAudiCustInfo = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+        return FAIL;
+    }
+    memset(gAudiCustInfo, 0, sizeof(AudiCustInfo));
+#endif //defined DD360Audi
+
+    return PASS;
+}
+
+//=================================
+// LCM Page
+//=================================
+void ChangeLcmByIndex(byte page_index)
+{
+    if (ShmSysConfigAndInfo->SysWarningInfo.Level != 2 ||
+            page_index == _LCM_COMPLETE || page_index == _LCM_FIX) {
+        ShmSysConfigAndInfo->SysInfo.PageIndex = page_index;
+    }
+}
+
+//======================================================
+// Peripheral initial
+//======================================================
+void InitGPIO()
+{
+    /*****************0~3, 4 bank, bank x 32+ num*********************/
+    /***************************************************************/
+    /*************** GPIO 0 ***************************************/
+    /***************************************************************/
+    /* GPMC_AD8         =>  GPIO0_22 *//*ID BD1_1*/
+    system("echo 22 > /sys/class/gpio/export");
+    system("echo \"in\" > /sys/class/gpio/gpio22/direction");
+    /* GPMC_AD9         =>  GPIO0_23 *//*ID BD1_2*/
+    system("echo 23 > /sys/class/gpio/export");
+    system("echo \"in\" > /sys/class/gpio/gpio23/direction");
+    /* GPMC_AD10        =>  GPIO0_26 *//*IO BD1_1*/
+    system("echo 26 > /sys/class/gpio/export");
+    system("echo \"out\" > /sys/class/gpio/gpio26/direction");
+    system("echo 1 > /sys/class/gpio/gpio26/value");
+    /* GPMC_AD11        =>  GPIO0_27 *//*IO BD1_2*/
+    system("echo 27 > /sys/class/gpio/export");
+    system("echo \"in\" > /sys/class/gpio/gpio27/direction");
+    /* RMII1_REF_CLK        =>  GPIO0_29 *//*USB 0 OCP detection*/
+    system("echo 29 > /sys/class/gpio/export");
+    system("echo \"in\" > /sys/class/gpio/gpio29/direction");
+    /*XDMA_EVENT_INTR0  =>  GPIO0_19 *//*AM_RFID_RST*/
+    system("echo 19 > /sys/class/gpio/export");
+    system("echo \"out\" > /sys/class/gpio/gpio19/direction");
+    system("echo 1 > /sys/class/gpio/gpio19/value");
+    /*XDMA_EVENT_INTR1  =>  GPIO0_20 *//*AM_RFID_ICC*/
+    system("echo 20 > /sys/class/gpio/export");
+    system("echo \"in\" > /sys/class/gpio/gpio20/direction");
+    /***************************************************************/
+    /*************** GPIO 1 ***************************************/
+    /***************************************************************/
+    /* GPMC_AD12    =>  GPIO1_12 *//*ID BD2_1*/
+    system("echo 44 > /sys/class/gpio/export");
+    system("echo \"in\" > /sys/class/gpio/gpio44/direction");
+    /* GPMC_AD13    =>  GPIO1_13 *//*ID BD2_2*/
+    system("echo 45 > /sys/class/gpio/export");
+    system("echo \"in\" > /sys/class/gpio/gpio45/direction");
+    /* GPMC_AD14    =>  GPIO1_14 *//*IO BD2_1*/
+    system("echo 46 > /sys/class/gpio/export");
+    system("echo \"out\" > /sys/class/gpio/gpio46/direction");
+    system("echo 0 > /sys/class/gpio/gpio46/value");
+    /* GPMC_AD15    =>  GPIO1_15 *//*IO BD2_2*/
+    system("echo 47 > /sys/class/gpio/export");
+    system("echo \"in\" > /sys/class/gpio/gpio47/direction");
+    /***************************************************************/
+    /*************** GPIO 2 ***************************************/
+    /***************************************************************/
+    /*LCD_AC_BIAS_EN    =>  GPIO2_25*//*RS-485 for module DE control*/
+    system("echo 89 > /sys/class/gpio/export");
+    system("echo \"out\" > /sys/class/gpio/gpio89/direction");
+    system("echo 1 > /sys/class/gpio/gpio89/value");
+    /*LCD_HSYNC     =>  GPIO2_23*//*RS-485 for module RE control*/
+    system("echo 87 > /sys/class/gpio/export");
+    system("echo \"out\" > /sys/class/gpio/gpio87/direction");
+    system("echo 0 > /sys/class/gpio/gpio87/value");
+    /*LCD_PCLK      =>  GPIO2_24*//*CCS communication board 1 proximity*/
+    system("echo 88 > /sys/class/gpio/export");
+    system("echo \"in\" > /sys/class/gpio/gpio88/direction");
+    /*LCD_VSYNC     =>  GPIO2_22*//*CCS communication board 2 proximity*/
+    system("echo 86 > /sys/class/gpio/export");
+    system("echo \"in\" > /sys/class/gpio/gpio86/direction");
+    /***************************************************************/
+    /*************** GPIO 3 ***************************************/
+    /***************************************************************/
+    /*MCASP0_FSX        =>  GPIO3_15*//*Emergency Stop button detect*/
+    system("echo 111 > /sys/class/gpio/export");
+    system("echo \"in\" > /sys/class/gpio/gpio111/direction");
+    /*MCASP0_ACLKR  =>  GPIO3_18*//*USB1 OCP detect*/
+    system("echo 114 > /sys/class/gpio/export");
+    system("echo \"in\" > /sys/class/gpio/gpio114/direction");
+    /*MCASP0_AHCLKR =>  GPIO3_17*//*Emergency IO for AM3352 and STM32F407*/
+    system("echo 113 > /sys/class/gpio/export");
+    system("echo \"in\" > /sys/class/gpio/gpio113/direction");
+    /*MCASP0_ACLKX  =>  GPIO3_14*//*Ethernet PHY reset*/
+    system("echo 110 > /sys/class/gpio/export");
+    system("echo \"out\" > /sys/class/gpio/gpio110/direction");
+    system("echo 0 > /sys/class/gpio/gpio110/value");
+    /* MCASP0_FSR       =>  GPIO3_19 *//*SMR Enable control_1 for Pskill_1*/
+    system("echo 115 > /sys/class/gpio/export");
+    system("echo \"out\" > /sys/class/gpio/gpio115/direction");
+    system("echo 0 > /sys/class/gpio/gpio115/value");
+    /* MCASP0_AXR0  =>  GPIO3_16 *//*CSU board function OK indicator.*/
+    system("echo 112 > /sys/class/gpio/export");
+    system("echo \"out\" > /sys/class/gpio/gpio112/direction");
+    system("echo 1 > /sys/class/gpio/gpio112/value");
+    /* MCASP0_AXR1  =>  GPIO3_20 *//*SMR Enable control_2 for Pskill_2*/
+    system("echo 116 > /sys/class/gpio/export");
+    system("echo \"out\" > /sys/class/gpio/gpio116/direction");
+    system("echo 0 > /sys/class/gpio/gpio116/value");
+
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
+    /* (C14) EMU0.gpio3[7] */  /*CP open/short feature enable/disable, pull low for default enable*/
+    system("echo 103 > /sys/class/gpio/export");
+    system("echo \"out\" > /sys/class/gpio/gpio103/direction");
+    system("echo 0 > /sys/class/gpio/gpio103/value");
+    /* (B14) EMU1.gpio3[8] */  /*4G module reset, pull high to reset when entry kernel, after Application start, it should be pull low.*/
+    system("echo 104 > /sys/class/gpio/export");
+    system("echo \"out\" > /sys/class/gpio/gpio104/direction");
+    system("echo 0 > /sys/class/gpio/gpio104/value");
+#endif //!defined DD360 && !defined DD360Audi
+
+    log_info("Initial GPIO OK");
+}
+
+int LoadSysConfigAndInfo(struct SysConfigData *ptr)
+{
+    int fd, wrd;
+    unsigned char *buf;
+    unsigned int ChkSum, ChkSumOrg;
+
+    if ((buf = malloc(MtdBlockSize)) == NULL) {
+        log_error("malloc buffer NG,rebooting..\r\n");
+        if (ShmStatusCodeData != NULL) {
+            ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CsuInitFailed = 1;
+        }
+        sleep(5);
+        system("reboot -f");
+        sleep(5);
+        system("reboot -f");
+    }
+    memset(buf, 0, MtdBlockSize);
+
+    //================================================
+    // Load configuration from mtdblock10
+    //================================================
+    fd = open("/dev/mtdblock10", O_RDWR);
+    if (fd < 0) {
+        free(buf);
+        log_error("open mtdblock10 NG,rebooting..\r\n");
+        if (ShmStatusCodeData != NULL) {
+            ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CsuInitFailed = 1;
+        }
+        sleep(5);
+        system("reboot -f");
+        sleep(5);
+        system("reboot -f");
+    }
+
+    wrd = read(fd, buf, MtdBlockSize);
+    close(fd);
+    if (wrd < MtdBlockSize) {
+        free(buf);
+        log_error("read SysConfigData data NG,rebooting..\r\n");
+        if (ShmStatusCodeData != NULL) {
+            ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CsuInitFailed = 1;
+        }
+        sleep(5);
+        system("reboot -f");
+        sleep(5);
+        system("reboot -f");
+    }
+    ChkSum = 0;
+    for (wrd = 0; wrd < MtdBlockSize - 4; wrd++) {
+        ChkSum += buf[wrd];
+    }
+    memcpy(&ChkSumOrg, buf + (0x00600000 - 4), sizeof(ChkSumOrg));
+
+    //================================================
+    // Load configuration from mtdblock11
+    //================================================
+    if (ChkSum != ChkSumOrg) {
+        log_error("Primary SysConfigData checksum NG, read backup\r\n");
+        fd = open("/dev/mtdblock11", O_RDWR);
+        if (fd < 0) {
+            free(buf);
+            log_error("open mtdblock11 (backup) NG,rebooting..\r\n");
+            if (ShmStatusCodeData != NULL) {
+                ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CsuInitFailed = 1;
+            }
+            sleep(5);
+            system("reboot -f");
+            sleep(5);
+            system("reboot -f");
+        }
+
+        memset(buf, 0, MtdBlockSize);
+        wrd = read(fd, buf, MtdBlockSize);
+        close(fd);
+        if (wrd < MtdBlockSize) {
+            free(buf);
+            log_error("read backup SysConfigData data NG,rebooting..\r\n");
+            if (ShmStatusCodeData != NULL) {
+                ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CsuInitFailed = 1;
+            }
+            sleep(5);
+            system("reboot -f");
+            sleep(5);
+            system("reboot -f");
+        }
+        ChkSum = 0;
+        for (wrd = 0; wrd < MtdBlockSize - 4; wrd++) {
+            ChkSum += buf[wrd];
+        }
+        memcpy(&ChkSumOrg, buf + (0x00600000 - 4), sizeof(ChkSumOrg));
+
+        //================================================
+        // Load configuration from mtdblock12 (Factory default)
+        //================================================
+        if (ChkSum != ChkSumOrg) {
+            log_error("backup SysConfigData checksum NG, read Factory default\r\n");
+            fd = open("/dev/mtdblock12", O_RDWR);
+            if (fd < 0) {
+                free(buf);
+                log_error("open mtdblock12 (Factory default) NG,rebooting..\r\n");
+                if (ShmStatusCodeData != NULL) {
+                    ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CsuInitFailed = 1;
+                }
+                sleep(5);
+                system("reboot -f");
+                sleep(5);
+                system("reboot -f");
+            }
+            memset(buf, 0, MtdBlockSize);
+            wrd = read(fd, buf, MtdBlockSize);
+            close(fd);
+            if (wrd < MtdBlockSize) {
+                free(buf);
+                log_error("read factory default  SysConfigData data NG,rebooting..\r\n");
+                if (ShmStatusCodeData != NULL) {
+                    ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CsuInitFailed = 1;
+                }
+                sleep(5);
+                system("reboot -f");
+                sleep(5);
+                system("reboot -f");
+            }
+            ChkSum = 0;
+            for (wrd = 0; wrd < MtdBlockSize - 4; wrd++) {
+                ChkSum += buf[wrd];
+            }
+            memcpy(&ChkSumOrg, buf + (0x00600000 - 4), sizeof(ChkSumOrg));
+            if (ChkSum != ChkSumOrg) {
+                log_error("factory default  SysConfigData checksum NG, restore factory default\r\n");
+                free(buf);
+                system("cd /root;./FactoryConfig -m");
+                system("sync");
+                sleep(5);
+                system("reboot -f");
+                sleep(5);
+                system("reboot -f");
+
+                return FAIL;
+            }
+        }
+    }
+
+    //load OK
+    memcpy((struct SysConfigData *)ptr, buf, sizeof(struct SysConfigData));
+    free(buf);
+    //log_info("Load SysConfigData OK\n");
+    return PASS;
+}
+
+int isRouteFail()
+{
+    int result = YES;
+    FILE *fp;
+    char buf[512];
+
+    fp = popen("route -n", "r");
+    if (fp != NULL) {
+        while (fgets(buf, sizeof(buf), fp) != NULL) {
+            if (strstr(buf, "eth0") != NULL) {
+                result = NO;
+            }
+        }
+    }
+    pclose(fp);
+
+    return result;
+}
+
+int isReachableInternet()
+{
+    int result = FAIL;
+    FILE *fp;
+    char cmd[256];
+    char buf[512];
+    char tmp[512];
+
+    strcpy(cmd, "ifconfig eth0");
+    fp = popen(cmd, "r");
+
+    if (fp != NULL) {
+        while (fgets(buf, sizeof(buf), fp) != NULL) {
+            if (strstr(buf, "inet addr:") > 0) {
+                sscanf(buf, "%*s%s", tmp);
+                substr(tmp, tmp, strspn(tmp, "addr:"), strlen(buf) - strspn(tmp, "addr:"));
+
+                if (strcmp(tmp, (char *)ShmSysConfigAndInfo->SysConfig.Eth0Interface.EthIpAddress) != EQUAL) {
+                    strcpy((char *) ShmSysConfigAndInfo->SysConfig.Eth0Interface.EthIpAddress, tmp);
+                }
+            }
+        }
+    }
+    pclose(fp);
+
+#if defined DD360 ||defined DD360Audi || defined DD360ComBox
+    if (ShmStatusCodeData->AlarmCode.AlarmEvents.bits.DisconnectedFromDo == NORMAL) {
+        result = FAIL;
+    } else {
+        result = PASS;
+    }
+#else
+    memset(buf, 0x00, sizeof(buf));
+    for (int idx = 0; idx < ARRAY_SIZE(valid_Internet); idx++) {
+        sprintf(cmd, "ping -c 1 -w 3 -I eth0 %s", valid_Internet[idx]);
+        fp = popen(cmd, "r");
+        if (fp != NULL) {
+            while (fgets(buf, sizeof(buf), fp) != NULL) {
+                if (strstr(buf, "transmitted") > 0) {
+                    //sscanf(buf, "%*s%*s%*s%*s%*s%*s%s", tmp);
+
+                    if (strstr(buf, "100%") != NULL) {
+                    } else {
+                        result = PASS;
+                    }
+                    //DEBUG_INFO("%s",buf);
+                    //DEBUG_INFO("%s\n",tmp);
+                }
+            }
+        }
+        pclose(fp);
+    }
+
+#endif //defined DD360 || defined DD360Audi
+
+    return result;
+}
+
+void InitEthernet()
+{
+    char tmpbuf[256];
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
+    bool ethResult = false;
+    uint8_t cnt_pingDNS_Fail = 0;
+#endif //!defined DD360 && !defined DD360Audi
+
+    system("ifconfig eth0 down");// eth0 down
+    system("ifconfig eth1 down");// eth1 down
+    sleep(2);
+
+    // /sbin/ifconfig eth0 192.168.1.10 netmask 255.255.255.0 down
+    system("echo 1 > /sys/class/gpio/gpio110/value");//reset PHY
+    sleep(2);
+    //Init Eth0 for internet
+    memset(tmpbuf, 0, 256);
+    sprintf(tmpbuf, "/sbin/ifconfig eth0 %s netmask %s up",
+            ShmSysConfigAndInfo->SysConfig.Eth0Interface.EthIpAddress,
+            ShmSysConfigAndInfo->SysConfig.Eth0Interface.EthSubmaskAddress);
+    //sprintf(tmpbuf,"/sbin/ifconfig eth0 192.168.100.10 netmask 255.255.255.0 up");
+    system(tmpbuf);
+
+    memset(tmpbuf, 0, 256);
+    sprintf(tmpbuf, "route add default gw %s eth0 ",
+            ShmSysConfigAndInfo->SysConfig.Eth0Interface.EthGatewayAddress);
+    //sprintf(tmpbuf,"route add default gw 192.168.100.1 eth0 ");
+    system(tmpbuf);
+    //system("ifconfig lo up");
+    //  /sbin/ifconfig eth0 192.168.1.10 netmask 255.255.255.0 up
+    //Init Eth1 for administrator tool
+    memset(tmpbuf, 0, 256);
+    sprintf(tmpbuf, "/sbin/ifconfig eth1 %s netmask %s up",
+            ShmSysConfigAndInfo->SysConfig.Eth1Interface.EthIpAddress,
+            ShmSysConfigAndInfo->SysConfig.Eth1Interface.EthSubmaskAddress);
+    system(tmpbuf);
+
+    //Run DHCP client if enabled
+    system("killall udhcpc");
+    system("rm -rf /etc/resolv.conf");
+    system("echo nameserver 8.8.8.8 > /etc/resolv.conf");       //Google DNS server
+    system("echo nameserver 180.76.76.76 > /etc/resolv.conf");  //Baidu DNS server
+    //system("/sbin/ifconfig eth0 down;/sbin/ifconfig eth0 up");
+
+    if (ShmSysConfigAndInfo->SysConfig.Eth0Interface.EthDhcpClient == 0) {
+        sprintf(tmpbuf, "/sbin/udhcpc -i eth0 -x hostname:CSU3_%s -s /root/dhcp_script/eth0.script > /dev/null &", ShmSysConfigAndInfo->SysConfig.SystemId);
+        system(tmpbuf);
+    }
+
+    //Upgrade system id to /etc/hostname
+    sprintf(tmpbuf, "echo %s > /etc/hostname", ShmSysConfigAndInfo->SysConfig.SystemId);
+    system(tmpbuf);
+
+    pid_t pid = fork();
+    if (pid == 0) {
+        log_info("InitEthernet = %d\r\n", pid);
+        for (;;) {
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
+            if (isRouteFail()) {
+                //PRINTF_FUNC("eth0 not in route, restart eht0. \n");
+                system("/sbin/ifconfig eth0 down;/sbin/ifconfig eth0 up");
+
+                if (ShmSysConfigAndInfo->SysConfig.Eth0Interface.EthDhcpClient == 0) {
+                    InitialDHCP();
+                }
+            }
+
+            if (isReachableInternet() == PASS) {
+                ShmSysConfigAndInfo->SysInfo.ethInternetConn = YES;
+                cnt_pingDNS_Fail = 0;
+            } else {
+                if (++cnt_pingDNS_Fail > 3) {
+                    ShmSysConfigAndInfo->SysInfo.ethInternetConn = NO;
+                }
+            }
+
+            ethResult = ShmSysConfigAndInfo->SysInfo.ethInternetConn;
+
+            if (ethResult == YES) {
+                system("/sbin/ifmetric eth0 0");
+
+                if ((ShmSysConfigAndInfo->SysConfig.ModelName[10] == 'W') ||
+                        (ShmSysConfigAndInfo->SysConfig.ModelName[10] == 'D')) {
+                    system("/sbin/ifmetric mlan0 1");
+                }
+
+                if ((ShmSysConfigAndInfo->SysConfig.ModelName[10] == 'T') ||
+                        (ShmSysConfigAndInfo->SysConfig.ModelName[10] == 'D')) {
+                    system("/sbin/ifmetric ppp0 2");
+                }
+            }
+
+            if (!ethResult &&
+                    ShmSysConfigAndInfo->SysConfig.AthInterface.WifiMode != _SYS_WIFI_MODE_DISABLE &&
+                    (ShmSysConfigAndInfo->SysConfig.ModelName[10] == 'W' ||
+                     ShmSysConfigAndInfo->SysConfig.ModelName[10] == 'D')) {
+                //ethResult = ShmSysConfigAndInfo->SysConfig.AthInterface.WifiNetworkConn;
+                ethResult = ShmStatusCodeData->InfoCode.InfoEvents.bits.InternetDisconnectViaWiFi == YES ? NO : YES;
+
+                if (ethResult) {
+                    if ((ShmSysConfigAndInfo->SysConfig.ModelName[10] == 'W') ||
+                            (ShmSysConfigAndInfo->SysConfig.ModelName[10] == 'D')) {
+                        system("/sbin/ifmetric eth0 1");
+                        system("/sbin/ifmetric mlan0 0");
+                    }
+
+
+                    if ((ShmSysConfigAndInfo->SysConfig.ModelName[10] == 'T') ||
+                            (ShmSysConfigAndInfo->SysConfig.ModelName[10] == 'D')) {
+                        system("/sbin/ifmetric ppp0 2");
+                    }
+                }
+            }
+
+            if (!ethResult &&
+                    ShmSysConfigAndInfo->SysConfig.TelecomInterface.TelcomEnabled == YES &&
+                    (ShmSysConfigAndInfo->SysConfig.ModelName[10] == 'T' ||
+                     ShmSysConfigAndInfo->SysConfig.ModelName[10] == 'D')) {
+                //ethResult = ShmSysConfigAndInfo->SysConfig.TelecomInterface.TelcomNetworkConn;
+                ethResult = ShmStatusCodeData->InfoCode.InfoEvents.bits.InternetDisconnectVia4Gi == YES ? NO : YES;
+
+                if (ethResult) {
+                    if ((ShmSysConfigAndInfo->SysConfig.ModelName[10] == 'W') ||
+                            (ShmSysConfigAndInfo->SysConfig.ModelName[10] == 'D')) {
+                        system("/sbin/ifmetric mlan0 2");
+                    }
+
+                    if ((ShmSysConfigAndInfo->SysConfig.ModelName[10] == 'T') ||
+                            (ShmSysConfigAndInfo->SysConfig.ModelName[10] == 'D')) {
+                        system("/sbin/ifmetric eth0 1");
+                        system("/sbin/ifmetric ppp0 0");
+                    }
+                }
+            }
+
+            ShmSysConfigAndInfo->SysInfo.InternetConn = ethResult;
+#else
+            isReachableInternet();
+#endif //!defined DD360 && !defined DD360
+
+            sleep(5);
+        }
+    }
+
+    log_info("Initial Ethernet OK\r\n");
+}
+
+int InitialRfidPort()
+{
+    int uartO2 = open(rfidPortName, O_RDWR);
+    struct termios tios;
+
+    if (uartO2 != FAIL) {
+        ioctl (uartO2, TCGETS, &tios);
+        tios.c_cflag = B19200 | CS8 | CLOCAL | CREAD;
+        tios.c_lflag = 0;
+        tios.c_iflag = 0;
+        tios.c_oflag = 0;
+        tios.c_cc[VMIN] = 0;
+        tios.c_cc[VTIME] = (unsigned char) 1;
+        tios.c_lflag = 0;
+        tcflush(uartO2, TCIFLUSH);
+        ioctl(uartO2, TCSETS, &tios);
+    }
+
+    if (uartO2 < 0) {
+        ShmStatusCodeData->AlarmCode.AlarmEvents.bits.RfidModuleCommFail = 1;
+    }
+
+    return uartO2;
+}
+
+void GetMacAddress()
+{
+    for (byte index = 0; index < 2; index++) {
+        int fd;
+        struct ifreq ifr;
+        char tarEth[5];
+        char Mac[18];
+
+        sprintf(tarEth, "eth%d", index);
+        fd = socket(AF_INET, SOCK_DGRAM, 0);
+
+        ifr.ifr_addr.sa_family = AF_INET;
+        strncpy(ifr.ifr_name, tarEth, IFNAMSIZ - 1);
+
+        ioctl(fd, SIOCGIFHWADDR, &ifr);
+        close(fd);
+
+        sprintf(Mac, "%.2x:%.2x:%.2x:%.2x:%.2x:%.2x",
+                ifr.ifr_hwaddr.sa_data[0], ifr.ifr_hwaddr.sa_data[1], ifr.ifr_hwaddr.sa_data[2],
+                ifr.ifr_hwaddr.sa_data[3], ifr.ifr_hwaddr.sa_data[4], ifr.ifr_hwaddr.sa_data[5]);
+
+        if (index == 0) {
+            strcpy((char *) ShmSysConfigAndInfo->SysConfig.Eth0Interface.EthMacAddress, Mac);
+        } else {
+            strcpy((char *) ShmSysConfigAndInfo->SysConfig.Eth1Interface.EthMacAddress, Mac);
+        }
+    }
+}
+
+void GetFirmwareVersion()
+{
+    // Get CSU root file system version
+    sprintf((char *)ShmSysConfigAndInfo->SysInfo.CsuRootFsFwRev, fwVersion);
+
+    byte count = 0, chademo = 0, ccs = 0, gb = 0;
+    for (uint8_t idx = 0; idx < 3; idx++) {
+        if (ShmSysConfigAndInfo->SysConfig.ModelName[7 + idx] == 'J') {
+            chademo++;
+            count++;
+        } else if (ShmSysConfigAndInfo->SysConfig.ModelName[7 + idx] == 'G') {
+            gb++;
+            count++;
+        } else if (ShmSysConfigAndInfo->SysConfig.ModelName[7 + idx] == 'U' ||
+                   ShmSysConfigAndInfo->SysConfig.ModelName[7 + idx] == 'V' ||
+                   ShmSysConfigAndInfo->SysConfig.ModelName[7 + idx] == 'E') {
+            ccs++;
+            count++;
+        }
+    }
+
+    if (count == 1) {
+        if (chademo > 0) {
+            ShmSysConfigAndInfo->SysInfo.CsuRootFsFwRev[7] = '1';
+        } else if (ccs > 0) {
+            ShmSysConfigAndInfo->SysInfo.CsuRootFsFwRev[7] = '2';
+        } else if (gb > 0) {
+            ShmSysConfigAndInfo->SysInfo.CsuRootFsFwRev[7] = '3';
+        }
+    } else {
+        if (chademo > 0 && ccs > 0) {
+            ShmSysConfigAndInfo->SysInfo.CsuRootFsFwRev[7] = '4';
+        } else if (chademo > 0 && gb > 0) {
+            ShmSysConfigAndInfo->SysInfo.CsuRootFsFwRev[7] = '5';
+        } else if (ccs > 0 && gb > 0) {
+            ShmSysConfigAndInfo->SysInfo.CsuRootFsFwRev[7] = '6';
+        }
+    }
+
+    // Get network option from model name
+    switch (ShmSysConfigAndInfo->SysConfig.ModelName[10]) {
+    case 'B':
+    case 'U':
+        //Blue tooth
+        ShmSysConfigAndInfo->SysInfo.CsuRootFsFwRev[9] = '3';
+        break;
+    case 'W':
+        // WIFI
+        ShmSysConfigAndInfo->SysInfo.CsuRootFsFwRev[9] = '1';
+        break;
+    case 'T':
+        // 3G/4G
+        ShmSysConfigAndInfo->SysInfo.CsuRootFsFwRev[9] = '2';
+        break;
+    case 'D': //DS60-120 add
+        ShmSysConfigAndInfo->SysInfo.CsuRootFsFwRev[9] = '5';
+        break;
+    default:
+        // LAN
+        ShmSysConfigAndInfo->SysInfo.CsuRootFsFwRev[9] = '0';
+        break;
+    }
+    // Get rating power from model name
+    memcpy(&ShmSysConfigAndInfo->SysInfo.CsuRootFsFwRev[10], &ShmSysConfigAndInfo->SysConfig.ModelName[4], 0x03);
+
+    // Get IEC or UL
+    char _buf[3] = {0};
+    memcpy(_buf, &ShmSysConfigAndInfo->SysConfig.ModelName[2], 2);
+
+    if (strcmp(_buf, "YE") == EQUAL || strcmp(_buf, "YC") == EQUAL) {
+        ShmSysConfigAndInfo->SysInfo.ChargerType = _CHARGER_TYPE_IEC;
+        log_info("IEC model");
+    } else if (strcmp(_buf, "WU") == EQUAL) {
+        ShmSysConfigAndInfo->SysInfo.ChargerType = _CHARGER_TYPE_UL;
+        log_info("UL model");
+    }
+}
+
+//DS60-120 add
+void InitialGunIndexToUnUse()
+{
+    for (byte index = 0; index < CHAdeMO_QUANTITY; index++) {
+        ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].Index = NO_DEFINE;
+    }
+
+    for (byte index = 0; index < CCS_QUANTITY; index++) {
+        ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].Index = NO_DEFINE;
+    }
+
+    for (byte index = 0; index < GB_QUANTITY; index++) {
+        ShmSysConfigAndInfo->SysInfo.GbChargingData[index].Index = NO_DEFINE;
+    }
+
+    for (byte index = 0; index < AC_QUANTITY; index++) {
+        ShmSysConfigAndInfo->SysInfo.AcChargingData[index].Index = NO_DEFINE;
+    }
+}
+
+void InitialShareMemoryInfo()
+{
+    FILE *fp;
+    char cmd[512];
+    char buf[512];
+
+    sprintf((char *)ShmSysConfigAndInfo->SysConfig.TelecomInterface.TelcomApn, "Internet");
+    sprintf((char *)ShmSysConfigAndInfo->SysConfig.TelecomInterface.TelcomChapPapId, " ");
+    sprintf((char *)ShmSysConfigAndInfo->SysConfig.TelecomInterface.TelcomChapPapPwd, " ");
+
+    ShmSysConfigAndInfo->SysConfig.TotalConnectorCount = 0;
+    ShmSysConfigAndInfo->SysConfig.AcConnectorCount = 0;
+
+    ShmSysConfigAndInfo->SysInfo.FactoryConfiguration = 0;
+    ShmSysConfigAndInfo->SysInfo.InputVoltageR = 0;
+    ShmSysConfigAndInfo->SysInfo.InputVoltageS = 0;
+    ShmSysConfigAndInfo->SysInfo.InputVoltageT = 0;
+    ShmSysConfigAndInfo->SysInfo.SystemFanRotaSpeed = 0;
+    ShmSysConfigAndInfo->SysInfo.PsuFanRotaSpeed = 0;
+    ShmSysConfigAndInfo->SysInfo.AuxPower5V = 0;
+    ShmSysConfigAndInfo->SysInfo.AuxPower12V = 0;
+    ShmSysConfigAndInfo->SysInfo.AuxPower24V = 0;
+    ShmSysConfigAndInfo->SysInfo.AuxPower48V = 0;
+
+    sprintf((char *)ShmSysConfigAndInfo->SysInfo.CsuHwRev, "REV:5.0");
+    memcpy(ShmSysConfigAndInfo->SysInfo.CsuBootLoadFwRev, ShmSysConfigAndInfo->SysConfig.CsuBootLoadFwRev, ARRAY_SIZE(ShmSysConfigAndInfo->SysConfig.CsuBootLoadFwRev));
+
+    sprintf(cmd, "/bin/uname -r");
+    fp = popen(cmd, "r");
+    if (fp == NULL) {
+        sprintf((char *)ShmSysConfigAndInfo->SysInfo.CsuKernelFwRev, "Unknown version");
+    } else {
+        while (fgets(buf, sizeof(buf), fp) != NULL) {
+            strcpy((char *)ShmSysConfigAndInfo->SysInfo.CsuKernelFwRev, buf);
+        }
+    }
+
+    // 雙槍 CCS + Chademo
+    GetFirmwareVersion();
+    //sprintf((char *) ShmSysConfigAndInfo->SysInfo.CsuRootFsFwRev, fwVersion);
+    sprintf((char *) ShmSysConfigAndInfo->SysInfo.CsuPrimFwRev, " ");
+
+    sprintf((char *) ShmSysConfigAndInfo->SysInfo.LcmHwRev, " ");
+    sprintf((char *) ShmSysConfigAndInfo->SysInfo.LcmFwRev, " ");
+    sprintf((char *) ShmSysConfigAndInfo->SysInfo.PsuHwRev, " ");
+    sprintf((char *) ShmSysConfigAndInfo->SysInfo.PsuPrimFwRev, " ");
+    sprintf((char *) ShmSysConfigAndInfo->SysInfo.PsuSecFwRev, " ");
+    sprintf((char *) ShmSysConfigAndInfo->SysInfo.AuxPwrHwRev, " ");
+    sprintf((char *) ShmSysConfigAndInfo->SysInfo.AuxPwrFwRev, " ");
+    sprintf((char *) ShmSysConfigAndInfo->SysInfo.FanModuleHwRev, " ");
+    sprintf((char *) ShmSysConfigAndInfo->SysInfo.FanModuleFwRev, " ");
+    sprintf((char *) ShmSysConfigAndInfo->SysInfo.RelayModuleHwRev, " ");
+    sprintf((char *) ShmSysConfigAndInfo->SysInfo.RelayModuleFwRev, " ");
+    sprintf((char *) ShmSysConfigAndInfo->SysInfo.TelcomModemFwRev, " ");
+    ShmSysConfigAndInfo->SysInfo.SystemAmbientTemp = 0;
+    ShmSysConfigAndInfo->SysInfo.SystemCriticalTemp = 0;
+    ShmSysConfigAndInfo->SysInfo.PsuAmbientTemp = 0;
+    ShmSysConfigAndInfo->SysInfo.CcsConnectorTemp = 0;
+    ShmSysConfigAndInfo->SysInfo.InternetConn = 0;
+    ShmSysConfigAndInfo->SysInfo.OcppConnStatus = 0;
+    ShmSysConfigAndInfo->SysInfo.OrderCharging = NO_DEFINE;
+
+    strcpy((char *) ShmSysConfigAndInfo->SysConfig.UserId, "");
+
+    ShmStatusCodeData->AlarmCode.AlarmEvents.bits.RelayboardStestFail = NO;
+    ShmStatusCodeData->AlarmCode.AlarmEvents.bits.FanboardStestFail = NO;
+    ShmStatusCodeData->AlarmCode.AlarmEvents.bits.PrimaryStestFail = NO;
+    ShmStatusCodeData->AlarmCode.AlarmEvents.bits.LedboardStestFail = NO; //DS60-120 Add
+    ShmStatusCodeData->AlarmCode.AlarmEvents.bits.ChademoboardStestFail = NO;
+    ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CCSboardStestFail = NO;
+    ShmStatusCodeData->AlarmCode.AlarmEvents.bits.AcContactStestFail = NO;
+    ShmStatusCodeData->AlarmCode.AlarmEvents.bits.PsuModuleStestFail = NO;
+    ShmStatusCodeData->AlarmCode.AlarmEvents.bits.PsuDipSwitchStestFail = NO; //DS60-120 Add
+    ShmSysConfigAndInfo->SysConfig.QRCodeMadeMode = NO; //DS60-120 add
+
+    memset(ShmSysConfigAndInfo->SysInfo.FanModuleFwRev, 0, ARRAY_SIZE(ShmSysConfigAndInfo->SysInfo.FanModuleFwRev));
+    memset(ShmSysConfigAndInfo->SysInfo.RelayModuleFwRev, 0, ARRAY_SIZE(ShmSysConfigAndInfo->SysInfo.RelayModuleFwRev));
+    ShmPrimaryMcuData->SelfTest_Comp = NO;
+    ShmRelayModuleData->SelfTest_Comp = NO;
+    ShmFanModuleData->SelfTest_Comp = NO;
+    ShmLedModuleData->SelfTest_Comp = NO;
+#if defined DD360Audi
+    ShmSysConfigAndInfo->SysInfo.SystemPage = _LCM_SELECT_GUN;
+#else
+    ShmSysConfigAndInfo->SysInfo.SystemPage = _LCM_NONE;
+#endif //defined DD360Audi
+    ShmSysConfigAndInfo->SysInfo.MainChargingMode = _MAIN_CHARGING_MODE_MAX;
+    ShmSysConfigAndInfo->SysInfo.ReAssignedFlag = _REASSIGNED_NONE;
+    ShmSysConfigAndInfo->SysInfo.CurGunSelectedByAc = NO_DEFINE;
+    ShmSysConfigAndInfo->SysInfo.BootingStatus = BOOTTING; //DS60-120 add
+
+    ShmFanModuleData->TestFanSpeed = 0;
+
+    ShmStatusCodeData->AlarmCode.AlarmEvents.bits.ModelNameNoneMatchStestFail = NO;
+    ShmStatusCodeData->AlarmCode.AlarmEvents.bits.PsuNoResource = NO;
+
+    //--- DS60-120 remove -----
+    /*char EvsePower[2];
+
+    EvsePower[2] = '\0';
+    unsigned short buf_pow = 0;
+    if (strlen((char *) ShmSysConfigAndInfo->SysConfig.ModelName) >= 6) {
+        strncpy(EvsePower, (char *)(ShmSysConfigAndInfo->SysConfig.ModelName + 4), 2);
+        if (strcmp(EvsePower, "15") == EQUAL) {
+            buf_pow = 150;
+        } else if (strcmp(EvsePower, "30") == EQUAL) {
+            buf_pow = 30;
+        } else if (strcmp(EvsePower, "60") == EQUAL) {
+            buf_pow = 60;
+        } else if (strcmp(EvsePower, "12") == EQUAL) {
+            buf_pow = 120;
+        } else if (strcmp(EvsePower, "18") == EQUAL) {
+            buf_pow = 180;
+        } else if (strcmp(EvsePower, "36") == EQUAL) {
+            buf_pow = 360;
+        }
+
+        ShmSysConfigAndInfo->SysConfig.RatingCurrent = (buf_pow / 30) * PSU_MIN_CUR;
+
+        if (ShmSysConfigAndInfo->SysConfig.MaxChargingPower == 0 ||
+                ShmSysConfigAndInfo->SysConfig.MaxChargingPower > buf_pow) {
+            ShmSysConfigAndInfo->SysConfig.MaxChargingPower = buf_pow;
+        }
+    }
+    */
+    //--------------------------------------------------------------------------
+
+    InitialGunIndexToUnUse();//DS60-120 add
+
+    ShmSysConfigAndInfo->SysConfig.SwitchDebugFlag = NO;
+    ShmSysConfigAndInfo->SysConfig.AlwaysGfdFlag = NO;
+
+#if defined METER_ENABLE
+    ShmDcCommonData->CcsVersion = _CCS_VERSION_CHECK_TAG_V015S0; //DS60-120
+#endif //defined METER_ENABLE
+
+    log_info("3InitialShareMemoryInfo done...\r\n");
+}
+
+int Initialization()
+{
+    // 初始化卡號驗證的 Flag
+    ClearAuthorizedFlag();
+    // 初始化插槍驗證的 Flag
+    ClearDetectPluginFlag();
+
+    // UART 2 for Rfid
+    rfidFd = InitialRfidPort();
+
+    int pinOut[2] = { 116, 115 };
+    for (byte count = 0; count < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; count++) {
+        chargingInfo[count]->RemoteStartFlag = NO;
+
+        if (chargingInfo[count]->Type == _Type_Chademo) {
+            gpio_set_value(pinOut[count], 0x00);
+            ShmCHAdeMOData->evse[chargingInfo[count]->type_index].SelfTest_Comp = NO;
+        } else if (chargingInfo[count]->Type == _Type_GB) {
+            gpio_set_value(pinOut[count], 0x00);
+            ShmGBTData->evse[chargingInfo[count]->type_index].SelfTest_Comp = NO;
+        } else if (chargingInfo[count]->Type == _Type_CCS_2) {
+            //if (ShmCcsData->CommProtocol == _CCS_COMM_V2GMessage_DIN70121) { //DS60-120 remove
+            if (ShmSysConfigAndInfo->SysConfig.TotalConnectorCount == 1) {
+                gpio_set_value(pinOut[1], 0x01);
+            } else {
+                gpio_set_value(pinOut[count], 0x01);
+            }
+            ShmCcsData->V2GMessage_DIN70121[chargingInfo[count]->type_index].SelfTest_Comp = NO;
+            //}
+        }
+
+        strcpy((char *)ShmOCPP16Data->StatusNotification[count].ErrorCode, "NoError");
+    }
+
+    for (byte count = 0; count < ShmSysConfigAndInfo->SysConfig.AcConnectorCount; count++) {
+        ac_chargingInfo[count]->RemoteStartFlag = NO;
+
+        if (ac_chargingInfo[count]->Type == _Type_AC) {
+            ac_chargingInfo[count]->SelfTest_Comp = NO;
+            strcpy((char *)ShmOCPP16Data->StatusNotification[count + ShmSysConfigAndInfo->SysConfig.TotalConnectorCount].ErrorCode, "NoError");
+        }
+    }
+
+    //PRINTF_FUNC("Initialization OK \n");
+    return PASS;
+}
+
+bool InitialSystemDefaultConfig()
+{
+    bool result = true;
+
+    LoadSysConfigAndInfo(&ShmSysConfigAndInfo->SysConfig);
+    InitGPIO();
+    InitEthernet();
+    GetMacAddress();
+
+//  system("echo 1 > /sys/class/gpio/gpio110/value"); //reset PHY
+//  sleep(3);
+//  system("/sbin/ifconfig eth0 192.168.1.10 netmask 255.255.255.0 down");
+//  sleep(1);
+//  system("/sbin/ifconfig eth1 192.168.0.10 netmask 255.255.255.0 up");
+
+    return result;
+}
+
+bool DisplaySelfTestFailReason()
+{
+    bool result = false;
+
+    // RB、FB、407、EV 小板中有些板子無回應
+    if (ShmRelayModuleData->SelfTest_Comp == NO)
+    { ShmStatusCodeData->AlarmCode.AlarmEvents.bits.RelayboardStestFail = true; }
+    if (ShmFanModuleData->SelfTest_Comp == NO)
+    { ShmStatusCodeData->AlarmCode.AlarmEvents.bits.FanboardStestFail = true; }
+    if (ShmPrimaryMcuData->SelfTest_Comp == NO)
+    { ShmStatusCodeData->AlarmCode.AlarmEvents.bits.PrimaryStestFail = true; }
+    if (ShmLedModuleData->SelfTest_Comp == NO)
+    { ShmStatusCodeData->AlarmCode.AlarmEvents.bits.LedboardStestFail = true; }
+    for (byte index = 0; index < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; index++) {
+        if (chargingInfo[index]->Type == _Type_Chademo) {
+            if (ShmCHAdeMOData->evse[chargingInfo[index]->type_index].SelfTest_Comp == NO)
+            { ShmStatusCodeData->AlarmCode.AlarmEvents.bits.ChademoboardStestFail = true; }
+        } else if (chargingInfo[index]->Type == _Type_GB) {
+            if (ShmGBTData->evse[chargingInfo[index]->type_index].SelfTest_Comp == NO)
+            { ShmStatusCodeData->AlarmCode.AlarmEvents.bits.GbtboardStestFail = true; }
+        } else if (chargingInfo[index]->Type == _Type_CCS_2) {
+            if (ShmCcsData->CommProtocol == _CCS_COMM_V2GMessage_DIN70121) {
+                if (ShmCcsData->V2GMessage_DIN70121[chargingInfo[index]->type_index].SelfTest_Comp == NO)
+                { ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CCSboardStestFail = true; }
+            }
+        }
+    }
+    for (byte index = 0; index < ShmSysConfigAndInfo->SysConfig.AcConnectorCount; index++) {
+        // 先借 GBT 顯示
+        if (ac_chargingInfo[index]->SelfTest_Comp == NO)
+        { ShmStatusCodeData->AlarmCode.AlarmEvents.bits.AcConnectorStestFail = true; }
+    }
+
+    if (ShmSysConfigAndInfo->SysInfo.AcContactorStatus == NO) {
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
+        // AC Contact 未搭上
+        ShmStatusCodeData->AlarmCode.AlarmEvents.bits.AcContactStestFail = true;
+        result = true;
+#endif //!defined DD360 && !defined DD360Audi
+    }
+#if 0
+    else if (ShmStatusCodeData->AlarmCode.AlarmEvents.bits.PsuDipSwitchStestFail == YES) { //DS60-120 add
+        result = true;
+    }
+#endif //0
+    else if (ShmPsuData->SystemAvailablePower <= 0 && ShmPsuData->SystemAvailableCurrent <= 0) {
+        // PSU 通訊問題
+        ShmStatusCodeData->AlarmCode.AlarmEvents.bits.PsuModuleStestFail = true;
+        result = true;
+    }
+
+    return result;
+}
+
+void SelfTestRun()
+{
+    bool evInitFlag = false;
+
+    StartSystemTimeoutDet(Timeout_SelftestChk);
+    ShmSysConfigAndInfo->SysInfo.SelfTestSeq = _STEST_VERSION;
+    while (ShmSysConfigAndInfo->SysInfo.SelfTestSeq != _STEST_COMPLETE ||
+            GetTimeoutValue(ShmSysConfigAndInfo->SysInfo.SystemTimeoutTimer) / uSEC_VAL <= 20 //DS60-120 add
+          ) {
+        ChkPrimaryStatus();
+        if (ShmSysConfigAndInfo->SysWarningInfo.Level == 2 ||
+                ShmStatusCodeData->AlarmCode.AlarmEvents.bits.PsuDipSwitchStestFail == YES //DS60-120 add
+           ) {
+            ShmSysConfigAndInfo->SysInfo.SelfTestSeq = _STEST_FAIL;
+            return;
+        }
+
+        if (ShmSysConfigAndInfo->SysConfig.TotalConnectorCount > 0) {
+            if (ShmPsuData->Work_Step == _NO_WORKING ||
+                    ShmSysConfigAndInfo->SysInfo.SelfTestSeq == _STEST_FAIL) {
+                ShmSysConfigAndInfo->SysInfo.SelfTestSeq = _STEST_FAIL;
+                return;
+            }
+
+            switch (ShmSysConfigAndInfo->SysInfo.SelfTestSeq) {
+            case _STEST_VERSION: {
+                if ((strlen((char *)ShmSysConfigAndInfo->SysInfo.RelayModuleFwRev) != 0 ||
+                        ShmSysConfigAndInfo->SysInfo.RelayModuleFwRev[0] != '\0')
+                        && (ShmRelayModuleData->SelfTest_Comp != YES)
+                   ) {
+                    log_info("Relay Board FW Rev = %s", ShmSysConfigAndInfo->SysInfo.RelayModuleFwRev);
+                    ShmRelayModuleData->SelfTest_Comp = YES;
+                }
+#if !defined NO_FAN_BOARD && !defined DD360ComBox
+                if ((strlen((char *)ShmSysConfigAndInfo->SysInfo.FanModuleFwRev) != 0 ||
+                        ShmSysConfigAndInfo->SysInfo.FanModuleFwRev[0] != '\0')
+                        && (ShmFanModuleData->SelfTest_Comp != YES)
+                   ) {
+                    log_info("Fan Board FW Rev = %s", ShmSysConfigAndInfo->SysInfo.FanModuleFwRev);
+                    ShmFanModuleData->SelfTest_Comp = YES;
+                }
+#else
+                ShmFanModuleData->SelfTest_Comp = YES;
+#endif //NO_FAN_BOARD
+
+                if ((strlen((char *)ShmPrimaryMcuData->version) != 0 ||
+                        ShmPrimaryMcuData->version[0] != '\0')
+                        && (ShmPrimaryMcuData->SelfTest_Comp != YES)
+                   ) {
+                    log_info("Primary FW Rev = %s", ShmSysConfigAndInfo->SysInfo.CsuPrimFwRev);
+                    ShmPrimaryMcuData->SelfTest_Comp = YES;
+                }
+#if 0 //DS60-120 remove
+                if ((strlen((char *)ShmSysConfigAndInfo->SysInfo.LedModuleFwRev) != 0 ||
+                        ShmSysConfigAndInfo->SysInfo.LedModuleFwRev[0] != '\0')
+                        && (ShmLedModuleData->SelfTest_Comp != YES)
+                   ) {
+                    log_info("LED Board FW Rev = %s", ShmSysConfigAndInfo->SysInfo.LedModuleFwRev);
+                    ShmLedModuleData->SelfTest_Comp = YES;
+                }
+#endif //0
+
+                // EV 小板
+                if (!evInitFlag) {
+                    evInitFlag = YES;
+                    for (byte index = 0; index < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; index++) {
+                        //log_info("index = %d, charging index = %d, type = %d\r\n",
+                        //         index,
+                        //         chargingInfo[index]->type_index,
+                        //         chargingInfo[index]->Type);
+                        if (chargingInfo[index]->Type == _Type_Chademo) {
+                            if ((strlen((char *)ShmCHAdeMOData->evse[chargingInfo[index]->type_index].version) != 0 ||
+                                    ShmCHAdeMOData->evse[chargingInfo[index]->type_index].version[0] != '\0')
+                                    //&& (ShmCHAdeMOData->evse[chargingInfo[index]->type_index].SelfTest_Comp != YES)
+                               ) {
+                                log_info("CHAdeMO[%d] FW Rev = %s", chargingInfo[index]->type_index, ShmCHAdeMOData->evse[chargingInfo[index]->type_index].version);
+                                ShmCHAdeMOData->evse[chargingInfo[index]->type_index].SelfTest_Comp = YES;
+                            } else {
+                                //PRINTF_FUNC("chademo fw lose...... %s \n", ShmCHAdeMOData->evse[chargingInfo[index]->type_index].version);
+                                evInitFlag = NO;
+                            }
+                        } else if (chargingInfo[index]->Type == _Type_GB) {
+                            if ((strlen((char *)ShmGBTData->evse[chargingInfo[index]->type_index].version) != 0 ||
+                                    ShmGBTData->evse[chargingInfo[index]->type_index].version[0] != '\0')
+                                    //&& (ShmGBTData->evse[chargingInfo[index]->type_index].SelfTest_Comp != YES)
+                               ) {
+                                log_info("GBT[%d] FW Rev = %s", chargingInfo[index]->type_index, ShmGBTData->evse[chargingInfo[index]->type_index].version);
+                                ShmGBTData->evse[chargingInfo[index]->type_index].SelfTest_Comp = YES;
+                            } else {
+                                //PRINTF_FUNC("GBT fw lose...... %s \n", ShmCHAdeMOData->evse[chargingInfo[index]->type_index].version);
+                                evInitFlag = NO;
+                            }
+                        } else if (chargingInfo[index]->Type == _Type_CCS_2) {
+                            if (ShmCcsData->CommProtocol == _CCS_COMM_V2GMessage_DIN70121) {
+                                if ((strlen((char *)ShmCcsData->V2GMessage_DIN70121[chargingInfo[index]->type_index].version) != 0 ||
+                                        ShmCcsData->V2GMessage_DIN70121[chargingInfo[index]->type_index].version[0] != '\0')
+                                        /*&&(ShmCcsData->V2GMessage_DIN70121[chargingInfo[index]->type_index].SelfTest_Comp != YES)*/
+                                   ) {
+                                    log_info("CCS[%d] FW Rev = %s",
+                                             chargingInfo[index]->type_index,
+                                             ShmCcsData->V2GMessage_DIN70121[chargingInfo[index]->type_index].version);
+                                    ShmCcsData->V2GMessage_DIN70121[chargingInfo[index]->type_index].SelfTest_Comp = YES;
+                                } else {
+                                    //log_info("CCS[%d] ccs fw lose...... %s \n",
+                                    //         chargingInfo[index]->type_index,
+                                    //         ShmCcsData->V2GMessage_DIN70121[chargingInfo[index]->type_index].version);
+                                    evInitFlag = NO;
+                                }
+                            }
+                        }
+                    }
+
+                    for (byte index = 0; index < ShmSysConfigAndInfo->SysConfig.AcConnectorCount; index++) {
+                        if (ac_chargingInfo[index]->Type == _Type_AC) {
+                            if ((strlen((char *)ac_chargingInfo[index]->version) != 0 || ac_chargingInfo[index]->version[0] != '\0')
+                                    && (ac_chargingInfo[index]->SelfTest_Comp != YES)
+                               ) {
+                                log_info("AC connector[%d] FW Rev = %s", index, ac_chargingInfo[index]->version);
+                                ac_chargingInfo[index]->SelfTest_Comp = YES;
+                            } else {
+                                evInitFlag = NO;
+                            }
+                        }
+                    }
+                }
+
+                if ( ShmFanModuleData->SelfTest_Comp &&
+                        ShmRelayModuleData->SelfTest_Comp &&
+                        ShmPrimaryMcuData->SelfTest_Comp &&
+                        //ShmLedModuleData->SelfTest_Comp &&
+                        evInitFlag
+                   ) {
+                    ShmSysConfigAndInfo->SysInfo.SelfTestSeq = _STEST_AC_CONTACTOR;
+                }
+            }
+            break;
+            case _STEST_AC_CONTACTOR: {
+                //ShmPsuData->Work_Step = _TEST_COMPLETE;
+                // 因為 30KW 以下沒有 Relay feedback 功能，所以暫時先直接跳過
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
+                if (ShmSysConfigAndInfo->SysInfo.AcContactorStatus == YES) {
+                    ShmSysConfigAndInfo->SysInfo.SelfTestSeq = _STEST_PSU_DETECT;
+                    log_info("AC contactor self test OK");
+                }
+#else
+                ShmSysConfigAndInfo->SysInfo.SelfTestSeq = _STEST_PSU_DETECT;
+                log_info("Waiting for DO communication");
+#endif //!defined DD360 && !defined DD360Audi
+            }
+            break;
+            case _STEST_PSU_DETECT: {
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
+                if (ShmPsuData->Work_Step >= GET_SYS_CAP) {
+                    ShmSysConfigAndInfo->SysInfo.SelfTestSeq = _STEST_PSU_CAP;
+                }
+#else
+                ShmSysConfigAndInfo->SysInfo.SelfTestSeq = _STEST_PSU_CAP;
+#endif //defined DD360 && !defined DD360Audi
+            }
+            break;
+            case _STEST_PSU_CAP: {
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
+                // 此測試是要確認當前總輸出能力
+                // 如果沒有 PSU 模組請 bypass
+                if (ShmPsuData->Work_Step == BOOTING_COMPLETE) {
+                    sleep(1);
+                    ShmSysConfigAndInfo->SysInfo.SelfTestSeq = _STEST_COMPLETE;
+                    ShmSysConfigAndInfo->SysInfo.BootingStatus = BOOT_COMPLETE;
+                }
+#else
+                //check the power limit from DO
+                ShmSysConfigAndInfo->SysInfo.SelfTestSeq = _STEST_COMPLETE;
+                ShmSysConfigAndInfo->SysInfo.BootingStatus = BOOT_COMPLETE;
+                log_info("Successful Self Test");
+#endif //defined DD360 && !defined DD360Audi
+            }
+            break;
+            }
+        } else {
+            break;
+        }
+
+        usleep(100000);
+    }
+}
+
+int SpawnTask()
+{
+    sleep(2);
+    system("/root/Module_EventLogging &");
+    system("/root/Module_PrimaryComm &");
+    system("/root/Module_EvComm &");
+    system("/root/Module_LcmControl &");
+    system("/root/Module_InternalComm &");
+    system("/root/Module_ProduceUtils &");
+
+#if defined DD360 ||defined DD360Audi || defined DD360ComBox
+    system("/root/DoComm &");
+#else
+    system("/root/Module_PsuComm &");
+
+    if (strcmp((char *)ShmSysConfigAndInfo->SysConfig.OcppServerURL, "") != EQUAL &&
+            strcmp((char *)ShmSysConfigAndInfo->SysConfig.ChargeBoxId, "") != EQUAL) {
+        system("/root/OcppBackend &");
+    }
+
+    if (ShmSysConfigAndInfo->SysConfig.ModelName[10] == 'T') {
+        system("/root/Module_4g &");
+    }
+
+    if (ShmSysConfigAndInfo->SysConfig.ModelName[10] == 'W') {
+        system("/root/Module_Wifi &");
+    }
+
+    if (ShmSysConfigAndInfo->SysConfig.ModelName[10] == 'D') {
+        system("/root/Module_4g &");
+        system("/root/Module_Wifi &");
+    }
+#endif //defined DD360 || defined DD360Audi
+
+    return PASS;
+}
+
+int StoreUsrConfigData(struct SysConfigData *UsrData)
+{
+    int result = PASS;
+    int fd, wrd;
+    unsigned int i, Chk;
+    unsigned char *ptr, *BufTmp;
+
+    Chk = 0;
+    ptr = (unsigned char *)UsrData;
+    if ((BufTmp = malloc(MtdBlockSize)) != NULL) {
+        memset(BufTmp, 0, MtdBlockSize);
+        memcpy(BufTmp, ptr, sizeof(struct SysConfigData));
+        for (i = 0; i < MtdBlockSize - 4; i++) {
+            Chk += *(ptr + i);
+        }
+
+        memcpy(BufTmp + MtdBlockSize - 4, &Chk, 4);
+        fd = open("/dev/mtdblock10", O_RDWR);
+        if (fd > 0) {
+            wrd = write(fd, BufTmp, MtdBlockSize);
+            close(fd);
+            if (wrd >= MtdBlockSize) {
+                fd = open("/dev/mtdblock11", O_RDWR);
+                if (fd > 0) {
+                    wrd = write(fd, BufTmp, MtdBlockSize);
+                    close(fd);
+                    if (wrd < MtdBlockSize) {
+                        log_error("write /dev/mtdblock11(backup) NG\r\n");
+                        result = FAIL;
+                    }
+                } else {
+                    log_error("open /dev/mtdblock11(backup) NG\r\n");
+                    result = FAIL;
+                }
+            } else {
+                log_error("write /dev/mtdblock10 NG\r\n");
+                result = FAIL;
+            }
+
+        } else {
+            log_error("open /dev/mtdblock10 NG\r\n");
+            result = FAIL;
+        }
+    } else {
+        log_error("alloc BlockSize NG\r\n");
+        result = FAIL;
+    }
+
+    if (BufTmp != NULL) {
+        free(BufTmp);
+    }
+
+    return result;
+}
+
+//===============================================
+// Common Detect Chk - Stop Charging ?
+//===============================================
+int isEvBoardStopChargeFlag(byte gunIndex)
+{
+    //printf("StopChargeFlag = %d\r\n", chargingInfo[gunIndex]->StopChargeFlag);
+    return chargingInfo[gunIndex]->StopChargeFlag;
+}
+
+bool isEvBoardNormalStopChargeFlag(byte gunIndex)
+{
+    return chargingInfo[gunIndex]->NormalStopChargeFlag;
+}
+
+//===============================================
+// 掃描插槍狀況
+//===============================================
+void ClearDetectPluginFlag()
+{
+    ShmSysConfigAndInfo->SysInfo.WaitForPlugit = NO;
+
+    //DS60-120 add
+    for (byte gun_index = 0; gun_index < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; gun_index++) {
+        if (chargingInfo[gun_index]->RemoteStartFlag == YES) {
+            chargingInfo[gun_index]->RemoteStartFlag = NO;
+        }
+    }
+
+    if (ShmSysConfigAndInfo->SysInfo.OrderCharging != NO_DEFINE) {
+        ShmSysConfigAndInfo->SysInfo.OrderCharging = NO_DEFINE;
+    }
+}
+
+void DetectPluginStart()
+{
+    ShmSysConfigAndInfo->SysInfo.WaitForPlugit = YES;
+}
+
+bool isDetectPlugin()
+{
+    if (ShmSysConfigAndInfo->SysInfo.WaitForPlugit == YES) {
+        return YES;
+    }
+
+    return NO;
+}
+
+//===============================================
+// Common Detect Chk - Chademo
+//===============================================
+bool isEvGunLocked_chademo(byte gunIndex)
+{
+    return (DetectBitValue(chargingInfo[gunIndex]->GunLocked , 0) == 0) ? NO : YES;
+}
+
+bool isEvContactorWelding_chademo(byte gunIndex)
+{
+    return DetectBitValue(ShmCHAdeMOData->ev[chargingInfo[gunIndex]->type_index].EvDetection, 3);
+}
+
+bool isEvStopReq_chademo(byte gunIndex)
+{
+    return DetectBitValue(ShmCHAdeMOData->ev[chargingInfo[gunIndex]->type_index].EvDetection, 4);
+}
+
+bool isEvStopCharging_chademo(byte gunIndex)
+{
+    if (isEvGunLocked_chademo(gunIndex) == NO) {
+        // 無鎖槍 = 停止
+        PRINTF_FUNC("gun locked none (%d) \n", gunIndex);
+        return YES;
+    }
+
+    return NO;
+}
+
+byte isPrechargeStatus_chademo(byte gunIndex)
+{
+    byte result = 0x00;
+
+    result = ShmCHAdeMOData->ev[chargingInfo[gunIndex]->type_index].PresentMsgFlowStatus;
+
+    return result;
+}
+//===============================================
+// Common Detect Chk - GB
+//===============================================
+bool isEvGunLocked_gb(byte gunIndex)
+{
+    return (DetectBitValue(chargingInfo[gunIndex]->GunLocked , 0) == 0) ? NO : YES;
+}
+
+bool isEvStopCharging_gb(byte gunIndex)
+{
+    if (isEvGunLocked_gb(gunIndex) == NO) {
+        // 無鎖槍 = 停止
+        PRINTF_FUNC("gun locked none. \n");
+        return YES;
+    }
+
+    return NO;
+}
+
+byte isPrechargeStatus_gb(byte gunIndex)
+{
+    byte result = 0x00;
+
+    result = ShmGBTData->ev[chargingInfo[gunIndex]->type_index].PresentMsgFlowStatus;
+
+    return result;
+}
+
+//===============================================
+// Common Detect Chk - CCS
+//===============================================
+bool isEvGunLocked_ccs(byte gunIndex)
+{
+    return (DetectBitValue(chargingInfo[gunIndex]->GunLocked , 0) == 0) ? NO : YES;
+}
+
+byte isPrechargeStatus_ccs(byte gunIndex)
+{
+    byte result = 0x00;
+
+    if (ShmCcsData->CommProtocol == _CCS_COMM_V2GMessage_DIN70121) {
+        result = ShmCcsData->V2GMessage_DIN70121[chargingInfo[gunIndex]->type_index].PresentMsgFlowStatus;
+    }
+
+    return result;
+}
+
+bool isEvStopCharging_ccs(byte gunIndex)
+{
+    if (isEvGunLocked_ccs(gunIndex) == NO) {
+        // 無鎖槍 = 停止
+        PRINTF_FUNC("gun locked none. \n");
+        return YES;
+    }
+
+    return NO;
+}
+
+//===============================================
+// Callback
+//===============================================
+void DisplayChargingInfo()
+{
+    PRINTF_FUNC("*********** DisplayChargingInfo *********** \n");
+    for (byte i = 0; i < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; i++) {
+        if (chargingInfo[i]->SystemStatus != S_IDLE &&
+                chargingInfo[i]->SystemStatus != S_RESERVATION) {
+            ChangeGunSelectByIndex(i);
+            return;
+        }
+    }
+
+    if (ShmSysConfigAndInfo->SysConfig.AcConnectorCount > 0 &&
+            ShmSysConfigAndInfo->SysInfo.CurGunSelectedByAc == NO_DEFINE &&
+            ac_chargingInfo[0]->SystemStatus >= S_PREPARNING && ac_chargingInfo[0]->SystemStatus <= S_COMPLETE) {
+        ShmSysConfigAndInfo->SysInfo.CurGunSelectedByAc = DEFAULT_AC_INDEX;
+    }
+
+    usleep(50000);
+#if defined DD360Audi
+    ShmSysConfigAndInfo->SysInfo.SystemPage = _LCM_SELECT_GUN;
+#else
+    ShmSysConfigAndInfo->SysInfo.SystemPage = _LCM_NONE;
+#endif //defined DD360Audi
+}
+
+void _AutoReturnTimeout()
+{
+    PRINTF_FUNC("*********** _AutoReturnTimeout %d*********** \n", ShmSysConfigAndInfo->SysInfo.PageIndex);
+    if (ShmSysConfigAndInfo->SysInfo.PageIndex == _LCM_WAIT_FOR_PLUG) {
+        ClearDetectPluginFlag();
+    } else if (ShmSysConfigAndInfo->SysInfo.PageIndex == _LCM_AUTHORIZ_COMP) {
+        DetectPluginStart();
+    }
+    usleep(50000);
+#if defined DD360Audi
+    ShmSysConfigAndInfo->SysInfo.SystemPage = _LCM_SELECT_GUN;
+#else
+    ShmSysConfigAndInfo->SysInfo.SystemPage = _LCM_NONE;
+#endif //defined DD360Audi
+}
+
+void _SelfTestTimeout()
+{
+    if (ShmSysConfigAndInfo->SysInfo.BootingStatus != BOOT_COMPLETE) {
+        for (byte gun_index = 0; gun_index < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; gun_index++) {
+            setChargerMode(gun_index, MODE_ALARM);
+        }
+    }
+    ShmPsuData->Work_Step = _NO_WORKING;
+    ShmSysConfigAndInfo->SysInfo.SelfTestSeq = _STEST_FAIL;
+    PRINTF_FUNC("Self test timeout. \n");
+}
+
+void _AuthorizedTimeout()
+{
+    if (IsAuthorizingMode()) {
+        PRINTF_FUNC("*********** _AuthorizedTimeout *********** \n");
+        isCardScan = false;
+        //gAudiCustInfo->PricesInfo[ShmSysConfigAndInfo->SysInfo.CurGunSelected].Balance = 0.0; //Jerry add
+        ShmSysConfigAndInfo->SysInfo.SystemPage = _LCM_AUTHORIZ_FAIL;
+        //ChangeLcmByIndex(_LCM_AUTHORIZ_FAIL);
+        strcpy((char *)ShmSysConfigAndInfo->SysConfig.UserId, "");
+        ClearAuthorizedFlag();
+    }
+}
+
+void _DetectPlugInTimeout()
+{
+    PRINTF_FUNC("*********** _DetectPlugInTimeout *********** \n");
+    strcpy((char *)ShmSysConfigAndInfo->SysConfig.UserId, "");
+    ClearDetectPluginFlag();
+    //usleep(50000);
+    sleep(1); //Jerry add
+#if defined DD360Audi
+    ShmSysConfigAndInfo->SysInfo.SystemPage = _LCM_SELECT_GUN;
+#else
+    ShmSysConfigAndInfo->SysInfo.SystemPage = _LCM_NONE;
+#endif //defined DD360Audi
+}
+
+void _DetectEvChargingEnableTimeout(byte gunIndex)
+{
+    if (chargingInfo[gunIndex]->Type == _Type_Chademo) {
+        if (!isEvGunLocked_chademo(gunIndex)) {
+            PRINTF_FUNC("*********** _DetectEvChargingEnableTimeout (chademo) ***********\n");
+        }
+    } else if (chargingInfo[gunIndex]->Type == _Type_GB) {
+        if (!isEvGunLocked_ccs(gunIndex)) {
+            PRINTF_FUNC("*********** _DetectEvChargingEnableTimeout (gb) ***********\n");
+        }
+    } else if (chargingInfo[gunIndex]->Type == _Type_CCS_2) {
+        if (!isEvGunLocked_ccs(gunIndex)) {
+            PRINTF_FUNC("*********** _DetectEvChargingEnableTimeout (ccs) ***********\n");
+        }
+    }
+    ChargingTerminalProcess(gunIndex);
+    _AutoReturnTimeout();
+}
+
+void _DetectEvseChargingEnableTimeout(byte gunIndex)
+{
+    PRINTF_FUNC("*********** _DetectEvseChargingEnableTimeout (GFD timeout) ***********\n");
+    //if (chargingInfo[gunIndex]->GroundFaultStatus != GFD_PASS)
+    {
+        setChargerMode(gunIndex, MODE_IDLE);
+        _AutoReturnTimeout();
+    }
+}
+
+void _PrepareTimeout(byte gunIndex)
+{
+    PRINTF_FUNC("*********** _PrepareTimeout ***********\n");
+    setChargerMode(gunIndex, MODE_IDLE);
+    ShmStatusCodeData->AlarmCode.AlarmEvents.bits.PsuNoResource = YES;
+    _AutoReturnTimeout();
+}
+
+void _CcsPrechargeTimeout(byte gunIndex)
+{
+    PRINTF_FUNC("*********** _CcsPrechargeTimeout ***********\n");
+    setChargerMode(gunIndex, MODE_IDLE);
+}
+
+//===============================================
+// 取得卡號與卡號驗證
+//===============================================
+bool canStartCharging()
+{
+    char buf2[16] = "";
+    memset(buf2, 0, ARRAY_SIZE(buf2));
+
+    for (byte index = 0; index < strlen((char *)ShmOCPP16Data->Authorize.ResponseIdTagInfo.Status); index++) {
+        sprintf(buf2 + (index - 1) * 2, "%02X", ShmOCPP16Data->Authorize.ResponseIdTagInfo.Status[index]);
+    }
+    sprintf(buf2, "%s", ShmOCPP16Data->Authorize.ResponseIdTagInfo.Status);
+
+    // 因為無法得知實際的長度，所以只能用搜尋的方式
+    if (strcmp(buf2, "Accepted") == EQUAL) {
+        return true;
+    } else {
+
+    }
+
+    return false;
+}
+
+void AuthorizingStart()
+{
+    ShmOCPP16Data->SpMsg.bits.AuthorizeReq = YES;
+    ShmSysConfigAndInfo->SysInfo.AuthorizeFlag = YES;
+}
+
+void ClearAuthorizedFlag()
+{
+    ShmOCPP16Data->SpMsg.bits.AuthorizeConf = NO;
+    ShmSysConfigAndInfo->SysInfo.AuthorizeFlag = NO;
+}
+
+bool isAuthorizedComplete()
+{
+    if (ShmSysConfigAndInfo->SysInfo.AuthorizeFlag == YES) {
+        return false;
+    }
+    return true;
+}
+
+bool IsAuthorizingMode()
+{
+    if (ShmSysConfigAndInfo->SysInfo.AuthorizeFlag == NO) {
+        return false;
+    }
+
+    return true;
+}
+
+//===============================================
+// 紀錄 Alarm Code
+//===============================================
+void RecordAlarmCode(byte gunIndex, char *code)
+{
+    memcpy(chargingInfo[gunIndex]->ConnectorAlarmCode, code, 6);
+
+    if (strcmp(code, "012234") == EQUAL) { ShmStatusCodeData->AlarmCode.AlarmEvents.bits.ChademoGfdTrip = YES; }
+    if (strcmp(code, "012235") == EQUAL) { ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CcsGfdTrip = YES; }
+    if (strcmp(code, "012236") == EQUAL) { ShmStatusCodeData->AlarmCode.AlarmEvents.bits.GbGfdTrip = YES; }
+    if (strcmp(code, "012288") == EQUAL) { ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CcsOutputUVPFail = YES; }
+    if (strcmp(code, "012289") == EQUAL) { ShmStatusCodeData->AlarmCode.AlarmEvents.bits.ChademoOutputUVPFail = YES; }
+    if (strcmp(code, "012290") == EQUAL) { ShmStatusCodeData->AlarmCode.AlarmEvents.bits.GbtOutputUVPFail = YES; }
+}
+
+void RecordWarningCode(byte gunIndex, char *code)
+{
+    memcpy(chargingInfo[gunIndex]->ConnectorWarningCode, code, 6);
+
+    if (strcmp(code, "012296") == EQUAL) { ShmStatusCodeData->AlarmCode.AlarmEvents.bits.ChademoGroundWarning = YES; }
+    if (strcmp(code, "012297") == EQUAL) { ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CcsGroundfaultWarning = YES; }
+    if (strcmp(code, "012298") == EQUAL) { ShmStatusCodeData->AlarmCode.AlarmEvents.bits.GbGroundfaultWarning = YES; }
+}
+
+void ReleaseAlarmCode(byte gunIndex)
+{
+    bool isCleanCheck = false;
+    char code[7];
+
+    if (chargingInfo[gunIndex]->Type == _Type_Chademo) {
+        if (strncmp((char *)chargingInfo[gunIndex]->ConnectorAlarmCode, "012234", 6) == EQUAL &&
+                ShmStatusCodeData->AlarmCode.AlarmEvents.bits.ChademoGfdTrip == YES) {
+            memcpy(code, "012234", 6);
+            memcpy(chargingInfo[gunIndex]->ConnectorAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)chargingInfo[gunIndex]->ConnectorAlarmCode, "012289", 6) == EQUAL &&
+                   ShmStatusCodeData->AlarmCode.AlarmEvents.bits.ChademoOutputUVPFail == YES) {
+            memcpy(code, "012289", 6);
+            memcpy(chargingInfo[gunIndex]->ConnectorAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (ShmStatusCodeData->AlarmCode.AlarmEvents.bits.ChademoGroundWarning == YES) {
+            ReleaseWarningCodeByString(gunIndex, "012296");
+        }
+    } else if (chargingInfo[gunIndex]->Type == _Type_GB) {
+        if (strncmp((char *)chargingInfo[gunIndex]->ConnectorAlarmCode, "012236", 6) == EQUAL &&
+                ShmStatusCodeData->AlarmCode.AlarmEvents.bits.GbGfdTrip == YES) {
+            memcpy(code, "012236", 6);
+            memcpy(chargingInfo[gunIndex]->ConnectorAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)chargingInfo[gunIndex]->ConnectorAlarmCode, "012290", 6) == EQUAL &&
+                   ShmStatusCodeData->AlarmCode.AlarmEvents.bits.GbtOutputUVPFail == YES) {
+            memcpy(code, "012290", 6);
+            memcpy(chargingInfo[gunIndex]->ConnectorAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (ShmStatusCodeData->AlarmCode.AlarmEvents.bits.GbGroundfaultWarning == YES) {
+            ReleaseWarningCodeByString(gunIndex, "012298");
+        }
+    } else if (chargingInfo[gunIndex]->Type == _Type_CCS_2) {
+        if (strncmp((char *)chargingInfo[gunIndex]->ConnectorAlarmCode, "012235", 6) == EQUAL &&
+                ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CcsGfdTrip == YES) {
+            memcpy(code, "012235", 6);
+            memcpy(chargingInfo[gunIndex]->ConnectorAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)chargingInfo[gunIndex]->ConnectorAlarmCode, "012288", 6) == EQUAL &&
+                   ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CcsOutputUVPFail == YES) {
+            memcpy(code, "012288", 6);
+            memcpy(chargingInfo[gunIndex]->ConnectorAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CcsGroundfaultWarning == YES) {
+            ReleaseWarningCodeByString(gunIndex, "012297");
+        }
+    }
+
+    if (isCleanCheck) {
+        for (byte index = 0; index < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; index++) {
+            if (index != gunIndex || ShmSysConfigAndInfo->SysConfig.TotalConnectorCount == 1) {
+                if (strncmp((char *)chargingInfo[index]->ConnectorAlarmCode, code, 6) != EQUAL) {
+                    if (strncmp(code, "012234", 6) == EQUAL) { ShmStatusCodeData->AlarmCode.AlarmEvents.bits.ChademoGfdTrip = NO; }
+                    if (strncmp(code, "012289", 6) == EQUAL) { ShmStatusCodeData->AlarmCode.AlarmEvents.bits.ChademoOutputUVPFail = NO; }
+
+                    if (strncmp(code, "012236", 6) == EQUAL) { ShmStatusCodeData->AlarmCode.AlarmEvents.bits.GbGfdTrip = NO; }
+                    if (strncmp(code, "012290", 6) == EQUAL) { ShmStatusCodeData->AlarmCode.AlarmEvents.bits.GbtOutputUVPFail = NO; }
+
+                    if (strncmp(code, "012235", 6) == EQUAL) { ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CcsGfdTrip = NO; }
+                    if (strncmp(code, "012288", 6) == EQUAL) { ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CcsOutputUVPFail = NO; }
+                }
+            }
+        }
+    }
+
+    if (strncmp((char *)chargingInfo[gunIndex]->ConnectorAlarmCode, "012251", 6) == EQUAL ||
+            strncmp((char *)chargingInfo[gunIndex]->ConnectorAlarmCode, "012252", 6) == EQUAL ||
+            strncmp((char *)chargingInfo[gunIndex]->ConnectorAlarmCode, "012238", 6) == EQUAL ||
+            strncmp((char *)chargingInfo[gunIndex]->ConnectorAlarmCode, "012304", 6) == EQUAL
+       ) {
+        memset(chargingInfo[gunIndex]->ConnectorAlarmCode, 0, sizeof(chargingInfo[gunIndex]->ConnectorAlarmCode));
+    }
+}
+
+void ReleaseWarningCodeByString(byte gunIndex, char *code)
+{
+    bool isCleanCheck = false;
+
+    if (strncmp((char *)chargingInfo[gunIndex]->ConnectorWarningCode, code, 6) == EQUAL &&
+            ShmStatusCodeData->AlarmCode.AlarmEvents.bits.ChademoGroundWarning == YES) {
+        memcpy(chargingInfo[gunIndex]->ConnectorWarningCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)chargingInfo[gunIndex]->ConnectorWarningCode, code, 6) == EQUAL &&
+               ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CcsGroundfaultWarning == YES) {
+        memcpy(chargingInfo[gunIndex]->ConnectorWarningCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)chargingInfo[gunIndex]->ConnectorWarningCode, code, 6) == EQUAL &&
+               ShmStatusCodeData->AlarmCode.AlarmEvents.bits.GbGroundfaultWarning == YES) {
+        memcpy(chargingInfo[gunIndex]->ConnectorWarningCode, "", 6);
+        isCleanCheck = true;
+    }
+
+    if (isCleanCheck) {
+        for (byte index = 0; index < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; index++) {
+            if (index != gunIndex || ShmSysConfigAndInfo->SysConfig.TotalConnectorCount == 1) {
+                if (strncmp((char *)chargingInfo[index]->ConnectorWarningCode, code, 6) != EQUAL) {
+                    if (strncmp(code, "012296", 6) == EQUAL) { ShmStatusCodeData->AlarmCode.AlarmEvents.bits.ChademoGroundWarning = NO; }
+                    if (strncmp(code, "012297", 6) == EQUAL) { ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CcsGroundfaultWarning = NO; }
+                    if (strncmp(code, "012298", 6) == EQUAL) { ShmStatusCodeData->AlarmCode.AlarmEvents.bits.GbGroundfaultWarning = NO; }
+                }
+            }
+        }
+    }
+}
+//===============================================
+// EmergencyStop and Charging Stop
+//===============================================
+void ChargingTerminalProcess(byte gunIndex)
+{
+    setChargerMode(gunIndex, MODE_TERMINATING);
+}
+
+void ChargingAlarmProcess(byte gunIndex)
+{
+    setChargerMode(gunIndex, MODE_ALARM);
+}
+
+void AcChargingTerminalProcess()
+{
+    ac_chargingInfo[0]->SystemStatus = MODE_TERMINATING;
+}
+
+void StopChargingProcessByString(byte level)
+{
+    if (level > ShmSysConfigAndInfo->SysWarningInfo.Level) {
+        ShmSysConfigAndInfo->SysWarningInfo.Level = level;
+    }
+}
+
+void ReleaseChargingProcessByString(byte level)
+{
+    if (level >= ShmSysConfigAndInfo->SysWarningInfo.Level) {
+        ShmSysConfigAndInfo->SysWarningInfo.Level = 0;
+    }
+}
+
+// 一般錯誤停止充電處理函式
+void BoardErrOccurByString(byte index, char *code)
+{
+    byte level = 1;
+    if ((chargingInfo[index]->SystemStatus > S_IDLE && chargingInfo[index]->SystemStatus < S_TERMINATING) ||
+            (chargingInfo[index]->SystemStatus >= S_CCS_PRECHARGE_ST0 && chargingInfo[index]->SystemStatus <= S_CCS_PRECHARGE_ST1)) {
+        if (strncmp(code, "023730", 6) == EQUAL && ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoChargerGetEmergencyStop == NO) {
+            ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoChargerGetEmergencyStop = YES;
+        }
+        ChargingTerminalProcess(index);
+    }
+
+    StopChargingProcessByString(level);
+}
+
+// 急停狀況的停止充電處理函式
+void EmcOccureByString(char *code)
+{
+    byte level = 2;
+    // 嚴重的急停有以下幾種 : EMC 按鈕、Mainbreak、Dooropen
+    // 其錯誤等級為 2
+
+#if defined DD360 ||defined DD360Audi || defined DD360ComBox
+    //DS60-120 remove
+    if (strncmp(code, "012251", 6) == EQUAL ||
+            strncmp(code, "012252", 6) == EQUAL ||
+            strncmp(code, "012238", 6) == EQUAL ||
+            strncmp(code, "042251", 6) == EQUAL ||
+            strncmp(code, "042252", 6) == EQUAL ||
+            strncmp(code, "012304", 6) == EQUAL ||
+            strncmp(code, "042200", 6) == EQUAL ||
+            strncmp(code, "042201", 6) == EQUAL ||
+            strncmp(code, "042202", 6) == EQUAL ||
+            strncmp(code, "042267", 6) == EQUAL)
+#endif //defined DD360 || defined DD360Audi
+    {
+        for (byte gun = 0; gun < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; gun++) {
+            //strncpy((char *)ShmOCPP16Data->StatusNotification[gun].VendorErrorCode, code, 6);
+
+            if ((chargingInfo[gun]->SystemStatus > S_IDLE &&
+                    chargingInfo[gun]->SystemStatus < S_TERMINATING) ||
+                    (chargingInfo[gun]->SystemStatus >= S_CCS_PRECHARGE_ST0 &&
+                     chargingInfo[gun]->SystemStatus <= S_CCS_PRECHARGE_ST1)) {
+                //ChargingTerminalProcess(gun);
+                ChargingAlarmProcess(gun);
+            }
+        }
+#if defined DD360 ||defined DD360Audi || defined DD360ComBox
+        StopChargingProcessByString(level);
+        InformOcppErrOccur(4);
+#endif //defined DD360 || defined DD360Audi
+    }
+}
+
+void ReleaseBoardErrOccurByString(byte index, char *code)
+{
+    bool isTrigger = false;
+    byte level = 1;
+
+    if (strncmp(code, "023730", 6) == 0 && ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoChargerGetEmergencyStop == YES) {
+        isTrigger = true;
+        ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoChargerGetEmergencyStop = NO;
+    }
+
+    if (isTrigger) {
+        ReleaseChargingProcessByString(level);
+    }
+}
+
+void ReleaseEmsOccureByString(byte index, char *code)
+{
+    bool isTrigger = false;
+    byte level = 2;
+
+    if (strncmp(code, "042251", 6) == 0 ) {
+        isTrigger = true;
+    } else if (strncmp(code, "012251", 6) == 0 && ShmStatusCodeData->AlarmCode.AlarmEvents.bits.EmergencyStopTrip == YES) {
+        isTrigger = true;
+        ShmStatusCodeData->AlarmCode.AlarmEvents.bits.EmergencyStopTrip = NO;
+    } else if (strncmp(code, "012252", 6) == 0 && ShmStatusCodeData->AlarmCode.AlarmEvents.bits.DoorOpen == YES) {
+        isTrigger = true;
+        ShmStatusCodeData->AlarmCode.AlarmEvents.bits.DoorOpen = NO;
+    } else if (strncmp(code, "012237", 6) == 0 && ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SpdTrip == YES) {
+        isTrigger = true;
+        ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SpdTrip = NO;
+    } else if (strncmp(code, "012238", 6) == 0 && ShmStatusCodeData->AlarmCode.AlarmEvents.bits.MainPowerBreakerTrip == YES) {
+        isTrigger = true;
+        ShmStatusCodeData->AlarmCode.AlarmEvents.bits.MainPowerBreakerTrip = NO;
+    }
+
+    if (isTrigger) {
+        ReleaseChargingProcessByString(level);
+        InformOcppErrOccur(6);
+    }
+}
+
+//===============================================
+// 確認硬體 (按鈕) 狀態
+//===============================================
+bool leftBtnPush = false;
+bool rightBtnPush = false;
+
+void ChkPrimaryStatus()
+{
+    unsigned char Rtn;
+
+    if (ShmSysConfigAndInfo->SysWarningInfo.WarningCount > 0) {
+        Rtn = 0;
+        for (unsigned char i = 0; i < ShmSysConfigAndInfo->SysWarningInfo.WarningCount; i++) {
+            if (memcmp(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i][0], "042251", 6) == 0) {
+                EmcOccureByString("042251");
+                Rtn = 1;
+            } else if (memcmp(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i][0], "042252", 6) == 0) {
+                EmcOccureByString("042252");
+                Rtn = 1;
+            } else if (memcmp(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i][0], "042200", 6) == 0) {
+                EmcOccureByString("042200");
+                Rtn = 1;
+            } else if (memcmp(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i][0], "042201", 6) == 0) {
+                EmcOccureByString("042201");
+                Rtn = 1;
+            } else if (memcmp(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i][0], "042202", 6) == 0) {
+                EmcOccureByString("042202");
+                Rtn = 1;
+            } else if (memcmp(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i][0], "012304", 6) == 0) {
+                EmcOccureByString("012304");
+                Rtn = 1;
+            }
+        }
+        if (Rtn == 0) {
+            ReleaseEmsOccureByString(0, "042251");
+            ReleaseEmsOccureByString(0, "042252");
+            ReleaseEmsOccureByString(0, "042200");
+            ReleaseEmsOccureByString(0, "042201");
+            ReleaseEmsOccureByString(0, "042202");
+            ReleaseEmsOccureByString(0, "012304");
+        }
+    } else {
+        ReleaseEmsOccureByString(0, "042251");
+        ReleaseEmsOccureByString(0, "042252");
+        ReleaseEmsOccureByString(0, "042200");
+        ReleaseEmsOccureByString(0, "042201");
+        ReleaseEmsOccureByString(0, "042202");
+        ReleaseEmsOccureByString(0, "012304");
+    }
+
+    if (ShmPrimaryMcuData->InputDet.bits.EmergencyButton == ABNORMAL) {
+        ShmStatusCodeData->AlarmCode.AlarmEvents.bits.EmergencyStopTrip = YES;
+        EmcOccureByString("012251");
+    } else {
+        ReleaseEmsOccureByString(0, "012251");
+    }
+
+    if (ShmPrimaryMcuData->InputDet.bits.AcMainBreakerDetec == ABNORMAL) {
+        ShmStatusCodeData->AlarmCode.AlarmEvents.bits.MainPowerBreakerTrip = YES;
+        EmcOccureByString("012238");
+    } else {
+        ReleaseEmsOccureByString(0, "012238");
+    }
+
+    if (ShmPrimaryMcuData->InputDet.bits.SpdDetec == ABNORMAL) {
+        ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SpdTrip = YES;
+    } else {
+        ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SpdTrip = NO;
+    }
+
+    if (ShmPrimaryMcuData->InputDet.bits.DoorOpen == ABNORMAL) {
+        ShmStatusCodeData->AlarmCode.AlarmEvents.bits.DoorOpen = YES;
+        EmcOccureByString("012252");
+    } else {
+        ReleaseEmsOccureByString(0, "012252");
+    }
+
+    //DS60-120 add
+    //if (ShmPrimaryMcuData->InputDet.bits.Button1 == BTN_PRESS &&
+    //        ShmPrimaryMcuData->InputDet.bits.Button2 == BTN_PRESS) {
+    //    ShmSysConfigAndInfo->SysConfig.ShowInformation = YES;
+    //} else {
+    //    ShmSysConfigAndInfo->SysConfig.ShowInformation = NO;
+    //}
+
+    if (ShmPrimaryMcuData->InputDet.bits.Button1 == BTN_PRESS &&
+            !leftBtnPush
+#if defined DD360Audi
+            &&
+            getCurLcmPage() != _LCM_AUTHORIZING &&
+            getCurLcmPage() != _LCM_AUTHORIZ_COMP &&
+            getCurLcmPage() != _LCM_AUTHORIZ_FAIL
+#endif //defined DD360Audi
+       ) {
+        if (!leftBtnPush) {
+            leftBtnPush = true;
+            PRINTF_FUNC("left btn down...............................%x\n",
+                        chargingInfo[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->SystemStatus);
+            if (ShmSysConfigAndInfo->SysInfo.CurGunSelectedByAc != NO_DEFINE) {
+                switch (ac_chargingInfo[0]->SystemStatus) {
+                case S_IDLE: {
+                    if (isDetectPlugin()) {
+                        _DetectPlugInTimeout();
+                        StopSystemTimeoutDet();
+                    }
+                }
+                break;
+                case S_REASSIGN_CHECK:
+                case S_REASSIGN:
+                case S_PREPARNING:
+                case S_PREPARING_FOR_EV:
+                case S_PREPARING_FOR_EVSE:
+                case S_CCS_PRECHARGE_ST0:
+                case S_CCS_PRECHARGE_ST1: {
+                    // 取消充電
+                    AcChargingTerminalProcess();
+                }
+                break;
+                case S_CHARGING: {
+                    if (ShmSysConfigAndInfo->SysConfig.AuthorisationMode == AUTH_MODE_DISABLE) {
+                        // 停止充電
+                        AcChargingTerminalProcess();
+                    }
+                }
+                break;
+                case S_COMPLETE:
+                {}
+                break;
+                }
+            }
+
+            switch (chargingInfo[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->SystemStatus) {
+            case S_IDLE: {
+                if (isDetectPlugin()) {
+                    _DetectPlugInTimeout();
+                    StopSystemTimeoutDet();
+#if defined DD360Audi
+                    destroySelGun(ShmSysConfigAndInfo->SysInfo.CurGunSelected);
+#endif //defined DD360Audi
+                }
+#if defined DD360Audi
+                else {
+                    if (getConfirmSelectedGun(ShmSysConfigAndInfo->SysInfo.CurGunSelected) == PASS) {
+                        //printf("destroy gun = %d\r\n", ShmSysConfigAndInfo->SysInfo.CurGunSelected);
+                        destroySelGun(ShmSysConfigAndInfo->SysInfo.CurGunSelected);
+                    } else {
+                        confirmSelGun(ShmSysConfigAndInfo->SysInfo.CurGunSelected);
+                        PRINTF_FUNC("confirm select gun ............................... %d \n",
+                                    ShmSysConfigAndInfo->SysInfo.CurGunSelected);
+                    }
+                }
+#endif //defined DD360Audi
+            }
+            break;
+            case S_REASSIGN_CHECK:
+            case S_REASSIGN:
+            case S_PREPARNING:
+            case S_PREPARING_FOR_EV:
+            case S_PREPARING_FOR_EVSE:
+            case S_CCS_PRECHARGE_ST0:
+            case S_CCS_PRECHARGE_ST1: {
+                // 取消充電
+                if (ShmSysConfigAndInfo->SysInfo.CurGunSelectedByAc != NO_DEFINE) {
+                    AcChargingTerminalProcess();
+                } else {
+                    ChargingTerminalProcess(ShmSysConfigAndInfo->SysInfo.CurGunSelected);
+                }
+            }
+            break;
+            case S_CHARGING: {
+                if (ShmSysConfigAndInfo->SysConfig.AuthorisationMode == AUTH_MODE_DISABLE) {
+                    // 停止充電
+                    ChargingTerminalProcess(ShmSysConfigAndInfo->SysInfo.CurGunSelected);
+                }
+            }
+            break;
+            case S_COMPLETE: {
+                // 回 IDLE
+                //PRINTF_FUNC("right btn down.................S_COMPLETE \n");
+                //chargingInfo[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->SystemStatus = S_IDLE;
+            }
+            break;
+            }
+        }
+    } else if (ShmPrimaryMcuData->InputDet.bits.Button1 == BTN_RELEASE) {
+        if (leftBtnPush) {
+            leftBtnPush = false;
+            //PRINTF_FUNC("left btn up............................... \n");
+        }
+    }
+
+    if (ShmPrimaryMcuData->InputDet.bits.Button2 == BTN_PRESS &&
+            !rightBtnPush
+#if defined DD360Audi
+            &&
+            getCurLcmPage() != _LCM_IDLE &&
+            getCurLcmPage() != _LCM_AUTHORIZING &&
+            getCurLcmPage() != _LCM_AUTHORIZ_COMP &&
+            getCurLcmPage() != _LCM_AUTHORIZ_FAIL &&
+            getCurLcmPage() != _LCM_WAIT_FOR_PLUG
+#endif //defined DD360Audi
+       ) {
+        if (!rightBtnPush) {
+            rightBtnPush = true;
+            //PRINTF_FUNC("right btn down............................... %d \n", ShmSysConfigAndInfo->SysInfo.CurGunSelected);
+            if (ShmSysConfigAndInfo->SysInfo.CurGunSelected + 1 < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount &&
+                    ShmSysConfigAndInfo->SysInfo.IsAlternatvieConf == NO) {
+                ShmSysConfigAndInfo->SysInfo.CurGunSelected++;
+                ChangeGunSelectByIndex(ShmSysConfigAndInfo->SysInfo.CurGunSelected);
+            } else if (ShmSysConfigAndInfo->SysConfig.AcConnectorCount > 0 &&
+                       ShmSysConfigAndInfo->SysInfo.CurGunSelectedByAc == NO_DEFINE) {
+                ShmSysConfigAndInfo->SysInfo.CurGunSelectedByAc = DEFAULT_AC_INDEX;
+            } else if (ShmSysConfigAndInfo->SysInfo.IsAlternatvieConf == YES) {
+                for (byte _index = 0; _index < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; _index++) {
+                    if (chargingInfo[_index]->SystemStatus != S_BOOTING &&
+                            chargingInfo[_index]->SystemStatus != S_IDLE &&
+                            chargingInfo[_index]->SystemStatus != S_RESERVATION) {
+                        ShmSysConfigAndInfo->SysInfo.CurGunSelected = _index;
+                        ChangeGunSelectByIndex(ShmSysConfigAndInfo->SysInfo.CurGunSelected);
+                        return;
+                    }
+                }
+                ShmSysConfigAndInfo->SysInfo.CurGunSelected = 0;
+                ChangeGunSelectByIndex(ShmSysConfigAndInfo->SysInfo.CurGunSelected);
+            } else {
+                ShmSysConfigAndInfo->SysInfo.CurGunSelected = 0;
+                ChangeGunSelectByIndex(ShmSysConfigAndInfo->SysInfo.CurGunSelected);
+            }
+        }
+        PRINTF_FUNC("current select gun ............................... %d \n",
+                    ShmSysConfigAndInfo->SysInfo.CurGunSelected);
+    } else if (ShmPrimaryMcuData->InputDet.bits.Button2 == BTN_RELEASE) {
+        if (rightBtnPush) {
+            rightBtnPush = false;
+            //PRINTF_FUNC("right btn up............................... \n");
+        }
+    }
+}
+
+//===============================================
+// 確認各小板偵測的錯誤狀況
+//===============================================
+void CheckErrorOccurStatus(byte index)
+{
+    // 小板
+    if (chargingInfo[index]->Type == _Type_Chademo) {
+        if (ShmStatusCodeData->FaultCode.FaultEvents.bits.ChademoOutputRelayDrivingFault == YES) {
+            BoardErrOccurByString(index, "011012");
+        }
+//      else if (ShmStatusCodeData->AlarmCode.AlarmEvents.bits.ChademoGfdTrip == YES)
+//          BoardErrOccurByString(index, "012234");
+    } else if (chargingInfo[index]->Type == _Type_GB) {
+        if (ShmStatusCodeData->FaultCode.FaultEvents.bits.GbOutputRelayDrivingFault == YES) {
+            BoardErrOccurByString(index, "011016");
+        }
+//      else if (ShmStatusCodeData->AlarmCode.AlarmEvents.bits.GbGfdTrip == YES)
+//          BoardErrOccurByString(index, "012236");
+    } else if (chargingInfo[index]->Type == _Type_CCS_2) {
+        if (ShmStatusCodeData->FaultCode.FaultEvents.bits.CcsOutputRelayDrivingFault == YES) {
+            BoardErrOccurByString(index, "011014");
+        }
+//      else if (ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CcsGfdTrip == YES)
+//          BoardErrOccurByString(index, "012235");
+    }
+
+    // RB
+    if (ShmSysConfigAndInfo->SysConfig.PhaseLossPolicy == YES) {
+        if (ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL1InputUVP == YES ||
+                ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL2InputUVP == YES ||
+                ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL3InputUVP == YES) {
+            if (ShmSysConfigAndInfo->SysWarningInfo.ExtraErrProcess == _EXTRA_ERR_PROCESS_NONE) {
+                ShmSysConfigAndInfo->SysWarningInfo.ExtraErrProcess = _EXTRA_ERR_PROCESS_INUVP;
+                StopChargingProcessByString(2);
+                InformOcppErrOccur(13);
+            }
+
+            //DS60-120 add -----
+            if (strncmp((char *)chargingInfo[index]->ConnectorAlarmCode, "", 6) == EQUAL) {
+                if (ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL1InputUVP == YES) {
+                    memcpy(chargingInfo[index]->ConnectorAlarmCode, "012203", 6);
+                } else if (ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL2InputUVP == YES) {
+                    memcpy(chargingInfo[index]->ConnectorAlarmCode, "012204", 6);
+                } else if (ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL3InputUVP == YES) {
+                    memcpy(chargingInfo[index]->ConnectorAlarmCode, "012205", 6);
+                }
+            }
+            //log_info("1 CheckErrorOccurStatus\r\n");
+            chargingInfo[index]->StopChargeFlag = YES;
+            //------------------------------------------------------------------
+        } else {
+            if (ShmSysConfigAndInfo->SysWarningInfo.ExtraErrProcess == _EXTRA_ERR_PROCESS_INUVP) {
+                ShmSysConfigAndInfo->SysWarningInfo.ExtraErrProcess = _EXTRA_ERR_PROCESS_NONE;
+                ReleaseChargingProcessByString(2);
+                InformOcppErrOccur(6);
+            }
+        }
+    } else {
+        if (ShmSysConfigAndInfo->SysWarningInfo.ExtraErrProcess == _EXTRA_ERR_PROCESS_INUVP) {
+            ShmSysConfigAndInfo->SysWarningInfo.ExtraErrProcess = _EXTRA_ERR_PROCESS_NONE;
+            ReleaseChargingProcessByString(2);
+            InformOcppErrOccur(6);
+        }
+    }
+
+    if (ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL1InputOVP == YES ||
+            ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL2InputOVP == YES ||
+            ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL3InputOVP == YES) {
+        if (ShmSysConfigAndInfo->SysWarningInfo.ExtraErrProcess == _EXTRA_ERR_PROCESS_NONE) {
+            ShmSysConfigAndInfo->SysWarningInfo.ExtraErrProcess = _EXTRA_ERR_PROCESS_INOVP;
+            StopChargingProcessByString(2);
+            InformOcppErrOccur(14);
+        }
+
+        //DS60-120 -----
+        if (strncmp((char *)chargingInfo[index]->ConnectorAlarmCode, "", 6) == EQUAL) {
+            if (ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL1InputOVP == YES) {
+                memcpy(chargingInfo[index]->ConnectorAlarmCode, "012200", 6);
+            } else if (ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL2InputOVP == YES) {
+                memcpy(chargingInfo[index]->ConnectorAlarmCode, "012201", 6);
+            } else if (ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL3InputOVP == YES) {
+                memcpy(chargingInfo[index]->ConnectorAlarmCode, "012202", 6);
+            }
+        }
+        //log_info("2 CheckErrorOccurStatus\r\n");
+        chargingInfo[index]->StopChargeFlag = YES;
+        //----------------------------------------------------------------------
+    } else {
+        if (ShmSysConfigAndInfo->SysWarningInfo.ExtraErrProcess == _EXTRA_ERR_PROCESS_INOVP) {
+            ShmSysConfigAndInfo->SysWarningInfo.ExtraErrProcess = _EXTRA_ERR_PROCESS_NONE;
+            ReleaseChargingProcessByString(2);
+            InformOcppErrOccur(6);
+        }
+    }
+
+    //DS60-120 ----
+    if (chargingInfo[index]->Type == _Type_Chademo) {
+        if (ShmStatusCodeData->FaultCode.FaultEvents.bits.ChademoOutputRelayWelding == YES) {
+            memcpy(chargingInfo[index]->ConnectorAlarmCode, "011011", 6);
+        } else if (ShmStatusCodeData->FaultCode.FaultEvents.bits.ChademoOutputRelayDrivingFault == YES) {
+            memcpy(chargingInfo[index]->ConnectorAlarmCode, "011012", 6);
+        } else if (ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemChademoOutputOVP == YES) {
+            memcpy(chargingInfo[index]->ConnectorAlarmCode, "012217", 6);
+        }
+    } else if (chargingInfo[index]->Type == _Type_GB) {
+        if (ShmStatusCodeData->FaultCode.FaultEvents.bits.GbOutputRelayWelding == YES) {
+            memcpy(chargingInfo[index]->ConnectorAlarmCode, "011015", 6);
+        } else if (ShmStatusCodeData->FaultCode.FaultEvents.bits.GbOutputRelayDrivingFault == YES) {
+            memcpy(chargingInfo[index]->ConnectorAlarmCode, "011016", 6);
+        } else if (ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemGbOutputOVP == YES) {
+            memcpy(chargingInfo[index]->ConnectorAlarmCode, "012221", 6);
+        }
+    } else if (chargingInfo[index]->Type == _Type_CCS_2) {
+        if (ShmStatusCodeData->FaultCode.FaultEvents.bits.CcsOutputRelayWelding == YES) {
+            memcpy(chargingInfo[index]->ConnectorAlarmCode, "011013", 6);
+        } else if (ShmStatusCodeData->FaultCode.FaultEvents.bits.CcsOutputRelayDrivingFault == YES) {
+            memcpy(chargingInfo[index]->ConnectorAlarmCode, "011014", 6);
+        } else if (ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemCcsOutputOVP == YES) {
+            memcpy(chargingInfo[index]->ConnectorAlarmCode, "012219", 6);
+        }
+    }
+    //--------------------------------------------------------------------------
+    if (strlen(chargingInfo[index]->ConnectorAlarmCode) == 0) {
+        //Primary
+        if (ShmStatusCodeData->AlarmCode.AlarmEvents.bits.EmergencyStopTrip == YES) {
+            memcpy(chargingInfo[index]->ConnectorAlarmCode, "012251", 6);
+        } else if (ShmStatusCodeData->AlarmCode.AlarmEvents.bits.DoorOpen == YES) {
+            memcpy(chargingInfo[index]->ConnectorAlarmCode, "012252", 6);
+        } else if (ShmStatusCodeData->AlarmCode.AlarmEvents.bits.MainPowerBreakerTrip == YES) {
+            memcpy(chargingInfo[index]->ConnectorAlarmCode, "012238", 6);
+        } else if (ShmStatusCodeData->AlarmCode.AlarmEvents.bits.DisconnectedFromDo == YES) {
+            memcpy(chargingInfo[index]->ConnectorAlarmCode, "012304", 6);
+        }
+    }
+}
+
+//===============================================
+// 確認 GPIO 狀態
+//===============================================
+void gpio_set_value(unsigned int gpio, unsigned int value)
+{
+    int fd;
+    char buf[MAX_BUF];
+
+    snprintf(buf, sizeof(buf), SYSFS_GPIO_DIR "/gpio%d/value", gpio);
+    fd = open(buf, O_WRONLY);
+    if (fd < 0) {
+        perror("gpio/set-value");
+        return;
+    }
+
+    if (value) {
+        write(fd, "1", 2);
+    } else {
+        write(fd, "0", 2);
+    }
+
+    close(fd);
+}
+
+int gpio_get_value(unsigned int gpio, unsigned int *value)
+{
+    int fd;
+    char buf[MAX_BUF];
+    char ch;
+
+    snprintf(buf, sizeof(buf), SYSFS_GPIO_DIR "/gpio%d/value", gpio);
+
+    fd = open(buf, O_RDONLY);
+    if (fd < 0) {
+        perror("gpio/get-value");
+        return fd;
+    }
+
+    read(fd, &ch, 1);
+
+    if (ch != '0') {
+        *value = 1;
+    } else {
+        *value = 0;
+    }
+
+    close(fd);
+    return 0;
+}
+
+void CheckGunTypeFromHw()
+{
+    uint8_t i = 0;
+    int pinIn[4] = {22, 23, 44, 45};
+    unsigned int gpioValue = 0;
+    unsigned char tmp[2] = {0};
+
+    log_info("ModelName = %s", ShmSysConfigAndInfo->SysConfig.ModelName);
+    for (i = 0; i < ARRAY_SIZE(pinIn); i++) {
+        gpio_get_value(pinIn[i], &gpioValue);
+        switch (pinIn[i]) {
+        //right slot
+        case 22:
+            bd1_1_status = gpioValue;
+            break;
+        case 23:
+            bd1_2_status = gpioValue;
+            break;
+
+        //left slot
+        case 44:
+            bd0_1_status = gpioValue;
+            break;
+        case 45:
+            bd0_2_status = gpioValue;
+            break;
+        }
+    }
+
+#if 1 //DS60-120 remove
+    //BD1(Left-CCS-CND1-SMR2-左槍), BD2(Right-CHADEMO-CND2-SMR1-右槍), CCS: 10 , CHAdeMO: 01 , GBT: 11
+    //CcsChargingData [0至1] 分別為 Right至Left
+    //model name 槍順序左至右分別為Right至Left
+    tmp[1] = (bd0_1_status << 4 | bd0_2_status);
+    tmp[0] = (bd1_1_status << 4 | bd1_2_status);
+    for (i = 0; i < 2; i++) {
+        switch (tmp[i]) {
+        case 0x01:
+            log_info("BD%d(%s) = %s ", i + 1, i == 0 ? "Left" : "Right", "CHAdeMO");
+            break;
+
+        case 0x10:
+            log_info("BD%d(%s) = %s ", i + 1, i == 0 ? "Left" : "Right", "CCS");
+            break;
+
+        case 0x11:
+            log_info("BD%d(%s) = %s ", i + 1, i == 0 ? "Left" : "Right", "GBT");
+            break;
+
+        case 0x00:
+            log_info("BD%d(%s) = %s ", i + 1, i == 0 ? "Left" : "Right", "None");
+            break;
+        }
+    }
+#endif //0
+}
+
+void CheckGpioInStatus()
+{
+    int pinIn[2] = { 27, 47 };//{IO BD1_2, IO BD2_2}
+    unsigned int gpioValue = 0;
+
+    for (int i = 0; i < ARRAY_SIZE(pinIn); i++) {
+        gpio_get_value(pinIn[i], &gpioValue);
+        if (gpioValue == 0x01) {
+            switch (pinIn[i]) {
+            // 小板緊急停止
+            case 47: {
+                for (int i = 0; i < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; i++) {
+                    if (chargingInfo[i]->slotsIndex == 1) {
+                        if (chargingInfo[i]->Type == _Type_Chademo) {
+                            BoardErrOccurByString(i, "023730");
+                        } else if (chargingInfo[i]->Type == _Type_CCS_2) {
+                            BoardErrOccurByString(i, "013627");
+                        }
+                        break;
+                    }
+                }
+            }
+            break;
+            case 27: {
+                for (int i = 0; i < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; i++) {
+                    if (chargingInfo[i]->slotsIndex == 3) {
+                        if (chargingInfo[i]->Type == _Type_Chademo) {
+                            BoardErrOccurByString(i, "023730");
+                        } else if (chargingInfo[i]->Type == _Type_CCS_2) {
+                            BoardErrOccurByString(i, "013627");
+                        }
+                        break;
+                    }
+                }
+            }
+            break;
+            }
+        } else {
+            switch (pinIn[i]) {
+            // 小板解除緊急停止
+            case 47: {
+                for (int i = 0; i < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; i++) {
+                    if (chargingInfo[i]->slotsIndex == 1) {
+                        if (chargingInfo[i]->Type == _Type_Chademo) {
+                            ReleaseBoardErrOccurByString(i, "023730");
+                        } else if (chargingInfo[i]->Type == _Type_CCS_2) {
+                            ReleaseBoardErrOccurByString(i, "013627");
+                        }
+                        break;
+                    }
+                }
+            }
+            break;
+            case 27: {
+                for (int i = 0; i < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; i++) {
+                    if (chargingInfo[i]->slotsIndex == 3) {
+                        if (chargingInfo[i]->Type == _Type_Chademo) {
+                            ReleaseBoardErrOccurByString(i, "023730");
+                        } else if (chargingInfo[i]->Type == _Type_CCS_2) {
+                            ReleaseBoardErrOccurByString(i, "013627");
+                        }
+                        break;
+                    }
+                }
+            }
+            break;
+            }
+        }
+    }
+}
+
+//===============================================
+// Main process
+//===============================================
+// 檢查 Byte 中某個 Bit 的值
+// _byte : 欲改變的 byte
+// _bit : 該 byte 的第幾個 bit
+unsigned char DetectBitValue(unsigned char _byte, unsigned char _bit)
+{
+    return ( _byte & mask_table[_bit] ) != 0x00;
+}
+
+// 設定 Byte 中某個 Biｔ的值
+// _byte : 欲改變的 byte
+// _bit : 該 byte 的第幾個 bit
+// value : 修改的值為 0 or 1
+void SetBitValue(unsigned char *_byte, unsigned char _bit, unsigned char value)
+{
+    if (value == 1) {
+        *_byte |= (1 << _bit);
+    } else if (value == 0) {
+        *_byte ^= (1 << _bit);
+    }
+}
+
+void UserScanFunction()
+{
+    bool idleReq = false;
+    unsigned char stopReq = 255;
+
+    // 當前非驗證的狀態
+    if (!IsAuthorizingMode()) {
+#if defined DD360Audi
+        //當前沒有選槍
+        if (getConfirmSelectedGun(ShmSysConfigAndInfo->SysInfo.CurGunSelected) == FAIL) { //Jerry add
+            strcpy((char *)ShmSysConfigAndInfo->SysConfig.UserId, "");
+            return;
+        }
+#endif //defined DD360Audi
+
+        // 先判斷現在是否可以提供刷卡
+        // 1. 如果當前沒有槍是閒置狀態，則無提供刷卡功能
+        // 2. 停止充電
+        if (ShmSysConfigAndInfo->SysInfo.PageIndex == _LCM_FIX) {
+            strcpy((char *)ShmSysConfigAndInfo->SysConfig.UserId, "");
+            return;
+        }
+
+        for (byte i = 0; i < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; i++) {
+            if (chargingInfo[i]->SystemStatus == S_CHARGING) {
+                stopReq = i;
+            }
+            if ((chargingInfo[i]->SystemStatus == S_IDLE && chargingInfo[i]->IsAvailable) == YES ||
+                    (_acgunIndex > 0 && ac_chargingInfo[0]->SystemStatus == S_IDLE && ac_chargingInfo[0]->IsAvailable)) {
+                idleReq = true;
+            }
+        }
+
+        if (_acgunIndex > 0 && ShmSysConfigAndInfo->SysInfo.CurGunSelectedByAc == DEFAULT_AC_INDEX &&
+                ac_chargingInfo[0]->SystemStatus == S_CHARGING) {
+            stopReq = DEFAULT_AC_INDEX;
+        }
+
+        if (strlen((char *)ShmSysConfigAndInfo->SysConfig.UserId) > 0) {
+            if (_acgunIndex > 0 && stopReq == DEFAULT_AC_INDEX && ShmSysConfigAndInfo->SysInfo.CurGunSelectedByAc == DEFAULT_AC_INDEX) {
+                char value[32];
+
+                PRINTF_FUNC("ac stop charging \n");
+                PRINTF_FUNC("index = %d, card number = %s, UserId = %s \n", ShmSysConfigAndInfo->SysInfo.CurGunSelectedByAc,
+                            ac_chargingInfo[0]->StartUserId, ShmSysConfigAndInfo->SysConfig.UserId);
+                memcpy(value, (unsigned char *)ac_chargingInfo[0]->StartUserId,
+                       ARRAY_SIZE(ac_chargingInfo[0]->StartUserId));
+                if (strcmp((char *)ShmSysConfigAndInfo->SysConfig.UserId, value) == EQUAL) {
+                    AcChargingTerminalProcess();
+                }
+                strcpy((char *)ShmSysConfigAndInfo->SysConfig.UserId, "");
+            } else if (stopReq < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount &&
+                       chargingInfo[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->SystemStatus == S_CHARGING &&
+                       (_acgunIndex <= 0 || (_acgunIndex > 0 && ShmSysConfigAndInfo->SysInfo.CurGunSelectedByAc == NO_DEFINE))) {
+                char value[32];
+
+                PRINTF_FUNC("stop charging \n");
+                PRINTF_FUNC("index = %d, card number = %s, UserId = %s \n", ShmSysConfigAndInfo->SysInfo.CurGunSelected,
+                            chargingInfo[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->StartUserId, ShmSysConfigAndInfo->SysConfig.UserId);
+                memcpy(value, (unsigned char *)chargingInfo[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->StartUserId,
+                       ARRAY_SIZE(chargingInfo[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->StartUserId));
+
+                // 同一張卡直接停掉
+                if (strcmp((char *)ShmSysConfigAndInfo->SysConfig.UserId, value) == EQUAL) {
+                    ChargingTerminalProcess(ShmSysConfigAndInfo->SysInfo.CurGunSelected);
+                    strcpy((char *)ShmSysConfigAndInfo->SysConfig.UserId, "");
+                } else {
+                    // 進驗證
+                    if (_acgunIndex > 0 && ShmSysConfigAndInfo->SysInfo.CurGunSelectedByAc == DEFAULT_AC_INDEX) {
+                        _authorizeIndex = ShmSysConfigAndInfo->SysInfo.CurGunSelectedByAc;
+                    } else {
+                        _authorizeIndex = ShmSysConfigAndInfo->SysInfo.CurGunSelected;
+                    }
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
+                    StartSystemTimeoutDet(Timeout_AuthorizingForStop);
+                    AuthorizingStart();
+#else
+                    strcpy((char *)ShmSysConfigAndInfo->SysConfig.UserId, "");
+#endif //!defined DD360 && !defined DD360Audi
+                }
+            } else if (idleReq) {
+                if (ShmSysConfigAndInfo->SysConfig.TotalConnectorCount > 1 &&
+                        stopReq != 255 &&
+                        ShmSysConfigAndInfo->SysInfo.IsAlternatvieConf == YES) {
+                    idleReq = false;
+                    strcpy((char *)ShmSysConfigAndInfo->SysConfig.UserId, "");
+                } else if ((_acgunIndex > 0 && ShmSysConfigAndInfo->SysInfo.CurGunSelectedByAc == DEFAULT_AC_INDEX) ||
+                           chargingInfo[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->SystemStatus == S_IDLE) {
+                    PRINTF_FUNC("// LCM => Authorizing \n");
+#if defined DD360Audi
+                    setSelGunWaitToAuthor(ShmSysConfigAndInfo->SysInfo.CurGunSelected); //Jerry add
+#endif //defined DD360Audi
+                    // LCM => Authorizing
+                    ShmSysConfigAndInfo->SysInfo.SystemPage = _LCM_AUTHORIZING;
+                    // 進入確認卡號狀態
+                    AuthorizingStart();
+                } else {
+                    strcpy((char *)ShmSysConfigAndInfo->SysConfig.UserId, "");
+                }
+            } else {
+                strcpy((char *)ShmSysConfigAndInfo->SysConfig.UserId, "");
+            }
+        }
+    } else {
+        // 透過後臺停止充電的判斷
+        if (isAuthorizedComplete()
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
+                || (ShmSysConfigAndInfo->SysInfo.OcppConnStatus == NO &&
+                    ShmSysConfigAndInfo->SysConfig.OfflinePolicy == _OFFLINE_POLICY_FREE_CHARGING)
+#endif //!defined DD360 && !defined DD360Audi
+           ) {
+            // 判斷後台回覆狀態
+            if (canStartCharging()
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
+                    || (ShmSysConfigAndInfo->SysInfo.OcppConnStatus == NO &&
+                        ShmSysConfigAndInfo->SysConfig.OfflinePolicy == _OFFLINE_POLICY_FREE_CHARGING)
+#endif //!defined DD360 && !defined DD360Audi
+               ) {
+                if (_authorizeIndex != NO_DEFINE) {
+                    // 先找 AC
+                    if (_authorizeIndex == DEFAULT_AC_INDEX) {
+                        if (ShmSysConfigAndInfo->SysConfig.OfflinePolicy == _OFFLINE_POLICY_LOCAL_LIST &&
+                                strcmp((char *)chargingInfo[_authorizeIndex]->StartUserId, "") != EQUAL) {
+                            AcChargingTerminalProcess();
+                        }
+                    } else {
+                        if (ShmSysConfigAndInfo->SysConfig.OfflinePolicy == _OFFLINE_POLICY_LOCAL_LIST &&
+                                strcmp((char *)chargingInfo[_authorizeIndex]->StartUserId, "") != EQUAL) {
+                            ChargingTerminalProcess(_authorizeIndex);
+                        }
+                    }
+                    strcpy((char *)ShmSysConfigAndInfo->SysConfig.UserId, "");
+                    _authorizeIndex = NO_DEFINE;
+                }
+            } else {
+                strcpy((char *)ShmSysConfigAndInfo->SysConfig.UserId, "");
+            }
+            ClearAuthorizedFlag();
+        } else if (ShmSysConfigAndInfo->SysConfig.OfflinePolicy == _OFFLINE_POLICY_LOCAL_LIST) {
+            // 白名單驗證
+            for (int i = 0; i < 10; i++) {
+                if (strcmp((char *)ShmSysConfigAndInfo->SysConfig.LocalWhiteCard[i], "") != EQUAL) {
+                    if (strcmp((char *)ShmSysConfigAndInfo->SysConfig.LocalWhiteCard[i], (char *)ShmSysConfigAndInfo->SysConfig.UserId) == EQUAL) {
+                        ChargingTerminalProcess(_authorizeIndex);
+                        strcpy((char *)ShmSysConfigAndInfo->SysConfig.UserId, "");
+                        ClearAuthorizedFlag();
+                        break;
+                    }
+                }
+            }
+        }
+    }
+}
+
+unsigned char isModeChange(unsigned char gun_index)
+{
+    unsigned char result = NO;
+
+    if (chargingInfo[gun_index]->SystemStatus != chargingInfo[gun_index]->PreviousSystemStatus) {
+        result = YES;
+        chargingInfo[gun_index]->PreviousSystemStatus = chargingInfo[gun_index]->SystemStatus;
+    }
+
+    return result;
+}
+
+void ScannerCardProcess()
+{
+    if (!isDetectPlugin() && !isCardScan && ShmSysConfigAndInfo->SysWarningInfo.Level != 2 &&
+            ShmSysConfigAndInfo->SysConfig.AuthorisationMode == AUTH_MODE_ENABLE) {
+        isCardScan = true;
+        // 處理刷卡及驗證卡號的動作
+        UserScanFunction();
+    }
+
+    if (ShmSysConfigAndInfo->SysInfo.PageIndex == _LCM_AUTHORIZING) {
+        StartSystemTimeoutDet(Timeout_Authorizing);
+
+        // 確認驗證卡號完成沒
+        if (isAuthorizedComplete()
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
+                || ShmSysConfigAndInfo->SysConfig.OfflinePolicy == _OFFLINE_POLICY_FREE_CHARGING
+#endif //!defined DD360 && !defined DD360Audi
+           ) {
+            StopSystemTimeoutDet();
+            // 判斷後台回覆狀態
+            if (canStartCharging()
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
+                    || ShmSysConfigAndInfo->SysConfig.OfflinePolicy == _OFFLINE_POLICY_FREE_CHARGING
+#endif //!defined DD360 && !defined DD360Audi
+               ) {
+                // LCM => Authorize complete
+                ShmSysConfigAndInfo->SysInfo.SystemPage = _LCM_AUTHORIZ_COMP;
+            } else {
+                // LCM => Authorize fail
+                ShmSysConfigAndInfo->SysInfo.SystemPage = _LCM_AUTHORIZ_FAIL;
+                strcpy((char *)ShmSysConfigAndInfo->SysConfig.UserId, "");
+            }
+            ClearAuthorizedFlag();
+        } else if (ShmSysConfigAndInfo->SysConfig.OfflinePolicy == _OFFLINE_POLICY_LOCAL_LIST) {
+            // 白名單驗證
+            for (int i = 0; i < 10; i++) {
+                if (strcmp((char *)ShmSysConfigAndInfo->SysConfig.LocalWhiteCard[i], "") != EQUAL) {
+                    if (strcmp((char *)ShmSysConfigAndInfo->SysConfig.LocalWhiteCard[i], (char *)ShmSysConfigAndInfo->SysConfig.UserId) == EQUAL) {
+                        ShmSysConfigAndInfo->SysInfo.SystemPage = _LCM_AUTHORIZ_COMP;
+                        ClearAuthorizedFlag();
+                        break;
+                    }
+                }
+            }
+        }
+    } else if (ShmSysConfigAndInfo->SysInfo.PageIndex == _LCM_AUTHORIZ_FAIL) {
+        StartSystemTimeoutDet(Timeout_VerifyFail);
+        isCardScan = false;
+    } else if (ShmSysConfigAndInfo->SysInfo.PageIndex == _LCM_AUTHORIZ_COMP) {
+        StartSystemTimeoutDet(Timeout_VerifyComp);
+    } else if (ShmSysConfigAndInfo->SysInfo.PageIndex == _LCM_WAIT_FOR_PLUG) {
+        StartSystemTimeoutDet(Timeout_WaitPlug);
+    } else {
+        isCardScan = false;
+    }
+}
+
+bool AddGunInfoByConnector(byte typeValue, byte slots)
+{
+    bool result = true;
+
+    switch (typeValue) {
+    case '0': // none
+        break;
+    case '1': // IEC 62196-2 Type 1/SAE J1772 Plug
+        break;
+    case '2': // IEC 62196-2 Type 1/SAE J1772 Socket
+        break;
+    case '3': // IEC 62196-2 Type 2 Plug
+    case '4': // IEC 62196-2 Type 2 Socket
+        if (AC_QUANTITY > _ac_Index) {
+            ac_chargingInfo[_acgunIndex] = &ShmSysConfigAndInfo->SysInfo.AcChargingData[_ac_Index];
+
+            // AC 固定 index
+            ac_chargingInfo[_acgunIndex]->Index = 0;
+            ac_chargingInfo[_acgunIndex]->ReservationId = -1;
+            ac_chargingInfo[_acgunIndex]->SystemStatus = S_IDLE;
+            ac_chargingInfo[_acgunIndex]->Type = _Type_AC;
+            ac_chargingInfo[_acgunIndex]->IsAvailable = YES;
+            ac_chargingInfo[_acgunIndex]->schedule.isTriggerStart = NO; //DS60-120 add
+            ac_chargingInfo[_acgunIndex]->schedule.isTriggerStop = NO;  //DS60-120 add
+            _ac_Index++;
+            _acgunIndex++;
+        } else {
+            result = false;
+        }
+        break;
+    case '5': // GB/T AC Plug
+        break;
+    case '6': // GB/T AC Socket
+        break;
+    case 'J':
+    case 'K': { // CHAdeMO
+        if (CHAdeMO_QUANTITY > _chademoIndex) {
+            chargingInfo[_gunIndex] = &ShmSysConfigAndInfo->SysInfo.ChademoChargingData[_chademoIndex];
+            chargingInfo[_gunIndex]->Index = _gunIndex;
+            chargingInfo[_gunIndex]->ReservationId = -1;
+            chargingInfo[_gunIndex]->slotsIndex = slots;
+            chargingInfo[_gunIndex]->SystemStatus = S_BOOTING;
+            chargingInfo[_gunIndex]->Type = _Type_Chademo;
+            chargingInfo[_gunIndex]->type_index = _chademoIndex;
+            chargingInfo[_gunIndex]->IsAvailable = YES;
+            chargingInfo[_acgunIndex]->schedule.isTriggerStart = NO; //DS60-120 add
+            chargingInfo[_acgunIndex]->schedule.isTriggerStop = NO;  //DS60-120 add
+            _chademoIndex++;
+            _gunIndex++;
+        } else {
+            result = false;
+        }
+    }
+    break;
+    case 'U': // CCS1 combo
+    case 'E': // CCS2 combo
+    case 'V': // Liquid CCS1 combo
+    case 'F': { // Liquid CCS2 combo
+        if (CCS_QUANTITY > _ccsIndex) {
+            chargingInfo[_gunIndex] = &ShmSysConfigAndInfo->SysInfo.CcsChargingData[_ccsIndex];
+
+            chargingInfo[_gunIndex]->Index = _gunIndex;
+            chargingInfo[_gunIndex]->ReservationId = -1;
+            chargingInfo[_gunIndex]->slotsIndex = slots;
+            chargingInfo[_gunIndex]->SystemStatus = S_BOOTING;
+            chargingInfo[_gunIndex]->Type = _Type_CCS_2;
+            chargingInfo[_gunIndex]->type_index = _ccsIndex;
+            chargingInfo[_gunIndex]->IsAvailable = YES;
+            chargingInfo[_acgunIndex]->schedule.isTriggerStart = NO;//DS60-120 add
+            chargingInfo[_acgunIndex]->schedule.isTriggerStop = NO; //DS60-120 add
+            // 現階段預設為走 DIN70121
+            ShmCcsData->CommProtocol = _CCS_COMM_V2GMessage_DIN70121;
+            _ccsIndex++;
+            _gunIndex++;
+        } else {
+            result = false;
+        }
+    }
+    break;
+    case 'G': { // GBT DC
+        if (GB_QUANTITY > _gb_Index) {
+            chargingInfo[_gunIndex] = &ShmSysConfigAndInfo->SysInfo.GbChargingData[_gb_Index];
+
+            chargingInfo[_gunIndex]->Index = _gunIndex;
+            chargingInfo[_gunIndex]->ReservationId = -1;
+            chargingInfo[_gunIndex]->slotsIndex = slots;
+            chargingInfo[_gunIndex]->SystemStatus = S_BOOTING;
+            chargingInfo[_gunIndex]->Type = _Type_GB;
+            chargingInfo[_gunIndex]->type_index = _gb_Index;
+            chargingInfo[_gunIndex]->IsAvailable = YES;
+            chargingInfo[_acgunIndex]->schedule.isTriggerStart = NO;//DS60-120 add
+            chargingInfo[_acgunIndex]->schedule.isTriggerStop = NO; //DS60-120 add
+            _gb_Index++;
+            _gunIndex++;
+        } else {
+            result = false;
+        }
+    }
+    break;
+    case 'D': // GBT DC x 2
+        break;
+    }
+    return result;
+}
+
+bool CheckConnectorTypeStatus()
+{
+    bool result = true;
+
+
+    //PRINTF_FUNC("bd0_1_status = %d, bd0_2_status = %d, bd1_1_status = %d, bd1_2_status = %d \n",
+    //            bd0_1_status,
+    //            bd0_2_status,
+    //            bd1_1_status,
+    //            bd1_2_status);
+
+    if (strlen((char *) ShmSysConfigAndInfo->SysConfig.ModelName) >= 9) {
+        //printf("1 CheckConnectorTypeStatus\r\n");
+        byte slots = 1;
+        for (byte typeIndex = 7; typeIndex <= 9; typeIndex++) {
+            if (!AddGunInfoByConnector(ShmSysConfigAndInfo->SysConfig.ModelName[typeIndex], slots)) {
+                return false;
+            }
+
+            slots++;
+        }
+
+        // AC index 接在 DC 後面
+        //if (AC_QUANTITY > 0) {
+        if (_ac_Index > 0) { //DS60-120 add
+            ac_chargingInfo[0]->Index += _gunIndex;
+        }
+
+        ShmSysConfigAndInfo->SysConfig.TotalConnectorCount = _gunIndex;
+        ShmSysConfigAndInfo->SysConfig.AcConnectorCount = _acgunIndex;
+        log_info("DC connector Quality = %d, AC connector Quality = %d",
+                 ShmSysConfigAndInfo->SysConfig.TotalConnectorCount,
+                 ShmSysConfigAndInfo->SysConfig.AcConnectorCount);
+        log_info("Type 0~3 = CHAdeMO, CCS, GB, AC");
+        if (ShmSysConfigAndInfo->SysConfig.TotalConnectorCount == 0 &&
+                ShmSysConfigAndInfo->SysConfig.AcConnectorCount == 0) {
+            result = false;
+        }
+
+        if (ShmSysConfigAndInfo->SysConfig.TotalConnectorCount == 1) {
+            //DS60-120 add
+            bool isFind = false;
+            if (chargingInfo[0]->Type == _Type_Chademo) {
+                if ((bd0_1_status == 0 && bd0_2_status == 1) ||
+                        (bd1_1_status == 0 && bd1_2_status == 1)) {
+                    isFind = true;
+                }
+            } else if (chargingInfo[0]->Type == _Type_CCS_2) {
+                if ((bd0_1_status == 1 && bd0_2_status == 0) ||
+                        (bd1_1_status == 1 && bd1_2_status == 0)) {
+                    isFind = true;
+                }
+            } else if (chargingInfo[0]->Type == _Type_GB) {
+                if ((bd0_1_status == 1 && bd0_2_status == 1) ||
+                        (bd1_1_status == 1 && bd1_2_status == 1)) {
+                    isFind = true;
+                }
+            }
+
+            if (isFind) {
+                if (bd0_1_status == 1 || bd0_2_status == 1) {
+                    chargingInfo[0]->Evboard_id = 0x01;
+                }
+
+                if (bd1_1_status == 1 || bd1_2_status == 1) {
+                    chargingInfo[0]->Evboard_id = 0x02;
+                }
+                CheckHwSlotStatusLog(0);
+            } else {
+                result = false;
+            }
+            //chargingInfo[0]->Evboard_id = 0x01;
+            log_info("index = %d, Type = %d, Evboard_id = %d", 0, chargingInfo[0]->Type, chargingInfo[0]->Evboard_id);
+        } else {
+            char type = NO_DEFINE; //DS60-120 add
+
+            // 偵測槍屬於哪個 slot : 可知道插在板上的Slot 0 或 1 是 Chademo 還是 CCS
+            for (byte gunIndex = 0; gunIndex < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; gunIndex++) {
+                if (gunIndex == 0 && bd0_1_status == 0 && bd0_2_status == 1) {
+                    // 與硬體相同 type : Chademo
+                    if (chargingInfo[gunIndex]->Type == _Type_Chademo) {
+                        chargingInfo[gunIndex]->Evboard_id = 0x01;
+                    }
+                } else if (gunIndex == 0 && bd0_1_status == 1 && bd0_2_status == 0) {
+                    // 與硬體相同 type : CCS
+                    if (chargingInfo[gunIndex]->Type == _Type_CCS_2) {
+                        chargingInfo[gunIndex]->Evboard_id = 0x01;
+                    }
+                } else if (gunIndex == 0 && bd0_1_status == 1 && bd0_2_status == 1) {
+                    // 與硬體相同 type : GB
+                    if (chargingInfo[gunIndex]->Type == _Type_GB) {
+                        chargingInfo[gunIndex]->Evboard_id = 0x01;
+                    }
+                }
+
+                if (gunIndex == 1 && bd1_1_status == 0 && bd1_2_status == 1) {
+                    // 與硬體相同 type : Chademo
+                    if (chargingInfo[gunIndex]->Type == _Type_Chademo) {
+                        chargingInfo[gunIndex]->Evboard_id = 0x02;
+                    }
+
+                    if (ShmSysConfigAndInfo->SysConfig.TotalConnectorCount == 1) {
+                        chargingInfo[gunIndex]->Evboard_id = 0x01;
+                    }
+                } else if (gunIndex == 1 && bd1_1_status == 1 && bd1_2_status == 0) {
+                    // 與硬體相同 type : CCS
+                    if (chargingInfo[gunIndex]->Type == _Type_CCS_2) {
+                        chargingInfo[gunIndex]->Evboard_id = 0x02;
+                    }
+
+                    if (ShmSysConfigAndInfo->SysConfig.TotalConnectorCount == 1) {
+                        chargingInfo[gunIndex]->Evboard_id = 0x01;
+                    }
+                } else if (gunIndex == 1 && bd1_1_status == 1 && bd1_2_status == 1) {
+                    // 與硬體相同 type : GB
+                    if (chargingInfo[gunIndex]->Type == _Type_GB) {
+                        chargingInfo[gunIndex]->Evboard_id = 0x02;
+                    }
+
+                    if (ShmSysConfigAndInfo->SysConfig.TotalConnectorCount == 1) {
+                        chargingInfo[gunIndex]->Evboard_id = 0x01;
+                    }
+                }
+
+                log_info("index = %d, Type = %d, Evboard_id = %d",
+                         gunIndex,
+                         chargingInfo[gunIndex]->Type,
+                         chargingInfo[gunIndex]->Evboard_id);
+                CheckHwSlotStatusLog(gunIndex);
+
+                if (type == NO_DEFINE) {
+                    type = chargingInfo[gunIndex]->Type;
+                }
+#if defined METER_ENABLE
+                else {
+                    // 雙槍都是同一個 type
+                    if (type == chargingInfo[gunIndex]->Type) {
+                        ShmDcCommonData->SysGunAreSameType = YES;
+                    }
+                }
+#endif //METER_ENABLE
+                if (chargingInfo[gunIndex]->Evboard_id == 0x00) {
+                    result = false;
+                }
+            }
+        }
+    } else {
+        // Module Name 不正確 - 告警
+        result = false;
+    }
+
+    return result;
+}
+
+void KillTask()
+{
+    ChangeLcmByIndex(_LCM_FIX);
+    system("killall Module_EventLogging");
+    system("killall Module_PrimaryComm");
+    system("killall Module_EvComm");
+    system("killall Module_LcmControl");
+    system("killall Module_InternalComm");
+    //system("killall DoComm");
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
+    system("killall Module_PsuComm");
+    system("killall OcppBackend &");
+    system("killall Module_4g &");
+    system("killall Module_Wifi &");
+#endif //!defined DD360 && !defined DD360Audi
+}
+
+void KillTaskExceptPrimary()
+{
+    ChangeLcmByIndex(_LCM_FIX);
+    system("killall Module_EvComm");
+    system("killall Module_InternalComm");
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
+    system("killall Module_PsuComm");
+    system("killall Module_4g &");
+    system("killall Module_Wifi &");
+#endif //!defined DD360 && !defined DD360Audi
+}
+
+void KillAllTask()
+{
+    ChangeLcmByIndex(_LCM_FIX);
+    system("killall Module_EventLogging");
+    system("killall Module_PrimaryComm");
+    system("killall Module_EvComm");
+    system("killall Module_LcmControl");
+    system("killall Module_InternalComm");
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
+    system("killall Module_PsuComm");
+    system("killall OcppBackend &");
+    system("killall Module_4g &");
+    system("killall Module_Wifi &");
+#else
+    system("killall DoComm");
+#endif //!defined DD360 && !defined DD360Audi
+}
+
+int CheckUpdateProcess(void)
+{
+    //bool isPass = true;
+    uint8_t retSucc = 0;
+    uint8_t retFail = 0;
+    byte index = 0;
+    byte target = 0;
+    char *new_str = NULL;
+    unsigned char *ptr = NULL;
+    int fd = 0;
+    int CanFd = 0;
+    int uartFd = 0;
+    unsigned int Type = 0;
+    long int MaxLen = 48 * 1024 * 1024, ImageLen = 0;
+    DIR *d;
+    struct dirent *dir;
+
+    d = opendir("/mnt/");
+    if (d) {
+        while ((dir = readdir(d)) != NULL) {
+            if (strcmp(dir->d_name, ".") == 0 || strcmp(dir->d_name, "..") == 0) {
+                continue;
+            }
+
+            new_str = calloc(strlen("/mnt/") + strlen(dir->d_name) + 1, sizeof(char));
+            //new_str[0] = '\0';
+            strcat(new_str, "/mnt/");
+            strcat(new_str, dir->d_name);
+            log_info("%s%s\r\n", "/mnt/", dir->d_name);
+            fd = open(new_str, O_RDONLY);
+            if (fd < 0) {
+                return FAIL;
+            }
+
+            ptr = calloc(MaxLen, sizeof(char)); //-48 is take out the header
+            //memset(ptr, 0xFF, MaxLen);  //-48 is take out the header
+
+            //get the image length
+            ImageLen = read(fd, ptr, MaxLen);
+            for (byte i = 0; i < 16; i++) {
+                if (ShmSysConfigAndInfo->SysConfig.ModelName[i] != ptr[i]) {
+                    return FAIL;
+                }
+            }
+
+            PRINTF_FUNC("model name check pass. \n");
+            if (ImageLen > 20) {
+                Type = (((unsigned int)ptr[16]) << 24 |
+                        ((unsigned int)ptr[17]) << 16 |
+                        ((unsigned int)ptr[18]) << 8  |
+                        ((unsigned int)ptr[19]));
+                PRINTF_FUNC("Typed...%x \r\n", Type);
+
+                switch (Type) {
+                case 0x10000001:
+                case 0x10000002:
+                case 0x10000003:
+                case 0x10000004:
+                case 0x10000005:
+                    if (Upgrade_Flash(Type, new_str, (char *)ShmSysConfigAndInfo->SysConfig.ModelName) == PASS) {
+                        //return PASS;
+                        retSucc++;
+                    } else {
+                        PRINTF_FUNC("Upgrade %x Failed\r\n", Type);
+                        //return FAIL;
+                        retFail++;
+                    }
+                    break;
+
+                case 0x10000007:
+                case 0x10000008:
+                case 0x10000009:
+                case 0x1000000A:
+                    //isPass = true;
+                    CanFd = InitCanBus();
+                    if (CanFd > 0) {
+                        for (index = 0; index < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; index++) {
+                            //if (!isPass) {
+                            //    break;
+                            //}
+
+                            if (chargingInfo[index]->Type == _Type_CCS_2) {
+                                if (Upgrade_CCS(CanFd, Type, chargingInfo[index]->Evboard_id, new_str, (char *)ShmSysConfigAndInfo->SysConfig.ModelName) == FAIL) {
+                                    //isPass = false;
+                                    PRINTF_FUNC("Upgrade %x Failed\r\n", Type);
+                                    retFail++;
+                                }
+                            }
+                        }
+                    } else {
+                        log_error("Upgrade CCS open CAN FD fail.\n");
+                        //isPass = false;
+                        return FAIL;
+                    }
+
+                    if (retFail != 0) {
+                        break;
+                    } else {
+                        retSucc++;
+                    }
+                    //return isPass;
+                    break;
+
+                case 0x10000006:
+                case 0x1000000D:
+                case 0x1000000E:
+                case 0x20000002:
+                case 0x10000014:
+                    // CSU_PRIMARY_CONTROLLER : 0x10000006
+                    target = 0x00;
+
+                    if (Type == 0x10000006) {
+                        target = UPGRADE_PRI;
+                    } else if (Type == 0x1000000D) {
+                        target = UPGRADE_RB;
+                    } else if (Type == 0x1000000E) {
+                        target = UPGRADE_FAN;
+                    } else if (Type == 0x20000002) {
+                        target = UPGRADE_AC;
+                    } else if (Type == 0x10000014) {
+                        target = UPGRADE_LED;
+                    }
+
+                    uartFd = InitComPort(target);
+
+                    if (Upgrade_UART(uartFd, Type, target, new_str, (char *)ShmSysConfigAndInfo->SysConfig.ModelName) == PASS) {
+                        //return PASS;
+                        retSucc++;
+                    } else {
+                        PRINTF_FUNC("Upgrade %x Failed\r\n", Type);
+                        //return FAIL;
+                        return FAIL;
+                    }
+
+                    if (uartFd > 0) {
+                        close(uartFd);
+                    }
+                    break;
+
+                case 0x1000000B:
+                case 0x1000000C:
+                    // CHAdeMO_BOARD : 0x1000000B, GBT : 0x1000000C
+                    //bool isPass = true;
+                    CanFd = InitCanBus();
+                    if (CanFd > 0) {
+                        for (index = 0; index < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; index++) {
+                            //if (!isPass) {
+                            //    break;
+                            //}
+
+                            if ((Type == 0x1000000B && chargingInfo[index]->Type == _Type_Chademo) ||
+                                    (Type == 0x1000000C && chargingInfo[index]->Type == _Type_GB)) {
+                                if (Upgrade_CAN(CanFd, Type, chargingInfo[index]->Evboard_id, new_str, (char *)ShmSysConfigAndInfo->SysConfig.ModelName) == PASS) {
+                                    //isPass = PASS;
+                                    retSucc++;
+                                } else {
+                                    PRINTF_FUNC("Upgrade %x Failed\r\n", Type);
+                                    //isPass = FAIL;
+                                    retFail++;
+                                }
+                            }
+                        }
+                    } else {
+                        PRINTF_FUNC("Upgrad FD fail. \n");
+                        //isPass = false;
+                        return FAIL;
+                    }
+
+                    //return isPass;
+                    break;
+                }
+            }
+            free(new_str);
+            free(ptr);
+        }
+    }
+    free(dir);
+    closedir(d);
+
+    if (retFail != 0) {
+        return FAIL;
+    }
+
+    return PASS;
+}
+
+void CreateRfidFork()
+{
+    pid_t rfidRecPid;
+
+    rfidRecPid = fork();
+    log_info("CreateRfidFork = %d\r\n", rfidRecPid);
+    if (rfidRecPid == 0) {
+        while (true) {
+            // 刷卡判斷
+            RFID rfid;
+            if (ShmSysConfigAndInfo->SysConfig.OfflinePolicy == _OFFLINE_POLICY_NO_CHARGING ||
+                    !ShmSysConfigAndInfo->SysConfig.isRFID)
+            {}
+            else if (getRequestCardSN(rfidFd, 0, &rfid)) {
+                //log_info("Get Card..-%s- \n", ShmSysConfigAndInfo->SysConfig.UserId);
+                if (strlen((char *)ShmSysConfigAndInfo->SysConfig.UserId) == 0) {
+                    if (ShmSysConfigAndInfo->SysConfig.RfidCardNumEndian == RFID_ENDIAN_LITTLE) {
+                        switch (rfid.snType) {
+                        case RFID_SN_TYPE_6BYTE:
+                            sprintf((char *) ShmSysConfigAndInfo->SysConfig.UserId,
+                                    "%02X%02X%02X%02X%02X%02X",
+                                    rfid.currentCard[0], rfid.currentCard[1],
+                                    rfid.currentCard[2], rfid.currentCard[3],
+                                    rfid.currentCard[4], rfid.currentCard[5]);
+                            break;
+                        case RFID_SN_TYPE_7BYTE:
+                            sprintf((char *) ShmSysConfigAndInfo->SysConfig.UserId,
+                                    "%02X%02X%02X%02X%02X%02X%02X",
+                                    rfid.currentCard[0], rfid.currentCard[1],
+                                    rfid.currentCard[2], rfid.currentCard[3],
+                                    rfid.currentCard[4], rfid.currentCard[5],
+                                    rfid.currentCard[6]);
+                            break;
+                        case RFID_SN_TYPE_10BYTE:
+                            sprintf((char *) ShmSysConfigAndInfo->SysConfig.UserId,
+                                    "%02X%02X%02X%02X%02X%02X%02X%02X%02X%02X",
+                                    rfid.currentCard[0], rfid.currentCard[1],
+                                    rfid.currentCard[2], rfid.currentCard[3],
+                                    rfid.currentCard[4], rfid.currentCard[5],
+                                    rfid.currentCard[6], rfid.currentCard[7],
+                                    rfid.currentCard[8], rfid.currentCard[9]);
+                            break;
+                        case RFID_SN_TYPE_4BYTE:
+                            sprintf((char *) ShmSysConfigAndInfo->SysConfig.UserId,
+                                    "%02X%02X%02X%02X",
+                                    rfid.currentCard[0], rfid.currentCard[1],
+                                    rfid.currentCard[2], rfid.currentCard[3]);
+                            break;
+                        }
+                    } else if (ShmSysConfigAndInfo->SysConfig.RfidCardNumEndian == RFID_ENDIAN_BIG) {
+                        switch (rfid.snType) {
+                        case RFID_SN_TYPE_6BYTE:
+                            sprintf((char *) ShmSysConfigAndInfo->SysConfig.UserId,
+                                    "%02X%02X%02X%02X%02X%02X",
+                                    rfid.currentCard[5], rfid.currentCard[4],
+                                    rfid.currentCard[3], rfid.currentCard[2],
+                                    rfid.currentCard[1], rfid.currentCard[0]);
+                            break;
+                        case RFID_SN_TYPE_7BYTE:
+                            sprintf((char *) ShmSysConfigAndInfo->SysConfig.UserId,
+                                    "%02X%02X%02X%02X%02X%02X%02X",
+                                    rfid.currentCard[6], rfid.currentCard[5],
+                                    rfid.currentCard[4], rfid.currentCard[3],
+                                    rfid.currentCard[2], rfid.currentCard[1],
+                                    rfid.currentCard[0]);
+                            break;
+                        case RFID_SN_TYPE_10BYTE:
+                            sprintf((char *) ShmSysConfigAndInfo->SysConfig.UserId,
+                                    "%02X%02X%02X%02X%02X%02X%02X%02X%02X%02X",
+                                    rfid.currentCard[9], rfid.currentCard[8],
+                                    rfid.currentCard[7], rfid.currentCard[6],
+                                    rfid.currentCard[5], rfid.currentCard[4],
+                                    rfid.currentCard[3], rfid.currentCard[2],
+                                    rfid.currentCard[1], rfid.currentCard[0]);
+                            break;
+                        case RFID_SN_TYPE_4BYTE:
+                            sprintf((char *) ShmSysConfigAndInfo->SysConfig.UserId,
+                                    "%02X%02X%02X%02X",
+                                    rfid.currentCard[3], rfid.currentCard[2],
+                                    rfid.currentCard[1], rfid.currentCard[0]);
+                            break;
+                        }
+                    }
+                    log_info("card number = %s\n", ShmSysConfigAndInfo->SysConfig.UserId);
+                }
+            }
+            usleep(500000);
+        }
+    }
+}
+
+void StartSystemTimeoutDet(unsigned char flag)
+{
+    if (ShmSysConfigAndInfo->SysInfo.SystemTimeoutFlag != flag) {
+        gettimeofday(&ShmSysConfigAndInfo->SysInfo.SystemTimeoutTimer, NULL);
+    }
+    ShmSysConfigAndInfo->SysInfo.SystemTimeoutFlag = flag;
+}
+
+void StopSystemTimeoutDet()
+{
+    gettimeofday(&ShmSysConfigAndInfo->SysInfo.SystemTimeoutTimer, NULL);
+    ShmSysConfigAndInfo->SysInfo.SystemTimeoutFlag = Timeout_None;
+}
+
+void StartGunInfoTimeoutDet(unsigned char gunIndex, unsigned char flag)
+{
+    if (gunIndex < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount) {
+        if (chargingInfo[gunIndex]->TimeoutFlag != flag) {
+            gettimeofday(&chargingInfo[gunIndex]->TimeoutTimer, NULL);
+        }
+        chargingInfo[gunIndex]->TimeoutFlag = flag;
+    }
+}
+
+void StopGunInfoTimeoutDet(unsigned char gunIndex)
+{
+    if (gunIndex < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount) {
+        chargingInfo[gunIndex]->TimeoutFlag = Timeout_None;
+    }
+}
+
+void CheckConnectionTimeout()
+{
+    if (gAudiCustInfo->RemoteSetup.ConnectionTimeout != 0) { //Jerry add
+        _connectionTimeout = gAudiCustInfo->RemoteSetup.ConnectionTimeout;
+    } else {
+        _connectionTimeout = CONN_PLUG_TIME_OUT;
+    }
+
+#if 0
+    if (system("pidof -s OcppBackend > /dev/null") != 0) {
+        _connectionTimeout = CONN_PLUG_TIME_OUT;
+    } else {
+        if (strcmp((char *)ShmOCPP16Data->ConfigurationTable.CoreProfile[ConnectionTimeOut].ItemData, "") != 0) {
+            _connectionTimeout = atoi((char *)ShmOCPP16Data->ConfigurationTable.CoreProfile[ConnectionTimeOut].ItemData);
+            if (_connectionTimeout <= 0) {
+                _connectionTimeout = CONN_PLUG_TIME_OUT;
+            }
+        } else {
+            _connectionTimeout = CONN_PLUG_TIME_OUT;
+        }
+    }
+#endif //0
+}
+
+void CreateTimeoutFork()
+{
+    pid_t timeoutPid;
+
+    timeoutPid = fork();
+    log_info("CreateTimeoutFork = %d\r\n", timeoutPid);
+    if (timeoutPid == 0) {
+        gettimeofday(&_cmdSubPriority_time, NULL);
+        CheckConnectionTimeout();
+
+        while (1) {
+            if ((GetTimeoutValue(_cmdSubPriority_time) / 1000) > 5000) {
+                CheckConnectionTimeout();
+                gettimeofday(&_cmdSubPriority_time, NULL);
+            }
+
+            //printf("Timeout ***********SystemTimeoutFlag = %d, ********\n", ShmSysConfigAndInfo->SysInfo.SystemTimeoutFlag);
+            // 系統
+            switch (ShmSysConfigAndInfo->SysInfo.SystemTimeoutFlag) {
+            case Timeout_SelftestChk:
+                if (GetTimeoutValue(ShmSysConfigAndInfo->SysInfo.SystemTimeoutTimer) / uSEC_VAL >= SELFTEST_TIMEOUT) {
+                    _SelfTestTimeout();
+                    StopSystemTimeoutDet();
+#if defined DD360Audi
+                    destroySelGun(DESTROY_ALL_SEL); //jerry add
+#endif //defined DD360Audi
+                }
+                break;
+            case Timeout_Authorizing:
+                if (GetTimeoutValue(ShmSysConfigAndInfo->SysInfo.SystemTimeoutTimer) / uSEC_VAL >= AUTHORIZE_TIMEOUT) {
+                    _AuthorizedTimeout();
+                    StopSystemTimeoutDet();
+#if defined DD360Audi
+                    destroySelGun(ShmSysConfigAndInfo->SysInfo.CurGunSelected);
+#endif //defined DD360Audi
+                }
+                break;
+            case Timeout_VerifyFail:
+                if (GetTimeoutValue(ShmSysConfigAndInfo->SysInfo.SystemTimeoutTimer) / uSEC_VAL >= AUTHORIZE_FAIL_TIMEOUT) {
+                    _AutoReturnTimeout();
+                    StopSystemTimeoutDet();
+#if defined DD360Audi
+                    destroySelGun(ShmSysConfigAndInfo->SysInfo.CurGunSelected);
+#endif //defined DD360Audi
+                }
+                break;
+            case Timeout_VerifyComp:
+                if (GetTimeoutValue(ShmSysConfigAndInfo->SysInfo.SystemTimeoutTimer) / uSEC_VAL >= AUTHORIZE_COMP_TIMEOUT) {
+                    _AutoReturnTimeout();
+                    StopSystemTimeoutDet();
+                }
+                break;
+            case Timeout_WaitPlug:
+                if (GetTimeoutValue(ShmSysConfigAndInfo->SysInfo.SystemTimeoutTimer) / uSEC_VAL >= _connectionTimeout) {
+                    _DetectPlugInTimeout();
+                    StopSystemTimeoutDet();
+#if defined DD360Audi
+                    destroySelGun(ShmSysConfigAndInfo->SysInfo.CurGunSelected);
+#endif //defined DD360Audi
+                }
+                break;
+            case Timeout_ReturnToChargingGunDet: {
+                if (GetTimeoutValue(ShmSysConfigAndInfo->SysInfo.SystemTimeoutTimer) / uSEC_VAL >= RETURN_TO_CHARGING_PAGE) {
+#if defined DD360Audi
+                    if (getCurLcmPage() != _LCM_PRE_CHARGE &&
+                            getCurLcmPage() != _LCM_CHARGING &&
+                            getCurLcmPage() != _LCM_COMPLETE) {
+                        destroySelGun(ShmSysConfigAndInfo->SysInfo.CurGunSelected); //jerry add
+
+                    }
+#endif //defined DD360Audi
+                    DisplayChargingInfo();
+                    StopSystemTimeoutDet();
+                }
+            }
+            break;
+            case Timeout_AuthorizingForStop: {
+                if (GetTimeoutValue(ShmSysConfigAndInfo->SysInfo.SystemTimeoutTimer) / uSEC_VAL >= AUTHORIZE_STOP_TIMEOUT) {
+                    strcpy((char *)ShmSysConfigAndInfo->SysConfig.UserId, "");
+                    ClearAuthorizedFlag();
+                    StopSystemTimeoutDet();
+                }
+            }
+            break;
+            }
+            // 各槍
+            for (byte gun_index = 0; gun_index < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; gun_index++) {
+                //printf("Timeout ***********TimeoutFlag = %d, ********\n", chargingInfo[gun_index]->TimeoutFlag);
+                switch (chargingInfo[gun_index]->TimeoutFlag) {
+                case Timeout_Preparing: {
+                    if (GetTimeoutValue(chargingInfo[gun_index]->TimeoutTimer) / uSEC_VAL >= GUN_PREPARE_TIMEOUT) {
+                        _PrepareTimeout(gun_index);
+                        StopGunInfoTimeoutDet(gun_index);
+#if defined DD360Audi
+                        destroySelGun(gun_index); //jerry add
+#endif //defined DD360Audi
+                    }
+                }
+                break;
+                case Timeout_EvChargingDet: {
+                    if (GetTimeoutValue(chargingInfo[gun_index]->TimeoutTimer) / uSEC_VAL >= GUN_EV_WAIT_TIMEOUT) {
+                        _DetectEvChargingEnableTimeout(gun_index);
+                        StopGunInfoTimeoutDet(gun_index);
+#if defined DD360Audi
+                        destroySelGun(gun_index); //jerry add
+#endif //defined DD360Audi
+                    }
+                }
+                break;
+                case Timeout_EvseChargingDet: {
+                    if (GetTimeoutValue(chargingInfo[gun_index]->TimeoutTimer) / uSEC_VAL >= GUN_EVSE_WAIT_TIMEOUT) {
+                        _DetectEvseChargingEnableTimeout(gun_index);
+                        StopGunInfoTimeoutDet(gun_index);
+#if defined DD360Audi
+                        destroySelGun(gun_index); //jerry add
+#endif //defined DD360Audi
+                    }
+                }
+                break;
+                case Timeout_EvseCompleteDet: {
+                    if (GetTimeoutValue(chargingInfo[gun_index]->TimeoutTimer) / uSEC_VAL >= GUN_COMP_WAIT_TIMEOUT) {
+                        StopGunInfoTimeoutDet(gun_index);
+#if defined DD360Audi
+                        destroySelGun(gun_index); //jerry add
+#endif //defined DD360Audi
+                    }
+                }
+                break;
+                case Timeout_ForCcsPrechargeDet: {
+                    if (GetTimeoutValue(chargingInfo[gun_index]->TimeoutTimer) / uSEC_VAL >= GUN_PRECHARGING_TIMEOUT) {
+                        _CcsPrechargeTimeout(gun_index);
+                        StopGunInfoTimeoutDet(gun_index);
+#if defined DD360Audi
+                        destroySelGun(gun_index); //jerry add
+#endif //defined DD360Audi
+                    }
+                }
+                break;
+
+#if defined DD360Audi
+                case Timeout_SelectGun: //Jerry add
+                    if (GetTimeoutValue(chargingInfo[gun_index]->TimeoutTimer) / uSEC_VAL >= SEL_GUN_TIMEOUT) {
+                        log_info("Timeout_SelectGun\r\n");
+                        StopGunInfoTimeoutDet(gun_index);
+                        destroySelGun(gun_index); //jerry add
+                    }
+                    break;
+#endif //defined DD360Audi
+                }
+            }
+            sleep(1);
+        }
+    }
+}
+
+void GetSystemTime()
+{
+    struct timeb csuTime;
+    struct tm *tmCSU;
+
+    ftime(&csuTime);
+    tmCSU = localtime(&csuTime.time);
+    PRINTF_FUNC("Time : %04d-%02d-%02d %02d:%02d:%02d \n", tmCSU->tm_year + 1900,
+                tmCSU->tm_mon + 1, tmCSU->tm_mday, tmCSU->tm_hour, tmCSU->tm_min,
+                tmCSU->tm_sec);
+
+//  byte date[14];
+//
+//
+//       //sprintf(&date, "%d", );
+//
+//       date[0] = '0' + ((tmCSU->tm_year + 1900) / 1000 % 10);
+
+//  date[0] = (tmCSU->tm_year + 1900) / 1000 % 10;
+//  date[1] = (tmCSU->tm_year + 1900) / 100 % 10;
+//  date[2] = (tmCSU->tm_year + 1900) / 10 % 10;
+//  date[3] = (tmCSU->tm_year + 1900) / 1 % 10;
+//
+//  date[4] = (tmCSU->tm_mon + 1) / 10 % 10;
+//  date[5] = (tmCSU->tm_mon + 1) / 1 % 10;
+//
+//  date[6] = (tmCSU->tm_mday) / 10 % 10;
+//  date[7] = (tmCSU->tm_mday) / 1 % 10;
+//
+//  date[8] = (tmCSU->tm_hour) / 10 % 10;
+//  date[9] = (tmCSU->tm_hour) / 1 % 10;
+//
+//  date[10] = (tmCSU->tm_min) / 10 % 10;
+//  date[11] = (tmCSU->tm_min) / 1 % 10;
+//
+//  date[12] = (tmCSU->tm_sec) / 10 % 10;
+//  date[13] = (tmCSU->tm_sec) / 1 % 10;
+
+//  PRINTF_FUNC("%x, %x, %x, %x, %x, %x, %x, %x, %x, %x, %x, %x, %x, %x \n", date[0], date[1], date[2], date[3],
+//          date[4], date[5], date[6], date[7],
+//          date[8], date[9], date[10], date[11],
+//          date[12], date[13]);
+}
+
+void CheckFactoryConfigFunction()
+{
+    char Buf[256] = {0};
+
+    if (ShmSysConfigAndInfo->SysInfo.FactoryConfiguration) {
+        sprintf(Buf, "cd /root;./FactoryConfig -m %s %s",
+                ShmSysConfigAndInfo->SysConfig.ModelName,
+                ShmSysConfigAndInfo->SysConfig.SerialNumber);
+        system(Buf);
+
+        system("rm -f /Storage/OCPP/OCPPConfiguration");
+        system("sync");
+        sleep(5);
+        system("reboot -f");
+        sleep(5);
+        system("reboot -f");
+    }
+}
+
+void CheckFwUpdateFunction()
+{
+    //PRINTF_FUNC("ShmSysConfigAndInfo->SysInfo.FirmwareUpdate = %d \n", ShmSysConfigAndInfo->SysInfo.FirmwareUpdate);
+    if (ShmSysConfigAndInfo->SysInfo.FirmwareUpdate == YES) {
+        log_info("ftp : update start. \n");
+        for (byte gun_index = 0; gun_index < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; gun_index++) {
+            setChargerMode(gun_index, MODE_UPDATE);
+        }
+
+        byte updateResult = CheckUpdateProcess();
+
+        if (updateResult == PASS) {
+            log_info("ftp : update complete. \n");
+        } else if (updateResult == MODELNAME_FAIL) {
+            log_info("ftp : model name is none match. \n");
+            KillAllTask();
+            ShmSysConfigAndInfo->SysInfo.FirmwareUpdate = NO;
+            sleep(5);
+            system("/usr/bin/run_evse_restart.sh");
+            return;
+        } else {
+            log_info("ftp : update fail. \n");
+        }
+
+        ShmSysConfigAndInfo->SysInfo.FirmwareUpdate = NO;
+        sleep(5);
+        system("reboot -f");
+    } else if (ShmOCPP16Data->MsMsg.bits.UpdateFirmwareReq == YES) {
+        ShmOCPP16Data->MsMsg.bits.UpdateFirmwareReq = NO;
+
+        if (strcmp((char *)ShmOCPP16Data->FirmwareStatusNotification.Status, "Downloaded") == EQUAL) {
+            log_info("Backend : update start. \n");
+            strcpy((char *)ShmOCPP16Data->FirmwareStatusNotification.Status, "");
+            strcpy((char *)ShmOCPP16Data->FirmwareStatusNotification.Status, "Installing");
+            ShmOCPP16Data->SpMsg.bits.FirmwareStatusNotificationReq = YES;
+            KillTask();
+
+            for (byte _index = 0; _index < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; _index++) {
+                setChargerMode(_index, MODE_UPDATE);
+            }
+            for (byte _index = 0; _index < ShmSysConfigAndInfo->SysConfig.AcConnectorCount; _index++) {
+                ac_chargingInfo[_index]->SystemStatus = MODE_UPDATE;
+            }
+
+            byte updateResult = CheckUpdateProcess();
+
+            if (updateResult == PASS) {
+                log_info("Backend : update complete. \n");
+                strcpy((char *)ShmOCPP16Data->FirmwareStatusNotification.Status, "Installed");
+            } else if (updateResult == MODELNAME_FAIL) {
+                log_info("Backend : model name is none match. \n");
+                KillAllTask();
+                strcpy((char *)ShmOCPP16Data->FirmwareStatusNotification.Status, "InstallationFailed");
+                ShmOCPP16Data->SpMsg.bits.FirmwareStatusNotificationReq = YES;
+                sleep(5);
+                system("/usr/bin/run_evse_restart.sh");
+                return;
+            } else {
+                log_info("Backend : update fail. \n");
+                strcpy((char *)ShmOCPP16Data->FirmwareStatusNotification.Status, "InstallationFailed");
+            }
+
+            strcpy((char *)ShmOCPP16Data->FirmwareStatusNotification.Status, "Installed");
+            ShmOCPP16Data->SpMsg.bits.FirmwareStatusNotificationReq = YES;
+            sleep(5);
+            system("reboot -f");
+        }
+    }
+}
+
+//===============================================
+// Check reservation date is expired
+//===============================================
+int isReservationExpired(unsigned char gun_index)
+{
+    int result = NO;
+    struct tm expiredDate;
+    struct timeb expiredTime;
+
+    if (sscanf((char *) ShmOCPP16Data->ReserveNow[gun_index].ExpiryDate,
+               "%4d-%2d-%2dT%2d:%2d:%2d", &expiredDate.tm_year,
+               &expiredDate.tm_mon, &expiredDate.tm_mday, &expiredDate.tm_hour,
+               &expiredDate.tm_min, &expiredDate.tm_sec) == 6) {
+        expiredDate.tm_year -= 1900;
+        expiredDate.tm_mon -= 1;
+
+        expiredTime.time = mktime(&expiredDate);
+        if (!CheckTimeOut(expiredTime)) {
+            result = YES;
+        }
+    }
+
+    return result;
+}
+
+//===============================================
+// OCPP
+//===============================================
+void CheckOcppStatus()
+{
+    if (ShmOCPP16Data->SpMsg.bits.BootNotificationConf == YES) {
+        ShmOCPP16Data->SpMsg.bits.BootNotificationConf = NO;
+    }
+
+    if (ShmOCPP16Data->MsMsg.bits.ResetReq == YES) {
+        bool canReset = true;
+        bool canHardReset = true; //DS60-120 add
+
+        if (ShmSysConfigAndInfo->SysWarningInfo.Level != 2) {
+            for (byte _index = 0; _index < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; _index++) {
+                if (chargingInfo[_index]->SystemStatus != S_IDLE &&
+                        chargingInfo[_index]->SystemStatus != S_RESERVATION &&
+                        chargingInfo[_index]->SystemStatus != S_MAINTAIN) {
+                    canReset = false;
+                    if (chargingInfo[_index]->SystemStatus >= S_REASSIGN &&
+                            chargingInfo[_index]->SystemStatus < S_TERMINATING) {
+                        canHardReset = false;
+                        ChargingTerminalProcess(_index);
+                        restartFlag = 1;
+                    }
+                }
+            }
+        }
+
+        if (canReset) {
+            ShmOCPP16Data->MsMsg.bits.ResetReq = NO;
+            sprintf((char *)ShmOCPP16Data->Reset.ResponseStatus, "Accepted");
+            if (strcmp((char *)ShmOCPP16Data->Reset.Type, "Hard") == EQUAL) {
+                log_error("****** Hard Reboot ****** \n");
+                ShmOCPP16Data->MsMsg.bits.ResetConf = YES;
+                sleep(3);
+                system("reboot -f");
+            } else if (strcmp((char *)ShmOCPP16Data->Reset.Type, "Soft") == EQUAL) {
+                log_error("****** Soft Reboot ****** \n");
+                ShmOCPP16Data->MsMsg.bits.ResetConf = YES;
+                sleep(3);
+                system("killall OcppBackend &");
+                KillAllTask();
+                system("/usr/bin/run_evse_restart.sh");
+            }
+        }
+    }
+}
+
+void OcppStartTransation(byte gunIndex)
+{
+    byte _OcppGunIndex = gunIndex;
+
+    // 如果有 AC 槍，而現在是 DC 第二把槍進入充電
+    if (ShmSysConfigAndInfo->SysConfig.AcConnectorCount == 1 && gunIndex == 1) {
+        _OcppGunIndex = 2;
+    }
+
+    if (strcmp((char *)chargingInfo[gunIndex]->StartUserId, "") == EQUAL) {
+        strcpy((char *)ShmOCPP16Data->StartTransaction[_OcppGunIndex].IdTag, (char *)ShmOCPP16Data->StartTransaction[_OcppGunIndex].IdTag);
+    } else {
+        strcpy((char *)ShmOCPP16Data->StartTransaction[_OcppGunIndex].IdTag, (char *)chargingInfo[gunIndex]->StartUserId);
+    }
+
+    PRINTF_FUNC("IdTag = %s \n", ShmOCPP16Data->StartTransaction[_OcppGunIndex].IdTag);
+    ShmOCPP16Data->CpMsg.bits[_OcppGunIndex].StartTransactionReq = YES;
+}
+
+void OcppStopTransation(byte gunIndex)
+{
+    byte _OcppGunIndex = gunIndex;
+
+    // 如果有 AC 槍，而現在是 DC 第二把槍進入充電
+    if (ShmSysConfigAndInfo->SysConfig.AcConnectorCount == 1 && gunIndex == 1) {
+        _OcppGunIndex = 2;
+    }
+
+    if (strcmp((char *)chargingInfo[gunIndex]->StartUserId, "") == EQUAL) {
+        strcpy((char *)ShmOCPP16Data->StopTransaction[_OcppGunIndex].IdTag, (char *)ShmOCPP16Data->StopTransaction[_OcppGunIndex].IdTag);
+    } else {
+        strcpy((char *)ShmOCPP16Data->StopTransaction[_OcppGunIndex].IdTag, (char *)chargingInfo[gunIndex]->StartUserId);
+    }
+
+    PRINTF_FUNC("IdTag = %s \n", ShmOCPP16Data->StopTransaction[_OcppGunIndex].IdTag);
+    ShmOCPP16Data->CpMsg.bits[_OcppGunIndex].StopTransactionReq = YES;
+}
+
+bool OcppRemoteStop(byte gunIndex)
+{
+    byte acDirIndex = ShmSysConfigAndInfo->SysConfig.AcConnectorCount;
+
+    // 有 AC 槍的話
+    if (acDirIndex > 0 && gunIndex > 0) {
+        gunIndex += acDirIndex;
+    }
+
+    bool result = ShmOCPP16Data->CsMsg.bits[gunIndex].RemoteStopTransactionReq;
+
+    if (ShmOCPP16Data->CsMsg.bits[gunIndex].RemoteStopTransactionReq == YES) {
+        strcpy((char *)ShmOCPP16Data->StopTransaction[gunIndex].StopReason, "Remote");
+        ShmOCPP16Data->CsMsg.bits[gunIndex].RemoteStopTransactionReq = NO;
+    }
+
+    return result;
+}
+
+bool WifiScheduleStop(byte gunIndex)
+{
+    bool result = false;
+
+    result = chargingInfo[gunIndex]->schedule.isTriggerStop;
+    chargingInfo[gunIndex]->schedule.isTriggerStop = NO;
+
+    return result;
+}
+
+void OcppRemoteStartChk()
+{
+    if (ShmSysConfigAndInfo->SysConfig.OfflinePolicy == _OFFLINE_POLICY_NO_CHARGING)
+    {}
+    else if (!isDetectPlugin()) {
+        // 如果有 AC 槍，則固定是第 2 把槍，所以索引固定為 1
+        byte acDirIndex = ShmSysConfigAndInfo->SysConfig.AcConnectorCount;
+
+        for (byte ac_index = 0; ac_index < ShmSysConfigAndInfo->SysConfig.AcConnectorCount; ac_index++) {
+            if (ShmOCPP16Data->CsMsg.bits[acDirIndex].RemoteStartTransactionReq == YES) {
+                if (ac_chargingInfo[ac_index]->SystemStatus == S_IDLE ||
+                        ac_chargingInfo[ac_index]->SystemStatus == S_RESERVATION) {
+                    ShmOCPP16Data->CsMsg.bits[acDirIndex].RemoteStartTransactionReq = NO;
+                    ac_chargingInfo[ac_index]->RemoteStartFlag = YES;
+                    ShmSysConfigAndInfo->SysInfo.OrderCharging = YES;
+                    //ShmSysConfigAndInfo->SysInfo.OrderCharging = DEFAULT_AC_INDEX;
+                    ShmOCPP16Data->CsMsg.bits[ShmSysConfigAndInfo->SysConfig.TotalConnectorCount + ac_index].RemoteStartTransactionReq = NO;
+                    DetectPluginStart();
+                    return;
+                }
+                ShmOCPP16Data->CsMsg.bits[acDirIndex].RemoteStartTransactionReq = NO;
+            }
+        }
+
+        byte threeGunIndex = 0;
+        byte dcIndex = 0;
+        bool isGunUsingStatus = false;
+
+        for (byte _index = 0; _index < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; _index++) {
+            // 如果有 AC 槍，且 DC 槍也有兩把
+            if (acDirIndex == 1 && _index == 1) {
+                threeGunIndex = 1;
+            }
+
+            if (ShmOCPP16Data->CsMsg.bits[_index + threeGunIndex].RemoteStartTransactionReq == YES) {
+                dcIndex = _index;
+            }
+
+            if (chargingInfo[_index]->SystemStatus != S_IDLE) {
+                isGunUsingStatus = true;
+            }
+        }
+
+        // 如果是雙槍單模，只認閒置狀態的槍，如果有預約~ 則預約也算被使用
+        if (isGunUsingStatus && ShmSysConfigAndInfo->SysInfo.IsAlternatvieConf) {
+            if (dcIndex == 0) {
+                threeGunIndex = 0;
+            }
+
+            ShmOCPP16Data->CsMsg.bits[dcIndex + threeGunIndex].RemoteStartTransactionReq = NO;
+            return;
+        }
+
+        if (dcIndex == 0) {
+            threeGunIndex = 0;
+        }
+
+        if (ShmOCPP16Data->CsMsg.bits[dcIndex + threeGunIndex].RemoteStartTransactionReq == YES) {
+            if (chargingInfo[dcIndex]->SystemStatus == S_IDLE ||
+                    chargingInfo[dcIndex]->SystemStatus == S_RESERVATION) {
+                chargingInfo[dcIndex]->RemoteStartFlag = YES;
+                ShmSysConfigAndInfo->SysInfo.OrderCharging = YES;
+                //ShmSysConfigAndInfo->SysInfo.OrderCharging = gun_index;
+                ShmOCPP16Data->CsMsg.bits[dcIndex + threeGunIndex].RemoteStartTransactionReq = NO;
+                DetectPluginStart();
+#if defined DD360Audi
+                setSelGunWaitToAuthor(dcIndex); //Jerry add
+#endif //defined DD360Audi
+            }
+            ShmOCPP16Data->CsMsg.bits[dcIndex + threeGunIndex].RemoteStartTransactionReq = NO;
+        }
+    }
+}
+
+void ChkOcppStatus(byte gunIndex)
+{
+    if (chargingInfo[gunIndex]->SystemStatus == S_IDLE &&
+            ShmOCPP16Data->CsMsg.bits[gunIndex].ReserveNowReq == YES) {
+        ShmOCPP16Data->CsMsg.bits[gunIndex].ReserveNowReq = NO;
+        if (isReservationExpired(gunIndex)) {
+            PRINTF_FUNC("***************ChkOcppStatus : OcppReservedStatus******************** \n");
+            log_error("***************ChkOcppStatus : OcppReservedStatus******************** \n");
+            chargingInfo[gunIndex]->ReservationId = ShmOCPP16Data->ReserveNow[gunIndex].ReservationId;
+            chargingInfo[gunIndex]->SystemStatus = S_RESERVATION;
+        }
+        ShmOCPP16Data->CsMsg.bits[gunIndex].ReserveNowConf = YES;
+    }
+
+    if (chargingInfo[gunIndex]->SystemStatus == S_RESERVATION &&
+            ShmOCPP16Data->CsMsg.bits[gunIndex].CancelReservationReq == YES) {
+        ShmOCPP16Data->CsMsg.bits[gunIndex].CancelReservationReq = NO;
+        if (isReservationExpired(gunIndex)) {
+            PRINTF_FUNC("***************ChkOcppStatus : Cancel OcppReservedStatus******************** \n");
+            log_error("***************ChkOcppStatus : Cancel OcppReservedStatus******************** \n");
+            chargingInfo[gunIndex]->ReservationId = 0;
+            chargingInfo[gunIndex]->SystemStatus = S_IDLE;
+        }
+        ShmOCPP16Data->CsMsg.bits[gunIndex].CancelReservationConf = YES;
+    }
+
+    if (ShmOCPP16Data->CsMsg.bits[gunIndex].ChangeAvailabilityReq == YES) {
+        PRINTF_FUNC("***************ChkOcppStatus : OcppChangeAvailability******************** \n");
+        log_error("***************ChkOcppStatus : OcppChangeAvailability******************** \n");
+        ShmOCPP16Data->CsMsg.bits[gunIndex].ChangeAvailabilityReq = NO;
+        if (strcmp((char *)ShmOCPP16Data->ChangeAvailability[gunIndex].Type, "Operative") == EQUAL) {
+            if (isDb_ready) {
+                DB_Update_Operactive(localDb, gunIndex, true);
+            }
+
+            chargingInfo[gunIndex]->IsAvailable = YES;
+            if (chargingInfo[gunIndex]->SystemStatus == S_IDLE ||
+                    chargingInfo[gunIndex]->SystemStatus == S_RESERVATION ||
+                    chargingInfo[gunIndex]->SystemStatus == S_MAINTAIN) {
+                setChargerMode(gunIndex, MODE_IDLE);
+            }
+        } else if (strcmp((char *)ShmOCPP16Data->ChangeAvailability[gunIndex].Type, "Inoperative") == EQUAL) {
+            if (isDb_ready) {
+                DB_Update_Operactive(localDb, gunIndex, false);
+            }
+
+            chargingInfo[gunIndex]->IsAvailable = NO;
+            if (chargingInfo[gunIndex]->SystemStatus == S_IDLE ||
+                    chargingInfo[gunIndex]->SystemStatus == S_RESERVATION ||
+                    chargingInfo[gunIndex]->SystemStatus == S_MAINTAIN) {
+                setChargerMode(gunIndex, MODE_MAINTAIN);
+            }
+        }
+    }
+
+    if (ShmOCPP16Data->CsMsg.bits[gunIndex].UnlockConnectorReq == YES) {
+        ShmOCPP16Data->CsMsg.bits[gunIndex].UnlockConnectorReq = NO;
+        if (chargingInfo[gunIndex]->SystemStatus >= S_REASSIGN_CHECK && // DS60-120 add ||
+                chargingInfo[gunIndex]->SystemStatus <= S_CHARGING) {
+            // 充電中，需停止充電
+            strcpy((char *)ShmOCPP16Data->StopTransaction[gunIndex].StopReason, "UnlockCommand");
+            ChargingTerminalProcess(gunIndex);
+        }
+        strcpy((char *)ShmOCPP16Data->UnlockConnector[gunIndex].ResponseStatus, "Unlocked");
+        ShmOCPP16Data->CsMsg.bits[gunIndex].UnlockConnectorConf = YES;
+    }
+}
+
+bool CheckBackendChargingTimeout(byte gunIndex)
+{
+    bool result = false;
+
+    if (ShmSysConfigAndInfo->SysConfig.AuthorisationMode == AUTH_MODE_ENABLE) {
+        if (ShmSysConfigAndInfo->SysConfig.MaxChargingDuration > 0) {
+            if (chargingInfo[gunIndex]->PresentChargedDuration > (ShmSysConfigAndInfo->SysConfig.MaxChargingDuration * 60)) {
+                result = true;
+            }
+        }
+    } else if (ShmSysConfigAndInfo->SysConfig.AuthorisationMode == AUTH_MODE_DISABLE) {
+        // 隨插即充電的要看 offline
+        if (ShmSysConfigAndInfo->SysConfig.OfflineMaxChargeDuration > 0) {
+            if (chargingInfo[gunIndex]->PresentChargedDuration > (ShmSysConfigAndInfo->SysConfig.OfflineMaxChargeDuration * 60)) {
+                result = true;
+            }
+        }
+    }
+
+    return result;
+}
+
+bool CheckBackendChargingEnergy(byte gunIndex)
+{
+    bool result = false;
+
+    if (ShmSysConfigAndInfo->SysConfig.AuthorisationMode == AUTH_MODE_ENABLE) {
+        if (ShmSysConfigAndInfo->SysConfig.MaxChargingEnergy > 0) {
+            if (chargingInfo[gunIndex]->PresentChargedEnergy > ShmSysConfigAndInfo->SysConfig.MaxChargingEnergy) {
+                result = true;
+            }
+        }
+    } else if (ShmSysConfigAndInfo->SysConfig.AuthorisationMode == AUTH_MODE_DISABLE) {
+        // 隨插即充電的要看 offline
+        if (ShmSysConfigAndInfo->SysConfig.OfflineMaxChargeEnergy > 0) {
+            if (chargingInfo[gunIndex]->PresentChargedEnergy > (ShmSysConfigAndInfo->SysConfig.OfflineMaxChargeEnergy)) {
+                result = true;
+            }
+        }
+    }
+
+    return result;
+}
+
+void InformOcppErrOccur(byte codeType)
+{
+    char _error[25];
+
+    switch (codeType) {
+    case 4: strcpy(_error, "InternalError"); break;
+    case 6: strcpy(_error, "NoError"); break;
+    case 7: strcpy(_error, "OtherError"); break;
+    case 13: strcpy(_error, "UnderVoltage"); break;
+    case 14: strcpy(_error, "OverVoltage"); break;
+    }
+
+    for (byte gun_index = 0; gun_index < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; gun_index++) {
+        strcpy((char *)ShmOCPP16Data->StatusNotification[gun_index].ErrorCode, _error);
+    }
+}
+
+//===============================================
+// SQLite3 related routine
+//===============================================
+int DB_Open(sqlite3 *db)
+{
+    int result = PASS;
+    char *errMsg = NULL;
+    char *createRecordSql = "CREATE TABLE IF NOT EXISTS charging_record("
+                            "idx integer primary key AUTOINCREMENT, "
+                            "reservationId text, "
+                            "transactionId text, "
+                            "startMethod text, "
+                            "userId text, "
+                            "dateTimeStart text, "
+                            "dateTimeStop text,"
+                            "socStart text, "
+                            "socStop text, "
+                            "chargeEnergy text, "
+                            "stopReason text"
+                            ");";
+
+    /*char *createCfgSql = "CREATE TABLE IF NOT EXISTS `config` ( "
+                         "`idx` INTEGER PRIMARY KEY AUTOINCREMENT, "
+                         "`IsAvailable` TEXT NOT NULL, "
+                         "`connector` INTEGER NOT NULL, "
+                         "`val` TEXT NOT NULL, unique(IsAvailable,connector) on conflict replace);";
+    */
+    //DS60-120 add
+    char *createCfgSql = "CREATE TABLE IF NOT EXISTS `config` ( "
+                         "`idx` INTEGER PRIMARY KEY AUTOINCREMENT, "
+                         "`item` TEXT NOT NULL, "
+                         "`connector` INTEGER NOT NULL, "
+                         "`val` TEXT NOT NULL, unique(item,connector) on conflict replace);";
+
+    char *createrecordSql = "CREATE TABLE IF NOT EXISTS `event_record` ( "
+                            "`idx` INTEGER PRIMARY KEY AUTOINCREMENT, "
+                            "`occurDatetime` TEXT NOT NULL, "
+                            "`statusCode` TEXT NOT NULL, unique(occurDatetime,statusCode) on conflict replace);";
+
+    char *createrebootSql = "CREATE TABLE IF NOT EXISTS `reboot_record` ( "
+                            "`idx` INTEGER PRIMARY KEY AUTOINCREMENT, "
+                            "`rebootDatetime` TEXT NOT NULL, unique(rebootDatetime) on conflict replace);";
+
+    if (sqlite3_open(DB_FILE, &db)) {
+        result = FAIL;
+        PRINTF_FUNC( "Can't open database: %s\r\n", sqlite3_errmsg(db));
+        sqlite3_close(db);
+    } else {
+        PRINTF_FUNC( "Local charging record database open successfully.\r\n");
+
+        if (sqlite3_exec(db, createRecordSql, 0, 0, &errMsg) != SQLITE_OK) {
+            result = FAIL;
+            PRINTF_FUNC( "Create local charging record table error message: %s\n", errMsg);
+        } else {
+            PRINTF_FUNC( "Opened local charging record table successfully\n");
+        }
+
+        if (sqlite3_exec(db, createCfgSql, 0, 0, &errMsg) != SQLITE_OK) {
+            result = FAIL;
+            PRINTF_FUNC( "Create local config table error message: %s\n", errMsg);
+        } else {
+            PRINTF_FUNC( "Opened local config table successfully\n");
+        }
+
+        //DS60-120
+        if (sqlite3_exec(db, createrecordSql, 0, 0, &errMsg) != SQLITE_OK) {
+            result = FAIL;
+            PRINTF_FUNC( "Create local record table error message: %s\n", errMsg);
+        } else {
+            PRINTF_FUNC( "Opened local record table successfully\n");
+        }
+
+        if (sqlite3_exec(db, createrebootSql, 0, 0, &errMsg) != SQLITE_OK) {
+            result = FAIL;
+            PRINTF_FUNC( "Create reboot record table error message: %s\n", errMsg);
+        } else {
+            PRINTF_FUNC( "Opened reboot record table successfully\n");
+        }
+        //-----
+
+        sqlite3_close(db);
+    }
+
+    return result;
+}
+
+int DB_Insert_Record(sqlite3 *db, int gun_index)
+{
+    int result = PASS;
+    char *errMsg = NULL;
+    char insertSql[1024];
+
+    sprintf(insertSql, "insert into charging_record(reservationId, transactionId, startMethod, userId, dateTimeStart, dateTimeStop, socStart, socStop, chargeEnergy, stopReason) "
+            "values('%d', '%d', '%d', '%s', '%s', '%s', '%d', '%d', '%f', '%s');",
+            chargingInfo[gun_index]->ReservationId, //DS60-120 add
+            ShmOCPP16Data->StartTransaction[gun_index].ResponseTransactionId,
+            chargingInfo[gun_index]->StartMethod,
+            chargingInfo[gun_index]->StartUserId,
+            chargingInfo[gun_index]->StartDateTime,
+            chargingInfo[gun_index]->StopDateTime,
+            chargingInfo[gun_index]->EvBatteryStartSoc,
+            chargingInfo[gun_index]->EvBatterySoc,
+            chargingInfo[gun_index]->PresentChargedEnergy,
+            //DS60-120 remove
+            //ShmSysConfigAndInfo->SysInfo.AcChargingData[gun_index].ReservationId,
+            //ShmOCPP16Data->StartTransaction[gun_index].ResponseTransactionId,
+            //ShmSysConfigAndInfo->SysInfo.AcChargingData[gun_index].StartMethod,
+            //ShmSysConfigAndInfo->SysInfo.AcChargingData[gun_index].StartUserId,
+            //ShmSysConfigAndInfo->SysInfo.AcChargingData[gun_index].StartDateTime,
+            //ShmSysConfigAndInfo->SysInfo.AcChargingData[gun_index].StopDateTime,
+            //ShmSysConfigAndInfo->SysInfo.AcChargingData[gun_index].EvBatterySoc,
+            //ShmSysConfigAndInfo->SysInfo.AcChargingData[gun_index].EvBatterySoc,
+            //ShmSysConfigAndInfo->SysInfo.AcChargingData[gun_index].PresentChargedEnergy,
+            ShmOCPP16Data->StopTransaction[gun_index].StopReason);
+
+    //if (sqlite3_open("/Storage/ChargeLog/localCgargingRecord.db", &db)) {
+    if (sqlite3_open(DB_FILE, &db)) { //DS60-120 add
+        result = FAIL;
+        PRINTF_FUNC( "Can't open database: %s\r\n", sqlite3_errmsg(db));
+        sqlite3_close(db);
+    } else {
+        PRINTF_FUNC( "Local charging record database open successfully.\r\n");
+        if (sqlite3_exec(db, insertSql, 0, 0, &errMsg) != SQLITE_OK) {
+            result = FAIL;
+            PRINTF_FUNC( "Insert local charging record error message: %s\n", errMsg);
+        } else {
+            PRINTF_FUNC( "Insert local charging record successfully\n");
+        }
+
+        //DS60-120 add
+        sprintf(insertSql, "delete from charging_record where idx < (select idx from charging_record order by idx desc limit 1)-2000;");
+        if (sqlite3_exec(db, insertSql, 0, 0, &errMsg) != SQLITE_OK) {
+            result = FAIL;
+            PRINTF_FUNC( "delete local charging error message: %s\n", errMsg);
+        } else {
+            PRINTF_FUNC( "delete local charging record successfully\n");
+        }
+
+        sqlite3_close(db);
+    }
+
+    return result;
+}
+
+int DB_Update_Operactive(sqlite3 *db, uint8_t gun_index, uint8_t IsAvailable)
+{
+    uint8_t result = false;
+    char *errMsg = NULL;
+    char sqlStr[1024];
+    srand(time(NULL));
+
+    if (sqlite3_open(DB_FILE, &db)) {
+        result = FAIL;
+        PRINTF_FUNC( "Can't open database: %s\r\n", sqlite3_errmsg(db));
+        sqlite3_close(db);
+    } else {
+        PRINTF_FUNC( "Local charging record database open successfully (%d).\r\n", IsAvailable);
+
+        //sprintf(sqlStr, "insert or replace into config (IsAvailable, connector, val) values('IsAvailable', %d, %d);", gun_index, IsAvailable);
+        sprintf(sqlStr, "insert or replace into config (item, connector, val) values('IsAvailable', %d, %d);", gun_index, IsAvailable); //DS60-120 add
+        PRINTF_FUNC("sqlStr= %s\r\n", sqlStr);
+        if (sqlite3_exec(db, sqlStr, 0, 0, &errMsg) != SQLITE_OK) {
+            result = FAIL;
+            PRINTF_FUNC( "update config error message: %s\n", errMsg);
+        } else {
+            PRINTF_FUNC("update connector-%d config item isOperactive to %d\r\n", gun_index, IsAvailable);
+        }
+
+        sqlite3_close(db);
+    }
+
+    return result;
+}
+
+int DB_Get_Operactive(sqlite3 *db, uint8_t gun_index)
+{
+    uint8_t result = true;
+    char *errMsg = NULL;
+    char sqlStr[1024];
+    char **rs;
+    int  rows, cols;
+
+    //sprintf(sqlStr, "select * from config where IsAvailable='IsAvailable' and connector=%d;", gun_index);
+    sprintf(sqlStr, "select * from config where item='IsAvailable' and connector=%d;", gun_index); //DS60-120 add
+    //DEBUG_INFO("sqlStr= %s\r\n", sqlStr);
+
+    if (sqlite3_open(DB_FILE, &db)) {
+        result = FAIL;
+        PRINTF_FUNC( "Can't open database: %s\r\n", sqlite3_errmsg(db));
+        sqlite3_close(db);
+    } else {
+        PRINTF_FUNC( "Local config query database open successfully.\r\n");
+        sqlite3_get_table(db, sqlStr, &rs, &rows, &cols, &errMsg);
+        if (rows > 0) {
+            for (int idxRow = 1; idxRow <= rows; idxRow++) {
+                if (strcmp(rs[(idxRow * cols) + 3], "0") == 0) {
+                    result = false;
+                }
+                PRINTF_FUNC("Query connector-%d isOperactive: %s\r\n", gun_index, rs[(idxRow * cols) + 3]);
+            }
+        } else {
+            PRINTF_FUNC("Query connector-%d fail, set default value to operactive.\r\n", gun_index);
+        }
+
+        sqlite3_free_table(rs);
+        sqlite3_close(db);
+    }
+
+    return result;
+}
+
+int DB_Reboot_Record(sqlite3 *db)
+{
+    int result = PASS;
+    char *errMsg = NULL;
+    char insertSql[256];
+
+    sprintf(insertSql, "insert into reboot_record(rebootDatetime) values(CURRENT_TIMESTAMP);");
+
+    if (sqlite3_open(DB_FILE, &db)) {
+        result = FAIL;
+        PRINTF_FUNC( "Can't open database: %s\n", sqlite3_errmsg(db));
+        sqlite3_close(db);
+    } else {
+        PRINTF_FUNC( "Local charging record database open successfully.\n");
+        if (sqlite3_exec(db, insertSql, 0, 0, &errMsg) != SQLITE_OK) {
+            result = FAIL;
+            PRINTF_FUNC( "Insert reboot record error message: %s\n", errMsg);
+        } else {
+            PRINTF_FUNC( "Insert reboot record successfully\n");
+        }
+
+        sprintf(insertSql, "delete from reboot_record where idx < (select idx from charging_record order by idx desc limit 1)-2000;");
+        if (sqlite3_exec(db, insertSql, 0, 0, &errMsg) != SQLITE_OK) {
+            result = FAIL;
+            PRINTF_FUNC( "delete reboot record error message: %s\n", errMsg);
+        } else {
+            PRINTF_FUNC( "delete reboot record successfully\n");
+        }
+
+        sqlite3_close(db);
+    }
+
+    return result;
+}
+
+//===============================================
+// Config process
+//===============================================
+void AddPlugInTimes(byte gunIndex)
+{
+    if (chargingInfo[gunIndex]->Type == _Type_Chademo) {
+        ShmSysConfigAndInfo->SysConfig.ChademoPlugInTimes += 1;
+    } else if (chargingInfo[gunIndex]->Type == _Type_CCS_2) {
+        ShmSysConfigAndInfo->SysConfig.Ccs2PlugInTimes += 1;
+    } else if (chargingInfo[gunIndex]->Type == _Type_GB) {
+        ShmSysConfigAndInfo->SysConfig.GbPlugInTimes += 1;
+    }
+}
+
+void ChangeStartOrStopDateTime(byte isStart, byte gunIndex)
+{
+    char cmdBuf[32];
+    struct timeb csuTime;
+    struct tm *tmCSU;
+
+    ftime(&csuTime);
+    tmCSU = localtime(&csuTime.time);
+
+    sprintf(cmdBuf, "%04d-%02d-%02d %02d:%02d:%02d", tmCSU->tm_year + 1900,
+            tmCSU->tm_mon + 1, tmCSU->tm_mday, tmCSU->tm_hour, tmCSU->tm_min,
+            tmCSU->tm_sec);
+    if (isStart) {
+        strcpy((char *)chargingInfo[gunIndex]->StartDateTime, cmdBuf);
+    } else {
+        strcpy((char *)chargingInfo[gunIndex]->StopDateTime, cmdBuf);
+    }
+}
+
+void zipLogFiles()
+{
+    const char *logPath = "/Storage/SystemLog";
+    // 獲取目錄
+    DIR *pDir = opendir(logPath);
+    if (pDir != NULL) {
+        struct timeb csuTime;
+        struct tm *tmCSU;
+
+        ftime(&csuTime);
+        tmCSU = localtime(&csuTime.time);
+//      PRINTF_FUNC("Time : %04d-%02d-%02d %02d:%02d:%02d \n", tmCSU->tm_year + 1900,
+//          tmCSU->tm_mon + 1, tmCSU->tm_mday, tmCSU->tm_hour, tmCSU->tm_min,
+//          tmCSU->tm_sec);
+
+        // Read items inside the folder
+        struct dirent *pEntry = NULL;
+        while ((pEntry = readdir(pDir)) != NULL) {
+            if (strcmp(pEntry->d_name, ".") != 0 &&
+                    strcmp(pEntry->d_name, "..") != 0 &&
+                    strncmp(pEntry->d_name, "[", 1) == 0 &&
+                    strstr(pEntry->d_name, "tar") < 0) {
+                char yearC[5];
+                unsigned short year = 0;
+                char monthC[3];
+                unsigned short month = 0;
+
+                yearC[4] = '\0';
+                strncpy(yearC, pEntry->d_name + 1, 4);
+                monthC[2] = '\0';
+                strncpy(monthC, pEntry->d_name + 6, 2);
+
+                year = atoi(yearC);
+                month = atoi(monthC);
+
+                if (year != 0) {
+                    if (year < tmCSU->tm_year + 1900 ||
+                            (year >= tmCSU->tm_year + 1900 && month < tmCSU->tm_mon + 1)) {
+                        log_info("tar file name : %s \n", pEntry->d_name);
+                        char file[256];
+
+                        memset(file, 0x00, sizeof(file));
+                        strcat(file, "tar zcvf ");
+                        strcat(file, logPath);
+                        strncat(file, "/", 1);
+                        strcat(file, pEntry->d_name);
+                        strcat(file, ".tar");
+                        strncat(file, " ", 1);
+                        strcat(file, logPath);
+                        strncat(file, "/", 1);
+                        strcat(file, pEntry->d_name);
+                        PRINTF_FUNC("zip = %s \n", file);
+                        system(file);
+                    }
+                }
+            }
+        }
+    }
+    // Close folder
+    closedir(pDir);
+}
+
+void ChangeGunSelectByIndex(byte sel)
+{
+    ShmSysConfigAndInfo->SysInfo.CurGunSelected = sel;
+    ShmSysConfigAndInfo->SysInfo.CurGunSelectedByAc = NO_DEFINE;
+}
+
+void CheckIsAlternatvieByModelName()
+{
+    // 黑白機 ?
+    /*if (strcmp((char *)ShmSysConfigAndInfo->SysConfig.ModelName, "DWWU301J0UT1PH") == EQUAL ||
+            strcmp((char *)ShmSysConfigAndInfo->SysConfig.ModelName, "DWYE301J0ET1PH") == EQUAL ||
+            strcmp((char *)ShmSysConfigAndInfo->SysConfig.ModelName, "DSYE301J3EW2PH") == EQUAL ||
+            strcmp((char *)ShmSysConfigAndInfo->SysConfig.ModelName, "DWYC301J0UW1PH") == EQUAL) {
+      */
+    if (ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'W') { //DS60-120
+        // 壁掛
+        ShmSysConfigAndInfo->SysInfo.IsAlternatvieConf = YES;
+    } else {
+        ShmSysConfigAndInfo->SysInfo.IsAlternatvieConf = NO;
+    }
+}
+
+void StopProcessingLoop()
+{
+    for (;;) {
+        CheckFactoryConfigFunction();
+        CheckFwUpdateFunction();
+        if (ShmSysConfigAndInfo->SysWarningInfo.Level == 2) {
+            ChkPrimaryStatus();
+            if (ShmSysConfigAndInfo->SysWarningInfo.Level == 0) {
+                PRINTF_FUNC("Soft reboot for retry self-tets (Primary). \n");
+                KillAllTask();
+                sleep(3);
+                system("/usr/bin/run_evse_restart.sh");
+                return;
+            }
+        }
+        sleep(1);
+    }
+}
+
+void CreateWatchdog()
+{
+    if (ShmSysConfigAndInfo->SysConfig.SwitchDebugFlag == NO) {
+        wtdFd = InitWatchDog();
+
+        if (wtdFd < 0) {
+            ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CsuInitFailed = 1;
+        }
+    }
+}
+
+bool IsConnectorWholeIdle()
+{
+    bool result = true;
+
+    for (byte count = 0; count < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; count++) {
+        if (chargingInfo[count]->SystemStatus != S_IDLE &&
+                chargingInfo[count]->SystemStatus != S_RESERVATION) {
+            result = false;
+            break;
+        }
+    }
+
+    for (byte count = 0; count < ShmSysConfigAndInfo->SysConfig.AcConnectorCount; count++) {
+        if (ac_chargingInfo[count]->SystemStatus != S_IDLE &&
+                ac_chargingInfo[count]->IsErrorOccur == NO) {
+            result = false;
+            break;
+        }
+    }
+
+    return result;
+}
+
+void ClearAlarmCodeWhenAcOff()
+{
+    if (!ShmSysConfigAndInfo->SysInfo.AcContactorStatus) {
+        ShmStatusCodeData->AlarmCode.AlarmEvents.bits.PsuNoResource = NO;
+    }
+}
+
+//==========================================
+// Check task processing
+//==========================================
+void CheckTask()
+{
+    /*+++ 20200908, vern, disable it for DD360 +++*/
+#if 0
+    if (ShmSysConfigAndInfo->SysConfig.ModelName[10] == 'T') {
+        if (system("pidof -s Module_4g > /dev/null") != 0) {
+            log_error("Module_4g not running, restart it.\r\n");
+            system("/root/Module_4g &");
+        }
+    } else if (ShmSysConfigAndInfo->SysConfig.ModelName[10] == 'W') {
+        if (system("pidof -s Module_Wifi > /dev/null") != 0) {
+            log_error("Module_Wifi not running, restart it.\r\n");
+            system("/root/Module_Wifi &");
+        }
+    }
+
+    if (strcmp((char *)ShmSysConfigAndInfo->SysConfig.OcppServerURL, "") != EQUAL &&
+            strcmp((char *)ShmSysConfigAndInfo->SysConfig.ChargeBoxId, "") != EQUAL) {
+        if (system("pidof -s OcppBackend > /dev/null") != 0) {
+            log_error("OcppBackend not running, restart it.\r\n");
+            system("/root/OcppBackend &");
+        }
+    }
+#endif
+    /*--- 20200908, vern, disable it for DD360 ---*/
+    if (system("pidof -s Module_ProduceUtils > /dev/null") != 0) {
+        log_error("Module_ProduceUtils not running, restart it.\r\n");
+        system ("/root/Module_ProduceUtils &");
+    }
+}
+
+void InitialDHCP()
+{
+    char tmpbuf[256] = {0};
+
+    system("pgrep -f \"udhcpc -i eth0\" | xargs kill");
+    sprintf(tmpbuf, "/sbin/udhcpc -i eth0 -x hostname:CSU3_%s -s /root/dhcp_script/eth0.script > /dev/null &",
+            ShmSysConfigAndInfo->SysConfig.SystemId);
+    system(tmpbuf);
+}
+
+//==========================================
+// Check Smart Charging Profile
+//==========================================
+int GetStartScheduleTime(unsigned char *time)
+{
+    int result = -1;
+    struct tm tmScheduleStart;
+    struct timeb tbScheduleStart;
+
+    if ((sscanf((char *)time, "%4d-%2d-%2dT%2d:%2d:%2d", &tmScheduleStart.tm_year, &tmScheduleStart.tm_mon, &tmScheduleStart.tm_mday, &tmScheduleStart.tm_hour, &tmScheduleStart.tm_min, &tmScheduleStart.tm_sec) == 6)) {
+        tmScheduleStart.tm_year -= 1900;
+        tmScheduleStart.tm_mon -= 1;
+        tbScheduleStart.time = mktime(&tmScheduleStart);
+        tbScheduleStart.millitm = 0;
+
+        result = DiffTimebWithNow(tbScheduleStart) / 1000;
+    }
+
+    return result;
+}
+
+void CheckSmartChargeProfile(byte _index)
+{
+    if (ShmOCPP16Data->CSUMsg.bits[_index].ChargingProfileConf == YES) {
+        // Get Charging Profile
+        ShmOCPP16Data->CSUMsg.bits[_index].ChargingProfileConf = NO;
+        if (strcmp((char *)ShmOCPP16Data->SmartChargingProfile[_index].ChargingProfileKind, "Absolute") == EQUAL &&
+                ShmOCPP16Data->SmartChargingProfile[_index].ChargingProfileId == YES //DS60-120 add
+           ) {
+            int _time = GetStartScheduleTime(ShmOCPP16Data->SmartChargingProfile[_index].ChargingSchedule.StartSchedule);
+            byte _startCount = NO_DEFINE;
+            byte _maxCount = ARRAY_SIZE(ShmOCPP16Data->SmartChargingProfile[_index].ChargingSchedule.ChargingSchedulePeriod);
+
+            for (byte _count = 0; _count < _maxCount; _count++) {
+                // 預設最小輸出電流 (MIN_OUTPUT_CUR) A
+                if (_time >= ShmOCPP16Data->SmartChargingProfile[_index].ChargingSchedule.ChargingSchedulePeriod[_count].StartPeriod) {
+                    if ((_count == 0 && ShmOCPP16Data->SmartChargingProfile[_index].ChargingSchedule.ChargingSchedulePeriod[_count].Limit >= MIN_OUTPUT_CUR) ||
+                            ShmOCPP16Data->SmartChargingProfile[_index].ChargingSchedule.ChargingSchedulePeriod[_count].Limit > MIN_OUTPUT_CUR) {
+                        _startCount = _count;
+                    }
+                }
+            }
+
+            PRINTF_FUNC("_startCount = %d \n", _startCount);
+            if (_startCount < _maxCount) {
+                //DS60-120 add
+                PRINTF_FUNC("Profile Limit = %f \n", ShmOCPP16Data->SmartChargingProfile[_index].ChargingSchedule.ChargingSchedulePeriod[_startCount].Limit);
+                chargingInfo[_index]->ChargingProfilePower = ShmOCPP16Data->SmartChargingProfile[_index].ChargingSchedule.ChargingSchedulePeriod[_startCount].Limit * AC_OUTPUT_VOL;
+                if (chargingInfo[_index]->EvBatterytargetVoltage > 0 && chargingInfo[_index]->PresentChargingVoltage > 0) {
+                    chargingInfo[_index]->ChargingProfileCurrent = (chargingInfo[_index]->ChargingProfilePower / chargingInfo[_index]->PresentChargingVoltage) * 10;
+                } else {
+                    chargingInfo[_index]->ChargingProfileCurrent = 0;
+                }
+
+                //DS60-120 remove
+                //PRINTF_FUNC("*********Limit = %f \n", ShmOCPP16Data->SmartChargingProfile[_index].ChargingSchedule.ChargingSchedulePeriod[_startCount].Limit);
+                //chargingInfo[_index]->ChargingProfileCurrent = ShmOCPP16Data->SmartChargingProfile[_index].ChargingSchedule.ChargingSchedulePeriod[_startCount].Limit * 10;
+                //chargingInfo[_index]->ChargingProfilePower = ShmOCPP16Data->SmartChargingProfile[_index].ChargingSchedule.ChargingSchedulePeriod[_startCount].Limit * chargingInfo[_index]->EvBatterytargetVoltage / 100;
+
+                //chargingInfo[_index]->ChargingProfilePower = ShmOCPP16Data->SmartChargingProfile[_index].ChargingSchedule.ChargingSchedulePeriod[_startCount].Limit * AC_OUTPUT_VOL;
+//              if ((chargingInfo[_index]->EvBatterytargetVoltage * 10) > 0)
+//              {
+//                  chargingInfo[_index]->ChargingProfileCurrent = chargingInfo[_index]->ChargingProfilePower / (chargingInfo[_index]->EvBatterytargetVoltage * 10);
+//              }
+            } else {
+                chargingInfo[_index]->ChargingProfilePower = -1;
+                chargingInfo[_index]->ChargingProfileCurrent = -1;
+            }
+        } else {
+            chargingInfo[_index]->ChargingProfilePower = -1;
+            chargingInfo[_index]->ChargingProfileCurrent = -1;
+        }
+
+        PRINTF_FUNC("ChargingProfilePower = %f \n", chargingInfo[_index]->ChargingProfilePower);
+        PRINTF_FUNC("ChargingProfileCurrent = %f \n", chargingInfo[_index]->ChargingProfileCurrent);
+    }
+//
+//      printf("-------------Schedule------------\n");
+//      printf("index = %d \n", _index);
+//      printf("StartSchedule = %s \n", ShmOCPP16Data->SmartChargingProfile[_index].ChargingSchedule.StartSchedule);
+//      printf("ChargingRateUnit = %s \n", ShmOCPP16Data->SmartChargingProfile[_index].ChargingSchedule.ChargingRateUnit);
+//      printf("----------SchedulePeriod---------\n");
+//      for (int v = 0; v < 10; v++)
+//      {
+//          printf("StartPeriod = %d \n", ShmOCPP16Data->SmartChargingProfile[_index].ChargingSchedule.ChargingSchedulePeriod[v].StartPeriod);
+//          printf("Limit = %f \n", ShmOCPP16Data->SmartChargingProfile[_index].ChargingSchedule.ChargingSchedulePeriod[v].Limit);
+//      }
+//      printf("---------------------------------\n");
+}
+
+void ChargingProfileFlat(byte _index)
+{
+    if (ShmOCPP16Data->CSUMsg.bits[_index].ChargingProfileConf == NO) {
+        if (ShmOCPP16Data->CSUMsg.bits[_index].ChargingProfileReq == NO) {
+            ShmOCPP16Data->CSUMsg.bits[_index].ChargingProfileReq = YES;
+        }
+    }
+}
+
+void CheckReturnToChargingConn()
+{
+    if ((ShmSysConfigAndInfo->SysConfig.TotalConnectorCount + ShmSysConfigAndInfo->SysConfig.AcConnectorCount) > 1 &&
+            ShmSysConfigAndInfo->SysInfo.PageIndex != _LCM_AUTHORIZING &&
+            ShmSysConfigAndInfo->SysInfo.PageIndex != _LCM_AUTHORIZ_FAIL &&
+            ShmSysConfigAndInfo->SysInfo.PageIndex != _LCM_AUTHORIZ_COMP &&
+            ShmSysConfigAndInfo->SysInfo.PageIndex != _LCM_WAIT_FOR_PLUG) {
+        bool isReturnTimeout = false;
+
+        for (byte count = 0; count < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; count++) {
+            // 如果選的 DC 槍在充電~ 則 DC 槍不改變
+            if (count == ShmSysConfigAndInfo->SysInfo.CurGunSelected) {
+                if ((chargingInfo[count]->SystemStatus >= S_REASSIGN_CHECK && chargingInfo[count]->SystemStatus <= S_COMPLETE) ||
+                        (chargingInfo[count]->SystemStatus >= S_CCS_PRECHARGE_ST0 && chargingInfo[count]->SystemStatus <= S_CCS_PRECHARGE_ST1)) {
+                    isReturnTimeout = false;
+                    break;
+                }
+            } else if (count != ShmSysConfigAndInfo->SysInfo.CurGunSelected) {
+                if ((chargingInfo[count]->SystemStatus >= S_REASSIGN_CHECK && chargingInfo[count]->SystemStatus <= S_COMPLETE) ||
+                        (chargingInfo[count]->SystemStatus >= S_CCS_PRECHARGE_ST0 && chargingInfo[count]->SystemStatus <= S_CCS_PRECHARGE_ST1)) {
+                    isReturnTimeout = true;
+                    StartSystemTimeoutDet(Timeout_ReturnToChargingGunDet);
+                }
+            }
+        }
+
+        // AC 槍
+        if (!isReturnTimeout && ShmSysConfigAndInfo->SysConfig.AcConnectorCount > 0) {
+            // 沒有選中 AC，且 AC 在充電中
+            if (ShmSysConfigAndInfo->SysInfo.CurGunSelectedByAc == NO_DEFINE &&
+                    (ac_chargingInfo[0]->SystemStatus >= S_PREPARNING && ac_chargingInfo[0]->SystemStatus <= S_COMPLETE)) {
+                // 當前 DC 充電槍在 idle 狀態
+                if (chargingInfo[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->SystemStatus == S_IDLE ||
+                        chargingInfo[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->SystemStatus == S_RESERVATION) {
+                    isReturnTimeout = true;
+                    StartSystemTimeoutDet(Timeout_ReturnToChargingGunDet);
+                }
+            } else if (ShmSysConfigAndInfo->SysInfo.CurGunSelectedByAc == DEFAULT_AC_INDEX &&
+                       ((chargingInfo[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->SystemStatus >= S_REASSIGN_CHECK && chargingInfo[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->SystemStatus <= S_COMPLETE) ||
+                        (chargingInfo[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->SystemStatus >= S_CCS_PRECHARGE_ST0 && chargingInfo[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->SystemStatus <= S_CCS_PRECHARGE_ST1))) {
+                // 當前 DC 充電槍在 idle 狀態
+                if (ac_chargingInfo[0]->SystemStatus == S_IDLE ||
+                        ac_chargingInfo[0]->SystemStatus == S_RESERVATION) {
+                    isReturnTimeout = true;
+                    StartSystemTimeoutDet(Timeout_ReturnToChargingGunDet);
+                }
+            }
+        }
+
+        if (!isReturnTimeout) {
+            StopSystemTimeoutDet();
+        }
+    }
+}
+
+bool GetStartChargingByAlterMode(byte _gun)
+{
+    bool result = true;
+
+    if (ShmSysConfigAndInfo->SysConfig.TotalConnectorCount == 2 &&
+            ShmSysConfigAndInfo->SysInfo.IsAlternatvieConf == YES) {
+        for (byte _select = 0; _select < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; _select++) {
+            if (_select != _gun) {
+                if (chargingInfo[_select]->SystemStatus != S_IDLE &&
+                        chargingInfo[_select]->SystemStatus != S_RESERVATION) {
+                    result = false;
+                    break;
+                }
+            }
+        }
+    }
+
+    return result;
+}
+
+void TheEndCharging(byte gun_index)
+{
+    ftime(&endChargingTime[gun_index]);
+    if (chargingInfo[gun_index]->PresentChargedDuration != 0) {
+        chargingInfo[gun_index]->PresentChargedDuration = DiffTimeb(startChargingTime[gun_index], endChargingTime[gun_index]);
+    }
+
+    chargingInfo[gun_index]->isRemoteStart = NO;
+
+    StopGunInfoTimeoutDet(gun_index);
+    StartGunInfoTimeoutDet(gun_index, Timeout_EvseCompleteDet);
+    ChangeStartOrStopDateTime(NO, gun_index);
+    DB_Insert_Record(localDb, gun_index);
+}
+
+void UpdateErrorCodeToOcpp(byte index)
+{
+    uint8_t i = 0;
+
+    //if ((strcmp((char *)chargingInfo[index]->ConnectorAlarmCode, "") == EQUAL) &&
+    //        (strcmp((char *)chargingInfo[index]->EvConnAlarmCode, "") == EQUAL)
+    //   ) {
+    //    for (i = 0; i < ShmSysConfigAndInfo->SysWarningInfo.WarningCount; i++) {
+    //        if (strncmp((char *)&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i][0], "012251", 6) == EQUAL ||
+    //                strncmp((char *)&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i][0], "012252", 6) == EQUAL ||
+    //                strncmp((char *)&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i][0], "012238", 6) == EQUAL ||
+    //                strncmp((char *)&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i][0], "042251", 6) == EQUAL ||
+    //                strncmp((char *)&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i][0], "042252", 6) == EQUAL ||
+    //                strncmp((char *)&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i][0], "012304", 6) == EQUAL ||
+    //                strncmp((char *)&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i][0], "042200", 6) == EQUAL ||
+    //                strncmp((char *)&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i][0], "042201", 6) == EQUAL ||
+    //                strncmp((char *)&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i][0], "042202", 6) == EQUAL ||
+    //                strncmp((char *)&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i][0], "042267", 6) == EQUAL) {
+    //            strncpy((char *)ShmOCPP16Data->StatusNotification[index].VendorErrorCode, (char *)&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i][0], 6);
+    //            //log_info("1 %d = VendorErrorCode = %s\r\n", index, (char *)ShmOCPP16Data->StatusNotification[index].VendorErrorCode);
+    //            break;
+    //        }
+    //    }
+    //}
+
+    //log_info("%d = ConnectorAlarmCode = %s\r\n", index, (char *)chargingInfo[index]->ConnectorAlarmCode);
+    //log_info("%d = EvConnAlarmCode = %s\r\n", index, (char *)chargingInfo[index]->EvConnAlarmCode);
+    if (strcmp((char *)chargingInfo[index]->ConnectorAlarmCode, "") != EQUAL) {
+        strcpy((char *)ShmOCPP16Data->StatusNotification[index].ErrorCode, "InternalError");
+        strcpy((char *)ShmOCPP16Data->StatusNotification[index].VendorErrorCode, (char *)chargingInfo[index]->ConnectorAlarmCode);
+    } else if (strcmp((char *)chargingInfo[index]->EvConnAlarmCode, "") != EQUAL) {
+        strcpy((char *)ShmOCPP16Data->StatusNotification[index].ErrorCode, "OtherError");
+        strcpy((char *)ShmOCPP16Data->StatusNotification[index].VendorErrorCode, (char *)chargingInfo[index]->EvConnAlarmCode);
+    }
+
+    //log_info("2 %d = VendorErrorCode = %s\r\n", index, (char *)ShmOCPP16Data->StatusNotification[index].VendorErrorCode);
+}
+
+void AdjustChargerCurrent()
+{
+    ShmSysConfigAndInfo->SysConfig.RatingCurrent = ShmPsuData->SystemAvailableCurrent / 10;
+
+    // 設定的電流~ 如超過可輸出的電流，則 bypass
+    if (ShmSysConfigAndInfo->SysConfig.RatingCurrent < ShmSysConfigAndInfo->SysConfig.MaxChargingCurrent ||
+            ShmSysConfigAndInfo->SysConfig.RatingCurrent == 0) {
+        ShmSysConfigAndInfo->SysConfig.MaxChargingCurrent = 0;
+    }
+
+    PRINTF_FUNC ("PSU : MaxChargingPower = %d, MaxChargingCurrent = %d",
+                 ShmPsuData->SystemAvailablePower / 10,
+                 ShmPsuData->SystemAvailableCurrent / 10
+                );
+
+    PRINTF_FUNC ("Config : ChargingPower = %d, ChargingCurrent = %d",
+                 ShmSysConfigAndInfo->SysConfig.MaxChargingPower,
+                 ShmSysConfigAndInfo->SysConfig.MaxChargingCurrent
+                );
+}
+
+#if METER_ENABLE
+void CheckStatusOfMeter()
+{
+    // 橋接如果搭上~ 則兩個電表都是使用狀態
+    // 如橋接沒有搭上~ 則視該火線 relay 狀態為電表使用狀態
+    if (ShmSysConfigAndInfo->SysInfo.BridgeRelayStatus == YES) {
+        for (byte mIndex = 0; mIndex < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; mIndex++) {
+            ShmCsuMeterData->_meter[mIndex].isCalculation = YES;
+        }
+    } else {
+        for (byte mIndex = 0; mIndex < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; mIndex++) {
+            if (chargingInfo[mIndex]->RelayKPK2Status == YES || chargingInfo[mIndex]->RelayK1K2Status) {
+                ShmCsuMeterData->_meter[mIndex].isCalculation = YES;
+            } else {
+                ShmCsuMeterData->_meter[mIndex].isCalculation = NO;
+            }
+        }
+    }
+}
+
+void CheckRelayWeldingOrDrivingFault(byte gun_index)
+{
+    // relay welding fault then stop the charging process.
+    byte faultCode = RELAY_STATUS_ERROR_NONE;
+
+    if (gun_index == 0) {
+        if (ShmDcCommonData->RelayCheckStatus[RELAY_SMR1_P_STATUS] == RELAY_STATUS_ERROR_WELDING ||
+                ShmDcCommonData->RelayCheckStatus[RELAY_SMR1_N_STATUS] == RELAY_STATUS_ERROR_WELDING) {
+            faultCode = RELAY_STATUS_ERROR_WELDING;
+        } else if (ShmDcCommonData->RelayCheckStatus[RELAY_SMR1_P_STATUS] == RELAY_STATUS_ERROR_DRIVING ||
+                   ShmDcCommonData->RelayCheckStatus[RELAY_SMR1_N_STATUS] == RELAY_STATUS_ERROR_DRIVING) {
+            faultCode = RELAY_STATUS_ERROR_DRIVING;
+        }
+    } else if (gun_index == 1) {
+        if (ShmDcCommonData->RelayCheckStatus[RELAY_SMR2_P_STATUS] == RELAY_STATUS_ERROR_WELDING ||
+                ShmDcCommonData->RelayCheckStatus[RELAY_SMR2_N_STATUS] == RELAY_STATUS_ERROR_WELDING) {
+            faultCode = RELAY_STATUS_ERROR_WELDING;
+        } else if (ShmDcCommonData->RelayCheckStatus[RELAY_SMR2_P_STATUS] == RELAY_STATUS_ERROR_DRIVING ||
+                   ShmDcCommonData->RelayCheckStatus[RELAY_SMR2_N_STATUS] == RELAY_STATUS_ERROR_DRIVING) {
+            faultCode = RELAY_STATUS_ERROR_DRIVING;
+        }
+    }
+
+    if (ShmSysConfigAndInfo->SysConfig.TotalConnectorCount >= 2 &&
+            !ShmSysConfigAndInfo->SysInfo.IsAlternatvieConf) {
+        // 橋接
+        if (ShmDcCommonData->RelayCheckStatus[RELAY_PARA_P_STATUS] == RELAY_STATUS_ERROR_WELDING ||
+                ShmDcCommonData->RelayCheckStatus[RELAY_PARA_N_STATUS] == RELAY_STATUS_ERROR_WELDING) {
+            faultCode = RELAY_STATUS_ERROR_WELDING;
+        } else if (ShmDcCommonData->RelayCheckStatus[RELAY_PARA_P_STATUS] == RELAY_STATUS_ERROR_DRIVING ||
+                   ShmDcCommonData->RelayCheckStatus[RELAY_PARA_N_STATUS] == RELAY_STATUS_ERROR_DRIVING) {
+            faultCode = RELAY_STATUS_ERROR_DRIVING;
+        }
+    }
+
+    if (faultCode == RELAY_STATUS_ERROR_WELDING) {
+        // welding
+        if (chargingInfo[gun_index]->Type == _Type_Chademo) {
+            ShmStatusCodeData->FaultCode.FaultEvents.bits.ChademoOutputRelayWelding = YES;
+        } else if (chargingInfo[gun_index]->Type == _Type_GB) {
+            ShmStatusCodeData->FaultCode.FaultEvents.bits.GbOutputRelayWelding = YES;
+        } else if (chargingInfo[gun_index]->Type == _Type_CCS_2) {
+            ShmStatusCodeData->FaultCode.FaultEvents.bits.CcsOutputRelayWelding = YES;
+        }
+
+        ShmDcCommonData->GunRelayWeldingOccur[gun_index] = YES;
+        EmcOccureByString("");
+    } else if (faultCode == RELAY_STATUS_ERROR_DRIVING) {
+        // driving
+        if (chargingInfo[gun_index]->Type == _Type_Chademo) {
+            ShmStatusCodeData->FaultCode.FaultEvents.bits.ChademoOutputRelayDrivingFault = YES;
+        } else if (chargingInfo[gun_index]->Type == _Type_GB) {
+            ShmStatusCodeData->FaultCode.FaultEvents.bits.GbOutputRelayDrivingFault = YES;
+        } else if (chargingInfo[gun_index]->Type == _Type_CCS_2) {
+            ShmStatusCodeData->FaultCode.FaultEvents.bits.CcsOutputRelayDrivingFault = YES;
+        }
+
+        ShmDcCommonData->GunRelayDrivingOccur[gun_index] = YES;
+        EmcOccureByString("");
+    } else {
+        ShmDcCommonData->GunRelayWeldingOccur[gun_index] = NO;
+        ShmDcCommonData->GunRelayDrivingOccur[gun_index] = NO;
+
+        bool isClear = false;
+        if (!relayDrivingCheck) {
+            if (chargingInfo[gun_index]->Type == _Type_Chademo &&
+                    ShmStatusCodeData->FaultCode.FaultEvents.bits.ChademoOutputRelayDrivingFault == YES) {
+                isClear = true;
+                ShmStatusCodeData->FaultCode.FaultEvents.bits.ChademoOutputRelayDrivingFault = NO;
+            } else if (chargingInfo[gun_index]->Type == _Type_GB &&
+                       ShmStatusCodeData->FaultCode.FaultEvents.bits.GbOutputRelayDrivingFault == YES) {
+                isClear = true;
+                ShmStatusCodeData->FaultCode.FaultEvents.bits.GbOutputRelayDrivingFault = NO;
+            } else if (chargingInfo[gun_index]->Type == _Type_CCS_2 &&
+                       ShmStatusCodeData->FaultCode.FaultEvents.bits.CcsOutputRelayDrivingFault == YES) {
+                isClear = true;
+                ShmStatusCodeData->FaultCode.FaultEvents.bits.CcsOutputRelayDrivingFault = NO;
+            }
+        }
+
+
+        if (!relayWeldingCheck) {
+            if (chargingInfo[gun_index]->Type == _Type_Chademo &&
+                    ShmStatusCodeData->FaultCode.FaultEvents.bits.ChademoOutputRelayWelding == YES) {
+                isClear = true;
+                ShmStatusCodeData->FaultCode.FaultEvents.bits.ChademoOutputRelayWelding = NO;
+            } else if (chargingInfo[gun_index]->Type == _Type_GB &&
+                       ShmStatusCodeData->FaultCode.FaultEvents.bits.GbOutputRelayWelding == YES) {
+                isClear = true;
+                ShmStatusCodeData->FaultCode.FaultEvents.bits.GbOutputRelayWelding = NO;
+            } else if (chargingInfo[gun_index]->Type == _Type_CCS_2 &&
+                       ShmStatusCodeData->FaultCode.FaultEvents.bits.CcsOutputRelayWelding == YES) {
+                isClear = true;
+                ShmStatusCodeData->FaultCode.FaultEvents.bits.CcsOutputRelayWelding = NO;
+            }
+        }
+
+        if (!relayDrivingCheck && !relayWeldingCheck && isClear) {
+            ReleaseChargingProcessByString(2);
+        }
+    }
+}
+
+bool PrecheckIsPass(byte gun_index)
+{
+    bool result = true;
+
+    // relay welding or driving 是反向
+    if (result) {
+        result = !ShmDcCommonData->GunRelayWeldingOccur[gun_index];
+    }
+
+    return result;
+}
+#endif //METER_ENABLE
+
+void ResetDetAlarmStatus(byte gun)
+{
+    if (chargingInfo[gun]->Type == _Type_Chademo) {
+        if (ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemChademoOutputOVP == YES) {
+            ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemChademoOutputOVP = NO;
+        }
+    } else if (chargingInfo[gun]->Type == _Type_GB) {
+        if (ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemGbOutputOVP == YES) {
+            ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemGbOutputOVP = NO;
+        }
+    } else if (chargingInfo[gun]->Type == _Type_CCS_2) {
+        if (ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemCcsOutputOVP == YES) {
+            ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemCcsOutputOVP = NO;
+        }
+    }
+}
+
+static void powerCabinetPsuAlarmStatus(void)
+{
+    uint8_t i = 0;
+
+    for (i = 0; i < ShmSysConfigAndInfo->SysWarningInfo.WarningCount; i++) {
+        if (memcmp(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i][0], "042267", 6) == 0) {
+            EmcOccureByString("042267");
+        }
+    }
+}
+
+static void autoStartChargingForComBox(uint8_t gunIndex)
+{
+#if defined DD360ComBox
+    if ((chargingInfo[gunIndex]->ConnectorPlugIn == YES) &&
+            (chargingInfo[gunIndex]->SystemStatus == S_IDLE)
+       ) {
+        ShmSysConfigAndInfo->SysInfo.CurGunSelected = gunIndex;
+        strcpy((char *)&ShmSysConfigAndInfo->SysConfig.UserId, "AutoStartCharging");
+    }
+#else
+    return;
+#endif //DD360ComBox
+}
+
+int main(void)
+{
+    uint8_t evBoardStopState = 0;
+
+    if (CreateShareMemory() == 0) {
+        log_error("CreatShareMemory NG\r\n");
+        if (ShmStatusCodeData != NULL) {
+            ShmStatusCodeData->AlarmCode.AlarmEvents.bits.FailToCreateShareMemory = 1;
+        }
+        sleep(5);
+        system("reboot -f");
+        sleep(5);
+        system("reboot -f");
+    }
+
+    log_info(" ****************  FileSystem Boot up ***************\n");
+    if (!InitialSystemDefaultConfig()) {
+        log_error("InitialSystemDefaultConfig NG \n");
+        //StopProcessingLoop();
+        sleep(5);
+        system("reboot -f");
+    }
+    CheckGunTypeFromHw();
+    CheckIsAlternatvieByModelName();
+    InitialShareMemoryInfo();
+    ChangeLcmByIndex(_LCM_INIT);
+    if (!CheckConnectorTypeStatus()) {
+        isModelNameMatch = false;
+    }
+
+    Initialization();
+    SpawnTask();
+    log_info("Spawned all Task");
+    if (!isModelNameMatch) {
+        ShmStatusCodeData->AlarmCode.AlarmEvents.bits.ModelNameNoneMatchStestFail = YES;
+        ChangeLcmByIndex(_LCM_FIX);
+        // Module Name 與硬體對應不正確
+        log_error("Module Name & HW info none match. \n");
+        sleep(3);
+        KillAllTask();
+        StopProcessingLoop();
+    }
+    CreateTimeoutFork();
+    log_info("Start self test... \n");
+    startPrimaryLedIndicatorCtrlFork();
+    SelfTestRun();
+    StopSystemTimeoutDet();
+    log_info("Self test finished : SelfTestSeq = %d, Work_Step = %d ",
+             ShmSysConfigAndInfo->SysInfo.SelfTestSeq,
+             ShmPsuData->Work_Step);
+
+    if (ShmSysConfigAndInfo->SysInfo.SelfTestSeq == _STEST_FAIL ||
+            ShmPsuData->Work_Step == _NO_WORKING ||
+            ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsSeccTimeoutQCA7000Comm == YES //DS60-120 add
+       ) {
+        if (ShmSysConfigAndInfo->SysWarningInfo.Level != 2) {
+            if (!DisplaySelfTestFailReason()) { //DS60-120 add
+                PRINTF_FUNC("Soft reboot for retry self-tets. \n");
+
+                sleep(3);
+                system("killall OcppBackend &");
+                KillAllTask();
+                system("/usr/bin/run_evse_restart.sh");
+            }
+        }
+
+        for (byte gun_index = 0; gun_index < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; gun_index++) {
+            setChargerMode(gun_index, MODE_ALARM);
+        }
+        //ChangeLcmByIndex(_LCM_FIX);
+        sleep(3);
+        if (ShmSysConfigAndInfo->SysWarningInfo.Level == 2) { //DS60-120 add
+            KillTaskExceptPrimary();
+        } else {
+            KillTask();
+        }
+        StopProcessingLoop();
+    } else {
+        for (byte gun_index = 0; gun_index < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; gun_index++) {
+            setChargerMode(gun_index, MODE_IDLE);
+        }
+    }
+
+    // Local DB
+    if (DB_Open(localDb) != PASS) {
+        PRINTF_FUNC("DB_Open fail. \n");
+        isDb_ready = false;
+    } else {
+        isDb_ready = true;
+        for (int _index = 0; _index < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; _index++) {
+            chargingInfo[_index]->IsAvailable = DB_Get_Operactive(localDb, _index);
+        }
+        DB_Reboot_Record(localDb);
+    }
+    PRINTF_FUNC("===== Create DB End ===== \n");
+
+#if defined DD360Audi
+    ChangeLcmByIndex(_LCM_SELECT_GUN);
+#else
+    ChangeLcmByIndex(_LCM_IDLE);
+#endif //defined DD360Audi
+
+    sleep(1);
+    //***** 須新增的偵測 *****//
+    // 1. Thernal - 控制風扇轉速
+    // 2. ouput fuse - 控制風扇轉速
+    CreateRfidFork();
+    // Create Watchdog
+    //CreateWatchdog();
+    // Main loop
+
+    PRINTF_FUNC("===== Charger info ===== ");
+    PRINTF_FUNC("SW Version = %s", fwVersion);
+    PRINTF_FUNC("ModelName = %s", ShmSysConfigAndInfo->SysConfig.ModelName);
+    CheckFwSlotStatusLog();
+    AdjustChargerCurrent();
+    gettimeofday(&_cmdMainPriority_time, NULL);
+
+    for (;;) {
+        CheckOcppStatus();
+        ChkPrimaryStatus();
+        if ((IsConnectorWholeIdle() || ShmSysConfigAndInfo->SysInfo.PageIndex == _LCM_FIX) &&
+                ShmSysConfigAndInfo->SysInfo.SystemTimeoutFlag != Timeout_ReturnToChargingGunDet) {
+            CheckFactoryConfigFunction();
+
+            CheckFwUpdateFunction();
+        }
+
+        // OCPP 邏輯
+        OcppRemoteStartChk();
+        // 讀卡邏輯
+        ScannerCardProcess();
+        // 當 AC 沒有搭上時，清除一些錯誤碼
+        ClearAlarmCodeWhenAcOff();
+        // 確認是否要回到充電中的槍畫面邏輯判斷
+        CheckReturnToChargingConn();
+#if defined DD360 ||defined DD360Audi || defined DD360ComBox
+        //確認Power cabinet PSU Status
+        powerCabinetPsuAlarmStatus();
+#endif // defined DD360 || defined DD360Audi
+
+        if (_acgunIndex > 0 && isDetectPlugin() && !isCardScan) {
+            ShmSysConfigAndInfo->SysInfo.SystemPage = _LCM_WAIT_FOR_PLUG;
+        }
+
+        if ((GetTimeoutValue(_cmdMainPriority_time) / 1000) > 5000) {
+            CheckTask();
+#if defined METER_ENABLE
+            relayWeldingCheck = false;
+            relayDrivingCheck = false;
+#endif //defined METER_ENABLE
+            for (byte _index = 0; _index < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; _index++) {
+                //if (chargingInfo[_index]->SystemStatus == S_CHARGING) {
+                //    CheckSmartChargeProfile(_index);
+                //}
+                if ((chargingInfo[_index]->SystemStatus >= S_PREPARING_FOR_EVSE &&
+                        chargingInfo[_index]->SystemStatus <= S_CHARGING) ||
+                        (chargingInfo[_index]->SystemStatus >= S_CCS_PRECHARGE_ST0 &&
+                         chargingInfo[_index]->SystemStatus <= S_CCS_PRECHARGE_ST1)) {
+                    if (chargingInfo[_index]->SystemStatus == S_CHARGING &&
+                            _ocppProfileChkFlag == 12) {
+                        ChargingProfileFlat(_index);
+                        _ocppProfileChkFlag = 0;
+                    } else if (chargingInfo[_index]->SystemStatus != S_CHARGING) {
+                        ChargingProfileFlat(_index);
+                        _ocppProfileChkFlag = 0;
+                    } else {
+                        _ocppProfileChkFlag++;
+                    }
+                }
+
+#if defined METER_ENABLE
+                if (ShmDcCommonData->SysGunAreSameType == YES) {
+                    if (ShmDcCommonData->GunRelayWeldingOccur[_index] == YES) {
+                        relayWeldingCheck = true;
+                    }
+                    if (ShmDcCommonData->GunRelayDrivingOccur[_index] == YES) {
+                        relayDrivingCheck = true;
+                    }
+                }
+#endif //defined METER_ENABLE
+            }
+            gettimeofday(&_cmdMainPriority_time, NULL);
+        }
+
+#if defined METER_ENABLE
+        if (ShmSysConfigAndInfo->SysConfig.ModelName[3] == 'M' ||
+                ShmSysConfigAndInfo->SysConfig.ModelName[3] == 'L') {
+            CheckStatusOfMeter();
+        }
+#endif //defined METER_ENABLE
+
+        for (byte gun_index = 0; gun_index < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; gun_index++) {
+            autoStartChargingForComBox(gun_index); //for DD360ComBox
+
+            CheckGpioInStatus();
+            CheckErrorOccurStatus(gun_index);
+            ChkOcppStatus(gun_index);
+
+#if defined METER_ENABLE
+            CheckRelayWeldingOrDrivingFault(gun_index);
+#endif //defined METER_ENABLE
+
+            if ((chargingInfo[gun_index]->SystemStatus >= S_PREPARING_FOR_EVSE &&
+                    chargingInfo[gun_index]->SystemStatus <= S_CHARGING) ||
+                    (chargingInfo[gun_index]->SystemStatus >= S_CCS_PRECHARGE_ST0 &&
+                     chargingInfo[gun_index]->SystemStatus <= S_CCS_PRECHARGE_ST1)) {
+                CheckSmartChargeProfile(gun_index);
+            }
+
+            //PRINTF_FUNC("index = %d, ErrorCode = %s \n", gun_index, ShmOCPP16Data->StatusNotification[gun_index].ErrorCode);
+            switch (chargingInfo[gun_index]->SystemStatus) {
+            case S_IDLE:
+                ReleaseAlarmCode(gun_index);
+
+                if (isModeChange(gun_index)) {
+                    log_info("S_IDLE================================== %x \n", gun_index);
+                    chargingInfo[gun_index]->PresentChargedDuration = 0;
+                    chargingInfo[gun_index]->RemainChargingDuration = 0;
+                    chargingInfo[gun_index]->PresentChargingVoltage = 0;//DS60-120 add
+                    chargingInfo[gun_index]->PresentChargingCurrent = 0;//DS60-120 add
+                    strcpy((char *)chargingInfo[gun_index]->StartDateTime, "");
+                    strcpy((char *)chargingInfo[gun_index]->StopDateTime, "");
+                    strcpy((char *)chargingInfo[gun_index]->StartUserId, "");
+                    strcpy((char *)ShmOCPP16Data->StopTransaction[gun_index].StopReason, "");
+
+                    //Jerry add
+                    memset(&gAudiCustInfo->PricesInfo[gun_index], 0, sizeof(PricesInfo));
+                    gAudiCustInfo->PricesInfo[gun_index].Balance = FAIL_BALANCE_PRICES;
+#if defined DD360Audi
+                    destroySelGun(gun_index);
+#endif //defined DD360Audi
+                    ResetDetAlarmStatus(gun_index); //recovery OVP status code
+                    //strcpy((char *)ShmOCPP16Data->StatusNotification[gun_index].VendorErrorCode, "");
+                }
+            case S_RESERVATION:
+                if (isModeChange(gun_index)) {
+                    log_info("S_RESERVATION....................%x \n", gun_index);
+                    ShmOCPP16Data->CsMsg.bits[gun_index].ReserveNowConf = YES;
+                }
+
+                if (chargingInfo[gun_index]->IsAvailable == NO) {
+                    setChargerMode(gun_index, MODE_MAINTAIN);
+                }
+
+            case S_MAINTAIN:
+            case S_FAULT: {
+                if (ShmSysConfigAndInfo->SysWarningInfo.Level == 2) {
+                    if (gun_index == ShmSysConfigAndInfo->SysInfo.CurGunSelected) {
+                        ShmSysConfigAndInfo->SysInfo.SystemPage = _LCM_FIX;
+                    } else if (chargingInfo[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->SystemStatus != S_IDLE &&
+                               chargingInfo[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->SystemStatus != S_RESERVATION &&
+                               chargingInfo[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->SystemStatus != S_MAINTAIN &&
+                               chargingInfo[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->SystemStatus != S_FAULT) {
+                        if (chargingInfo[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->SystemStatus == S_CHARGING) {
+                            ShmSysConfigAndInfo->SysInfo.SystemPage = _LCM_COMPLETE;
+                        } else {
+#if defined DD360Audi
+                            ShmSysConfigAndInfo->SysInfo.SystemPage = _LCM_SELECT_GUN;
+#else
+                            ShmSysConfigAndInfo->SysInfo.SystemPage = _LCM_NONE;
+#endif //defined DD360Audi
+                        }
+                    }
+
+                    ClearDetectPluginFlag();
+//#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
+                    UpdateErrorCodeToOcpp(gun_index);
+//#endif //!defined DD360 && !defined DD360Audi
+                    setChargerMode(gun_index, MODE_FAULT);
+                } else {
+#if 1
+                    if (chargingInfo[gun_index]->SystemStatus == S_FAULT) {
+#if defined DD360Audi
+                        ShmSysConfigAndInfo->SysInfo.SystemPage = _LCM_SELECT_GUN;
+#else
+                        ShmSysConfigAndInfo->SysInfo.SystemPage = _LCM_NONE;
+#endif //defined DD360Audi
+                        setChargerMode(gun_index, MODE_IDLE);
+                    }
+
+                    //if (ShmSysConfigAndInfo->SysInfo.SystemPage == _LCM_FIX) {
+                    //    ShmSysConfigAndInfo->SysInfo.SystemPage = _LCM_SELECT_GUN;//_LCM_NONE; //Jerry add
+                    //    //for (byte g_index = 0; g_index < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; g_index++) {
+                    //    setChargerMode(gun_index, MODE_IDLE);
+                    //    //}
+                    //}
+#endif //0
+
+                    if (ShmSysConfigAndInfo->SysInfo.MainChargingMode == _MAIN_CHARGING_MODE_AVER) {
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
+                        if (ShmSysConfigAndInfo->SysInfo.AcContactorStatus == YES)
+#else
+                        if (1)
+#endif //!defined DD360 && !defined DD360Audi
+                        {
+                            // 均充 -> 最大充
+                            if (ShmSysConfigAndInfo->SysInfo.BridgeRelayStatus == NO) {
+                                if (ShmSysConfigAndInfo->SysInfo.ReAssignedFlag == _REASSIGNED_NONE) {
+                                    log_info("=============Smart Charging============= Step 11 \n");
+                                    ShmSysConfigAndInfo->SysInfo.ReAssignedFlag = _REASSIGNED_PREPARE_A_TO_M;
+                                }
+                            } else if (ShmSysConfigAndInfo->SysInfo.ReAssignedFlag != _REASSIGNED_COMP &&
+                                       ShmSysConfigAndInfo->SysInfo.ReAssignedFlag != _REASSIGNED_WAITING) {
+                                log_info("=============Smart Charging============= Step 14 \n");
+                                ShmSysConfigAndInfo->SysInfo.ReAssignedFlag = _REASSIGNED_WAITING;
+                            } else if (ShmSysConfigAndInfo->SysInfo.ReAssignedFlag == _REASSIGNED_COMP) {
+                                ShmSysConfigAndInfo->SysInfo.MainChargingMode = _MAIN_CHARGING_MODE_MAX;
+                                ShmSysConfigAndInfo->SysInfo.ReAssignedFlag = _REASSIGNED_NONE;
+                            }
+                        } else {
+                            ShmSysConfigAndInfo->SysInfo.MainChargingMode = _MAIN_CHARGING_MODE_MAX;
+                            ShmSysConfigAndInfo->SysInfo.ReAssignedFlag = _REASSIGNED_NONE;
+                        }
+                    } else {
+                        ShmSysConfigAndInfo->SysInfo.ReAssignedFlag = _REASSIGNED_NONE;
+                    }
+
+#if defined METER_ENABLE
+                    if (PrecheckIsPass(gun_index)) {
+                        if (chargingInfo[gun_index]->SystemStatus == S_FAULT) {
+                            ShmSysConfigAndInfo->SysInfo.SystemPage = _LCM_NONE;
+                            setChargerMode(gun_index, MODE_IDLE);
+                        }
+#endif //defined METER_ENABLE
+
+                        if (ShmSysConfigAndInfo->SysConfig.OfflinePolicy == _OFFLINE_POLICY_NO_CHARGING) {
+                            if (ShmSysConfigAndInfo->SysInfo.CurGunSelected == gun_index) {
+#if defined DD360Audi
+                                ShmSysConfigAndInfo->SysInfo.ConnectorPage = _LCM_SELECT_GUN;
+#else
+                                ShmSysConfigAndInfo->SysInfo.ConnectorPage = _LCM_IDLE;
+#endif //
+                            }
+                        } else {
+                            // Idle 正常程序起點
+                            // 判斷是否有啟用檢查插槍
+                            if (isDetectPlugin()) {
+                                // 卡號驗證成功後，等待充電槍插入充電車
+                                if (chargingInfo[gun_index]->RemoteStartFlag == YES) {
+                                    if (chargingInfo[gun_index]->ConnectorPlugIn == YES &&
+                                            chargingInfo[gun_index]->IsAvailable) {
+                                        PRINTF_FUNC("-----------------1----------------- %d \n", gun_index);
+                                        chargingInfo[gun_index]->RemoteStartFlag = NO;
+                                        chargingInfo[gun_index]->isRemoteStart = YES; //DS60-120
+                                        ChangeGunSelectByIndex(gun_index);
+                                        AddPlugInTimes(gun_index);
+                                        setChargerMode(gun_index, MODE_REASSIGN_CHECK);
+                                        strcpy((char *)chargingInfo[gun_index]->StartUserId, "");
+                                        ClearDetectPluginFlag();
+                                        continue;
+                                    }
+                                } else if (ShmSysConfigAndInfo->SysInfo.OrderCharging == NO_DEFINE) {
+                                    if (chargingInfo[gun_index]->ConnectorPlugIn == YES &&
+                                            chargingInfo[gun_index]->IsAvailable &&
+                                            chargingInfo[gun_index]->SystemStatus == S_IDLE
+#if defined DD360Audi
+                                            && (waitRightGunPlugIt(gun_index) == PASS ||
+                                                waitLeftGunPlugIt(gun_index) == PASS)
+#endif //defined DD360Audi
+                                       ) {
+                                        PRINTF_FUNC("-----------------2----------------- \n");
+                                        ChangeGunSelectByIndex(gun_index);
+                                        AddPlugInTimes(gun_index);
+                                        strcpy((char *)chargingInfo[gun_index]->StartUserId, (char *)ShmSysConfigAndInfo->SysConfig.UserId);
+                                        PRINTF_FUNC("index = %d, CardNumber = %s \n", gun_index, chargingInfo[gun_index]->StartUserId);
+                                        strcpy((char *)ShmSysConfigAndInfo->SysConfig.UserId, "");
+                                        // 當前操作的槍號，進入 Preparing
+                                        setChargerMode(gun_index, MODE_REASSIGN_CHECK);
+                                        ClearDetectPluginFlag();
+                                        continue;
+                                    }
+                                }
+
+                                if (!isCardScan) {
+                                    // LCM => Waiting for plugging
+                                    ShmSysConfigAndInfo->SysInfo.SystemPage = _LCM_WAIT_FOR_PLUG;
+                                }
+                            } else if (chargingInfo[gun_index]->SystemStatus == S_RESERVATION) {
+                                if (!isReservationExpired(gun_index)) {
+                                    chargingInfo[gun_index]->SystemStatus = S_IDLE;
+                                }
+                            } else if (ShmSysConfigAndInfo->SysConfig.AuthorisationMode == AUTH_MODE_DISABLE &&
+                                       (chargingInfo[gun_index]->ConnectorPlugIn == YES && chargingInfo[gun_index]->IsAvailable)) {
+                                PRINTF_FUNC("-----------------3----------------- \n");
+                                bool isCanStartChargingFlag = GetStartChargingByAlterMode(gun_index);
+
+                                if (isCanStartChargingFlag) {
+                                    ChangeGunSelectByIndex(gun_index);
+                                    AddPlugInTimes(gun_index);
+                                    setChargerMode(gun_index, MODE_REASSIGN_CHECK);
+                                    ClearDetectPluginFlag();
+                                    continue;
+                                }
+                            } else {
+                                if (ShmSysConfigAndInfo->SysInfo.CurGunSelected == gun_index) {
+#if defined DD360Audi
+                                    ShmSysConfigAndInfo->SysInfo.ConnectorPage = _LCM_SELECT_GUN;
+#else
+                                    ShmSysConfigAndInfo->SysInfo.ConnectorPage = _LCM_IDLE;
+#endif // defined DD360Audi
+                                }
+                            }
+                        } // Idle 正常程序終點
+#if defined METER_ENABLE
+                    } else {
+                        setChargerMode(gun_index, MODE_FAULT);
+                        if (gun_index == ShmSysConfigAndInfo->SysInfo.CurGunSelected) {
+                            ShmSysConfigAndInfo->SysInfo.SystemPage = _LCM_FIX;
+                        }
+                    }
+#endif //defined METER_ENABLE
+                }
+            }
+            break;
+            case S_REASSIGN_CHECK: {
+                if (isModeChange(gun_index)) {
+                    log_info("S_REASSIGN_CHECK================================== %x \n", gun_index);
+#if defined DD360Audi
+                    ShmSysConfigAndInfo->SysInfo.SystemPage = _LCM_SELECT_GUN;
+#else
+                    ShmSysConfigAndInfo->SysInfo.SystemPage = _LCM_NONE;
+#endif //defined DD360Audi
+                    if (ShmSysConfigAndInfo->SysInfo.OrderCharging != NO_DEFINE) {
+                        ShmSysConfigAndInfo->SysInfo.OrderCharging = NO_DEFINE;
+                    }
+                    StopSystemTimeoutDet();
+                }
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
+                bool isRessign = false;
+                if (ShmSysConfigAndInfo->SysConfig.TotalConnectorCount > 1 && ShmSysConfigAndInfo->SysInfo.IsAlternatvieConf == NO) {
+                    if (ShmSysConfigAndInfo->SysInfo.MainChargingMode == _MAIN_CHARGING_MODE_MAX) {
+                        for (byte index = 0; index < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; index++) {
+                            // 有其他槍已經分配好 psu 模塊
+                            if (ShmSysConfigAndInfo->SysInfo.CurGunSelected != index &&
+                                    chargingInfo[index]->SystemStatus >= S_PREPARNING &&
+                                    chargingInfo[index]->SystemStatus != S_MAINTAIN) {
+                                log_info("=============Smart Charging============= Step 1 \n");
+                                ShmSysConfigAndInfo->SysInfo.ReAssignedFlag = _REASSIGNED_PREPARE_M_TO_A;
+                                isRessign = true;
+                                break;
+                            }
+                        }
+                    } else if (ShmSysConfigAndInfo->SysInfo.MainChargingMode == _MAIN_CHARGING_MODE_AVER &&
+                               ShmSysConfigAndInfo->SysInfo.ReAssignedFlag != _REASSIGNED_NONE) {
+                        // 如果在切換最大充的過程中，需等待最大充切換完成後，在走均充流程
+                        if (ShmSysConfigAndInfo->SysInfo.BridgeRelayStatus == YES) {
+                            if (ShmSysConfigAndInfo->SysInfo.ReAssignedFlag != _REASSIGNED_COMP &&
+                                    ShmSysConfigAndInfo->SysInfo.ReAssignedFlag != _REASSIGNED_WAITING) {
+                                log_info("=============Smart Charging============= Step 14 \n");
+                                ShmSysConfigAndInfo->SysInfo.ReAssignedFlag = _REASSIGNED_WAITING;
+                            } else if (ShmSysConfigAndInfo->SysInfo.ReAssignedFlag == _REASSIGNED_COMP) {
+                                ShmSysConfigAndInfo->SysInfo.MainChargingMode = _MAIN_CHARGING_MODE_MAX;
+                                ShmSysConfigAndInfo->SysInfo.ReAssignedFlag = _REASSIGNED_NONE;
+                                continue;
+                            }
+                        }
+
+                        if (ShmSysConfigAndInfo->SysInfo.CurGunSelected == gun_index) {
+                            ShmSysConfigAndInfo->SysInfo.ConnectorPage = _LCM_PRE_CHARGE;
+                        }
+                        continue;
+                    }
+                }
+#endif // !defined DD360 && !defined DD360Audi
+
+                if (0) { // if (isRessign)
+#if defined DD360 ||defined DD360Audi || defined DD360ComBox
+                    setChargerMode(gun_index, MODE_PRECHARGE);
+#else
+                    setChargerMode(gun_index, MODE_REASSIGN);
+#endif //defined DD360 || defined DD360Audi
+                } else {
+                    setChargerMode(gun_index, MODE_PRECHARGE);
+                }
+
+                if (ShmSysConfigAndInfo->SysInfo.CurGunSelected == gun_index) {
+                    ShmSysConfigAndInfo->SysInfo.ConnectorPage = _LCM_PRE_CHARGE;
+                }
+            }
+            break;
+            case S_REASSIGN: {
+                if (isModeChange(gun_index)) {
+                    PRINTF_FUNC("S_REASSIGN================================== %x \n", gun_index);
+                    gettimeofday(&_toAverage_time, NULL);
+                }
+
+                // 重新分配，此階段主要是讓已經在充電或者準備進入充電前的緩衝
+                // 此狀態下~ 控制權在於 PSU 及 EV小板 Process
+                if (ShmSysConfigAndInfo->SysInfo.ReAssignedFlag == _REASSIGNED_NONE ||
+                        ShmSysConfigAndInfo->SysInfo.MainChargingMode == _MAIN_CHARGING_MODE_AVER) {
+                    if (ShmSysConfigAndInfo->SysInfo.CanAverageCharging) {
+                        ShmSysConfigAndInfo->SysInfo.MainChargingMode = _MAIN_CHARGING_MODE_AVER;//DS60-120 add
+                        setChargerMode(gun_index, MODE_PRECHARGE);
+                    } else {
+                        setChargerMode(gun_index, MODE_IDLE);
+                    }
+                    ShmSysConfigAndInfo->SysInfo.ReAssignedFlag = _REASSIGNED_NONE; //DS60-120 add
+                } else if (ShmSysConfigAndInfo->SysInfo.ReAssignedFlag == _REASSIGNED_RELAY_M_TO_A &&
+                           ShmSysConfigAndInfo->SysInfo.BridgeRelayStatus == NO) {
+                    PRINTF_FUNC("=============Smart Charging : _REASSIGNED_COMP============= Step 6 \n");
+                    ShmSysConfigAndInfo->SysInfo.MainChargingMode = _MAIN_CHARGING_MODE_AVER;
+                    //ShmSysConfigAndInfo->SysInfo.ReAssignedFlag = _REASSIGNED_NONE; //DS60-120 remove
+                    ShmSysConfigAndInfo->SysInfo.CanAverageCharging = true; //DS60-120 add
+                }
+
+                //PRINTF_FUNC("CurGunSelected = %d, gun_index = %d \n", ShmSysConfigAndInfo->SysInfo.CurGunSelected, gun_index);
+                if (ShmSysConfigAndInfo->SysInfo.CurGunSelected == gun_index) {
+                    ShmSysConfigAndInfo->SysInfo.ConnectorPage = _LCM_PRE_CHARGE;
+                    // ShmSysConfigAndInfo->SysInfo.SystemPage = _LCM_NONE;
+                }
+            }
+            break;
+            case S_PREPARNING: {
+                if (isModeChange(gun_index)) {
+                    PRINTF_FUNC("S_PREPARNING================================== %x \n", gun_index);
+                    StopGunInfoTimeoutDet(gun_index);
+                    StartGunInfoTimeoutDet(gun_index, Timeout_Preparing);
+                }
+
+                if (ShmPsuData->SystemPresentPsuQuantity > 0 &&
+                        ShmPsuData->SystemAvailablePower > 10 &&
+                        GetTimeoutValue(chargingInfo[gun_index]->TimeoutTimer) >= 5000000) {
+                    //if ((chargingInfo[gun_index]->MaximumChargingVoltage > 0) && //DS60-120 remove
+                    //        (chargingInfo[gun_index]->AvailableChargingCurrent > 0) &&
+                    //        (chargingInfo[gun_index]->AvailableChargingPower > 0)) {
+                    setChargerMode(gun_index, MODE_PREPARE_FOR_EV);
+                    //}
+                }
+
+                //DS60-120 add
+                if (ShmSysConfigAndInfo->SysConfig.TotalConnectorCount >= 2) {
+                    bool oughtAver = true;
+                    for (byte index = 0; index < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; index++) {
+                        // 共同進入充電邏輯
+                        if (chargingInfo[index]->SystemStatus != S_PREPARNING) {
+                            oughtAver = false;
+                            break;
+                        }
+                    }
+
+                    if (oughtAver) {
+                        PRINTF_FUNC("********* Automatically change to aver mode ********** \n");
+                        ShmSysConfigAndInfo->SysInfo.MainChargingMode = _MAIN_CHARGING_MODE_AVER;
+                        ShmSysConfigAndInfo->SysInfo.ReAssignedFlag = _REASSIGNED_NONE;
+                    }
+                }
+
+                if ((evBoardStopState = isEvBoardStopChargeFlag(gun_index)) > 0) {
+                    // 板端要求停止 (錯誤)
+                    if (strcmp((char *)ShmOCPP16Data->StopTransaction[gun_index].StopReason, "") == EQUAL) {
+                        strcpy((char *)ShmOCPP16Data->StopTransaction[gun_index].StopReason, "EVDisconnected");
+                    }
+
+                    if (evBoardStopState == EV_BOARD_STOP_CHARGING) {
+                        ChargingAlarmProcess(gun_index);
+                    } else if (evBoardStopState == POWER_CABINET_STOP_CHARGING) {
+                        ChargingTerminalProcess(gun_index);
+                    }
+                } else if (isEvBoardNormalStopChargeFlag(gun_index) == YES) {
+                    // 板端要求停止 (正常)
+                    if (strcmp((char *)ShmOCPP16Data->StopTransaction[gun_index].StopReason, "") == EQUAL) {
+                        strcpy((char *)ShmOCPP16Data->StopTransaction[gun_index].StopReason, "EVDisconnected");
+                    }
+                    ChargingTerminalProcess(gun_index);
+                } else if (OcppRemoteStop(gun_index) == YES ||
+                           WifiScheduleStop(gun_index)) {
+                    // 後臺要求停止
+                    ChargingTerminalProcess(gun_index);
+                }
+
+                if (ShmSysConfigAndInfo->SysInfo.CurGunSelected == gun_index) {
+                    ShmSysConfigAndInfo->SysInfo.ConnectorPage = _LCM_PRE_CHARGE;
+                    // ShmSysConfigAndInfo->SysInfo.SystemPage = _LCM_NONE;
+                }
+            }
+            break;
+            case S_PREPARING_FOR_EV: { // 等待車端的通訊 (EV 小板)，待車端回報後，開始樁端的測試
+                if (isModeChange(gun_index)) {
+                    log_info("S_PREPARING_FOR_EV================================== %x \n", gun_index);
+                    //strcpy((char *)ShmSysConfigAndInfo->SysConfig.UserId, "");
+                    StopGunInfoTimeoutDet(gun_index);
+                    StartGunInfoTimeoutDet(gun_index, Timeout_EvChargingDet);
+                }
+
+                if (chargingInfo[gun_index]->Type == _Type_Chademo) {
+                    // 檢查車端的槍鎖是否為鎖上
+                    if (isEvGunLocked_chademo(gun_index) == YES) {
+                        setChargerMode(gun_index, MODE_PREPARE_FOR_EVSE);
+                    }
+                } else if (chargingInfo[gun_index]->Type == _Type_GB) {
+                    // 檢查車端的 charging enable 是否為 1
+                    if (isEvGunLocked_gb(gun_index) == YES) {
+                        setChargerMode(gun_index, MODE_PREPARE_FOR_EVSE);
+                    }
+                } else if (chargingInfo[gun_index]->Type == _Type_CCS_2) {
+                    // 檢查車端的 charging enable 是否為 1
+                    if (isEvGunLocked_ccs(gun_index) == YES) {
+                        setChargerMode(gun_index, MODE_PREPARE_FOR_EVSE);
+                    }
+                }
+
+                if ((evBoardStopState = isEvBoardStopChargeFlag(gun_index)) > 0) {
+                    // 板端要求停止 (錯誤)
+                    if (strcmp((char *)ShmOCPP16Data->StopTransaction[gun_index].StopReason, "") == EQUAL) {
+                        strcpy((char *)ShmOCPP16Data->StopTransaction[gun_index].StopReason, "EVDisconnected");
+                    }
+
+                    if (evBoardStopState == EV_BOARD_STOP_CHARGING) {
+                        ChargingAlarmProcess(gun_index);
+                    } else if (evBoardStopState == POWER_CABINET_STOP_CHARGING) {
+                        ChargingTerminalProcess(gun_index);
+                    }
+                } else if (isEvBoardNormalStopChargeFlag(gun_index) == YES) {
+                    // 板端要求停止 (正常)
+                    if (strcmp((char *)ShmOCPP16Data->StopTransaction[gun_index].StopReason, "") == EQUAL) {
+                        strcpy((char *)ShmOCPP16Data->StopTransaction[gun_index].StopReason, "EVDisconnected");
+                    }
+                    ChargingTerminalProcess(gun_index);
+                } else if (OcppRemoteStop(gun_index) == YES ||
+                           WifiScheduleStop(gun_index)) {
+                    // 後臺要求停止
+                    ChargingTerminalProcess(gun_index);
+                }
+
+                // LCM => Pre-charging
+                if (ShmSysConfigAndInfo->SysInfo.CurGunSelected == gun_index) {
+                    ShmSysConfigAndInfo->SysInfo.ConnectorPage = _LCM_PRE_CHARGE;
+                    // ShmSysConfigAndInfo->SysInfo.SystemPage = _LCM_NONE;
+                }
+            }
+            break;
+            case S_PREPARING_FOR_EVSE: { // 等待 RB 通訊及測試，並將狀態回報， CSU 確認 Pass 後，開始進入充電
+                if (isModeChange(gun_index)) {
+                    log_info("S_PREPARING_FOR_EVSE================================== %x \n", gun_index);
+                    StopGunInfoTimeoutDet(gun_index);
+                    StartGunInfoTimeoutDet(gun_index, Timeout_EvseChargingDet);
+                }
+
+                if (chargingInfo[gun_index]->Type == _Type_Chademo) {
+                    // 檢查樁端的 GFD 結果
+                    if (isPrechargeStatus_chademo(gun_index) > 5 && isPrechargeStatus_chademo(gun_index) < 8) {
+                        // 當前操作的槍號，進入 Charging
+                        setChargerMode(gun_index, MODE_CHARGING);
+                    }
+
+                    if (chargingInfo[gun_index]->GroundFaultStatus == GFD_FAIL) {
+                        // GFD 錯誤停止
+                        RecordAlarmCode(gun_index, "012234");
+                    } else if (chargingInfo[gun_index]->GroundFaultStatus == GFD_WARNING) {
+                        // GFD 警告
+                        RecordWarningCode(gun_index, "012296");
+                    }
+                } else if (chargingInfo[gun_index]->Type == _Type_GB) {
+                    // 檢查樁端的 GFD 結果
+                    if (isPrechargeStatus_gb(gun_index) > 5 && isPrechargeStatus_gb(gun_index) < 9) {
+                        setChargerMode(gun_index, MODE_CHARGING);
+                    }
+
+                    if (chargingInfo[gun_index]->GroundFaultStatus == GFD_FAIL) {
+                        // GFD 錯誤停止
+                        RecordAlarmCode(gun_index, "012236");
+                    } else if (chargingInfo[gun_index]->GroundFaultStatus == GFD_WARNING) {
+                        // GFD 警告
+                        RecordWarningCode(gun_index, "012298");
+                    }
+                } else if (chargingInfo[gun_index]->Type == _Type_CCS_2) {
+                    // 檢查樁端的 GFD 結果
+                    if ((chargingInfo[gun_index]->GroundFaultStatus == GFD_PASS ||
+                            chargingInfo[gun_index]->GroundFaultStatus == GFD_WARNING)) {
+                        setChargerMode(gun_index, MODE_CCS_PRECHARGE_STEP0);
+                    }
+
+                    if (chargingInfo[gun_index]->GroundFaultStatus == GFD_FAIL) {
+                        // GFD 錯誤停止
+                        RecordAlarmCode(gun_index, "012235");
+                    } else if (chargingInfo[gun_index]->GroundFaultStatus == GFD_WARNING) {
+                        // GFD 警告
+                        RecordWarningCode(gun_index, "012297");
+                    }
+                }
+
+                if ((evBoardStopState = isEvBoardStopChargeFlag(gun_index)) > 0) {
+                    // 板端要求停止 (錯誤)
+                    if (strcmp((char *)ShmOCPP16Data->StopTransaction[gun_index].StopReason, "") == EQUAL) {
+                        strcpy((char *)ShmOCPP16Data->StopTransaction[gun_index].StopReason, "EVDisconnected");
+                    }
+
+                    if (evBoardStopState == EV_BOARD_STOP_CHARGING) {
+                        ChargingAlarmProcess(gun_index);
+                    } else if (evBoardStopState == POWER_CABINET_STOP_CHARGING) {
+                        ChargingTerminalProcess(gun_index);
+                    }
+                } else if (isEvBoardNormalStopChargeFlag(gun_index) == YES) {
+                    // 板端要求停止 (正常)
+                    if (strcmp((char *)ShmOCPP16Data->StopTransaction[gun_index].StopReason, "") == EQUAL) {
+                        strcpy((char *)ShmOCPP16Data->StopTransaction[gun_index].StopReason, "EVDisconnected");
+                    }
+                    ChargingTerminalProcess(gun_index);
+                } else if (OcppRemoteStop(gun_index) == YES ||
+                           WifiScheduleStop(gun_index)) {
+                    // 後臺要求停止
+                    ChargingTerminalProcess(gun_index);
+                }
+
+                // LCM => Pre-charging
+                if (ShmSysConfigAndInfo->SysInfo.CurGunSelected == gun_index) {
+                    ShmSysConfigAndInfo->SysInfo.ConnectorPage = _LCM_PRE_CHARGE;
+                    // ShmSysConfigAndInfo->SysInfo.SystemPage = _LCM_NONE;
+                }
+            }
+            break;
+            case S_CHARGING: { // 剛進入充電狀態，等待 EV 小板要求的輸出電流後開始輸出
+                if (isModeChange(gun_index)) {
+                    log_info("S_CHARGING================================== %x \n", gun_index);
+                    StopGunInfoTimeoutDet(gun_index);
+                    ftime(&startChargingTime[gun_index]);
+                    strcpy((char *)ShmOCPP16Data->StartTransaction[gun_index].ResponseIdTagInfo.Status, ""); //DS60-120 add
+                    ChangeStartOrStopDateTime(YES, gun_index);
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
+                    OcppStartTransation(gun_index);
+#endif //!defined DD360 && !defined DD360Audi
+                }
+
+                if (ShmOCPP16Data->CpMsg.bits[gun_index].StartTransactionConf) {
+                    ShmOCPP16Data->CpMsg.bits[gun_index].StartTransactionConf = NO;
+                }
+                ftime(&endChargingTime[gun_index]);
+                chargingInfo[gun_index]->PresentChargedDuration = DiffTimeb(startChargingTime[gun_index], endChargingTime[gun_index]);
+
+                if (chargingInfo[gun_index]->Type == _Type_Chademo) {
+                    if (chargingInfo[gun_index]->GroundFaultStatus == GFD_FAIL) {
+                        // GFD 錯誤停止
+                        RecordAlarmCode(gun_index, "012234");
+                    }
+                    //else if (((chargingInfo[gun_index]->EvBatterytargetVoltage * 10) > 0 && chargingInfo[gun_index]->EvBatterytargetVoltage < SYSTEM_MIN_VOL) ||
+                    //           (chargingInfo[gun_index]->PresentChargedDuration >= 10 && chargingInfo[gun_index]->PresentChargingVoltage < SYSTEM_MIN_VOL)) {
+                    //    // UVP
+                    //    RecordAlarmCode(gun_index, "012289");
+                    //    ChargingTerminalProcess(gun_index);
+                    //}
+                    else if (chargingInfo[gun_index]->GroundFaultStatus == GFD_WARNING) {
+                        // GFD 警告
+                        RecordWarningCode(gun_index, "012296");
+                    }
+                } else if (chargingInfo[gun_index]->Type == _Type_GB) {
+                    if (chargingInfo[gun_index]->GroundFaultStatus == GFD_FAIL) {
+                        // GFD 錯誤停止
+                        RecordAlarmCode(gun_index, "012236");
+                    }
+                    //else if (isPrechargeStatus_gb(gun_index) == 10 &&
+                    //           (((chargingInfo[gun_index]->EvBatterytargetVoltage * 10) > 0 && chargingInfo[gun_index]->EvBatterytargetVoltage < SYSTEM_MIN_VOL) ||
+                    //            (chargingInfo[gun_index]->PresentChargedDuration >= 10 && chargingInfo[gun_index]->PresentChargingVoltage < SYSTEM_MIN_VOL))) {
+                    //    // UVP
+                    //    RecordAlarmCode(gun_index, "012290");
+                    //    ChargingTerminalProcess(gun_index);
+                    //}
+                    else if (chargingInfo[gun_index]->GroundFaultStatus == GFD_WARNING) {
+                        // GFD 警告
+                        RecordWarningCode(gun_index, "012298");
+                    }
+                } else if (chargingInfo[gun_index]->Type == _Type_CCS_2) {
+                    if (chargingInfo[gun_index]->GroundFaultStatus == GFD_FAIL) {
+                        // GFD 錯誤停止
+                        RecordAlarmCode(gun_index, "012235");
+                    }
+                    //else if (((chargingInfo[gun_index]->EvBatterytargetVoltage * 10) > 0 && chargingInfo[gun_index]->EvBatterytargetVoltage < SYSTEM_MIN_VOL) ||
+                    //           (chargingInfo[gun_index]->PresentChargedDuration >= 10 && chargingInfo[gun_index]->PresentChargingVoltage < SYSTEM_MIN_VOL)) {
+                    //    // UVP
+                    //    RecordAlarmCode(gun_index, "012288");
+                    //    ChargingTerminalProcess(gun_index);
+                    //}
+                    else if (chargingInfo[gun_index]->GroundFaultStatus == GFD_WARNING) {
+                        // GFD 警告
+                        RecordWarningCode(gun_index, "012297");
+                    }
+                }
+
+                if ((evBoardStopState = isEvBoardStopChargeFlag(gun_index)) > 0) {
+                    // 板端要求停止 (錯誤)
+                    if (strcmp((char *)ShmOCPP16Data->StopTransaction[gun_index].StopReason, "") == EQUAL) {
+                        strcpy((char *)ShmOCPP16Data->StopTransaction[gun_index].StopReason, "EVDisconnected");
+                    }
+                    //printf("%d evBoardStopState = %d\r\n", gun_index, evBoardStopState);
+                    if (evBoardStopState == EV_BOARD_STOP_CHARGING) {
+                        ChargingAlarmProcess(gun_index);
+                    } else if (evBoardStopState == POWER_CABINET_STOP_CHARGING) {
+                        ChargingTerminalProcess(gun_index);
+                    }
+                } else if (isEvBoardNormalStopChargeFlag(gun_index) == YES) {
+                    // 板端要求停止 (正常)
+                    if (strcmp((char *)ShmOCPP16Data->StopTransaction[gun_index].StopReason, "") == EQUAL) {
+                        strcpy((char *)ShmOCPP16Data->StopTransaction[gun_index].StopReason, "EVDisconnected");
+                    }
+                    ChargingTerminalProcess(gun_index);
+                } else if (OcppRemoteStop(gun_index) == YES ||
+                           WifiScheduleStop(gun_index) ||
+                           CheckBackendChargingTimeout(gun_index) ||
+                           CheckBackendChargingEnergy(gun_index) ||
+                           strcmp((char *)ShmOCPP16Data->StartTransaction[gun_index].ResponseIdTagInfo.Status, "Invalid") == EQUAL) {
+
+                    // 後臺要求停止
+                    ChargingTerminalProcess(gun_index);
+                }
+
+                // LCM => Charging
+                if (ShmSysConfigAndInfo->SysInfo.CurGunSelected == gun_index) {
+                    ShmSysConfigAndInfo->SysInfo.ConnectorPage = _LCM_CHARGING;
+                    // ShmSysConfigAndInfo->SysInfo.SystemPage = _LCM_NONE;
+                }
+            }
+            break;
+            case S_ALARM:
+            case S_TERMINATING: {
+                if (isModeChange(gun_index)) {
+                    if (strcmp((char *)ShmOCPP16Data->StopTransaction[gun_index].StopReason, "") == EQUAL) {
+                        strcpy((char *)ShmOCPP16Data->StopTransaction[gun_index].StopReason, "Local");
+                    }
+
+                    if (chargingInfo[gun_index]->SystemStatus == S_ALARM) {
+                        PRINTF_FUNC("================== S_ALARM (%x) ================ \n", gun_index);
+                        UpdateErrorCodeToOcpp(gun_index);
+
+                        if (strcmp((char *)chargingInfo[gun_index]->StartDateTime, "") != EQUAL) {
+                            OcppStopTransation(gun_index);
+                        }
+
+                        TheEndCharging(gun_index);
+                    } else {
+                        PRINTF_FUNC("================== S_TERMINATING (%x) ================ \n", gun_index);
+                    }
+
+                    //log_info ("terminating......................... %x \n", gun_index);
+                    StopGunInfoTimeoutDet(gun_index);
+                }
+
+                if (chargingInfo[gun_index]->Type == _Type_Chademo) {
+                    // 非車端的停止 : 需等待小板送出停止指令，讓車端解除槍
+                    //if (isEvStopCharging_chademo(gun_index) == YES) {
+                    //    /*+++ 20200908, vern, disable it for DD360 +++*/
+                    //    /*if (strcmp((char *)ShmOCPP16Data->StopTransaction[gun_index].StopReason, "") == EQUAL)
+                    //        strcpy((char *)ShmOCPP16Data->StopTransaction[gun_index].StopReason, "Local");*/
+                    //    /*--- 20200908, vern, disable it for DD360 ---*/
+                    //}
+
+                    if (chargingInfo[gun_index]->GroundFaultStatus == GFD_FAIL) {
+                        // GFD 錯誤停止
+                        RecordAlarmCode(gun_index, "012234");
+                    } else if (chargingInfo[gun_index]->GroundFaultStatus == GFD_WARNING) {
+                        // GFD 警告
+                        RecordWarningCode(gun_index, "012296");
+                    }
+
+                    //if (isEvStopCharging_chademo(gun_index) == YES ||
+                    //        isPrechargeStatus_chademo(gun_index) <= 0) {
+                    //    setChargerMode(gun_index, MODE_COMPLETE);
+                    //}
+                } else if (chargingInfo[gun_index]->Type == _Type_GB) {
+                    log_info("************ GB lock Status = %d, status = %d \n", isEvStopCharging_gb(gun_index), isPrechargeStatus_gb(gun_index));
+                    // 非車端的停止 : 需等待小板送出停止指令，讓車端解除槍
+                    //if (isEvStopCharging_chademo(gun_index) == YES) {
+                    //    /*+++ 20200908, vern, disable it for DD360 +++*/
+                    //    /*if (strcmp((char *)ShmOCPP16Data->StopTransaction[gun_index].StopReason, "") == EQUAL)
+                    //            strcpy((char *)ShmOCPP16Data->StopTransaction[gun_index].StopReason, "Local");*/
+                    //    /*--- 20200908, vern, disable it for DD360 ---*/
+                    //}
+
+                    if (chargingInfo[gun_index]->GroundFaultStatus == GFD_FAIL) {
+                        // GFD 錯誤停止
+                        RecordAlarmCode(gun_index, "012236");
+                    } else if (chargingInfo[gun_index]->GroundFaultStatus == GFD_WARNING) {
+                        // GFD 警告
+                        RecordWarningCode(gun_index, "012298");
+                    }
+
+                    //if (isEvStopCharging_gb(gun_index) == YES ||
+                    //        isPrechargeStatus_gb(gun_index) <= 0) {
+                    //    setChargerMode(gun_index, MODE_COMPLETE);
+                    //}
+                } else if (chargingInfo[gun_index]->Type == _Type_CCS_2) {
+                    // 非車端的停止 : 需等待小板送出停止指令，讓車端解除槍
+                    //if (isEvStopCharging_chademo(gun_index) == YES) {
+                    //    /*+++ 20200908, vern, disable it for DD360 +++*/
+                    //    /*if (strcmp((char *)ShmOCPP16Data->StopTransaction[gun_index].StopReason, "") == EQUAL)
+                    //            strcpy((char *)ShmOCPP16Data->StopTransaction[gun_index].StopReason, "Local");*/
+                    //    /*--- 20200908, vern, disable it for DD360 ---*/
+                    //}
+
+                    if (chargingInfo[gun_index]->GroundFaultStatus == GFD_FAIL) {
+                        // GFD 錯誤停止
+                        RecordAlarmCode(gun_index, "012235");
+                    } else if (chargingInfo[gun_index]->GroundFaultStatus == GFD_WARNING) {
+                        // GFD 警告
+                        RecordWarningCode(gun_index, "012297");
+                    }
+
+                    //if (isEvStopCharging_ccs(gun_index) == YES &&
+                    //        (isPrechargeStatus_ccs(gun_index) >= 53 || isPrechargeStatus_ccs(gun_index) == 0 ||
+                    //         isPrechargeStatus_ccs(gun_index) == 13 || isPrechargeStatus_ccs(gun_index) == 14)) {
+                    //    setChargerMode(gun_index, MODE_COMPLETE);
+                    //}
+                }
+
+                if (chargingInfo[gun_index]->SystemStatus == S_ALARM) {
+                    if (chargingInfo[gun_index]->ConnectorPlugIn == NO &&
+                            GetTimeoutValue(chargingInfo[gun_index]->TimeoutTimer) >= 10000000) {
+                        setChargerMode(gun_index, MODE_IDLE);
+                    }
+                } else {
+                    if (chargingInfo[gun_index]->Type == _Type_Chademo) {
+                        if (isEvStopCharging_chademo(gun_index) == YES ||
+                                isPrechargeStatus_chademo(gun_index) <= 0) {
+                            setChargerMode(gun_index, MODE_COMPLETE);
+                        }
+                    } else if (chargingInfo[gun_index]->Type == _Type_GB) {
+                        if (isEvStopCharging_gb(gun_index) == YES ||
+                                isPrechargeStatus_gb(gun_index) <= 0) {
+                            setChargerMode(gun_index, MODE_COMPLETE);
+                        }
+                    } else if (chargingInfo[gun_index]->Type == _Type_CCS_2) {
+                        if (isEvStopCharging_ccs(gun_index) == YES &&
+                                (isPrechargeStatus_ccs(gun_index) >= 53 || isPrechargeStatus_ccs(gun_index) == 0 ||
+                                 isPrechargeStatus_ccs(gun_index) == 13 || isPrechargeStatus_ccs(gun_index) == 14)) {
+                            setChargerMode(gun_index, MODE_COMPLETE);
+                        }
+                    }
+                }
+
+                // 車端的停止
+                //if (strcmp((char *)ShmOCPP16Data->StopTransaction[gun_index].StopReason, "") == EQUAL) {
+                //    strcpy((char *)ShmOCPP16Data->StopTransaction[gun_index].StopReason, "EVDisconnected");
+                //}
+
+                if (ShmSysConfigAndInfo->SysInfo.CurGunSelected == gun_index) {
+                    ShmSysConfigAndInfo->SysInfo.ConnectorPage = _LCM_COMPLETE;
+                    // ShmSysConfigAndInfo->SysInfo.SystemPage = _LCM_NONE;
+                }
+            }
+            break;
+            case S_COMPLETE: {
+                if (isModeChange(gun_index)) {
+                    PRINTF_FUNC ("complete......................... %x \n", gun_index);
+                    if (strcmp((char *)chargingInfo[gun_index]->StartDateTime, "") != EQUAL) {
+                        OcppStopTransation(gun_index);
+                    }
+
+                    TheEndCharging(gun_index);
+                    //ftime(&endChargingTime[gun_index]);
+                    //if (chargingInfo[gun_index]->PresentChargedDuration != 0) {
+                    //    chargingInfo[gun_index]->PresentChargedDuration = DiffTimeb(startChargingTime[gun_index], endChargingTime[gun_index]);
+                    //}
+
+                    //StopGunInfoTimeoutDet(gun_index);
+                    //StartGunInfoTimeoutDet(gun_index, Timeout_EvseCompleteDet);
+                    //ChangeStartOrStopDateTime(NO, gun_index);
+                }
+
+                //if (((chargingInfo[gun_index]->ConnectorPlugIn == NO) ||
+                //        (restartFlag == 1)) &&
+                //        (GetTimeoutValue(chargingInfo[gun_index]->TimeoutTimer) >= 10000000)) {
+                //    setChargerMode(gun_index, MODE_IDLE);
+                //    destroySelGun(gun_index); //Jerry add
+                //}
+
+                if (chargingInfo[gun_index]->ConnectorPlugIn == NO &&
+                        GetTimeoutValue(chargingInfo[gun_index]->TimeoutTimer) >= 10000000) {
+                    setChargerMode(gun_index, MODE_IDLE);
+#if defined DD360Audi
+                    destroySelGun(gun_index); //Jerry add
+#endif //defined DD360Audi
+                }
+
+                if (ShmSysConfigAndInfo->SysInfo.CurGunSelected == gun_index) {
+                    ShmSysConfigAndInfo->SysInfo.ConnectorPage = _LCM_COMPLETE;
+                    // ShmSysConfigAndInfo->SysInfo.SystemPage = _LCM_NONE;
+                }
+            }
+            break;
+            case S_CCS_PRECHARGE_ST0: {
+                if (isModeChange(gun_index)) {
+                    PRINTF_FUNC("CCS Precharge Processing 1....................%x \n", gun_index);
+                    StopGunInfoTimeoutDet(gun_index);
+                    StartGunInfoTimeoutDet(gun_index, Timeout_ForCcsPrechargeDet);
+                }
+
+                if (chargingInfo[gun_index]->GroundFaultStatus == GFD_FAIL) {
+                    // GFD 錯誤停止
+                    RecordAlarmCode(gun_index, "012235");
+                }
+
+                if ((evBoardStopState = isEvBoardStopChargeFlag(gun_index)) > 0) {
+                    // 板端要求停止 (錯誤)
+                    if (evBoardStopState == EV_BOARD_STOP_CHARGING) {
+                        ChargingAlarmProcess(gun_index);
+                    } else if (evBoardStopState == POWER_CABINET_STOP_CHARGING) {
+                        ChargingTerminalProcess(gun_index);
+                    }
+                } else if (isEvBoardNormalStopChargeFlag(gun_index) == YES) {
+                    // 板端要求停止 (正常)
+                    ChargingTerminalProcess(gun_index);
+                } else if (OcppRemoteStop(gun_index) == YES ||
+                           WifiScheduleStop(gun_index)) {
+                    // 後臺要求停止
+                    ChargingTerminalProcess(gun_index);
+                }
+
+                // 等待 EV 小板 (CCS) 通知可以開始 Precharge
+                // 切換 D+ Relay to Precharge Relay
+                if (isPrechargeStatus_ccs(gun_index) == 39 || isPrechargeStatus_ccs(gun_index) == 40) {
+                    if (chargingInfo[gun_index]->RelayKPK2Status == YES && chargingInfo[gun_index]->PrechargeStatus != PRECHARGE_READY)
+                        //if (chargingInfo[gun_index]->PrechargeStatus != PRECHARGE_PRERELAY_PASS)
+                    {
+                        //PRINTF_FUNC("Send precharge ready 1..........%x, status = %d \n", gun_index, isPrechargeStatus_ccs(gun_index));
+                        if (isPrechargeStatus_ccs(gun_index) == 39) {
+                            PRINTF_FUNC("Conn %x, Precharge ready, CCS status = PreChargeResponse (%d) \n", gun_index, isPrechargeStatus_ccs(gun_index));
+                        } else if (isPrechargeStatus_ccs(gun_index) == 40) {
+                            PRINTF_FUNC("Conn %x, Precharge ready, CCS status = PowerDeliveryRequest start (%d) \n", gun_index, isPrechargeStatus_ccs(gun_index));
+                        }
+
+                        chargingInfo[gun_index]->PrechargeStatus = PRECHARGE_READY;
+                    }
+                } else if (isPrechargeStatus_ccs(gun_index) == 45 || isPrechargeStatus_ccs(gun_index) == 46) {
+                    setChargerMode(gun_index, MODE_CCS_PRECHARGE_STEP1);
+                }
+
+                if (ShmSysConfigAndInfo->SysInfo.CurGunSelected == gun_index) {
+                    ShmSysConfigAndInfo->SysInfo.ConnectorPage = _LCM_PRE_CHARGE;
+                    // ShmSysConfigAndInfo->SysInfo.SystemPage = _LCM_NONE;
+                }
+                break;
+            }
+            case S_CCS_PRECHARGE_ST1: {
+                if (isModeChange(gun_index)) {
+                    log_info("CCS Precharge Processing 2....................%x \n", gun_index);
+                }
+
+                if (chargingInfo[gun_index]->GroundFaultStatus == GFD_FAIL) {
+                    // GFD 錯誤停止
+                    RecordAlarmCode(gun_index, "012235");
+                }
+
+                if ((evBoardStopState = isEvBoardStopChargeFlag(gun_index)) > 0) {
+                    // 板端要求停止 (錯誤)
+                    if (evBoardStopState == EV_BOARD_STOP_CHARGING) {
+                        ChargingAlarmProcess(gun_index);
+                    } else if (evBoardStopState == POWER_CABINET_STOP_CHARGING) {
+                        ChargingTerminalProcess(gun_index);
+                    }
+
+                } else if (isEvBoardNormalStopChargeFlag(gun_index) == YES) {
+                    // 板端要求停止 (正常)
+                    ChargingTerminalProcess(gun_index);
+                } else if (OcppRemoteStop(gun_index) == YES ||
+                           WifiScheduleStop(gun_index)) {
+                    // 後臺要求停止
+                    ChargingTerminalProcess(gun_index);
+                }
+
+                // 等待小板通知進入充電
+                // 切換 D+ Relay to Precharge Relay
+                if (chargingInfo[gun_index]->RelayK1K2Status == YES) {
+                    chargingInfo[gun_index]->PrechargeStatus = PRECHARGE_READY;
+                    setChargerMode(gun_index, MODE_CHARGING);
+                }
+
+                if (ShmSysConfigAndInfo->SysInfo.CurGunSelected == gun_index) {
+                    ShmSysConfigAndInfo->SysInfo.ConnectorPage = _LCM_PRE_CHARGE;
+                    // ShmSysConfigAndInfo->SysInfo.SystemPage = _LCM_NONE;
+                }
+                break;
+            }
+            }
+        }
+
+#if defined DD360Audi
+        if (ShmSysConfigAndInfo->SysInfo.SystemPage != _LCM_SELECT_GUN) {
+#else
+        if (ShmSysConfigAndInfo->SysInfo.SystemPage != _LCM_NONE) {
+#endif //defined DD360Audi
+            ChangeLcmByIndex(ShmSysConfigAndInfo->SysInfo.SystemPage);
+        } else {
+            bool dcPageRun = false;
+            if (_acgunIndex > 0 && ShmSysConfigAndInfo->SysInfo.CurGunSelectedByAc != NO_DEFINE) {
+                if  (ac_chargingInfo[0]->SystemStatus == S_IDLE) {
+                    ChangeLcmByIndex(_LCM_IDLE);
+                } else if (ac_chargingInfo[0]->SystemStatus == S_PREPARNING) {
+                    ChangeLcmByIndex(_LCM_PRE_CHARGE);
+                } else if (ac_chargingInfo[0]->SystemStatus == S_CHARGING) {
+                    ChangeLcmByIndex(_LCM_CHARGING);
+                } else if (ac_chargingInfo[0]->SystemStatus == S_TERMINATING ||
+                           ac_chargingInfo[0]->SystemStatus == S_COMPLETE) {
+                    ChangeLcmByIndex(_LCM_COMPLETE);
+                } else {
+                    dcPageRun = true;
+                }
+            } else {
+                dcPageRun = true;
+            }
+
+            if (dcPageRun) {
+                ChangeLcmByIndex(ShmSysConfigAndInfo->SysInfo.ConnectorPage);
+            }
+        }
+
+        write(wtdFd, "a", 1);
+        usleep(whileLoopTime);
+    }
+
+    return FAIL;
+}

EVSE/Projects/DD360ComBox/Apps/ReModule_EvComm.c

@@ -0,0 +1,3484 @@
+#include <sys/time.h>
+#include <sys/timeb.h>
+#include <sys/types.h>
+#include <sys/stat.h>
+#include <sys/types.h>
+#include <sys/ioctl.h>
+#include <sys/socket.h>
+#include <sys/ipc.h>
+#include <sys/shm.h>
+#include <sys/shm.h>
+#include <sys/mman.h>
+#include <linux/can.h>
+#include <linux/can/raw.h>
+#include <linux/wireless.h>
+#include <arpa/inet.h>
+#include <netinet/in.h>
+
+#include <unistd.h>
+#include <stdarg.h>
+#include <stdio.h>      /*標準輸入輸出定義*/
+#include <stdlib.h>     /*標準函數庫定義*/
+#include <unistd.h>     /*Unix 標準函數定義*/
+#include <fcntl.h>      /*檔控制定義*/
+#include <termios.h>    /*PPSIX 終端控制定義*/
+#include <errno.h>      /*錯誤號定義*/
+#include <errno.h>
+#include <string.h>
+#include <time.h>
+#include <ctype.h>
+#include <ifaddrs.h>
+
+#include "../../define.h"
+#include "Module_EvComm.h"
+#include "Config.h"
+
+#define ARRAY_SIZE(A)       (sizeof(A) / sizeof(A[0]))
+#define PASS                1
+#define FAIL                -1
+#define START               1
+#define STOP                0
+#define COMMUNICATION       2
+#define YES                 1
+#define NO                  0
+#define EQUAL               0
+#define CHK_VOL_RANGE       50
+#define CHK_CUR_RANGE       20
+#define PLUG                1
+#define UNPLUG              0
+
+struct SysConfigAndInfo         *ShmSysConfigAndInfo;
+struct StatusCodeData           *ShmStatusCodeData;
+struct FanModuleData            *ShmFanModuleData;
+struct CHAdeMOData              *ShmCHAdeMOData;
+struct GBTData                  *ShmGBTData;
+struct CcsData                  *ShmCcsData;
+struct PsuData                  *ShmPsuData;
+#if defined METER_ENABLE //DS60-120 add
+struct MeterInformation         *ShmCsuMeterData;
+struct DcCommonInformation      *ShmDcCommonData;
+#endif //defined METER_ENABLE
+
+byte gun_count;
+int chargingTime[CHAdeMO_QUANTITY + CCS_QUANTITY + GB_QUANTITY];
+//struct timeval _chk_ratingPower_timeout[CHAdeMO_QUANTITY + CCS_QUANTITY + GB_QUANTITY]; //DS60-120 remove
+
+float LogInfo[2][10]; //DS60-120 add
+
+//DS60-120 remove
+//float _pow_1 = 0;
+//float _cur_1 = 0;
+//float _pow_2 = 0;
+//float _cur_2 = 0;
+
+//float _outVol_1 = 0;
+//float _outCur_1 = 0;
+//float _outVol_2 = 0;
+//float _outCur_2 = 0;
+
+// 限制最大充電電壓，因應不同 type 槍線來限制
+// Chademo : 500V, 125A,
+// GB : 750, 120A
+// CCS : 950V, 120A
+//DS60-120 add
+double chademoVol = 5000;
+double ccsVol = 9500;
+double gbVol = 7500;
+float maxChargingVol[2] = { 0, 0 };         // 限制最大充電電壓，如依照模塊則填上 0
+// 限制最大充電電流與能量透過 Web
+float maxChargingCur[2] = { 0, 0 };         // 限制最大充電電流，如依照模塊則填上 0
+float maxChargingPow = 0;                   // 限制最大充電能量，如依照模塊則填上 0
+//float maxChargingVol[2] = { 9500, 9500 };           // 限制最大充電電壓，如依照模塊則填上 0
+//// 限制最大充電電流與能量透過 Web
+//float maxChargingCur[2] = { 5000, 2000 };           // 限制最大充電電流，如依照模塊則填上 0
+//float maxChargingPow = 0;                           // 限制最大充電能量，如依照模塊則填上 0
+
+// 槍資訊
+struct ChargingInfoData *_chargingData[CHAdeMO_QUANTITY + CCS_QUANTITY + GB_QUANTITY];
+//DS60-120 add
+struct timeval _chk_ratingPower_timeout[CHAdeMO_QUANTITY + CCS_QUANTITY + GB_QUANTITY];
+struct timeval _chk_chademo_permission_timeout[CHAdeMO_QUANTITY + CCS_QUANTITY + GB_QUANTITY];
+bool chkChademoPermission[2] = { false, false };
+byte SendErrorCount[2] = { 0, 0};
+
+struct Ev_Board_Cmd Ev_Cmd = {
+    0,
+    0x00000200,
+    0x00000400,
+    0x00000500,
+    0x00000600,
+    0x00000700,
+    0x00000800,
+    0x00000900,
+    0x00000A00,
+    0x00000C00,
+    0x00000D00,
+
+    0x00000E00,
+    0x00000F00,
+    0x00001000,
+    0x00001100,
+
+    0x00001200,
+    0x00001400,
+    0x00001500,
+};
+
+unsigned char mask_table[] = { 0x01, 0x02, 0x04, 0x08, 0x10, 0x20, 0x40, 0x80 };
+
+void PRINTF_FUNC(char *string, ...);
+
+void GetMaxVolAndCurMethod(byte index, float *vol, float *cur);
+void GetMaxPowerMethod(byte index, float *pow);
+unsigned long GetTimeoutValue(struct timeval _sour_time);
+
+#define DEBUG_INFO(format, args...) StoreLogMsg("[%s:%d][%s][Info] "format, __FILE__, __LINE__, __FUNCTION__, ##args)
+#define DEBUG_WARN(format, args...) StoreLogMsg("[%s:%d][%s][Warn] "format, __FILE__, __LINE__, __FUNCTION__, ##args)
+#define DEBUG_ERROR(format, args...) StoreLogMsg("[%s:%d][%s][Error] "format, __FILE__, __LINE__, __FUNCTION__, ##args)
+
+unsigned long GetTimeoutValue(struct timeval _sour_time)
+{
+    struct timeval _end_time;
+    gettimeofday(&_end_time, NULL);
+
+    return 1000000 * (_end_time.tv_sec - _sour_time.tv_sec) + _end_time.tv_usec - _sour_time.tv_usec;
+}
+
+int StoreLogMsg(const char *fmt, ...)
+{
+    char Buf[4096 + 256];
+    char buffer[4096];
+    va_list args;
+    struct timeb  SeqEndTime;
+    struct tm *tm;
+
+    va_start(args, fmt);
+    int rc = vsnprintf(buffer, sizeof(buffer), fmt, args);
+    va_end(args);
+
+    memset(Buf, 0, sizeof(Buf));
+    ftime(&SeqEndTime);
+    SeqEndTime.time = time(NULL);
+    tm = localtime(&SeqEndTime.time);
+
+    if (ShmSysConfigAndInfo->SysConfig.SwitchDebugFlag == YES) {
+        sprintf(Buf, "%02d:%02d:%02d:%03d - %s",
+                tm->tm_hour, tm->tm_min, tm->tm_sec, SeqEndTime.millitm, buffer);
+        printf("%s \n", Buf);
+    } else {
+        sprintf(Buf, "echo \"%04d-%02d-%02d %02d:%02d:%02d:%03d - %s\" >> /Storage/SystemLog/[%04d.%02d]SystemLog",
+                tm->tm_year + 1900, tm->tm_mon + 1, tm->tm_mday, tm->tm_hour, tm->tm_min, tm->tm_sec, SeqEndTime.millitm,
+                buffer,
+                tm->tm_year + 1900, tm->tm_mon + 1);
+        system(Buf);
+    }
+
+    return rc;
+}
+
+int DiffTimeb(struct timeb ST, struct timeb ET)
+{
+    //return milli-second
+    unsigned int StartTime, StopTime;
+
+    StartTime = (unsigned int)ST.time;
+    StopTime = (unsigned int)ET.time;
+    return (StopTime - StartTime) * 1000 + ET.millitm - ST.millitm;
+}
+
+void PRINTF_FUNC(char *string, ...)
+{
+    va_list args;
+    char buffer[4096];
+    va_start(args, string);
+    vsnprintf(buffer, sizeof(buffer), string, args);
+    va_end(args);
+
+    DEBUG_INFO("%s \n", buffer);
+}
+
+//=================================
+// Common routine
+//=================================
+void getTimeString(char *buff)
+{
+    time_t timep;
+    struct tm *p;
+    time(&timep);
+    p = gmtime(&timep);
+
+    sprintf(buff, "[%04d-%02d-%02d %02d:%02d:%02d]", (1900 + p->tm_year), (1 + p->tm_mon), p->tm_mday, p->tm_hour, p->tm_hour, p->tm_sec);
+}
+
+bool CheckUniqNumber(byte value)
+{
+    for (byte index = 0; index < gun_count; index++) {
+        if (_chargingData[index]->Evboard_id == value) {
+            struct timeval _end_time;
+            gettimeofday(&_end_time, NULL);
+            unsigned long diff = 1000000 *  (_end_time.tv_sec - _id_assign_time.tv_sec) + _end_time.tv_usec - _id_assign_time.tv_usec;
+            if (diff >= 3000000) {
+                gettimeofday(&_id_assign_time, NULL);
+                return true;
+            } else {
+                return false;
+            }
+        }
+    }
+
+    gettimeofday(&_id_assign_time, NULL);
+    return true;
+}
+
+//==========================================
+// Init all share memory
+//==========================================
+int InitShareMemory()
+{
+    int result = PASS;
+    int MeterSMId;
+
+    //initial ShmSysConfigAndInfo
+    if ((MeterSMId = shmget(ShmSysConfigAndInfoKey, sizeof(struct SysConfigAndInfo),  0777)) < 0) {
+        result = FAIL;
+    } else if ((ShmSysConfigAndInfo = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+        result = FAIL;
+    }
+
+    //initial ShmStatusCodeData
+    if ((MeterSMId = shmget(ShmStatusCodeKey, sizeof(struct StatusCodeData),  0777)) < 0) {
+        result = FAIL;
+    } else if ((ShmStatusCodeData = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+        result = FAIL;
+    }
+
+    //creat ShmPsuData
+    if ((MeterSMId = shmget(ShmPsuKey, sizeof(struct PsuData),  0777)) < 0) { //DS60-120 add
+        result = FAIL;
+    } else if ((ShmPsuData = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+        result = FAIL;
+    }
+
+    if (CHAdeMO_QUANTITY > 0) {
+        if ((MeterSMId = shmget(ShmCHAdeMOCommKey, sizeof(struct CHAdeMOData),  IPC_CREAT | 0777)) < 0) {
+            return FAIL;
+        } else if ((ShmCHAdeMOData = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+            return FAIL;
+        }
+    }
+
+    if (GB_QUANTITY > 0) {
+        if ((MeterSMId = shmget(ShmGBTCommKey, sizeof(struct GBTData),  IPC_CREAT | 0777)) < 0) {
+            return FAIL;
+        } else if ((ShmGBTData = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+            return FAIL;
+        }
+    }
+
+    if (CCS_QUANTITY > 0) {
+        if ((MeterSMId = shmget(ShmCcsCommKey, sizeof(struct CcsData),  IPC_CREAT | 0777)) < 0) {
+            return FAIL;
+        } else if ((ShmCcsData = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+            return FAIL;
+        }
+    }
+
+#if defined METER_ENABLE //DS60-120 add
+    if ((MeterSMId = shmget(ShmCsuMeterKey, sizeof(struct MeterInformation), IPC_CREAT | 0777)) < 0) {
+        return FAIL;
+    } else if ((ShmCsuMeterData = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+        return FAIL;
+    }
+
+    if ((MeterSMId = shmget(ShmCommonKey, sizeof(struct DcCommonInformation), IPC_CREAT | 0777)) < 0) {
+        return FAIL;
+    } else if ((ShmDcCommonData = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+        return FAIL;
+    }
+#endif //define METER_ENABLE
+
+    return result;
+}
+
+//================================================
+// initial can-bus
+//================================================
+int InitCanBus()
+{
+    int                     s0, nbytes;
+    struct timeval          tv;
+    struct ifreq            ifr0;
+    struct sockaddr_can     addr0;
+
+    system("/sbin/ip link set can0 down");
+    system("/sbin/ip link set can0 type can bitrate 500000 restart-ms 100");
+    system("/sbin/ip link set can0 up");
+
+    s0 = socket(PF_CAN, SOCK_RAW, CAN_RAW);
+
+    tv.tv_sec = 0;
+    tv.tv_usec = 10000;
+    if (setsockopt(s0, SOL_SOCKET, SO_RCVTIMEO, (char *)&tv, sizeof(struct  timeval)) < 0) {
+#ifdef SystemLogMessage
+        DEBUG_ERROR("Set SO_RCVTIMEO NG");
+#endif
+    }
+    nbytes = 40960;
+    if (setsockopt(s0, SOL_SOCKET,  SO_RCVBUF, &nbytes, sizeof(int)) < 0) {
+#ifdef SystemLogMessage
+        DEBUG_ERROR("Set SO_RCVBUF NG");
+#endif
+    }
+    nbytes = 40960;
+    if (setsockopt(s0, SOL_SOCKET, SO_SNDBUF, &nbytes, sizeof(int)) < 0) {
+#ifdef SystemLogMessage
+        DEBUG_ERROR("Set SO_SNDBUF NG");
+#endif
+    }
+
+    strcpy(ifr0.ifr_name, "can0" );
+    ioctl(s0, SIOCGIFINDEX, &ifr0); /* ifr.ifr_ifindex gets filled with that device's index */
+    addr0.can_family = AF_CAN;
+    addr0.can_ifindex = ifr0.ifr_ifindex;
+    bind(s0, (struct sockaddr *)&addr0, sizeof(addr0));
+    return s0;
+}
+
+//================================================
+//================================================
+// CANBUS receive task
+//================================================
+//================================================
+bool FindChargingInfoData(byte target, struct ChargingInfoData **chargingData)
+{
+    for (byte index = 0; index < CHAdeMO_QUANTITY; index++) {
+        if (ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].Index == target) {
+            chargingData[target] = &ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index];
+            return true;
+        }
+    }
+
+    for (byte index = 0; index < CCS_QUANTITY; index++) {
+        if (ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].Index == target) {
+            chargingData[target] = &ShmSysConfigAndInfo->SysInfo.CcsChargingData[index];
+            return true;
+        }
+    }
+
+    for (byte index = 0; index < GB_QUANTITY; index++) {
+        if (ShmSysConfigAndInfo->SysInfo.GbChargingData[index].Index == target) {
+            chargingData[target] = &ShmSysConfigAndInfo->SysInfo.GbChargingData[index];
+            return true;
+        }
+    }
+
+    return false;
+}
+
+void AddrAssignment(byte *data)
+{
+    byte target_number[8];
+    byte index = 0x00;
+
+    memcpy(target_number, data, sizeof(target_number));
+    index = *(data + 4);
+
+    if (gun_count == 1) {
+        index = 0x01;
+    }
+//  if (CheckUniqNumber(index))
+    {
+        //DS60-120 add
+        if (_chargingData[index - 1]->Type == _Type_Chademo) {
+            PRINTF_FUNC("Set EV board info : (Chademo) TargetAddr = %d \n", index);
+        } else if (_chargingData[index - 1]->Type == _Type_CCS_2) {
+            PRINTF_FUNC("Set EV board info : (CCS) TargetAddr = %d \n", index);
+        } else if (_chargingData[index - 1]->Type == _Type_GB) {
+            PRINTF_FUNC("Set EV board info : (GB) TargetAddr = %d \n", index);
+        }
+        //PRINTF_FUNC("EV board id = %x \n", index); //DS60-120 remove
+
+//      PRINTF_FUNC("target_number[0] = %x \n", target_number[0]);
+//      PRINTF_FUNC("target_number[1] = %x \n", target_number[1]);
+//      PRINTF_FUNC("target_number[2] = %x \n", target_number[2]);
+//      PRINTF_FUNC("target_number[3] = %x \n", target_number[3]);
+//      PRINTF_FUNC("target_number[4] = %x \n", target_number[4]);
+
+        PRINTF_FUNC("SetTargetAddr = %d, type = %d \n", index, _chargingData[index - 1]->Type);
+        SetTargetAddr(target_number, index);
+    }
+}
+
+void ClearAbnormalStatus_Chademo(byte gun_index)
+{
+    bool isCleanCheck = false;
+    char code[7];
+
+    if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "", 6) == EQUAL) {
+        return;
+    }
+
+    if (true) {
+        if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023700", 6) == EQUAL &&
+                ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoEvCommFail == YES) {
+            memcpy(code, "023700", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023704", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBatteryMalfun == YES) {
+            memcpy(code, "023704", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023705", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoNoPermission == YES) {
+            memcpy(code, "023705", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023706", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBatteryIncompatibility == YES) {
+            memcpy(code, "023706", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023707", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBatteryOVP == YES) {
+            memcpy(code, "023707", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023708", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBatteryUVP == YES) {
+            memcpy(code, "023708", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023709", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBatteryOTP == YES) {
+            memcpy(code, "023709", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023710", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBatteryCurrentDiff == YES) {
+            memcpy(code, "023710", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023711", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBatteryVoltageDiff == YES) {
+            memcpy(code, "023711", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023712", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoShiftPosition == YES) {
+            memcpy(code, "023712", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023713", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBatteryOtherFault == YES) {
+            memcpy(code, "023713", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023714", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoChargingSystemError == YES) {
+            memcpy(code, "023714", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023715", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoEvNormalStop == YES) {
+            memcpy(code, "023715", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023716", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoTempSensorBroken == YES) {
+            memcpy(code, "023716", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023717", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoConnectorLockFail == YES) {
+            memcpy(code, "023717", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023718", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoD1OnNoReceive == YES) {
+            memcpy(code, "023718", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023719", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBmsKtoJTimeout == YES) {
+            memcpy(code, "023719", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023720", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBmsChargeAllowTimeout == YES) {
+            memcpy(code, "023720", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023721", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoWaitGfdTimeout == YES) {
+            memcpy(code, "023721", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023722", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBmsEvRelayTimeout == YES) {
+            memcpy(code, "023722", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023723", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBmsReqCurrentTimeout == YES) {
+            memcpy(code, "023723", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023724", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBmsKtoJOffTimeout == YES) {
+            memcpy(code, "023724", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023725", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBmsEvRelayOffTimeout == YES) {
+            memcpy(code, "023725", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023726", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoAdcMoreThan10V == YES) {
+            memcpy(code, "023726", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023727", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoAdcMoreThan20V == YES) {
+            memcpy(code, "023727", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023728", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBmsChargeBeforeStop == YES) {
+            memcpy(code, "023728", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023729", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoChargerGetNormalStop == YES) {
+            memcpy(code, "023729", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023730", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoChargerGetEmergencyStop == YES) {
+            memcpy(code, "023730", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023731", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoIsolationResultFail == YES) {
+            memcpy(code, "023731", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023732", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoMissLinkWithMotherBoard == YES) {
+            memcpy(code, "023732", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023733", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoOutputVolMoreThanLimit == YES) {
+            memcpy(code, "023733", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023734", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoReqCurrentMoreThanLimit == YES) {
+            memcpy(code, "023734", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023735", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoReCapBmsEqrCurrentExceed == YES) {
+            memcpy(code, "023735", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023736", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoChargeRemainCountDown == YES) {
+            memcpy(code, "023736", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        }
+    }
+
+    if (isCleanCheck) {
+        for (byte index = 0; index < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; index++) {
+            if (index != gun_index || ShmSysConfigAndInfo->SysConfig.TotalConnectorCount == 1) {
+                PRINTF_FUNC("CHA clean error : index = %d, EvConnAlarmCode = %s, code = %s \n", index, _chargingData[index]->EvConnAlarmCode, code);
+                if (strncmp((char *)_chargingData[index]->EvConnAlarmCode, code, 6) != EQUAL) {
+                    if (strncmp(code, "023700", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoEvCommFail = NO; }
+                    if (strncmp(code, "023704", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBatteryMalfun = NO; }
+                    if (strncmp(code, "023705", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoNoPermission = NO; }
+                    if (strncmp(code, "023706", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBatteryIncompatibility = NO; }
+                    if (strncmp(code, "023707", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBatteryOVP = NO; }
+                    if (strncmp(code, "023708", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBatteryUVP = NO; }
+                    if (strncmp(code, "023709", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBatteryOTP = NO; }
+                    if (strncmp(code, "023710", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBatteryCurrentDiff = NO; }
+                    if (strncmp(code, "023711", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBatteryVoltageDiff = NO; }
+                    if (strncmp(code, "023712", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoShiftPosition = NO; }
+                    if (strncmp(code, "023713", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBatteryOtherFault = NO; }
+                    if (strncmp(code, "023714", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoChargingSystemError = NO; }
+                    if (strncmp(code, "023715", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoEvNormalStop = NO; }
+                    if (strncmp(code, "023716", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoTempSensorBroken = NO; }
+                    if (strncmp(code, "023717", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoConnectorLockFail = NO; }
+                    if (strncmp(code, "023718", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoD1OnNoReceive = NO; }
+                    if (strncmp(code, "023719", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBmsKtoJTimeout = NO; }
+                    if (strncmp(code, "023720", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBmsChargeAllowTimeout = NO; }
+                    if (strncmp(code, "023721", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoWaitGfdTimeout = NO; }
+                    if (strncmp(code, "023722", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBmsEvRelayTimeout = NO; }
+                    if (strncmp(code, "023723", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBmsReqCurrentTimeout = NO; }
+                    if (strncmp(code, "023724", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBmsKtoJOffTimeout = NO; }
+                    if (strncmp(code, "023725", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBmsEvRelayOffTimeout = NO; }
+                    if (strncmp(code, "023726", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoAdcMoreThan10V = NO; }
+                    if (strncmp(code, "023727", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoAdcMoreThan20V = NO; }
+                    if (strncmp(code, "023728", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBmsChargeBeforeStop = NO; }
+                    if (strncmp(code, "023729", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoChargerGetNormalStop = NO; }
+                    if (strncmp(code, "023730", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoChargerGetEmergencyStop = NO; }
+                    if (strncmp(code, "023731", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoIsolationResultFail = NO; }
+                    if (strncmp(code, "023732", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoMissLinkWithMotherBoard = NO; }
+                    if (strncmp(code, "023733", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoOutputVolMoreThanLimit = NO; }
+                    if (strncmp(code, "023734", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoReqCurrentMoreThanLimit = NO; }
+                    if (strncmp(code, "023735", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoReCapBmsEqrCurrentExceed = NO; }
+                    if (strncmp(code, "023736", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoChargeRemainCountDown = NO; }
+                }
+            }
+        }
+    }
+}
+
+void ClearAbnormalStatus_GB(byte gun_index)
+{
+    bool isCleanCheck = false;
+    char code[7];
+
+    if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "", 6) == EQUAL) {
+        return;
+    }
+
+    if (true) {
+        if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023702", 6) == EQUAL &&
+                ShmStatusCodeData->InfoCode.InfoEvents.bits.GbEvCommFail == YES) {
+            memcpy(code, "023702", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023900", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_LOS_CC1 == YES) {
+            memcpy(code, "023900", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023901", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_CONNECTOR_LOCK_FAIL == YES) {
+            memcpy(code, "023901", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023902", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_BATTERY_INCOMPATIBLE == YES) {
+            memcpy(code, "023902", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023903", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_BMS_BROAA_TIMEOUT == YES) {
+            memcpy(code, "023903", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023904", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_CSU_PRECHARGE_TIMEOUT == YES) {
+            memcpy(code, "023904", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023905", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_BMS_PRESENT_VOLTAGE_FAULT == YES) {
+            memcpy(code, "023905", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023906", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_BMS_VOLTAGE_OVER_RANGE == YES) {
+            memcpy(code, "023906", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023907", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_BSM_CHARGE_ALLOW_00_10MIN_COUUNTDONE == YES) {
+            memcpy(code, "023907", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023908", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_WAIT_GROUNDFAULT_TIMEOUT == YES) {
+            memcpy(code, "023908", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023909", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_ADC_MORE_THAN_10V == YES) {
+            memcpy(code, "023909", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023910", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_ADC_MORE_THAN_60V == YES) {
+            memcpy(code, "023910", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023911", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_CHARGER_GET_NORMAL_STOP_CMD == YES) {
+            memcpy(code, "023911", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023912", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_CHARGER_GET_EMERGENCY_STOP_CMD == YES) {
+            memcpy(code, "023912", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023913", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_ISOLATION_RESULT_FAIL == YES) {
+            memcpy(code, "023913", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023914", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_MOTHER_BOARD_MISS_LINK == YES) {
+            memcpy(code, "023914", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023915", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_OUTPUT_VOLTAGE_MORE_THAN_LIMIT == YES) {
+            memcpy(code, "023915", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023916", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_REQ_CURRENT_MORE_THAN_LIMIT == YES) {
+            memcpy(code, "023916", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023917", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_OUTPUT_VOLTAGE_MORE_THAN_10_PERCENT == YES) {
+            memcpy(code, "023917", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023918", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_OUTPUT_VOLTAGE_DIFF_BCS_5_PERCENT == YES) {
+            memcpy(code, "023918", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023919", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_STOP_ADC_MORE_THAN_10V == YES) {
+            memcpy(code, "023919", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023930", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_CEM_BHM_TIMEOUT == YES) {
+            memcpy(code, "023930", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023931", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_CEM_BRM_TIMEOUT == YES) {
+            memcpy(code, "023931", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023932", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_CEM_BCP_TIMEOUT == YES) {
+            memcpy(code, "023932", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023933", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_CEM_BRO_TIMEOUT == YES) {
+            memcpy(code, "023933", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023934", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_CEM_BCL_TIMEOUT == YES) {
+            memcpy(code, "023934", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023935", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_CEM_BCS_TIMEOUT == YES) {
+            memcpy(code, "023935", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023936", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_CEM_BSM_TIMEOUT == YES) {
+            memcpy(code, "023936", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023937", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_CEM_BST_TIMEOUT == YES) {
+            memcpy(code, "023937", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023938", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_CEM_BSD_TIMEOUT == YES) {
+            memcpy(code, "023938", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023939", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_CEM_BEM_OTHER_TIMEOUT == YES) {
+            memcpy(code, "023939", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023940", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BEM_CRM_TIMEOUT == YES) {
+            memcpy(code, "023940", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023941", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BEM_CRMAA_TIMEOUT == YES) {
+            memcpy(code, "023941", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023942", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BEM_CTS_CML_TIMEOUT == YES) {
+            memcpy(code, "023942", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023943", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BEM_CRO_TIMEOUT == YES) {
+            memcpy(code, "023943", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023944", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BEM_CCS_TIMEOUT == YES) {
+            memcpy(code, "023944", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023945", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BEM_CST_TIMEOUT == YES) {
+            memcpy(code, "023945", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023946", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BEM_CSD_TIMEOUT == YES) {
+            memcpy(code, "023946", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023947", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BEM_BEM_OTHER_TIMEOUT == YES) {
+            memcpy(code, "023947", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023950", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_SOC_GOAL == YES) {
+            memcpy(code, "023950", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023951", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_TOTAL_VOLTAGE_GOAL == YES) {
+            memcpy(code, "023951", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023952", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_CELL_VOLTAGE_GOAL == YES) {
+            memcpy(code, "023952", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023953", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_GET_CST == YES) {
+            memcpy(code, "023953", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023954", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_ISOLATION == YES) {
+            memcpy(code, "023954", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023955", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_OUTPUT_CONNECTOR_OTP == YES) {
+            memcpy(code, "023955", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023956", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_COMPONENT == YES) {
+            memcpy(code, "023956", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023957", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_CHARGE_CONNECTOR == YES) {
+            memcpy(code, "023957", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023958", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_OTP == YES) {
+            memcpy(code, "023958", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023959", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_OTHER == YES) {
+            memcpy(code, "023959", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023960", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_HIGH_V == YES) {
+            memcpy(code, "023960", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023961", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_CC2 == YES) {
+            memcpy(code, "023961", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023962", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_CURRENT == YES) {
+            memcpy(code, "023962", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023963", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_VOLTAGE == YES) {
+            memcpy(code, "023963", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023964", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GET_BST_NO_REASON == YES) {
+            memcpy(code, "023964", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023970", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BSM_CELL_OVER_VOLTAGE == YES) {
+            memcpy(code, "023970", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023971", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BSM_CELL_UNDER_VOLTAGE == YES) {
+            memcpy(code, "023971", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023972", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BSM_OVER_SOC == YES) {
+            memcpy(code, "023972", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023973", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BSM_UNDER_SOC == YES) {
+            memcpy(code, "023973", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023974", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BSM_CURRENT == YES) {
+            memcpy(code, "023974", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023975", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BSM_TEMPERATURE == YES) {
+            memcpy(code, "023975", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023976", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BSM_ISOLATE == YES) {
+            memcpy(code, "023976", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023977", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BSM_OUTPUT_CONNECTOR == YES) {
+            memcpy(code, "023977", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        }
+    }
+
+    if (isCleanCheck) {
+        for (byte index = 0; index < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; index++) {
+            if (index != gun_index || ShmSysConfigAndInfo->SysConfig.TotalConnectorCount == 1) {
+                PRINTF_FUNC("GBT clean error : index = %d, EvConnAlarmCode = %s, code = %s \n", index, _chargingData[index]->EvConnAlarmCode, code);
+                if (strncmp((char *)_chargingData[index]->EvConnAlarmCode, code, 6) != EQUAL) {
+                    if (strncmp(code, "023702", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.GbEvCommFail = NO; }
+                    if (strncmp(code, "023900", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_LOS_CC1 = NO; }
+                    if (strncmp(code, "023901", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_CONNECTOR_LOCK_FAIL = NO; }
+                    if (strncmp(code, "023902", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_BATTERY_INCOMPATIBLE = NO; }
+                    if (strncmp(code, "023903", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_BMS_BROAA_TIMEOUT = NO; }
+                    if (strncmp(code, "023904", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_CSU_PRECHARGE_TIMEOUT = NO; }
+                    if (strncmp(code, "023905", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_BMS_PRESENT_VOLTAGE_FAULT = NO; }
+                    if (strncmp(code, "023906", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_BMS_VOLTAGE_OVER_RANGE = NO; }
+                    if (strncmp(code, "023907", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_BSM_CHARGE_ALLOW_00_10MIN_COUUNTDONE = NO; }
+                    if (strncmp(code, "023908", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_WAIT_GROUNDFAULT_TIMEOUT = NO; }
+                    if (strncmp(code, "023909", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_ADC_MORE_THAN_10V = NO; }
+                    if (strncmp(code, "023910", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_ADC_MORE_THAN_60V = NO; }
+                    if (strncmp(code, "023911", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_CHARGER_GET_NORMAL_STOP_CMD = NO; }
+                    if (strncmp(code, "023912", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_CHARGER_GET_EMERGENCY_STOP_CMD = NO; }
+                    if (strncmp(code, "023913", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_ISOLATION_RESULT_FAIL = NO; }
+                    if (strncmp(code, "023914", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_MOTHER_BOARD_MISS_LINK = NO; }
+                    if (strncmp(code, "023915", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_OUTPUT_VOLTAGE_MORE_THAN_LIMIT = NO; }
+                    if (strncmp(code, "023916", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_REQ_CURRENT_MORE_THAN_LIMIT = NO; }
+                    if (strncmp(code, "023917", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_OUTPUT_VOLTAGE_MORE_THAN_10_PERCENT = NO; }
+                    if (strncmp(code, "023918", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_OUTPUT_VOLTAGE_DIFF_BCS_5_PERCENT = NO; }
+                    if (strncmp(code, "023919", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_STOP_ADC_MORE_THAN_10V = NO; }
+                    if (strncmp(code, "023930", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_CEM_BHM_TIMEOUT = NO; }
+                    if (strncmp(code, "023931", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_CEM_BRM_TIMEOUT = NO; }
+                    if (strncmp(code, "023932", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_CEM_BCP_TIMEOUT = NO; }
+                    if (strncmp(code, "023933", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_CEM_BRO_TIMEOUT = NO; }
+                    if (strncmp(code, "023934", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_CEM_BCL_TIMEOUT = NO; }
+                    if (strncmp(code, "023935", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_CEM_BCS_TIMEOUT = NO; }
+                    if (strncmp(code, "023936", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_CEM_BSM_TIMEOUT = NO; }
+                    if (strncmp(code, "023937", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_CEM_BST_TIMEOUT = NO; }
+                    if (strncmp(code, "023938", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_CEM_BSD_TIMEOUT = NO; }
+                    if (strncmp(code, "023939", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_CEM_BEM_OTHER_TIMEOUT = NO; }
+                    if (strncmp(code, "023940", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BEM_CRM_TIMEOUT = NO; }
+                    if (strncmp(code, "023941", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BEM_CRMAA_TIMEOUT = NO; }
+                    if (strncmp(code, "023942", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BEM_CTS_CML_TIMEOUT = NO; }
+                    if (strncmp(code, "023943", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BEM_CRO_TIMEOUT = NO; }
+                    if (strncmp(code, "023944", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BEM_CCS_TIMEOUT = NO; }
+                    if (strncmp(code, "023945", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BEM_CST_TIMEOUT = NO; }
+                    if (strncmp(code, "023946", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BEM_CSD_TIMEOUT = NO; }
+                    if (strncmp(code, "023947", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BEM_BEM_OTHER_TIMEOUT = NO; }
+                    if (strncmp(code, "023950", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_SOC_GOAL = NO; }
+                    if (strncmp(code, "023951", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_TOTAL_VOLTAGE_GOAL = NO; }
+                    if (strncmp(code, "023952", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_CELL_VOLTAGE_GOAL = NO; }
+                    if (strncmp(code, "023953", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_GET_CST = NO; }
+                    if (strncmp(code, "023954", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_ISOLATION = NO; }
+                    if (strncmp(code, "023955", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_OUTPUT_CONNECTOR_OTP = NO; }
+                    if (strncmp(code, "023956", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_COMPONENT = NO; }
+                    if (strncmp(code, "023957", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_CHARGE_CONNECTOR = NO; }
+                    if (strncmp(code, "023958", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_OTP = NO; }
+                    if (strncmp(code, "023959", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_OTHER = NO; }
+                    if (strncmp(code, "023960", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_HIGH_V = NO; }
+                    if (strncmp(code, "023961", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_CC2 = NO; }
+                    if (strncmp(code, "023962", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_CURRENT = NO; }
+                    if (strncmp(code, "023963", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_VOLTAGE = NO; }
+                    if (strncmp(code, "023964", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GET_BST_NO_REASON = NO; }
+                    if (strncmp(code, "023970", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BSM_CELL_OVER_VOLTAGE = NO; }
+                    if (strncmp(code, "023971", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BSM_CELL_UNDER_VOLTAGE = NO; }
+                    if (strncmp(code, "023972", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BSM_OVER_SOC = NO; }
+                    if (strncmp(code, "023973", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BSM_UNDER_SOC = NO; }
+                    if (strncmp(code, "023974", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BSM_CURRENT = NO; }
+                    if (strncmp(code, "023975", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BSM_TEMPERATURE = NO; }
+                    if (strncmp(code, "023976", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BSM_ISOLATE = NO; }
+                    if (strncmp(code, "023977", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BSM_OUTPUT_CONNECTOR = NO; }
+                }
+            }
+        }
+    }
+}
+
+void ClearAbnormalStatus_CCS(byte gun_index)
+{
+    bool isCleanCheck = false;
+    char code[7];
+
+    if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "", 6) == EQUAL) {
+        return;
+    }
+
+    if (true) {
+        if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "012219", 6) == EQUAL &&
+                ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemCcsOutputOVP == YES) {
+            memcpy(code, "012219", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023701", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsEvCommFail == YES) {
+            memcpy(code, "023701", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023737", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsRESTemperatureInhibit == YES) {
+            memcpy(code, "023737", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023738", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsEVShiftPosition == YES) {
+            memcpy(code, "023738", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023739", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsChargerConnectorLockFault == YES) {
+            memcpy(code, "023739", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023740", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsEVRESSMalfunction == YES) {
+            memcpy(code, "023740", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023741", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsChargingCurrentdifferential == YES) {
+            memcpy(code, "023741", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023742", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsChargingVoltageOutOfRange == YES) {
+            memcpy(code, "023742", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023743", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsChargingSystemIncompatibility == YES) {
+            memcpy(code, "023743", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023744", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsEmergencyEvent == YES) {
+            memcpy(code, "023744", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023745", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsBreaker == YES) {
+            memcpy(code, "023745", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023746", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsNoData == YES) {
+            memcpy(code, "023746", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023747", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.Ccsreserved_by_DIN_A == YES) {
+            memcpy(code, "023747", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023748", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.Ccsreserved_by_DIN_B == YES) {
+            memcpy(code, "023748", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023749", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.Ccsreserved_by_DIN_C == YES) {
+            memcpy(code, "023749", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023750", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.Ccsreserved_by_ISO_1 == YES) {
+            memcpy(code, "023750", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023751", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.Ccsreserved_by_ISO_2 == YES) {
+            memcpy(code, "023751", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023752", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.Ccsreserved_by_ISO_3 == YES) {
+            memcpy(code, "023752", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023753", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.Ccsreserved_by_OEM_1 == YES) {
+            memcpy(code, "023753", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023754", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.Ccsreserved_by_OEM_2 == YES) {
+            memcpy(code, "023754", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023755", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.Ccsreserved_by_OEM_3 == YES) {
+            memcpy(code, "023755", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023756", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.Ccsreserved_by_OEM_4 == YES) {
+            memcpy(code, "023756", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023757", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.Ccsreserved_by_OEM_5 == YES) {
+            memcpy(code, "023757", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023758", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsSequenceError == YES) {
+            memcpy(code, "023758", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023759", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsSignatureError == YES) {
+            memcpy(code, "023759", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023760", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsUnknownSession == YES) {
+            memcpy(code, "023760", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023761", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsServiceIDInvalid == YES) {
+            memcpy(code, "023761", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023762", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsPaymentSelectionInvalid == YES) {
+            memcpy(code, "023762", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023763", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsIdentificationSelectionInvalid == YES) {
+            memcpy(code, "023763", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023764", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsServiceSelectionInvalid == YES) {
+            memcpy(code, "023764", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023765", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCertificateExpired == YES) {
+            memcpy(code, "023765", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023766", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCertificateNotYetValid == YES) {
+            memcpy(code, "023766", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023767", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCertificateRevoked == YES) {
+            memcpy(code, "023767", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023768", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsNoCertificateAvailable == YES) {
+            memcpy(code, "023768", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023769", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCertChainError == YES) {
+            memcpy(code, "023769", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023770", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCertValidationError == YES) {
+            memcpy(code, "023770", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023771", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCertVerificationError == YES) {
+            memcpy(code, "023771", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023772", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsContractCanceled == YES) {
+            memcpy(code, "023772", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023773", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsChallengeInvalid == YES) {
+            memcpy(code, "023773", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023774", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsWrongEnergyTransferMode == YES) {
+            memcpy(code, "023774", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023775", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsWrongChargeParameter == YES) {
+            memcpy(code, "023775", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023776", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsChargingProfileInvalid == YES) {
+            memcpy(code, "023776", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023777", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTariffSelectionInvalid == YES) {
+            memcpy(code, "023777", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023778", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsEVSEPresentVoltageToLow == YES) {
+            memcpy(code, "023778", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023779", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsPowerDeliveryNotApplied == YES) {
+            memcpy(code, "023779", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023780", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsMeteringSignatureNotValid == YES) {
+            memcpy(code, "023780", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023781", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsNoChargeServiceSelected == YES) {
+            memcpy(code, "023781", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023782", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsContactorError == YES) {
+            memcpy(code, "023782", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023783", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCertificateNotAllowedAtThisEVSE == YES) {
+            memcpy(code, "023783", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023784", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsGAChargeStop == YES) {
+            memcpy(code, "023784", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023785", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsAlignmentError == YES) {
+            memcpy(code, "023785", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023786", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsACDError == YES) {
+            memcpy(code, "023786", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023787", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsAssociationError == YES) {
+            memcpy(code, "023787", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023788", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsEVSEChargeAbort == YES) {
+            memcpy(code, "023788", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023789", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsNoSupportedAppProtocol == YES) {
+            memcpy(code, "023789", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023790", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsContractNotAccepted == YES) {
+            memcpy(code, "023790", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023791", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsMOUnknown == YES) {
+            memcpy(code, "023791", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023792", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsOEM_Prov_CertificateRevoke == YES) {
+            memcpy(code, "023792", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023793", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsOEM_SubCA1_CertificateRevoked == YES) {
+            memcpy(code, "023793", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023794", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsOEM_SubCA2_CertificateRevoked == YES) {
+            memcpy(code, "023794", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023795", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsOEM_RootCA_CertificateRevoked == YES) {
+            memcpy(code, "023795", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023796", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsMO_Prov_CertificateRevoked == YES) {
+            memcpy(code, "023796", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023797", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsMO_SubCA1_CertificateRevoked == YES) {
+            memcpy(code, "023797", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023798", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsMO_SubCA2_CertificateRevoked == YES) {
+            memcpy(code, "023798", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023799", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsMO_RootCA_CertificateRevoked == YES) {
+            memcpy(code, "023799", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023800", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCPS_Prov_CertificateRevoked == YES) {
+            memcpy(code, "023800", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023801", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCPS_SubCA1_CertificateRevoked == YES) {
+            memcpy(code, "023801", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023802", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCPS_SubCA2_CertificateRevoked == YES) {
+            memcpy(code, "023802", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023803", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCPS_RootCA_CertificateRevoked == YES) {
+            memcpy(code, "023803", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023809", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_EVSE_SLAC_init == YES) {
+            memcpy(code, "023809", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023810", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_match_response == YES) {
+            memcpy(code, "023810", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023811", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_match_sequence == YES) {
+            memcpy(code, "023811", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023812", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_EVSE_match_MNBC == YES) {
+            memcpy(code, "023812", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023813", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_EVSE_avg_atten_calc == YES) {
+            memcpy(code, "023813", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023814", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_match_response == YES) {
+            memcpy(code, "023814", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023815", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_EVSE_match_session == YES) {
+            memcpy(code, "023815", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023816", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_EVSE_assoc_session == YES) {
+            memcpy(code, "023816", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023817", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_EVSE_vald_toggle == YES) {
+            memcpy(code, "023817", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023818", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsSeccSlacTimeoutCmMnbcSound == YES) {
+            memcpy(code, "023818", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023819", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsSeccSlacTimeoutCmValidateReq == YES) {
+            memcpy(code, "023819", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023823", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsUDP_TT_match_join == YES) {
+            memcpy(code, "023823", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023824", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTCP_TT_match_join == YES) {
+            memcpy(code, "023824", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023825", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_amp_map_exchange == YES) {
+            memcpy(code, "023825", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023826", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_link_ready_notification == YES) {
+            memcpy(code, "023826", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023832", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsSupportedAppProtocolRes == YES) {
+            memcpy(code, "023832", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023833", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsSessionSetupRes == YES) {
+            memcpy(code, "023833", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023834", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsServiceDiscoveryRes == YES) {
+            memcpy(code, "023834", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023835", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsServicePaymentSelectionRes == YES) {
+            memcpy(code, "023835", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023836", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsContractAuthenticationRes == YES) {
+            memcpy(code, "023836", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023837", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsChargeParameterDiscoveryRes == YES) {
+            memcpy(code, "023837", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023838", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsPowerDeliveryRes == YES) {
+            memcpy(code, "023838", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023839", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCableCheckRes == YES) {
+            memcpy(code, "023839", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023840", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsPreChargeRes == YES) {
+            memcpy(code, "023840", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023841", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCurrentDemandRes == YES) {
+            memcpy(code, "023841", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023842", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsWeldingDetectionRes == YES) {
+            memcpy(code, "023842", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023843", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsSessionStopRes == YES) {
+            memcpy(code, "023843", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023844", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsSequence_Time == YES) {
+            memcpy(code, "023844", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023845", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsReadyToCharge_Performance_Time == YES) {
+            memcpy(code, "023845", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023846", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCommunicationSetup_Performance_Time == YES) {
+            memcpy(code, "023846", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023847", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCableCheck_Performance_Time == YES) {
+            memcpy(code, "023847", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023848", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCPState_Detection_Time == YES) {
+            memcpy(code, "023848", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023849", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCPOscillator_Retain_Time == YES) {
+            memcpy(code, "023849", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023850", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsSeccTimeoutV2GPreChargePerformaceTime == YES) {
+            memcpy(code, "023850", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023855", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_GET_EV_TARGET_INFO == YES) {
+            memcpy(code, "023855", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023856", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_GET_EV_TARGET_INFO == YES) {
+            memcpy(code, "023856", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023857", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_GET_EV_BATTERY_INFO == YES) {
+            memcpy(code, "023857", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023858", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_GET_EV_BATTERY_INFO == YES) {
+            memcpy(code, "023858", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023859", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_EV_STOP_EVENT == YES) {
+            memcpy(code, "023859", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023860", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_EV_STOP_EVENT == YES) {
+            memcpy(code, "023860", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023861", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_EVSE_STOP_EVENT == YES) {
+            memcpy(code, "023861", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023862", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_EVSE_STOP_EVENT == YES) {
+            memcpy(code, "023862", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023863", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_GET_MISC_INFO == YES) {
+            memcpy(code, "023863", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023864", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_GET_MISC_INFO == YES) {
+            memcpy(code, "023864", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023865", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_DOWNLOAD_REQUEST == YES) {
+            memcpy(code, "023865", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023866", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_DOWNLOAD_REQUEST == YES) {
+            memcpy(code, "023866", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023867", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_START_BLOCK_TRANSFER == YES) {
+            memcpy(code, "023867", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023868", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_START_BLOCK_TRANSFER == YES) {
+            memcpy(code, "023868", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023869", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_DATA_TRANSFER == YES) {
+            memcpy(code, "023869", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023870", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_DATA_TRANSFER == YES) {
+            memcpy(code, "023870", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023871", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_DOWNLOAD_FINISH == YES) {
+            memcpy(code, "023871", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023872", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_DOWNLOAD_FINISH == YES) {
+            memcpy(code, "023872", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023873", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_ISOLATION_STATUS == YES) {
+            memcpy(code, "023873", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023874", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_ISOLATION_STATUS == YES) {
+            memcpy(code, "023874", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023875", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_CONNECTOR_INFO == YES) {
+            memcpy(code, "023875", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023876", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_CONNECTOR_INFO == YES) {
+            memcpy(code, "023876", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023877", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_RTC_INFO == YES) {
+            memcpy(code, "023877", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023878", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_RTC_INFO == YES) {
+            memcpy(code, "023878", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023879", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_EVSE_PRECHARGE_INFO == YES) {
+            memcpy(code, "023879", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023880", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_EVSE_PRECHARGE_INFO == YES) {
+            memcpy(code, "023880", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023881", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsMSG_Sequence == YES) {
+            memcpy(code, "023881", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023882", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCAN_MSG_Unrecognized_CMD_ID == YES) {
+            memcpy(code, "023882", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023883", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsDIN_Msg_Decode_Error == YES) {
+            memcpy(code, "023883", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023884", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsDIN_Msg_Encode_Error == YES) {
+            memcpy(code, "023884", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023885", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsISO1_Msg_Decode_Error == YES) {
+            memcpy(code, "023885", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023886", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsISO1_Msg_Encode_Error == YES) {
+            memcpy(code, "023886", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023887", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsISO2_Msg_Decode_Error == YES) {
+            memcpy(code, "023887", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023888", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsISO2_Msg_Encode_Error == YES) {
+            memcpy(code, "023888", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023889", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCpStatus_Error == YES) {
+            memcpy(code, "023889", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023890", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsUnexpectVolBeforeCharing_Error == YES) {
+            memcpy(code, "023890", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023891", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsSeccNotReadyForCharging == YES) {
+            memcpy(code, "023891", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        }
+//  else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023892", 6) == EQUAL &&
+//          ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsSeccTimeoutQCA7000Comm == YES)
+//  {
+//      memcpy(code, "023892", 6);
+//      memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+//      isCleanCheck = true;
+//  }
+        else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023893", 6) == EQUAL &&
+                 ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsSeccFailForQCA7000SetKey == YES) {
+            memcpy(code, "023893", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023979", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.EV_Full_Charging == YES) {
+            memcpy(code, "023979", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "023983", 6) == EQUAL &&
+                   ShmStatusCodeData->InfoCode.InfoEvents.bits.Stop_by_EV_with_unknow_reason == YES) {
+            memcpy(code, "023983", 6);
+            memcpy(_chargingData[gun_index]->EvConnAlarmCode, "", 6);
+            isCleanCheck = true;
+        }
+    }
+
+    if (isCleanCheck) {
+        for (byte index = 0; index < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; index++) {
+            if (index != gun_index || ShmSysConfigAndInfo->SysConfig.TotalConnectorCount == 1) {
+                PRINTF_FUNC("CCS clean error : index = %d, EvConnAlarmCode = %s, code = %s \n", index, _chargingData[index]->EvConnAlarmCode, code);
+                if (strncmp((char *)_chargingData[index]->EvConnAlarmCode, code, 6) != EQUAL) {
+                    if (strncmp(code, "012219", 6) == EQUAL) { ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemCcsOutputOVP = NO; }
+                    if (strncmp(code, "023701", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsEvCommFail = NO; }
+                    if (strncmp(code, "023737", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsRESTemperatureInhibit = NO; }
+                    if (strncmp(code, "023738", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsEVShiftPosition = NO; }
+                    if (strncmp(code, "023739", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsChargerConnectorLockFault = NO; }
+                    if (strncmp(code, "023740", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsEVRESSMalfunction = NO; }
+                    if (strncmp(code, "023741", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsChargingCurrentdifferential = NO; }
+                    if (strncmp(code, "023742", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsChargingVoltageOutOfRange = NO; }
+                    if (strncmp(code, "023743", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsChargingSystemIncompatibility = NO; }
+                    if (strncmp(code, "023744", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsEmergencyEvent = NO; }
+                    if (strncmp(code, "023745", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsBreaker = NO; }
+                    if (strncmp(code, "023746", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsNoData = NO; }
+                    if (strncmp(code, "023747", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.Ccsreserved_by_DIN_A = NO; }
+                    if (strncmp(code, "023748", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.Ccsreserved_by_DIN_B = NO; }
+                    if (strncmp(code, "023749", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.Ccsreserved_by_DIN_C = NO; }
+                    if (strncmp(code, "023750", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.Ccsreserved_by_ISO_1 = NO; }
+                    if (strncmp(code, "023751", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.Ccsreserved_by_ISO_2 = NO; }
+                    if (strncmp(code, "023752", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.Ccsreserved_by_ISO_3 = NO; }
+                    if (strncmp(code, "023753", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.Ccsreserved_by_OEM_1 = NO; }
+                    if (strncmp(code, "023754", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.Ccsreserved_by_OEM_2 = NO; }
+                    if (strncmp(code, "023755", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.Ccsreserved_by_OEM_3 = NO; }
+                    if (strncmp(code, "023756", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.Ccsreserved_by_OEM_4 = NO; }
+                    if (strncmp(code, "023757", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.Ccsreserved_by_OEM_5 = NO; }
+                    if (strncmp(code, "023758", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsSequenceError = NO; }
+                    if (strncmp(code, "023759", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsSignatureError = NO; }
+                    if (strncmp(code, "023760", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsUnknownSession = NO; }
+                    if (strncmp(code, "023761", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsServiceIDInvalid = NO; }
+                    if (strncmp(code, "023762", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsPaymentSelectionInvalid = NO; }
+                    if (strncmp(code, "023763", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsIdentificationSelectionInvalid = NO; }
+                    if (strncmp(code, "023764", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsServiceSelectionInvalid = NO; }
+                    if (strncmp(code, "023765", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCertificateExpired = NO; }
+                    if (strncmp(code, "023766", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCertificateNotYetValid = NO; }
+                    if (strncmp(code, "023767", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCertificateRevoked = NO; }
+                    if (strncmp(code, "023768", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsNoCertificateAvailable = NO; }
+                    if (strncmp(code, "023769", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCertChainError = NO; }
+                    if (strncmp(code, "023770", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCertValidationError = NO; }
+                    if (strncmp(code, "023771", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCertVerificationError = NO; }
+                    if (strncmp(code, "023772", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsContractCanceled = NO; }
+                    if (strncmp(code, "023773", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsChallengeInvalid = NO; }
+                    if (strncmp(code, "023774", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsWrongEnergyTransferMode = NO; }
+                    if (strncmp(code, "023775", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsWrongChargeParameter = NO; }
+                    if (strncmp(code, "023776", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsChargingProfileInvalid = NO; }
+                    if (strncmp(code, "023777", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTariffSelectionInvalid = NO; }
+                    if (strncmp(code, "023778", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsEVSEPresentVoltageToLow = NO; }
+                    if (strncmp(code, "023779", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsPowerDeliveryNotApplied = NO; }
+                    if (strncmp(code, "023780", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsMeteringSignatureNotValid = NO; }
+                    if (strncmp(code, "023781", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsNoChargeServiceSelected = NO; }
+                    if (strncmp(code, "023782", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsContactorError = NO; }
+                    if (strncmp(code, "023783", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCertificateNotAllowedAtThisEVSE = NO; }
+                    if (strncmp(code, "023784", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsGAChargeStop = NO; }
+                    if (strncmp(code, "023785", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsAlignmentError = NO; }
+                    if (strncmp(code, "023786", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsACDError = NO; }
+                    if (strncmp(code, "023787", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsAssociationError = NO; }
+                    if (strncmp(code, "023788", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsEVSEChargeAbort = NO; }
+                    if (strncmp(code, "023789", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsNoSupportedAppProtocol = NO; }
+                    if (strncmp(code, "023790", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsContractNotAccepted = NO; }
+                    if (strncmp(code, "023791", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsMOUnknown = NO; }
+                    if (strncmp(code, "023792", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsOEM_Prov_CertificateRevoke = NO; }
+                    if (strncmp(code, "023793", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsOEM_SubCA1_CertificateRevoked = NO; }
+                    if (strncmp(code, "023794", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsOEM_SubCA2_CertificateRevoked = NO; }
+                    if (strncmp(code, "023795", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsOEM_RootCA_CertificateRevoked = NO; }
+                    if (strncmp(code, "023796", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsMO_Prov_CertificateRevoked = NO; }
+                    if (strncmp(code, "023797", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsMO_SubCA1_CertificateRevoked = NO; }
+                    if (strncmp(code, "023798", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsMO_SubCA2_CertificateRevoked = NO; }
+                    if (strncmp(code, "023799", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsMO_RootCA_CertificateRevoked = NO; }
+                    if (strncmp(code, "023800", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCPS_Prov_CertificateRevoked = NO; }
+                    if (strncmp(code, "023801", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCPS_SubCA1_CertificateRevoked = NO; }
+                    if (strncmp(code, "023802", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCPS_SubCA2_CertificateRevoked = NO; }
+                    if (strncmp(code, "023803", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCPS_RootCA_CertificateRevoked = NO; }
+                    if (strncmp(code, "023809", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_EVSE_SLAC_init = NO; }
+                    if (strncmp(code, "023810", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_match_response = NO; }
+                    if (strncmp(code, "023811", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_match_sequence = NO; }
+                    if (strncmp(code, "023812", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_EVSE_match_MNBC = NO; }
+                    if (strncmp(code, "023813", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_EVSE_avg_atten_calc = NO; }
+                    if (strncmp(code, "023814", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_match_response = NO; }
+                    if (strncmp(code, "023815", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_EVSE_match_session = NO; }
+                    if (strncmp(code, "023816", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_EVSE_assoc_session = NO; }
+                    if (strncmp(code, "023817", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_EVSE_vald_toggle = NO; }
+                    if (strncmp(code, "023818", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsSeccSlacTimeoutCmMnbcSound = NO; }
+                    if (strncmp(code, "023819", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsSeccSlacTimeoutCmValidateReq = NO; }
+                    if (strncmp(code, "023823", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsUDP_TT_match_join = NO; }
+                    if (strncmp(code, "023824", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTCP_TT_match_join = NO; }
+                    if (strncmp(code, "023825", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_amp_map_exchange = NO; }
+                    if (strncmp(code, "023826", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_link_ready_notification = NO; }
+                    if (strncmp(code, "023832", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsSupportedAppProtocolRes = NO; }
+                    if (strncmp(code, "023833", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsSessionSetupRes = NO; }
+                    if (strncmp(code, "023834", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsServiceDiscoveryRes = NO; }
+                    if (strncmp(code, "023835", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsServicePaymentSelectionRes = NO; }
+                    if (strncmp(code, "023836", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsContractAuthenticationRes = NO; }
+                    if (strncmp(code, "023837", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsChargeParameterDiscoveryRes = NO; }
+                    if (strncmp(code, "023838", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsPowerDeliveryRes = NO; }
+                    if (strncmp(code, "023839", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCableCheckRes = NO; }
+                    if (strncmp(code, "023840", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsPreChargeRes = NO; }
+                    if (strncmp(code, "023841", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCurrentDemandRes = NO; }
+                    if (strncmp(code, "023842", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsWeldingDetectionRes = NO; }
+                    if (strncmp(code, "023843", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsSessionStopRes = NO; }
+                    if (strncmp(code, "023844", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsSequence_Time = NO; }
+                    if (strncmp(code, "023845", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsReadyToCharge_Performance_Time = NO; }
+                    if (strncmp(code, "023846", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCommunicationSetup_Performance_Time = NO; }
+                    if (strncmp(code, "023847", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCableCheck_Performance_Time = NO; }
+                    if (strncmp(code, "023848", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCPState_Detection_Time = NO; }
+                    if (strncmp(code, "023849", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCPOscillator_Retain_Time = NO; }
+                    if (strncmp(code, "023850", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsSeccTimeoutV2GPreChargePerformaceTime = NO; }
+                    if (strncmp(code, "023855", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_GET_EV_TARGET_INFO = NO; }
+                    if (strncmp(code, "023856", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_GET_EV_TARGET_INFO = NO; }
+                    if (strncmp(code, "023857", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_GET_EV_BATTERY_INFO = NO; }
+                    if (strncmp(code, "023858", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_GET_EV_BATTERY_INFO = NO; }
+                    if (strncmp(code, "023859", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_EV_STOP_EVENT = NO; }
+                    if (strncmp(code, "023860", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_EV_STOP_EVENT = NO; }
+                    if (strncmp(code, "023861", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_EVSE_STOP_EVENT = NO; }
+                    if (strncmp(code, "023862", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_EVSE_STOP_EVENT = NO; }
+                    if (strncmp(code, "023863", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_GET_MISC_INFO = NO; }
+                    if (strncmp(code, "023864", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_GET_MISC_INFO = NO; }
+                    if (strncmp(code, "023865", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_DOWNLOAD_REQUEST = NO; }
+                    if (strncmp(code, "023866", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_DOWNLOAD_REQUEST = NO; }
+                    if (strncmp(code, "023867", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_START_BLOCK_TRANSFER = NO; }
+                    if (strncmp(code, "023868", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_START_BLOCK_TRANSFER = NO; }
+                    if (strncmp(code, "023869", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_DATA_TRANSFER = NO; }
+                    if (strncmp(code, "023870", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_DATA_TRANSFER = NO; }
+                    if (strncmp(code, "023871", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_DOWNLOAD_FINISH = NO; }
+                    if (strncmp(code, "023872", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_DOWNLOAD_FINISH = NO; }
+                    if (strncmp(code, "023873", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_ISOLATION_STATUS = NO; }
+                    if (strncmp(code, "023874", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_ISOLATION_STATUS = NO; }
+                    if (strncmp(code, "023875", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_CONNECTOR_INFO = NO; }
+                    if (strncmp(code, "023876", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_CONNECTOR_INFO = NO; }
+                    if (strncmp(code, "023877", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_RTC_INFO = NO; }
+                    if (strncmp(code, "023878", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_RTC_INFO = NO; }
+                    if (strncmp(code, "023879", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_EVSE_PRECHARGE_INFO = NO; }
+                    if (strncmp(code, "023880", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_EVSE_PRECHARGE_INFO = NO; }
+                    if (strncmp(code, "023881", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsMSG_Sequence = NO; }
+                    if (strncmp(code, "023882", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCAN_MSG_Unrecognized_CMD_ID = NO; }
+                    if (strncmp(code, "023883", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsDIN_Msg_Decode_Error = NO; }
+                    if (strncmp(code, "023884", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsDIN_Msg_Encode_Error = NO; }
+                    if (strncmp(code, "023885", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsISO1_Msg_Decode_Error = NO; }
+                    if (strncmp(code, "023886", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsISO1_Msg_Encode_Error = NO; }
+                    if (strncmp(code, "023887", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsISO2_Msg_Decode_Error = NO; }
+                    if (strncmp(code, "023888", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsISO2_Msg_Encode_Error = NO; }
+                    if (strncmp(code, "023889", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCpStatus_Error = NO; }
+                    if (strncmp(code, "023890", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsUnexpectVolBeforeCharing_Error = NO; }
+                    if (strncmp(code, "023891", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsSeccNotReadyForCharging = NO; }
+                    //if (strncmp(code, "023892", 6) == EQUAL) ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsSeccTimeoutQCA7000Comm = NO;
+                    if (strncmp(code, "023893", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsSeccFailForQCA7000SetKey = NO; }
+
+                    if (strncmp(code, "023979", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.EV_Full_Charging = NO; }
+                    if (strncmp(code, "023983", 6) == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.Stop_by_EV_with_unknow_reason = NO; }
+                }
+            }
+        }
+    }
+}
+
+bool AbnormalStopAnalysis(byte gun_index, byte *errCode)
+{
+    char string[7];
+    sprintf(string, "%d%d%d%d%d%d", *(errCode + 0), *(errCode + 1), *(errCode + 2), *(errCode + 3), *(errCode + 4), *(errCode + 5));
+
+    PRINTF_FUNC("NOTIFICATION_EV_STOP : Err Code = %s \n", string);
+    //if (strncmp(string, "000000", 6) == EQUAL ||
+    //        strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "", 6) != EQUAL) {
+    //    return;
+    //}
+    if (strncmp(string, "000000", 6) == EQUAL ||
+            strncmp(string, "023979", 6) == EQUAL) {
+        return false;
+    }
+
+    if (strncmp((char *)_chargingData[gun_index]->EvConnAlarmCode, "", 6) != EQUAL) {
+        return true;
+    }
+
+    memcpy(_chargingData[gun_index]->EvConnAlarmCode, string, 6);
+    PRINTF_FUNC("NOTIFICATION_EV_STOP : EvConnAlarmCode = %s \n", _chargingData[gun_index]->EvConnAlarmCode);
+    //OVP error
+    if (strcmp(string, "012217") == EQUAL) { ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemChademoOutputOVP = YES; }
+    if (strcmp(string, "012219") == EQUAL) { ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemCcsOutputOVP = YES; }
+    if (strcmp(string, "012221") == EQUAL) { ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemGbOutputOVP = YES; }
+
+    if (strcmp(string, "023700") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoEvCommFail = YES; }
+    if (strcmp(string, "023704") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBatteryMalfun = YES; }
+    if (strcmp(string, "023705") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoNoPermission = YES; }
+    if (strcmp(string, "023706") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBatteryIncompatibility = YES; }
+    if (strcmp(string, "023707") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBatteryOVP = YES; }
+    if (strcmp(string, "023708") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBatteryUVP = YES; }
+    if (strcmp(string, "023709") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBatteryOTP = YES; }
+    if (strcmp(string, "023710") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBatteryCurrentDiff = YES; }
+    if (strcmp(string, "023711") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBatteryVoltageDiff = YES; }
+    if (strcmp(string, "023712") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoShiftPosition = YES; }
+    if (strcmp(string, "023713") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBatteryOtherFault = YES; }
+    if (strcmp(string, "023714") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoChargingSystemError = YES; }
+    if (strcmp(string, "023715") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoEvNormalStop = YES; }
+    if (strcmp(string, "023716") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoTempSensorBroken = YES; }
+    if (strcmp(string, "023717") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoConnectorLockFail = YES; }
+    if (strcmp(string, "023718") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoD1OnNoReceive = YES; }
+    if (strcmp(string, "023719") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBmsKtoJTimeout = YES; }
+    if (strcmp(string, "023720") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBmsChargeAllowTimeout = YES; }
+    if (strcmp(string, "023721") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoWaitGfdTimeout = YES; }
+    if (strcmp(string, "023722") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBmsEvRelayTimeout = YES; }
+    if (strcmp(string, "023723") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBmsReqCurrentTimeout = YES; }
+    if (strcmp(string, "023724") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBmsKtoJOffTimeout = YES; }
+    if (strcmp(string, "023725") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBmsEvRelayOffTimeout = YES; }
+    if (strcmp(string, "023726") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoAdcMoreThan10V = YES; }
+    if (strcmp(string, "023727") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoAdcMoreThan20V = YES; }
+    if (strcmp(string, "023728") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoBmsChargeBeforeStop = YES; }
+    if (strcmp(string, "023729") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoChargerGetNormalStop = YES; }
+    if (strcmp(string, "023730") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoChargerGetEmergencyStop = YES; }
+    if (strcmp(string, "023731") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoIsolationResultFail = YES; }
+    if (strcmp(string, "023732") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoMissLinkWithMotherBoard = YES; }
+    if (strcmp(string, "023733") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoOutputVolMoreThanLimit = YES; }
+    if (strcmp(string, "023734") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoReqCurrentMoreThanLimit = YES; }
+    if (strcmp(string, "023735") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoReCapBmsEqrCurrentExceed = YES; }
+    if (strcmp(string, "023736") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoChargeRemainCountDown = YES; }
+
+    if (strcmp(string, "012288") == EQUAL) { ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CcsOutputUVPFail = YES; }
+    if (strcmp(string, "023701") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsEvCommFail = YES; }
+    if (strcmp(string, "023737") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsRESTemperatureInhibit = YES; }
+    if (strcmp(string, "023738") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsEVShiftPosition = YES; }
+    if (strcmp(string, "023739") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsChargerConnectorLockFault = YES; }
+    if (strcmp(string, "023740") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsEVRESSMalfunction = YES; }
+    if (strcmp(string, "023741") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsChargingCurrentdifferential = YES; }
+    if (strcmp(string, "023742") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsChargingVoltageOutOfRange = YES; }
+    if (strcmp(string, "023743") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsChargingSystemIncompatibility = YES; }
+    if (strcmp(string, "023744") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsEmergencyEvent = YES; }
+    if (strcmp(string, "023745") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsBreaker = YES; }
+    if (strcmp(string, "023746") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsNoData = YES; }
+    if (strcmp(string, "023747") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.Ccsreserved_by_DIN_A = YES; }
+    if (strcmp(string, "023748") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.Ccsreserved_by_DIN_B = YES; }
+    if (strcmp(string, "023749") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.Ccsreserved_by_DIN_C = YES; }
+    if (strcmp(string, "023750") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.Ccsreserved_by_ISO_1 = YES; }
+    if (strcmp(string, "023751") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.Ccsreserved_by_ISO_2 = YES; }
+    if (strcmp(string, "023752") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.Ccsreserved_by_ISO_3 = YES; }
+    if (strcmp(string, "023753") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.Ccsreserved_by_OEM_1 = YES; }
+    if (strcmp(string, "023754") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.Ccsreserved_by_OEM_2 = YES; }
+    if (strcmp(string, "023755") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.Ccsreserved_by_OEM_3 = YES; }
+    if (strcmp(string, "023756") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.Ccsreserved_by_OEM_4 = YES; }
+    if (strcmp(string, "023757") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.Ccsreserved_by_OEM_5 = YES; }
+    if (strcmp(string, "023758") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsSequenceError = YES; }
+    if (strcmp(string, "023759") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsSignatureError = YES; }
+    if (strcmp(string, "023760") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsUnknownSession = YES; }
+    if (strcmp(string, "023761") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsServiceIDInvalid = YES; }
+    if (strcmp(string, "023762") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsPaymentSelectionInvalid = YES; }
+    if (strcmp(string, "023763") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsIdentificationSelectionInvalid = YES; }
+    if (strcmp(string, "023764") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsServiceSelectionInvalid = YES; }
+    if (strcmp(string, "023765") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCertificateExpired = YES; }
+    if (strcmp(string, "023766") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCertificateNotYetValid = YES; }
+    if (strcmp(string, "023767") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCertificateRevoked = YES; }
+    if (strcmp(string, "023768") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsNoCertificateAvailable = YES; }
+    if (strcmp(string, "023769") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCertChainError = YES; }
+    if (strcmp(string, "023770") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCertValidationError = YES; }
+    if (strcmp(string, "023771") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCertVerificationError = YES; }
+    if (strcmp(string, "023772") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsContractCanceled = YES; }
+    if (strcmp(string, "023773") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsChallengeInvalid = YES; }
+    if (strcmp(string, "023774") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsWrongEnergyTransferMode = YES; }
+    if (strcmp(string, "023775") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsWrongChargeParameter = YES; }
+    if (strcmp(string, "023776") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsChargingProfileInvalid = YES; }
+    if (strcmp(string, "023777") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTariffSelectionInvalid = YES; }
+    if (strcmp(string, "023778") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsEVSEPresentVoltageToLow = YES; }
+    if (strcmp(string, "023779") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsPowerDeliveryNotApplied = YES; }
+    if (strcmp(string, "023780") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsMeteringSignatureNotValid = YES; }
+    if (strcmp(string, "023781") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsNoChargeServiceSelected = YES; }
+    if (strcmp(string, "023782") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsContactorError = YES; }
+    if (strcmp(string, "023783") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCertificateNotAllowedAtThisEVSE = YES; }
+    if (strcmp(string, "023784") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsGAChargeStop = YES; }
+    if (strcmp(string, "023785") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsAlignmentError = YES; }
+    if (strcmp(string, "023786") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsACDError = YES; }
+    if (strcmp(string, "023787") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsAssociationError = YES; }
+    if (strcmp(string, "023788") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsEVSEChargeAbort = YES; }
+    if (strcmp(string, "023789") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsNoSupportedAppProtocol = YES; }
+    if (strcmp(string, "023790") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsContractNotAccepted = YES; }
+    if (strcmp(string, "023791") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsMOUnknown = YES; }
+    if (strcmp(string, "023792") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsOEM_Prov_CertificateRevoke = YES; }
+    if (strcmp(string, "023793") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsOEM_SubCA1_CertificateRevoked = YES; }
+    if (strcmp(string, "023794") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsOEM_SubCA2_CertificateRevoked = YES; }
+    if (strcmp(string, "023795") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsOEM_RootCA_CertificateRevoked = YES; }
+    if (strcmp(string, "023796") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsMO_Prov_CertificateRevoked = YES; }
+    if (strcmp(string, "023797") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsMO_SubCA1_CertificateRevoked = YES; }
+    if (strcmp(string, "023798") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsMO_SubCA2_CertificateRevoked = YES; }
+    if (strcmp(string, "023799") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsMO_RootCA_CertificateRevoked = YES; }
+    if (strcmp(string, "023800") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCPS_Prov_CertificateRevoked = YES; }
+    if (strcmp(string, "023801") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCPS_SubCA1_CertificateRevoked = YES; }
+    if (strcmp(string, "023802") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCPS_SubCA2_CertificateRevoked = YES; }
+    if (strcmp(string, "023803") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCPS_RootCA_CertificateRevoked = YES; }
+    if (strcmp(string, "023809") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_EVSE_SLAC_init = YES; }
+    if (strcmp(string, "023810") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_match_response = YES; }
+    if (strcmp(string, "023811") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_match_sequence = YES; }
+    if (strcmp(string, "023812") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_EVSE_match_MNBC = YES; }
+    if (strcmp(string, "023813") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_EVSE_avg_atten_calc = YES; }
+    if (strcmp(string, "023814") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_match_response = YES; }
+    if (strcmp(string, "023815") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_EVSE_match_session = YES; }
+    if (strcmp(string, "023816") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_EVSE_assoc_session = YES; }
+    if (strcmp(string, "023817") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_EVSE_vald_toggle = YES; }
+    if (strcmp(string, "023818") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsSeccSlacTimeoutCmMnbcSound = YES; }
+    if (strcmp(string, "023819") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsSeccSlacTimeoutCmValidateReq = YES; }
+    if (strcmp(string, "023823") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsUDP_TT_match_join = YES; }
+    if (strcmp(string, "023824") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTCP_TT_match_join = YES; }
+    if (strcmp(string, "023825") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_amp_map_exchange = YES; }
+    if (strcmp(string, "023826") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_link_ready_notification = YES; }
+    if (strcmp(string, "023832") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsSupportedAppProtocolRes = YES; }
+    if (strcmp(string, "023833") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsSessionSetupRes = YES; }
+    if (strcmp(string, "023834") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsServiceDiscoveryRes = YES; }
+    if (strcmp(string, "023835") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsServicePaymentSelectionRes = YES; }
+    if (strcmp(string, "023836") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsContractAuthenticationRes = YES; }
+    if (strcmp(string, "023837") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsChargeParameterDiscoveryRes = YES; }
+    if (strcmp(string, "023838") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsPowerDeliveryRes = YES; }
+    if (strcmp(string, "023839") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCableCheckRes = YES; }
+    if (strcmp(string, "023840") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsPreChargeRes = YES; }
+    if (strcmp(string, "023841") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCurrentDemandRes = YES; }
+    if (strcmp(string, "023842") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsWeldingDetectionRes = YES; }
+    if (strcmp(string, "023843") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsSessionStopRes = YES; }
+    if (strcmp(string, "023844") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsSequence_Time = YES; }
+    if (strcmp(string, "023845") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsReadyToCharge_Performance_Time = YES; }
+    if (strcmp(string, "023846") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCommunicationSetup_Performance_Time = YES; }
+    if (strcmp(string, "023847") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCableCheck_Performance_Time = YES; }
+    if (strcmp(string, "023848") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCPState_Detection_Time = YES; }
+    if (strcmp(string, "023849") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCPOscillator_Retain_Time = YES; }
+    if (strcmp(string, "023850") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsSeccTimeoutV2GPreChargePerformaceTime = YES; }
+    if (strcmp(string, "023855") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_GET_EV_TARGET_INFO = YES; }
+    if (strcmp(string, "023856") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_GET_EV_TARGET_INFO = YES; }
+    if (strcmp(string, "023857") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_GET_EV_BATTERY_INFO = YES; }
+    if (strcmp(string, "023858") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_GET_EV_BATTERY_INFO = YES; }
+    if (strcmp(string, "023859") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_EV_STOP_EVENT = YES; }
+    if (strcmp(string, "023860") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_EV_STOP_EVENT = YES; }
+    if (strcmp(string, "023861") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_EVSE_STOP_EVENT = YES; }
+    if (strcmp(string, "023862") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_EVSE_STOP_EVENT = YES; }
+    if (strcmp(string, "023863") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_GET_MISC_INFO = YES; }
+    if (strcmp(string, "023864") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_GET_MISC_INFO = YES; }
+    if (strcmp(string, "023865") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_DOWNLOAD_REQUEST = YES; }
+    if (strcmp(string, "023866") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_DOWNLOAD_REQUEST = YES; }
+    if (strcmp(string, "023867") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_START_BLOCK_TRANSFER = YES; }
+    if (strcmp(string, "023868") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_START_BLOCK_TRANSFER = YES; }
+    if (strcmp(string, "023869") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_DATA_TRANSFER = YES; }
+    if (strcmp(string, "023870") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_DATA_TRANSFER = YES; }
+    if (strcmp(string, "023871") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_DOWNLOAD_FINISH = YES; }
+    if (strcmp(string, "023872") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_DOWNLOAD_FINISH = YES; }
+    if (strcmp(string, "023873") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_ISOLATION_STATUS = YES; }
+    if (strcmp(string, "023874") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_ISOLATION_STATUS = YES; }
+    if (strcmp(string, "023875") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_CONNECTOR_INFO = YES; }
+    if (strcmp(string, "023876") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_CONNECTOR_INFO = YES; }
+    if (strcmp(string, "023877") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_RTC_INFO = YES; }
+    if (strcmp(string, "023878") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_RTC_INFO = YES; }
+    if (strcmp(string, "023879") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTP_EVSE_PRECHARGE_INFO = YES; }
+    if (strcmp(string, "023880") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsTT_EVSE_PRECHARGE_INFO = YES; }
+    if (strcmp(string, "023881") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsMSG_Sequence = YES; }
+    if (strcmp(string, "023882") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCAN_MSG_Unrecognized_CMD_ID = YES; }
+    if (strcmp(string, "023883") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsDIN_Msg_Decode_Error = YES; }
+    if (strcmp(string, "023884") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsDIN_Msg_Encode_Error = YES; }
+    if (strcmp(string, "023885") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsISO1_Msg_Decode_Error = YES; }
+    if (strcmp(string, "023886") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsISO1_Msg_Encode_Error = YES; }
+    if (strcmp(string, "023887") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsISO2_Msg_Decode_Error = YES; }
+    if (strcmp(string, "023888") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsISO2_Msg_Encode_Error = YES; }
+    if (strcmp(string, "023889") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsCpStatus_Error = YES; }
+    if (strcmp(string, "023890") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsUnexpectVolBeforeCharing_Error = YES; }
+    if (strcmp(string, "023891") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsSeccNotReadyForCharging = YES; }
+    if (strcmp(string, "023892") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsSeccTimeoutQCA7000Comm = YES; }
+    if (strcmp(string, "023893") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.CcsSeccFailForQCA7000SetKey = YES; }
+
+    if (strcmp(string, "023702") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.GbEvCommFail = YES; }
+    if (strcmp(string, "023900") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_LOS_CC1 = YES; }
+    if (strcmp(string, "023901") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_CONNECTOR_LOCK_FAIL = YES; }
+    if (strcmp(string, "023902") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_BATTERY_INCOMPATIBLE = YES; }
+    if (strcmp(string, "023903") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_BMS_BROAA_TIMEOUT = YES; }
+    if (strcmp(string, "023904") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_CSU_PRECHARGE_TIMEOUT = YES; }
+    if (strcmp(string, "023905") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_BMS_PRESENT_VOLTAGE_FAULT = YES; }
+    if (strcmp(string, "023906") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_BMS_VOLTAGE_OVER_RANGE = YES; }
+    if (strcmp(string, "023907") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_BSM_CHARGE_ALLOW_00_10MIN_COUUNTDONE = YES; }
+    if (strcmp(string, "023908") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_WAIT_GROUNDFAULT_TIMEOUT = YES; }
+    if (strcmp(string, "023909") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_ADC_MORE_THAN_10V = YES; }
+    if (strcmp(string, "023910") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_ADC_MORE_THAN_60V = YES; }
+    if (strcmp(string, "023911") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_CHARGER_GET_NORMAL_STOP_CMD = YES; }
+    if (strcmp(string, "023912") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_CHARGER_GET_EMERGENCY_STOP_CMD = YES; }
+    if (strcmp(string, "023913") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_ISOLATION_RESULT_FAIL = YES; }
+    if (strcmp(string, "023914") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_MOTHER_BOARD_MISS_LINK = YES; }
+    if (strcmp(string, "023915") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_OUTPUT_VOLTAGE_MORE_THAN_LIMIT = YES; }
+    if (strcmp(string, "023916") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_REQ_CURRENT_MORE_THAN_LIMIT = YES; }
+    if (strcmp(string, "023917") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_OUTPUT_VOLTAGE_MORE_THAN_10_PERCENT = YES; }
+    if (strcmp(string, "023918") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_OUTPUT_VOLTAGE_DIFF_BCS_5_PERCENT = YES; }
+    if (strcmp(string, "023919") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GBT_STOP_ADC_MORE_THAN_10V = YES; }
+    if (strcmp(string, "023930") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_CEM_BHM_TIMEOUT = YES; }
+    if (strcmp(string, "023931") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_CEM_BRM_TIMEOUT = YES; }
+    if (strcmp(string, "023932") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_CEM_BCP_TIMEOUT = YES; }
+    if (strcmp(string, "023933") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_CEM_BRO_TIMEOUT = YES; }
+    if (strcmp(string, "023934") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_CEM_BCL_TIMEOUT = YES; }
+    if (strcmp(string, "023935") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_CEM_BCS_TIMEOUT = YES; }
+    if (strcmp(string, "023936") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_CEM_BSM_TIMEOUT = YES; }
+    if (strcmp(string, "023937") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_CEM_BST_TIMEOUT = YES; }
+    if (strcmp(string, "023938") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_CEM_BSD_TIMEOUT = YES; }
+    if (strcmp(string, "023939") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_CEM_BEM_OTHER_TIMEOUT = YES; }
+    if (strcmp(string, "023940") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BEM_CRM_TIMEOUT = YES; }
+    if (strcmp(string, "023941") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BEM_CRMAA_TIMEOUT = YES; }
+    if (strcmp(string, "023942") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BEM_CTS_CML_TIMEOUT = YES; }
+    if (strcmp(string, "023943") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BEM_CRO_TIMEOUT = YES; }
+    if (strcmp(string, "023944") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BEM_CCS_TIMEOUT = YES; }
+    if (strcmp(string, "023945") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BEM_CST_TIMEOUT = YES; }
+    if (strcmp(string, "023946") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BEM_CSD_TIMEOUT = YES; }
+    if (strcmp(string, "023947") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BEM_BEM_OTHER_TIMEOUT = YES; }
+    if (strcmp(string, "023950") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_SOC_GOAL = YES; }
+    if (strcmp(string, "023951") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_TOTAL_VOLTAGE_GOAL = YES; }
+    if (strcmp(string, "023952") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_CELL_VOLTAGE_GOAL = YES; }
+    if (strcmp(string, "023953") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_GET_CST = YES; }
+    if (strcmp(string, "023954") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_ISOLATION = YES; }
+    if (strcmp(string, "023955") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_OUTPUT_CONNECTOR_OTP = YES; }
+    if (strcmp(string, "023956") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_COMPONENT = YES; }
+    if (strcmp(string, "023957") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_CHARGE_CONNECTOR = YES; }
+    if (strcmp(string, "023958") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_OTP = YES; }
+    if (strcmp(string, "023959") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_OTHER = YES; }
+    if (strcmp(string, "023960") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_HIGH_V = YES; }
+    if (strcmp(string, "023961") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_CC2 = YES; }
+    if (strcmp(string, "023962") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_CURRENT = YES; }
+    if (strcmp(string, "023963") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BST_VOLTAGE = YES; }
+    if (strcmp(string, "023964") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_GET_BST_NO_REASON = YES; }
+    if (strcmp(string, "023970") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BSM_CELL_OVER_VOLTAGE = YES; }
+    if (strcmp(string, "023971") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BSM_CELL_UNDER_VOLTAGE = YES; }
+    if (strcmp(string, "023972") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BSM_OVER_SOC = YES; }
+    if (strcmp(string, "023973") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BSM_UNDER_SOC = YES; }
+    if (strcmp(string, "023974") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BSM_CURRENT = YES; }
+    if (strcmp(string, "023975") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BSM_TEMPERATURE = YES; }
+    if (strcmp(string, "023976") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BSM_ISOLATE = YES; }
+    if (strcmp(string, "023977") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.ERROR_CODE_BSM_OUTPUT_CONNECTOR = YES; }
+
+    if (strcmp(string, "023979") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.EV_Full_Charging = YES; }
+    if (strcmp(string, "023983") == EQUAL) { ShmStatusCodeData->InfoCode.InfoEvents.bits.Stop_by_EV_with_unknow_reason = YES; }
+
+    return true;
+}
+
+void CANReceiver()
+{
+    pid_t canRecPid;
+
+    canRecPid = fork();
+
+    if (canRecPid > 0) {
+        int nbytes;
+        struct can_frame frame;
+        int intCmd;
+        bool isClearBuf = false; //DS60-120 add
+
+        // 槍資訊
+        struct ChargingInfoData *_chargingData[CHAdeMO_QUANTITY + CCS_QUANTITY + GB_QUANTITY];
+        struct timeval _cmd_ack_timeout[CHAdeMO_QUANTITY + CCS_QUANTITY + GB_QUANTITY];
+
+        bool isPass = false;
+        gun_count = ShmSysConfigAndInfo->SysConfig.TotalConnectorCount;
+
+        while (!isPass) {
+            isPass = true;
+            for (byte _index = 0; _index < gun_count; _index++) {
+                if (!FindChargingInfoData(_index, &_chargingData[0])) {
+                    DEBUG_ERROR("EvComm (main) : FindChargingInfoData false \n");
+                    isPass = false;
+                    break;
+                }
+            }
+
+            sleep(1);
+        }
+
+        for (byte _index = 0; _index < gun_count; _index++) {
+            gettimeofday(&_cmd_ack_timeout[_index], NULL);
+        }
+
+        while (1) {
+            memset(&frame, 0, sizeof(struct can_frame));
+            nbytes = read(CanFd, &frame, sizeof(struct can_frame));
+
+            for (byte _index = 0; _index < gun_count; _index++) {
+                if (GetTimeoutValue(_cmd_ack_timeout[_index]) >= 5000000) {
+                    // ACK timeout
+                    //PRINTF_FUNC("gun = %x, ack timeout \n", _index);
+                }
+            }
+
+            if (nbytes > 0) {
+                byte target;
+                byte targetGun = 0x00;
+                byte findIndex = 0x00; //DS60-120 add
+                intCmd = (int) (frame.can_id & CAN_EFF_MASK);
+
+                if (!isClearBuf) { //DS60-120 add
+                    continue;
+                }
+
+                if (intCmd == ADDRESS_REQ) {
+#if defined METER_ENABLE
+                    ShmDcCommonData->CcsVersion = _CCS_VERSION_CHECK_TAG_V013S0;
+#endif //defined METER_ENABLE
+                    AddrAssignment(frame.data);
+                    continue;
+                }
+                intCmd = (int) (frame.can_id & CAN_EFF_MASK & 0xFFFFFF00);
+
+                target = ((byte) (frame.can_id & 0x000000FF));      // 0x01 or 0x02
+
+                for (byte _index = 0; _index < gun_count; _index++) {                    // 假設有找到回應的 Index
+                    findIndex = target;
+#if defined METER_ENABLE
+                    if (gun_count == 1 &&
+                            _chargingData[_index]->Type == _Type_CCS_2 &&
+                            ShmDcCommonData->CcsVersion == _CCS_VERSION_CHECK_TAG_V015S0) {
+                        target -= 1;
+                    }
+#endif //defined METER_ENABLE
+                    if (_chargingData[_index]->Evboard_id == target) {
+                        targetGun = _index;
+                        break;
+                    }
+                }
+                //PRINTF_FUNC("target = %d, %d, %d\r\n", target, _chargingData[targetGun]->Evboard_id, targetGun);
+
+                if (targetGun < 0 || targetGun >= CHAdeMO_QUANTITY + CCS_QUANTITY + GB_QUANTITY) {
+                    PRINTF_FUNC("EvComm (CANReceiver) : Target index = %x is < 0 or > QUANTITY \n", targetGun);
+                    continue;
+                }
+#if defined METER_ENABLE
+                else if (gun_count == 1 && targetGun == 0 && findIndex == 1 &&
+                         ShmDcCommonData->CcsVersion == _CCS_VERSION_CHECK_TAG_V015S0) {
+                    // 這樣的條件下~ 也是單槍 CCS 舊版本的狀況 : 因為舊版 CCS 不會 timeout, then send request id
+                    ShmDcCommonData->CcsVersion = _CCS_VERSION_CHECK_TAG_V013S0;
+                }
+#endif //defined METER_ENABLE
+
+                if (intCmd == 256) {
+                    continue;
+                }
+
+                gettimeofday(&_cmd_ack_timeout[targetGun], NULL);
+                switch (intCmd) {
+                case NOTIFICATION_EV_STATUS: {
+                    if (_chargingData[targetGun]->ConnectorPlugIn != frame.data[0]) {
+                        //PRINTF_FUNC("index = %d, ConnectorPlugIn = %x, data[0] = %x \n", targetGun, _chargingData[targetGun]->ConnectorPlugIn, frame.data[0]);
+
+                        if (frame.data[0] == PLUG) {
+                            PRINTF_FUNC("Conn %d, Plugin. \n", targetGun);
+                        } else if (frame.data[0] == UNPLUG) {
+                            PRINTF_FUNC("Conn %d, Unplug. \n", targetGun);
+                        } else {
+                            PRINTF_FUNC("Conn %d, None Check. (%d) \n", targetGun, frame.data[0]);
+                        }
+                    }
+
+                    _chargingData[targetGun]->ConnectorPlugIn = frame.data[0];
+                    _chargingData[targetGun]->PilotVoltage = frame.data[1];
+
+                    //PRINTF_FUNC("index = %d, ConnectorPlugIn = %x, data[0] = %x \n", targetGun, _chargingData[targetGun]->ConnectorPlugIn, frame.data[0]);
+                    //PRINTF_FUNC("ConnectorPlugIn = %x \n", (-120 + frame.data[1]) / 10);
+                }
+                break;
+                case ACK_EV_FW_VERSION: {
+                    byte ver[16];
+
+                    memset(ver, 0, sizeof(ver));
+                    if (_chargingData[targetGun]->Type == _Type_Chademo) {
+                        memcpy(ver, frame.data, frame.can_dlc);
+                        memcpy(ShmCHAdeMOData->evse[_chargingData[targetGun]->type_index].version, ver, ARRAY_SIZE(ver));
+                        ShmCHAdeMOData->evse[_chargingData[targetGun]->type_index].SelfTest_Comp = PASS;
+                        //PRINTF_FUNC("chademo ver. : %s\n", ShmCHAdeMOData->evse[_chargingData[targetGun]->type_index].version);
+                    } else if (_chargingData[targetGun]->Type == _Type_GB) {
+                        memcpy(ver, frame.data, frame.can_dlc);
+                        memcpy(ShmGBTData->evse[_chargingData[targetGun]->type_index].version, ver, ARRAY_SIZE(ver));
+                        ShmGBTData->evse[_chargingData[targetGun]->type_index].SelfTest_Comp = PASS;
+                        //PRINTF_FUNC("gbt ver. : %s\n", ShmGBTData->evse[_chargingData[targetGun]->type_index].version);
+                    } else if (_chargingData[targetGun]->Type == _Type_CCS_2) {
+                        if (ShmCcsData->CommProtocol == _CCS_COMM_V2GMessage_DIN70121) {
+                            memcpy(ver, frame.data, frame.can_dlc); //DS60-120 add
+
+                            //for (byte _vCount = 0, _vPoint = 0; _vCount < frame.can_dlc; _vCount++) {//DS60-120 remove
+                            /*if (_vCount % 2 == 0 && _vCount != 0)
+                            {
+                                ver[_vCount + _vPoint] = 0x2E;
+                                _vPoint++;
+                            }*/
+
+                            //ver[_vCount + _vPoint] = frame.data[_vCount];
+                            //}
+
+                            memcpy(&ShmCcsData->V2GMessage_DIN70121[_chargingData[targetGun]->type_index].version, ver, ARRAY_SIZE(ver));
+                            ShmCcsData->V2GMessage_DIN70121[_chargingData[targetGun]->type_index].SelfTest_Comp = PASS;
+                            //PRINTF_FUNC("CCS FW = %s \n", ShmCcsData->V2GMessage_DIN70121[_chargingData[targetGun]->type_index].version);
+                        }
+                    }
+
+                    if (targetGun == 0) {
+                        memset(ShmSysConfigAndInfo->SysInfo.Connector1FwRev, 0, sizeof(ShmSysConfigAndInfo->SysInfo.Connector1FwRev));
+                        memcpy(ShmSysConfigAndInfo->SysInfo.Connector1FwRev, ver, ARRAY_SIZE(ver));
+                    } else {
+                        memset(ShmSysConfigAndInfo->SysInfo.Connector2FwRev, 0, sizeof(ShmSysConfigAndInfo->SysInfo.Connector2FwRev));
+                        memcpy(ShmSysConfigAndInfo->SysInfo.Connector2FwRev, ver, ARRAY_SIZE(ver));
+                    }
+                }
+                break;
+                case ACK_EV_HW_VERSION: {
+                    //PRINTF_FUNC("Get EV HW = %s \n", frame.data);
+                }
+                break;
+                case ACK_GET_OUTPUT_REQ: {
+                    //DS60-120 add
+                    if ((_chargingData[targetGun]->SystemStatus >= S_PREPARING_FOR_EV &&
+                            _chargingData[targetGun]->SystemStatus <= S_CHARGING) ||
+                            (_chargingData[targetGun]->SystemStatus >= S_CCS_PRECHARGE_ST0 &&
+                             _chargingData[targetGun]->SystemStatus <= S_CCS_PRECHARGE_ST1)) {
+                        if (_chargingData[targetGun]->EvBatteryStartSoc <= 0) {
+                            _chargingData[targetGun]->EvBatteryStartSoc = frame.data[1];
+                        }
+
+                        if (frame.data[1] > _chargingData[targetGun]->EvBatterySoc) {
+                            _chargingData[targetGun]->EvBatterySoc = frame.data[1];
+                        }
+                    }
+                    //_chargingData[targetGun]->EvBatterySoc = frame.data[1]; //DS60-120 remove
+
+                    //Jerry add set voltage limit
+                    _chargingData[targetGun]->EvBatterytargetVoltage = (float)((frame.data[3] << 8) + frame.data[2]) / 10;
+                    if (_chargingData[targetGun]->EvBatterytargetVoltage > maxChargingVol[targetGun] * 0.1) {
+                        _chargingData[targetGun]->EvBatterytargetVoltage = maxChargingVol[targetGun] * 0.1;
+                    }
+                    //printf("id = %d, EvBatterytargetVoltage = %.2f\r\n", targetGun, _chargingData[targetGun]->EvBatterytargetVoltage);
+                    //Jerry add set currency limit
+                    _chargingData[targetGun]->EvBatterytargetCurrent = (float)((frame.data[5] << 8) + frame.data[4]) / 10;
+                    if (_chargingData[targetGun]->EvBatterytargetCurrent > maxChargingCur[targetGun] * 0.1) {
+                        _chargingData[targetGun]->EvBatterytargetCurrent = maxChargingCur[targetGun] * 0.1;
+                    }
+                    //printf("id = %d, EvBatterytargetCurrent = %.2f\r\n", targetGun, _chargingData[targetGun]->EvBatterytargetCurrent);
+
+                    _chargingData[targetGun]->RemainChargingDuration = ((short) frame.data[7] << 8) + (short) frame.data[6];
+                    //printf("RemainChargingDuration = %d\r\n",  _chargingData[targetGun]->RemainChargingDuration);
+
+                    if (_chargingData[targetGun]->Type == _Type_Chademo) {
+                        //if (ShmCHAdeMOData->ev[_chargingData[targetGun]->type_index].EvDetection != frame.data[0])
+                        {
+                            ShmCHAdeMOData->ev[_chargingData[targetGun]->type_index].PresentMsgFlowStatus = frame.data[0];
+                        }
+
+                        ShmCHAdeMOData->ev[_chargingData[targetGun]->type_index].EvDetection = frame.data[0];
+                        ShmCHAdeMOData->ev[_chargingData[targetGun]->type_index].SOC = _chargingData[targetGun]->EvBatterySoc;
+                        ShmCHAdeMOData->ev[_chargingData[targetGun]->type_index].TargetBatteryVoltage = (_chargingData[targetGun]->EvBatterytargetVoltage * 10);
+                        ShmCHAdeMOData->ev[_chargingData[targetGun]->type_index].ChargingCurrentRequest = (_chargingData[targetGun]->EvBatterytargetCurrent * 10);
+                    } else if (_chargingData[targetGun]->Type == _Type_GB) {
+                        //if (ShmGBTData->ev[_chargingData[targetGun]->type_index].EvDetection != frame.data[0])
+                        {
+                            ShmGBTData->ev[_chargingData[targetGun]->type_index].PresentMsgFlowStatus = frame.data[0];
+                        }
+
+                        ShmGBTData->ev[_chargingData[targetGun]->type_index].EvDetection = frame.data[0];
+                        ShmGBTData->ev[_chargingData[targetGun]->type_index].SOC = _chargingData[targetGun]->EvBatterySoc;
+                        ShmGBTData->ev[_chargingData[targetGun]->type_index].TargetBatteryVoltage = (_chargingData[targetGun]->EvBatterytargetVoltage * 10);
+                        ShmGBTData->ev[_chargingData[targetGun]->type_index].ChargingCurrentRequest = (_chargingData[targetGun]->EvBatterytargetCurrent * 10);
+                    } else if (_chargingData[targetGun]->Type == _Type_CCS_2) {
+                        if (ShmCcsData->CommProtocol == _CCS_COMM_V2GMessage_DIN70121) {
+                            ShmCcsData->V2GMessage_DIN70121[_chargingData[targetGun]->type_index].PresentMsgFlowStatus = frame.data[0];
+                        }
+                    }
+
+                    //PRINTF_FUNC("EvBatterytargetVoltage = %f \n", _chargingData[targetGun]->EvBatterytargetVoltage);
+                    //PRINTF_FUNC("EvBatterytargetCurrent = %f \n", _chargingData[targetGun]->EvBatterytargetCurrent);
+                    //PRINTF_FUNC("BatteryVoltage = %d \n", ShmCHAdeMOData->ev[_chargingData[target]->type_index].TargetBatteryVoltage);
+                    //PRINTF_FUNC("CurrentRequest = %d \n", ShmCHAdeMOData->ev[_chargingData[target]->type_index].ChargingCurrentRequest);
+                }
+                break;
+                case ACK_GET_EV_BATTERY_INFO: {
+                    //_chargingData[target].EvACorDCcharging = frame.data[0];
+                    //_chargingData[target]->TotalBatteryCap = ((float) frame.data[4] << 8) + (short) frame.data[3];
+                    _chargingData[targetGun]->EvBatteryMaxVoltage = (((short) frame.data[4] << 8) + (short) frame.data[3]) / 10;
+                    //_chargingData[target]->EvBatteryMaxCurrent = ((float) frame.data[4] << 8) + (short) frame.data[3];
+                    //_chargingData[target].MaxiBatteryCurrent = ((short) frame.data[6] << 8) + (short) frame.data[5];
+                    if (_chargingData[targetGun]->Type == _Type_Chademo) {
+                        ShmCHAdeMOData->ev[_chargingData[targetGun]->type_index].TotalBatteryCapacity = ((short) frame.data[2] << 8) + (short) frame.data[1];
+                        ShmCHAdeMOData->ev[_chargingData[targetGun]->type_index].MaxiBatteryVoltage = _chargingData[targetGun]->EvBatteryMaxVoltage;
+
+                        //PRINTF_FUNC("EvBatteryMaxVoltage = %f \n", _chargingData[target]->EvBatteryMaxVoltage);
+                        //PRINTF_FUNC("TotalBatteryCapacity = %d \n", ShmCHAdeMOData->ev[_chargingData[target]->type_index].TotalBatteryCapacity);
+                        //PRINTF_FUNC("MaxiBatteryVoltage = %d \n", ShmCHAdeMOData->ev[_chargingData[target]->type_index].MaxiBatteryVoltage);
+                    } else if (_chargingData[targetGun]->Type == _Type_GB) {
+                        ShmGBTData->ev[_chargingData[targetGun]->type_index].TotalBatteryCapacity = ((short) frame.data[2] << 8) + (short) frame.data[1];
+                        ShmGBTData->ev[_chargingData[targetGun]->type_index].MaxiBatteryVoltage = _chargingData[targetGun]->EvBatteryMaxVoltage;
+                    } else if (_chargingData[targetGun]->Type == _Type_CCS_2) {
+
+                    }
+                }
+                break;
+                case ACK_GET_MISCELLANEOUS_INFO: {
+                    _chargingData[targetGun]->GunLocked = frame.data[0];
+                    _chargingData[targetGun]->PilotVoltage = (float)(-120 + frame.data[3]) / 10;
+
+                    if (_chargingData[targetGun]->Type == _Type_Chademo) {
+                        ShmCHAdeMOData->evse[_chargingData[targetGun]->type_index].ConnectorTemperatureP = frame.data[1];
+                        ShmCHAdeMOData->evse[_chargingData[targetGun]->type_index].ConnectorTemperatureN = frame.data[2];
+                        ShmCHAdeMOData->evse[_chargingData[targetGun]->type_index].EvboardStatus = frame.data[7];
+                    } else if (_chargingData[targetGun]->Type == _Type_GB) {
+                        ShmGBTData->evse[_chargingData[targetGun]->type_index].ConnectorTemperatureP = frame.data[1];
+                        ShmGBTData->evse[_chargingData[targetGun]->type_index].ConnectorTemperatureN = frame.data[2];
+                        ShmGBTData->evse[_chargingData[targetGun]->type_index].EvboardStatus = frame.data[7];
+                    } else if (_chargingData[targetGun]->Type == _Type_CCS_2) {
+                        if (ShmCcsData->CommProtocol == _CCS_COMM_V2GMessage_DIN70121) {
+                            //ShmCcsData->V2GMessage_DIN70121[_chargingData[targetGun]->type_index]. .ConnectorTemperatureP = frame.data[1];
+                            //ShmCcsData->V2GMessage_DIN70121[_chargingData[targetGun]->type_index]. .ConnectorTemperatureN = frame.data[2];
+                        }
+                    }
+
+                    //PRINTF_FUNC("EvboardStatus = %x \n", ShmCHAdeMOData->evse[_chargingData[target]->type_index].EvboardStatus);
+                    //PRINTF_FUNC("ConnectorPlug locked = %x \n", frame.data[0]);
+                    //PRINTF_FUNC("ConnectorTemp 0= %d \n", ShmCHAdeMOData->evse[_chargingData[target]->type_index].ConnectorTemperatureP);
+                    //PRINTF_FUNC("ConnectorTemp 1= %d \n", ShmCHAdeMOData->evse[_chargingData[target]->type_index].ConnectorTemperatureN);
+                    //PRINTF_FUNC("PilotVoltage = %x \n", (-120 + frame.data[3]) / 10);
+                }
+                break;
+                case ACK_EVSE_ISOLATION_STATUS: {}
+                    break;
+                case ACK_EVSE_PRECHAGE_INFO: {
+                    _chargingData[targetGun]->PrechargeStatus = frame.data[0];
+                }
+                break;
+                case NOTIFICATION_EV_STOP: {
+                    // 車端要求停止
+                    if ((_chargingData[targetGun]->SystemStatus >= S_REASSIGN_CHECK && //DS60-120 add
+                            _chargingData[targetGun]->SystemStatus <= S_TERMINATING) ||
+                            (_chargingData[targetGun]->SystemStatus >= S_CCS_PRECHARGE_ST0 &&
+                             _chargingData[targetGun]->SystemStatus <= S_CCS_PRECHARGE_ST1)) {
+                        // frame.data[0] : 0x01 => normal stop, 0x02 => ev emergency stop
+                        PRINTF_FUNC("(%d) NOTIFICATION_EV_STOP err level = %d-----------------------------\n",
+                                    targetGun,
+                                    frame.data[0]);
+                        if (frame.data[0] == 0x02) {
+                            if (AbnormalStopAnalysis(targetGun, frame.data + 1) == true) {
+                                _chargingData[targetGun]->StopChargeFlag = YES;
+                            } else {
+                                _chargingData[targetGun]->NormalStopChargeFlag = YES;
+                            }
+                        } else {
+                            AbnormalStopAnalysis(targetGun, frame.data + 1);
+                            _chargingData[targetGun]->NormalStopChargeFlag = YES;
+                        }
+                    }
+                }
+                break;
+                default:
+                    PRINTF_FUNC("EV board = %d, Ack none defined. intCmd = %d  \n", targetGun, intCmd);
+                    break;
+                }
+            } else { //DS60-120 add
+                isClearBuf = true;
+                usleep(10000);
+            }
+        }
+    }
+}
+
+//================================================
+// Main process
+//================================================
+// 檢查 Byte 中某個 Bit 的值
+// _byte : 欲改變的 byte
+// _bit : 該 byte 的第幾個 bit
+unsigned char EvDetectionStatus(unsigned char _byte, unsigned char _bit)
+{
+    return ( _byte & mask_table[_bit] ) != 0x00;
+}
+
+bool IsConnectorPlugIn(struct ChargingInfoData *chargingData)
+{
+    return (chargingData->ConnectorPlugIn == 0x01) ? true : false;
+}
+
+void SetPresentChargingOutputPower(struct ChargingInfoData *chargingData_1, struct ChargingInfoData *chargingData_2)
+{
+    float vol1 = 0, cur1 = 0;
+    float vol2 = 0, cur2 = 0;
+
+    vol1 = chargingData_1->FireChargingVoltage;
+    cur1 = (chargingData_1->PresentChargingCurrent * 10);
+    vol2 = chargingData_2->FireChargingVoltage;
+    cur2 = (chargingData_2->PresentChargingCurrent * 10);
+
+    //DS60-120 add
+    if (
+        (LogInfo[0][EV_LOG_NOW_OUTPUT_VOL] >= vol1 + CHK_VOL_RANGE) || (LogInfo[0][EV_LOG_NOW_OUTPUT_VOL] <= vol1 - CHK_VOL_RANGE) ||
+        (LogInfo[0][EV_LOG_NOW_OUTPUT_CUR] >= cur1 + CHK_CUR_RANGE) || (LogInfo[0][EV_LOG_NOW_OUTPUT_CUR] <= cur1 - CHK_CUR_RANGE) ||
+        (LogInfo[1][EV_LOG_NOW_OUTPUT_VOL] >= vol2 + CHK_VOL_RANGE) || (LogInfo[1][EV_LOG_NOW_OUTPUT_VOL] <= vol2 - CHK_VOL_RANGE) ||
+        (LogInfo[1][EV_LOG_NOW_OUTPUT_CUR] >= cur2 + CHK_CUR_RANGE) || (LogInfo[1][EV_LOG_NOW_OUTPUT_CUR] <= cur2 - CHK_CUR_RANGE)
+    ) {
+        PRINTF_FUNC("G1 -> Output Vol = %.1f, Output Cur = %.1f -- G2 -> Output Vol = %.1f, Output Cur = %.1f\r\n",
+                    vol1 / 10, cur1 / 10, vol2 / 10, cur2 / 10);
+
+        LogInfo[0][EV_LOG_NOW_OUTPUT_VOL] = vol1;
+        LogInfo[0][EV_LOG_NOW_OUTPUT_CUR] = cur1;
+        LogInfo[1][EV_LOG_NOW_OUTPUT_VOL] = vol2;
+        LogInfo[1][EV_LOG_NOW_OUTPUT_CUR] = cur2;
+    }
+    //if (_outVol_1 != vol1 ||
+    //        _outCur_1 != cur1 ||
+    //        _outVol_2 != vol2 ||
+    //        _outCur_2 != cur2) {
+    /*PRINTF_FUNC("G1 -> Output Vol = %f, Output Cur = %f -- G2 -> Output Vol = %f, Output Cur = %f \n",
+        vol1, cur1, vol2, cur2);
+    */
+    //    _outVol_1 = vol1; _outCur_1 = cur1; _outVol_2 = vol2; _outCur_2 = cur2;
+    //}
+
+    SetPresentOutputPower(vol1, cur1, vol2, cur2);
+}
+
+void SetPresentChargingOutputCap(struct ChargingInfoData *chargingData_1, struct ChargingInfoData *chargingData_2)
+{
+    float pow1 = 0, cur1 = 0;
+    float pow2 = 0, cur2 = 0;
+
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
+    float vol = 0;
+#endif //!defined DD360 && !defined DD360Audi
+
+    pow1 = chargingData_1->AvailableChargingPower;
+    cur1 = chargingData_1->AvailableChargingCurrent;
+
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
+    vol = chargingData_1->MaximumChargingVoltage;
+    GetMaxVolAndCurMethod(chargingData_1->Index, &vol, &cur1);
+    GetMaxPowerMethod(chargingData_1->Index, &pow1);
+#endif //!defined DD360 && !defined DD360Audi
+
+    //DS60-120 add
+    if (pow1 <= 0) {
+        cur1 = 0;
+    } else {
+        if (chargingData_1->SystemStatus == S_CHARGING &&
+                chargingData_1->FireChargingVoltage > 1500) {
+            float maxCur = 0;
+            maxCur = (pow1 * 1000) / chargingData_1->FireChargingVoltage;
+
+            if (maxCur * 10 <= cur1) {
+                //PRINTF_FUNC("Gun1 -> MaxCharging Current = %f, Cap Current = %f \n", (maxCur * 10), cur1);
+                cur1 = maxCur * 10;
+            }
+        }
+    }
+
+    pow2 = chargingData_2->AvailableChargingPower;
+    cur2 = chargingData_2->AvailableChargingCurrent;
+
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
+    vol = chargingData_2->MaximumChargingVoltage;
+    GetMaxVolAndCurMethod(chargingData_2->Index, &vol, &cur2);
+    GetMaxPowerMethod(chargingData_2->Index, &pow2);
+#endif //!defined DD360 && !defined DD360Audi
+
+    //DS60-120 add
+    if (pow2 <= 0) {
+        cur2 = 0;
+    } else {
+        if (chargingData_2->SystemStatus == S_CHARGING &&
+                chargingData_2->FireChargingVoltage > 1500) {
+            float maxCur = 0;
+            maxCur = (pow2 * 1000) / chargingData_2->FireChargingVoltage;
+
+            if (maxCur * 10 <= cur2) {
+                //PRINTF_FUNC("Gun2 -> MaxCharging Current = %f, Cap Current = %f \n", (maxCur * 10), cur2);
+                cur2 = maxCur * 10;
+            }
+        }
+    }
+
+    //DS60-120 add
+    if ((LogInfo[0][EV_LOG_OUTPUT_CAP_POW] <= pow1 - 5 || LogInfo[0][EV_LOG_OUTPUT_CAP_POW] >= pow1 + 5) ||
+            (LogInfo[0][EV_LOG_OUTPUT_CAP_CUR] <= cur1 - 5 || LogInfo[0][EV_LOG_OUTPUT_CAP_CUR] >= cur1 + 5) ||
+            (LogInfo[1][EV_LOG_OUTPUT_CAP_POW] <= pow2 - 5 || LogInfo[1][EV_LOG_OUTPUT_CAP_POW] >= pow2 + 5) ||
+            (LogInfo[1][EV_LOG_OUTPUT_CAP_CUR] <= cur2 - 5 || LogInfo[1][EV_LOG_OUTPUT_CAP_CUR] >= cur2 + 5)) {
+        //PRINTF_FUNC("----------------------------------------------------- \n");
+        PRINTF_FUNC("To EV (Real) Power_1 = %.1f, Cur_1 = %.1f, Power_2 = %.1f, Cur_2 = %.1f\r\n",
+                    pow1 / 10, cur1 / 10, pow2 / 10, cur2 / 10);
+        //PRINTF_FUNC("----------------------------------------------------- \n");
+
+        LogInfo[0][EV_LOG_OUTPUT_CAP_POW] = pow1;
+        LogInfo[0][EV_LOG_OUTPUT_CAP_CUR] = cur1;
+        LogInfo[1][EV_LOG_OUTPUT_CAP_POW] = pow2;
+        LogInfo[1][EV_LOG_OUTPUT_CAP_CUR] = cur2;
+        chargingData_1->RealMaxCurrent = cur1;
+        chargingData_1->RealMaxPower = pow1;
+
+        if (gun_count == 2) {
+            chargingData_2->RealMaxCurrent = cur2;
+            chargingData_2->RealMaxPower = pow2;
+        }
+    }
+
+    //DS60-120 remove
+    /*if (_pow_1 != pow1 ||
+            _cur_1 != cur1 ||
+            _pow_2 != pow2 ||
+            _cur_2 != cur2) {
+        PRINTF_FUNC("To EV (Real) Power_1 = %f, Cur_1 = %f, Power_2 = %f, Cur_2 = %f \n",
+                    pow1, cur1, pow2, cur2);
+        _pow_1 = pow1; _cur_1 = cur1; _pow_2 = pow2; _cur_2 = cur2;
+        chargingData_1->RealMaxCurrent = _cur_1;
+        chargingData_1->RealMaxPower = pow1;
+
+        if (gun_count == 2) {
+            chargingData_2->RealMaxCurrent = cur2;
+            chargingData_2->RealMaxPower = pow2;
+        }
+    }*/
+
+    SetPresentOutputCapacity(pow1, cur1, pow2, cur2);
+}
+
+void Initialization()
+{
+    bool isPass = false;
+    while (!isPass) {
+        isPass = true;
+        for (byte _index = 0; _index < gun_count; _index++) {
+            if (!FindChargingInfoData(_index, &_chargingData[0])) {
+                DEBUG_ERROR("EvComm (main) : FindChargingInfoData false \n");
+                isPass = false;
+                break;
+            }
+        }
+        sleep(1);
+    }
+}
+
+void GetMaxVolAndCurMethod(byte index, float *vol, float *cur)
+{
+    if (maxChargingVol[index] != 0 && maxChargingVol[index] <= *vol) {
+        *vol = maxChargingVol[index];
+    }
+
+    if (maxChargingCur[index] != 0 && maxChargingCur[index] <= *cur) {
+        *cur = maxChargingCur[index];
+    }
+
+    //if (_chargingData[index]->SystemStatus == S_CHARGING && //DS60-120 remove
+    //        _chargingData[index]->ChargingProfileCurrent > 0 &&
+    if (((_chargingData[index]->SystemStatus >= S_PREPARING_FOR_EVSE && _chargingData[index]->SystemStatus <= S_CHARGING) ||
+            (_chargingData[index]->SystemStatus >= S_CCS_PRECHARGE_ST0 && _chargingData[index]->SystemStatus <= S_CCS_PRECHARGE_ST1)) &&
+            _chargingData[index]->ChargingProfileCurrent >= 0 &&
+            _chargingData[index]->ChargingProfileCurrent <= *cur) {
+        *cur = _chargingData[index]->ChargingProfileCurrent;
+    }
+}
+
+void GetMaxPowerMethod(byte index, float *pow)
+{
+    if (maxChargingPow != 0 && maxChargingPow <= *pow) {
+        *pow = maxChargingPow;
+    }
+
+    if (_chargingData[index]->SystemStatus == S_CHARGING &&
+            _chargingData[index]->ChargingProfilePower > 0 &&
+            _chargingData[index]->ChargingProfilePower <= *pow) {
+        *pow = _chargingData[index]->ChargingProfilePower;
+    }
+}
+
+time_t GetRtcInfoForEpoch()
+{
+    struct timeb csuTime;
+    struct tm *tmCSU;
+    struct tm t;
+    time_t result;
+
+    ftime(&csuTime);
+    tmCSU = localtime(&csuTime.time);
+
+    t.tm_year = tmCSU->tm_year;
+    t.tm_mon = tmCSU->tm_mon;
+    t.tm_mday = tmCSU->tm_mday;
+    t.tm_hour = tmCSU->tm_hour;
+    t.tm_min = tmCSU->tm_min;
+    t.tm_sec = tmCSU->tm_sec;
+    t.tm_isdst = -1;
+    result = mktime(&t);
+
+    return result;
+}
+
+byte GetStopChargingReasonByEvse(byte gunIndex, byte *reason)
+{
+    byte result = NO;
+
+    if (ShmStatusCodeData->AlarmCode.AlarmEvents.bits.EmergencyStopTrip == 0x01) {
+        // 012251
+        *(reason + 5)  = 0;
+        *(reason + 4)  = 1;
+        *(reason + 3)  = 2;
+        *(reason + 2)  = 2;
+        *(reason + 1)  = 5;
+        *(reason + 0)  = 1;
+        result = YES;
+    }
+
+    if (_chargingData[gunIndex]->Type == _Type_Chademo) {
+        if (ShmStatusCodeData->FaultCode.FaultEvents.bits.ChademoOutputRelayDrivingFault == YES) {
+            // 011012
+            *(reason + 5) = 0;
+            *(reason + 4) = 1;
+            *(reason + 3) = 1;
+            *(reason + 2) = 0;
+            *(reason + 1) = 1;
+            *(reason + 0) = 2;
+            result = YES;
+        } else if (ShmStatusCodeData->AlarmCode.AlarmEvents.bits.ChademoOutputUVPFail == YES) {
+            // 012289
+            *(reason + 5) = 0;
+            *(reason + 4) = 1;
+            *(reason + 3) = 2;
+            *(reason + 2) = 2;
+            *(reason + 1) = 8;
+            *(reason + 0) = 9;
+            result = YES;
+        } else if (ShmStatusCodeData->AlarmCode.AlarmEvents.bits.ChademoGfdTrip == YES) {
+            // 012234
+            *(reason + 5) = 0;
+            *(reason + 4) = 1;
+            *(reason + 3) = 2;
+            *(reason + 2) = 2;
+            *(reason + 1) = 3;
+            *(reason + 0) = 4;
+            result = YES;
+        }
+    } else if (_chargingData[gunIndex]->Type == _Type_GB) {
+        if (ShmStatusCodeData->FaultCode.FaultEvents.bits.ChademoOutputRelayDrivingFault == YES) {
+            // 012290
+            *(reason + 5) = 0;
+            *(reason + 4) = 1;
+            *(reason + 3) = 2;
+            *(reason + 2) = 2;
+            *(reason + 1) = 9;
+            *(reason + 0) = 0;
+            result = YES;
+        } else if (ShmStatusCodeData->AlarmCode.AlarmEvents.bits.GbGfdTrip == YES) {
+            // 012236
+            *(reason + 5) = 0;
+            *(reason + 4) = 1;
+            *(reason + 3) = 2;
+            *(reason + 2) = 2;
+            *(reason + 1) = 3;
+            *(reason + 0) = 6;
+            result = YES;
+        }
+    } else if (_chargingData[gunIndex]->Type == _Type_CCS_2) {
+        if (ShmStatusCodeData->FaultCode.FaultEvents.bits.CcsOutputRelayDrivingFault == YES) {
+            // 011014
+            *(reason + 5) = 0;
+            *(reason + 4) = 1;
+            *(reason + 3) = 1;
+            *(reason + 2) = 0;
+            *(reason + 1) = 1;
+            *(reason + 0) = 4;
+            result = YES;
+        } else if (ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CcsOutputUVPFail == YES) {
+            // 012288
+            *(reason + 5) = 0;
+            *(reason + 4) = 1;
+            *(reason + 3) = 2;
+            *(reason + 2) = 2;
+            *(reason + 1) = 8;
+            *(reason + 0) = 8;
+            result = YES;
+        } else if (ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CcsGfdTrip == YES) {
+            // 012235
+            *(reason + 5) = 0;
+            *(reason + 4) = 1;
+            *(reason + 3) = 2;
+            *(reason + 2) = 2;
+            *(reason + 1) = 3;
+            *(reason + 0) = 5;
+            result = YES;
+        }
+    }
+
+    return result;
+}
+
+#if defined METER_ENABLE
+void SendCommunicationOnly(byte index)
+{
+    byte targetID = _chargingData[index]->Evboard_id;
+
+    if (gun_count == 1 &&
+            _chargingData[index]->Type == _Type_CCS_2 &&
+            ShmDcCommonData->CcsVersion == _CCS_VERSION_CHECK_TAG_V015S0) {
+        targetID += 1;
+    }
+
+    SetChargingPermission(index, COMMUNICATION,
+                          _chargingData[index]->AvailableChargingPower,
+                          0,
+                          0,
+                          targetID);
+}
+
+void SendStopOnly(byte index)
+{
+    byte targetID = _chargingData[index]->Evboard_id;
+
+    if (gun_count == 1 &&
+            _chargingData[index]->Type == _Type_CCS_2 &&
+            ShmDcCommonData->CcsVersion == _CCS_VERSION_CHECK_TAG_V015S0) {
+        targetID += 1;
+    }
+
+    SetChargingPermission(index, STOP,
+                          _chargingData[index]->AvailableChargingPower,
+                          0,
+                          0,
+                          targetID);
+}
+#endif //defined METER_ENABLE
+
+void FormatVoltageAndCurrent()
+{
+    char isLowCur = 0x00;
+    char EvsePower[2];
+
+    EvsePower[2] = '\0';
+    if (strlen((char *) ShmSysConfigAndInfo->SysConfig.ModelName) >= 6) {
+        strncpy(EvsePower, (char *)(ShmSysConfigAndInfo->SysConfig.ModelName + 4), 2);
+
+        if (strcmp(EvsePower, "30") == EQUAL) {
+            isLowCur = 0x00;
+        } else if (strcmp(EvsePower, "60") == EQUAL) {
+            isLowCur = 0x01;
+        } else {
+            isLowCur = 0x02;
+        }
+    }
+
+    for (byte _index = 0; _index < gun_count; _index++) {
+        if (_chargingData[_index]->Type == _Type_Chademo) {
+            maxChargingVol[_index] = chademoVol;
+        } else if (_chargingData[_index]->Type == _Type_CCS_2) {
+            maxChargingVol[_index] = ccsVol;
+        } else if (_chargingData[_index]->Type == _Type_GB) {
+            maxChargingVol[_index] = gbVol;
+        }
+
+        if (isLowCur == 0x00) {
+            if (_chargingData[_index]->Type == _Type_Chademo) {
+                maxChargingCur[_index] = 600;
+            } else if (_chargingData[_index]->Type == _Type_CCS_2) {
+                maxChargingCur[_index] = 600;
+            } else if (_chargingData[_index]->Type == _Type_GB) {
+                maxChargingCur[_index] = 800;
+            }
+        } else if (isLowCur == 0x01) {
+            if (_chargingData[_index]->Type == _Type_Chademo) {
+                maxChargingCur[_index] = 1200;
+            } else if (_chargingData[_index]->Type == _Type_CCS_2) {
+                maxChargingCur[_index] = 1200;
+            } else if (_chargingData[_index]->Type == _Type_GB) {
+                maxChargingCur[_index] = 1200;
+            }
+        } else {
+            if (_chargingData[_index]->Type == _Type_Chademo) {
+                if (_index == 0) {
+                    if (strncmp((char *)&ShmSysConfigAndInfo->SysConfig.ModelName[7], "K", 1) == 0) {
+                        maxChargingCur[_index] = 2000;
+                    } else {
+                        maxChargingCur[_index] = 1200;
+                    }
+                } else if (_index == 1) {
+                    if (strncmp((char *)&ShmSysConfigAndInfo->SysConfig.ModelName[9], "K", 1) == 0) {
+                        maxChargingCur[_index] = 2000;
+                    } else {
+                        maxChargingCur[_index] = 1200;
+                    }
+                }
+            } else if (_chargingData[_index]->Type == _Type_CCS_2) {
+                if (_index == 0) {
+                    if ((strncmp((char *)&ShmSysConfigAndInfo->SysConfig.ModelName[7], "V", 1) == 0) ||
+                            (strncmp((char *)&ShmSysConfigAndInfo->SysConfig.ModelName[7], "F", 1) == 0)
+                       ) {
+                        maxChargingCur[_index] = 5000;
+                    } else {
+                        maxChargingCur[_index] = 2000;
+                    }
+                } else if (_index == 1) {
+                    if ((strncmp((char *)&ShmSysConfigAndInfo->SysConfig.ModelName[9], "V", 1) == 0) ||
+                            (strncmp((char *)&ShmSysConfigAndInfo->SysConfig.ModelName[9], "F", 1) == 0)
+                       ) {
+                        maxChargingCur[_index] = 5000;
+                    } else {
+                        maxChargingCur[_index] = 2000;
+                    }
+                }
+            } else if (_chargingData[_index]->Type == _Type_GB) {
+                maxChargingCur[_index] = 2500;
+            }
+        }
+    }
+}
+
+// 如果是使用 Meter 計算的話
+void CalOutputPowerAndEnergy(int _index)
+{
+    if (ShmSysConfigAndInfo->SysConfig.ModelName[3] == 'M' ||
+            ShmSysConfigAndInfo->SysConfig.ModelName[3] == 'L') {
+        //printf("(%d), totalChargingValue = %f \n", _index, ShmCsuMeterData->_meter[_index]._curTotalCharging / 100);
+#if defined METER_ENABLE
+        float totalChargingValue = ShmCsuMeterData->_meter[_index]._curTotalCharging / 100;
+
+        _chargingData[_index]->PresentChargedEnergy = totalChargingValue;
+        _chargingData[_index]->PowerConsumption = totalChargingValue;
+
+        if (ShmSysConfigAndInfo->SysConfig.BillingData.isBilling) {
+            _chargingData[_index]->ChargingFee = totalChargingValue * ShmSysConfigAndInfo->SysConfig.BillingData.Cur_fee;
+        }
+#endif //METER_ENABLE
+    } else {
+        if (chargingTime[_index] == 0 ||
+                chargingTime[_index] > _chargingData[_index]->PresentChargedDuration) {
+            chargingTime[_index] = _chargingData[_index]->PresentChargedDuration;
+        } else {
+            int passTime = _chargingData[_index]->PresentChargedDuration - chargingTime[_index];
+
+            if (passTime > 0) {
+                float changingPow = (_chargingData[_index]->PresentChargingPower) * passTime / 3600;
+                if (ShmSysConfigAndInfo->SysConfig.BillingData.isBilling) {
+                    _chargingData[_index]->ChargingFee += changingPow * ShmSysConfigAndInfo->SysConfig.BillingData.Cur_fee;
+                }
+
+                _chargingData[_index]->PresentChargedEnergy += changingPow;
+                _chargingData[_index]->PowerConsumption += changingPow;
+                chargingTime[_index] = _chargingData[_index]->PresentChargedDuration;
+            }
+        }
+    }
+}
+
+int main(int argc, char *argv[])
+{
+    if (InitShareMemory() == FAIL) {
+#ifdef SystemLogMessage
+        DEBUG_ERROR("InitShareMemory NG\n");
+#endif
+        if (ShmStatusCodeData != NULL) {
+            ShmStatusCodeData->AlarmCode.AlarmEvents.bits.FailToCreateShareMemory = 1;
+        }
+        sleep(5);
+        return 0;
+    }
+
+    gun_count = ShmSysConfigAndInfo->SysConfig.TotalConnectorCount;
+    Initialization();
+    // 根據輸出能量與槍別給予當前最大耐壓耐流
+    FormatVoltageAndCurrent(); //DS60-120 add
+    CanFd = InitCanBus();
+    CANReceiver();
+
+    byte priorityLow = 1;
+    time_t rtc = GetRtcInfoForEpoch();
+
+    for (byte _index = 0; _index < gun_count; _index++) { //DS60-120 add
+        if (_chargingData[_index]->Type == _Type_Chademo) {
+            PRINTF_FUNC("Conn %d (Chademo), MaxVol = %f, MaxCur = %f \n",
+                        _index, maxChargingVol[_index], maxChargingCur[_index]);
+        } else if (_chargingData[_index]->Type == _Type_CCS_2) {
+            PRINTF_FUNC("Conn %d (CCS), MaxVol = %f, MaxCur = %f \n",
+                        _index, maxChargingVol[_index], maxChargingCur[_index]);
+        } else if (_chargingData[_index]->Type == _Type_GB) {
+            PRINTF_FUNC("Conn %d (GBT), MaxVol = %f, MaxCur = %f \n",
+                        _index, maxChargingVol[_index], maxChargingCur[_index]);
+        }
+    }
+
+    while (CanFd) {
+        for (byte _index = 0; _index < gun_count; _index++) {
+            byte targetID = _chargingData[_index]->Evboard_id;
+
+#if defined METER_ENABLE //DS60-120 add
+            if (gun_count == 1 &&
+                    _chargingData[_index]->Type == _Type_CCS_2 &&
+                    ShmDcCommonData->CcsVersion == _CCS_VERSION_CHECK_TAG_V015S0) {
+                targetID += 1;
+            }
+#endif //defined METER_ENABLE
+
+            if (priorityLow == 1) {
+                // 優先權較低 - 只要有回應即不會再詢問
+                if (_chargingData[_index]->Type == _Type_Chademo &&
+                        ShmCHAdeMOData->evse[_chargingData[_index]->type_index].SelfTest_Comp != PASS) {
+                    SyncRtcInfo(_index, _chargingData[_index]->Evboard_id, (int)rtc);
+                    GetFirmwareVersion(_index, _chargingData[_index]->Evboard_id);
+                } else if (_chargingData[_index]->Type == _Type_GB &&
+                           ShmGBTData->evse[_chargingData[_index]->type_index].SelfTest_Comp != PASS) {
+                    SyncRtcInfo(_index, _chargingData[_index]->Evboard_id, (int)rtc);
+                    GetFirmwareVersion(_index, _chargingData[_index]->Evboard_id);
+                } else if (_chargingData[_index]->Type == _Type_CCS_2) {
+                    if (ShmCcsData->CommProtocol == _CCS_COMM_V2GMessage_DIN70121 &&
+                            ShmCcsData->V2GMessage_DIN70121[_chargingData[_index]->type_index].SelfTest_Comp != PASS) {
+                        SyncRtcInfo(_index, _chargingData[_index]->Evboard_id, (int)rtc);
+                        GetFirmwareVersion(_index, _chargingData[_index]->Evboard_id);
+                    }
+                }
+
+                // 固定要取得的資訊 : 1.槍鎖狀態, 2."Connector 1" 溫度, 3."Connector 2" 溫度, 4.Pilot Voltage
+                //PRINTF_FUNC("GetMiscellaneousInfo. index = %d, Eid = %d \n", _index, _chargingData[_index]->Evboard_id);
+                GetMiscellaneousInfo(_index,
+                                     _chargingData[_index]->RelayK1K2Status,
+                                     _chargingData[_index]->PresentChargedEnergy,
+                                     (_chargingData[_index]->PresentChargingVoltage * 10),
+                                     _chargingData[_index]->Evboard_id);
+            }
+
+            switch (_chargingData[_index]->SystemStatus) {
+            case S_IDLE:
+            case S_RESERVATION:
+                if (_chargingData[_index]->Type == _Type_Chademo) {
+                    ClearAbnormalStatus_Chademo(_index);
+
+#if defined METER_ENABLE //DS60-120 add
+                    if (ShmSysConfigAndInfo->SysInfo.PageIndex == _LCM_WAIT_FOR_PLUG) {
+                        if (!chkChademoPermission[_index]) {
+                            chkChademoPermission[_index] = true;
+                            gettimeofday(&_chk_chademo_permission_timeout[_index], NULL);
+                            SendCommunicationOnly(_index);
+                        } else {
+                            if (GetTimeoutValue(_chk_chademo_permission_timeout[_index]) / 1000 > 10000) {
+                                SendCommunicationOnly(_index);
+                                gettimeofday(&_chk_chademo_permission_timeout[_index], NULL);
+                            }
+                        }
+                    } else if (chkChademoPermission[_index]) {
+                        chkChademoPermission[_index] = false;
+                        SendStopOnly(_index);
+                    }
+#endif //defined METER_ENABLE
+                } else if (_chargingData[_index]->Type == _Type_GB) {
+                    ClearAbnormalStatus_GB(_index);
+                } else if (_chargingData[_index]->Type == _Type_CCS_2) {
+                    ClearAbnormalStatus_CCS(_index);
+                }
+
+                if (priorityLow == 1) {
+                    _chargingData[_index]->PresentChargedEnergy = 0;
+                    _chargingData[_index]->PresentChargingPower = 0;
+                    _chargingData[_index]->GroundFaultStatus = GFD_WAIT;
+                    _chargingData[_index]->RealRatingPower = 0;
+                    _chargingData[_index]->StopChargeFlag = NO;
+                    _chargingData[_index]->NormalStopChargeFlag = NO;//DS60-120 add
+                    _chargingData[_index]->ChargingFee = 0.0;
+                    _chargingData[_index]->EvBatterySoc = 0;
+                    _chargingData[_index]->EvBatteryStartSoc = 0; //DS60-120 add
+                    _chargingData[_index]->EvBatteryMaxVoltage = 0; //DS60-120 add
+                    _chargingData[_index]->ChargingProfilePower = -1; //DS60-120 add
+                    _chargingData[_index]->ChargingProfileCurrent = -1; //DS60-120 add
+
+                    if (ShmSysConfigAndInfo->SysInfo.MainChargingMode == _MAIN_CHARGING_MODE_MAX) { //DS60-120 add
+
+                        _chargingData[_index]->PresentChargingVoltage = 0;
+                        _chargingData[_index]->PresentChargingCurrent = 0;
+                        _chargingData[_index]->EvBatteryMaxVoltage = 0;
+                    }
+
+                    chargingTime[_index] = 0;
+                    //maxChargingCur[_index] = ShmSysConfigAndInfo->SysConfig.MaxChargingCurrent * 10;
+                    //maxChargingPow = (ShmSysConfigAndInfo->SysConfig.MaxChargingPower * 10);
+                    //DS60-120 add
+                    SendErrorCount[_index] = 0;
+#if defined METER_ENABLE //DS60-120 add
+                    // 使用 Meter 狀況
+                    if (ShmSysConfigAndInfo->SysConfig.ModelName[3] == 'M' ||
+                            ShmSysConfigAndInfo->SysConfig.ModelName[3] == 'L') {
+                        if (ShmCsuMeterData->_meter[_index].isCalculation == NO) {
+                            if (ShmCsuMeterData->_meter[_index].curMeterValue != 0 ||
+                                    ShmCsuMeterData->_meter[_index]._chargingValue != 0 ||
+                                    ShmCsuMeterData->_meter[_index]._curTotalCharging != 0 ) {
+                                ShmCsuMeterData->_meter[_index].curMeterValue = 0;
+                                ShmCsuMeterData->_meter[_index]._chargingValue = 0;
+                                ShmCsuMeterData->_meter[_index]._curTotalCharging = 0;
+                            }
+                        }
+                    }
+#endif //defined METER_ENABLE
+
+                    //maxChargingPow = ShmSysConfigAndInfo->SysConfig.MaxChargingPower * 10;
+                    // ShmPsuData->SystemAvailablePower 已是 * 10
+                    maxChargingPow = ShmPsuData->SystemAvailablePower;
+                    if (ShmSysConfigAndInfo->SysConfig.MaxChargingPower * 10 != 0 &&
+                            ShmSysConfigAndInfo->SysConfig.MaxChargingPower * 10 < maxChargingPow) {
+                        maxChargingPow = ShmSysConfigAndInfo->SysConfig.MaxChargingPower * 10;
+                    }
+
+                    LogInfo[_index][EV_LOG_EVSE_MAX_VOL] = 0;
+                    LogInfo[_index][EV_LOG_EVSE_MAX_CUR] = 0;
+                    LogInfo[_index][EV_LOG_MAX_BATT_VOL] = 0;
+                    LogInfo[_index][EV_LOG_REAL_CAP_POW] = 0;
+                    LogInfo[_index][EV_LOG_SOC] = 0;
+
+                    if (gun_count == 1) {
+                        SetPresentChargingOutputPower(_chargingData[0], _chargingData[0]);
+                    } else if (gun_count == 2) {
+                        SetPresentChargingOutputPower(_chargingData[0], _chargingData[1]);
+                    }
+                }
+                break;
+            case S_PREPARNING: {
+                chkChademoPermission[_index] = false; //DS60-120 add
+                // 設定當前輸出
+                if (gun_count == 1) {
+                    SetPresentChargingOutputPower(_chargingData[0], _chargingData[0]);
+                } else if (gun_count == 2) {
+                    SetPresentChargingOutputPower(_chargingData[0], _chargingData[1]);
+                }
+
+                _chargingData[_index]->PowerConsumption = 0;
+            }
+            break;
+            case S_PREPARING_FOR_EV: {
+                // 開始確認車端是否同意開始充電 : 1.SOC, 2.Target Vol, 3.Target Cur, 4.Charging remaining time
+                GetOutputReq(_index, _chargingData[_index]->Evboard_id);
+
+//                  PRINTF_FUNC("PresentChargingVoltage = %f \n", _chargingData[_index]->PresentChargingVoltage);
+//                  PRINTF_FUNC("PresentChargingCurrent = %f \n", _chargingData[_index]->PresentChargingCurrent);
+//                  PRINTF_FUNC("AvailableChargingPower = %f \n", _chargingData[_index]->AvailableChargingPower);
+//                  PRINTF_FUNC("AvailableChargingCurrent = %f \n", _chargingData[_index]->AvailableChargingCurrent);
+//                  PRINTF_FUNC("MaximumChargingVoltage = %f \n", _chargingData[_index]->MaximumChargingVoltage);
+
+                // 設定當前輸出
+                if (gun_count == 1) {
+                    SetPresentChargingOutputPower(_chargingData[0], _chargingData[0]);
+                } else if (gun_count == 2) {
+                    SetPresentChargingOutputPower(_chargingData[0], _chargingData[1]);
+                }
+
+                if (priorityLow == 1) {
+                    float maxVol, maxCur;
+                    // 樁端輸出能力
+                    maxVol = _chargingData[_index]->MaximumChargingVoltage;
+                    maxCur = _chargingData[_index]->AvailableChargingCurrent;
+
+                    GetMaxVolAndCurMethod(_index, &maxVol, &maxCur);
+
+                    //DS60-120 add
+                    if (LogInfo[_index][EV_LOG_EVSE_MAX_VOL] != maxVol ||
+                            LogInfo[_index][EV_LOG_EVSE_MAX_CUR] != maxCur) {
+                        LogInfo[_index][EV_LOG_EVSE_MAX_VOL] = maxVol;
+                        LogInfo[_index][EV_LOG_EVSE_MAX_CUR] = maxCur;
+
+                        PRINTF_FUNC("To EV_%d Max_Vol = %.1f, Cap_Cur = %.1f, Cap_Pow = %.1f \n",
+                                    _index, maxVol / 10, maxCur / 10, _chargingData[_index]->AvailableChargingPower / 10);
+                    }
+                    //PRINTF_FUNC("To EV_%d Max_Vol = %f, Cap_Cur = %f, Cap_Pow = %f \n",
+                    //            _index, maxVol, maxCur, _chargingData[_index]->AvailableChargingPower);
+
+                    _chargingData[_index]->RealMaxVoltage = maxVol;
+
+                    SetChargingPermission(_index, START,
+                                          _chargingData[_index]->AvailableChargingPower,
+                                          maxCur,
+                                          maxVol,
+                                          _chargingData[_index]->Evboard_id);
+
+                    // 取得車端電池資訊 : 1.AC or DC ? 2.Total battery cap, 3.Max battery vol, 4.Max battery cur
+                    GetEvBatteryInfo(_index, _chargingData[_index]->Evboard_id);
+                }
+                gettimeofday(&_chk_ratingPower_timeout[_index], NULL);
+            }
+            break;
+            case S_PREPARING_FOR_EVSE:
+            case S_CCS_PRECHARGE_ST0:
+            case S_CCS_PRECHARGE_ST1: {
+                // 開始確認車端是否同意開始充電
+                GetOutputReq(_index, _chargingData[_index]->Evboard_id);
+
+                // 設定當前輸出
+                if (gun_count == 1) {
+                    SetPresentChargingOutputPower(_chargingData[0], _chargingData[0]);
+                } else if (gun_count == 2) {
+                    SetPresentChargingOutputPower(_chargingData[0], _chargingData[1]);
+                }
+
+                if (priorityLow % 5 == 1) {
+                    // 取得車端電池資訊 : 1.AC or DC ? 2.Total battery cap, 3.Max battery vol, 4.Max battery cur
+                    GetEvBatteryInfo(_index, _chargingData[_index]->Evboard_id); //DS60-120 add
+
+                    // 樁端輸出能力改變
+                    if (gun_count == 1) {
+                        SetPresentChargingOutputCap(_chargingData[0], _chargingData[0]);
+                    } else if (gun_count == 2) {
+                        SetPresentChargingOutputCap(_chargingData[0], _chargingData[1]);
+                    }
+                }
+
+                //DS60-120 add
+                if (LogInfo[_index][EV_LOG_MAX_BATT_VOL] != _chargingData[_index]->EvBatteryMaxVoltage) {
+                    LogInfo[_index][EV_LOG_MAX_BATT_VOL] = _chargingData[_index]->EvBatteryMaxVoltage;
+                    PRINTF_FUNC("index = %d, Ev Maximum Battery Voltage = %f \n", _index, _chargingData[_index]->EvBatteryMaxVoltage);
+                }
+
+                if (LogInfo[_index][EV_LOG_SOC] != _chargingData[_index]->EvBatterySoc) {
+                    LogInfo[_index][EV_LOG_SOC] = _chargingData[_index]->EvBatterySoc;
+                    PRINTF_FUNC("index = %d, SOC = %d \n", _index, _chargingData[_index]->EvBatterySoc);
+                }
+
+                // 持續通知 Isolation 測試狀態
+                if (priorityLow == 1) {
+                    // 拉 500 V 如果在一秒鐘內 GFD 都符合則 PASS
+//                      if (_chargingData[_index]->FireChargingVoltage >= 3500)
+//                          _chargingData[_index]->GroundFaultStatus = GFD_PASS;
+
+                    //PRINTF_FUNC("To EV_%d GFD = %d \n",   _index, _chargingData[_index]->GroundFaultStatus);
+                    //if(_chargingData[_index]->GroundFaultStatus != GFD_WAIT)
+                    {
+                        //if ((GetTimeoutValue(_derating_time) / 1000) > 1000)
+                        unsigned char _result = _chargingData[_index]->GroundFaultStatus;
+
+                        // GB & Chademo ~ Warning 也先算 Pass，因為 CCS 認證會驗 Warning 故不可更動
+                        if (_chargingData[_index]->Type == _Type_Chademo ||
+                                _chargingData[_index]->Type == _Type_GB) {
+                            if (_result == GFD_WARNING) {
+                                _result = GFD_PASS;
+                            }
+                        }
+
+                        if (_result == GFD_WARNING || _result == GFD_PASS) {
+                            if (((GetTimeoutValue(_chk_ratingPower_timeout[_index]) / 1000) > 12000 &&
+                                    _chargingData[_index]->RealRatingPower > 0) ||
+                                    (GetTimeoutValue(_chk_ratingPower_timeout[_index]) / 1000) > 14000) {
+                                //PRINTF_FUNC("**********EvComm : _index= %d, RealRatingPower = %d \n",
+                                //            _index, _chargingData[_index]->RealRatingPower);
+                                //_result = GFD_PASS;
+
+                                //DS60-120 add
+                                if (LogInfo[_index][EV_LOG_REAL_CAP_POW] != _chargingData[_index]->RealRatingPower) {
+                                    LogInfo[_index][EV_LOG_REAL_CAP_POW] = _chargingData[_index]->RealRatingPower;
+                                    PRINTF_FUNC("Conn %d, RealRatingPower = %d \n",
+                                                _index, _chargingData[_index]->RealRatingPower);
+
+                                }
+                            } else {
+                                _result = GFD_WAIT;
+                            }
+                        }
+
+                        SetIsolationStatus(_index, _result, _chargingData[_index]->Evboard_id);
+                    }
+
+                    if (_chargingData[_index]->SystemStatus == S_CCS_PRECHARGE_ST0 &&
+                            _chargingData[_index]->PrechargeStatus == PRECHARGE_READY) {
+                        SetEvsePrechargeInfo(_index, PRECHARGE_PRERELAY_PASS, _chargingData[_index]->Evboard_id);
+                    }
+                }
+            }
+            break;
+            case S_CHARGING: {
+                // 計算 Power
+                _chargingData[_index]->PresentChargingPower = ((float)((_chargingData[_index]->PresentChargingVoltage) * (_chargingData[_index]->PresentChargingCurrent)) / 1000);
+
+                //CalOutputPowerAndEnergy(_index); //DS60-120 add
+
+                //DS60-120 remove
+                if (chargingTime[_index] == 0 ||
+                        chargingTime[_index] > _chargingData[_index]->PresentChargedDuration) {
+                    chargingTime[_index] = _chargingData[_index]->PresentChargedDuration;
+                } else {
+                    int passTime = _chargingData[_index]->PresentChargedDuration - chargingTime[_index];
+
+                    if (passTime > 0) {
+                        float changingPow = (_chargingData[_index]->PresentChargingPower) * passTime / 3600;
+                        if (ShmSysConfigAndInfo->SysConfig.BillingData.isBilling) {
+                            _chargingData[_index]->ChargingFee += changingPow * ShmSysConfigAndInfo->SysConfig.BillingData.Cur_fee;
+                        }
+
+                        _chargingData[_index]->PresentChargedEnergy += changingPow;
+                        _chargingData[_index]->PowerConsumption += changingPow;
+                        chargingTime[_index] = _chargingData[_index]->PresentChargedDuration;
+                    }
+                }
+
+                // 開始確認車端是否同意開始充電
+                GetOutputReq(_index, _chargingData[_index]->Evboard_id);
+
+                // 設定當前輸出
+                if (gun_count == 1) {
+                    SetPresentChargingOutputPower(_chargingData[0], _chargingData[0]);
+                } else if (gun_count == 2) {
+                    SetPresentChargingOutputPower(_chargingData[0], _chargingData[1]);
+                }
+
+                // for test end
+                if (priorityLow % 5 == 0) {
+                    // 樁端輸出能力改變
+                    if (gun_count == 1) {
+                        SetPresentChargingOutputCap(_chargingData[0], _chargingData[0]);
+                    } else if (gun_count == 2) {
+                        SetPresentChargingOutputCap(_chargingData[0], _chargingData[1]);
+                    }
+                }
+
+                if ((_chargingData[_index]->GroundFaultStatus == GFD_FAIL) ||
+                        (_chargingData[_index]->Type == _Type_CCS_2)) {
+                    SetIsolationStatus(_index, _chargingData[_index]->GroundFaultStatus, _chargingData[_index]->Evboard_id);
+                }
+                /*
+                else if (_chargingData[_index]->Type == _Type_CCS_2) {
+                SetIsolationStatus(_index, _chargingData[_index]->GroundFaultStatus, _chargingData[_index]->Evboard_id);
+                }*/
+
+                // GFD 失敗再通知
+                if (priorityLow == 1) {
+                    if (_chargingData[_index]->Type == _Type_CCS_2 &&
+                            _chargingData[_index]->PrechargeStatus == PRECHARGE_READY) {
+                        SetEvsePrechargeInfo(_index, PRECHARGE_CHARELAY_PASS, _chargingData[_index]->Evboard_id);
+                    }
+                }
+            }
+            break;
+            case S_ALARM:
+            case S_TERMINATING: {
+                // 設定當前輸出
+                if (gun_count == 1) {
+                    if (_chargingData[0]->FireChargingVoltage <= 500) { //DS60-120 add
+                        _chargingData[0]->PresentChargingCurrent = 0;
+                    }
+
+                    SetPresentChargingOutputPower(_chargingData[0], _chargingData[0]);
+                } else if (gun_count == 2) {
+                    if (_chargingData[0]->FireChargingVoltage <= 500) { //DS60-120 add
+                        _chargingData[0]->PresentChargingCurrent = 0;
+                    }
+                    if (_chargingData[1]->FireChargingVoltage <= 500) {
+                        _chargingData[1]->PresentChargingCurrent = 0;
+                    }
+
+                    SetPresentChargingOutputPower(_chargingData[0], _chargingData[1]);
+                }
+
+                // 槍鎖還在，則代表是樁端要求的停止
+                if (_chargingData[_index]->GunLocked == START ||
+                        _chargingData[_index]->Type == _Type_CCS_2) {
+                    byte normalStop = 0x01;
+                    byte stopReason[6] = { 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 };
+
+                    if (GetStopChargingReasonByEvse(_index, stopReason)) {
+                        normalStop = 0x02;
+                    }
+
+                    EvseStopChargingEvent(normalStop, stopReason, _chargingData[_index]->Evboard_id);
+                    SendErrorCount[_index] += 1;//DS60-120 add
+                }
+
+                if (_chargingData[_index]->Type == _Type_CCS_2) {
+                    SetIsolationStatus(_index, _chargingData[_index]->GroundFaultStatus, _chargingData[_index]->Evboard_id);
+                }
+
+                GetOutputReq(_index, _chargingData[_index]->Evboard_id);
+
+                //DS60-120 add
+                if (_chargingData[_index]->SystemStatus == S_ALARM) {
+                    if (priorityLow == 1) {
+                        float maxVol, maxCur;
+
+                        // 樁端輸出能力
+                        maxVol = _chargingData[_index]->MaximumChargingVoltage;
+                        maxCur = _chargingData[_index]->AvailableChargingCurrent;
+
+                        GetMaxVolAndCurMethod(_index, &maxVol, &maxCur);
+                        SetChargingPermission(_index, STOP,
+                                              _chargingData[_index]->AvailableChargingPower,
+                                              maxCur,
+                                              maxVol,
+                                              _chargingData[_index]->Evboard_id);
+                    }
+                }
+            }
+            break;
+            case S_COMPLETE: {
+                // 設定當前輸出
+                if (gun_count == 1) {
+                    SetPresentChargingOutputPower(_chargingData[0], _chargingData[0]);
+                } else if (gun_count == 2) {
+                    SetPresentChargingOutputPower(_chargingData[0], _chargingData[1]);
+                }
+
+                if (priorityLow == 1) {
+                    float maxVol, maxCur;
+
+                    // 樁端輸出能力
+                    maxVol = _chargingData[_index]->MaximumChargingVoltage;
+                    maxCur = _chargingData[_index]->AvailableChargingCurrent;
+
+                    GetMaxVolAndCurMethod(_index, &maxVol, &maxCur);
+                    SetChargingPermission(_index, STOP,
+                                          _chargingData[_index]->AvailableChargingPower,
+                                          maxCur,
+                                          maxVol,
+                                          _chargingData[_index]->Evboard_id);
+
+                    //DS60-120 add
+                    //if (_chargingData[_index]->EvBatterySoc >= 100) {
+                    //    //滿電，則直接清掉錯誤
+                    //    if (_chargingData[_index]->Type == _Type_Chademo) {
+                    //        ClearAbnormalStatus_Chademo(_index);
+                    //    } else if (_chargingData[_index]->Type == _Type_GB) {
+                    //        ClearAbnormalStatus_GB(_index);
+                    //    } else if (_chargingData[_index]->Type == _Type_CCS_2) {
+                    //        ClearAbnormalStatus_CCS(_index);
+                    //    }
+                    //}
+                }
+            }
+            break;
+            }
+        }
+        priorityLow >= 20 ? priorityLow = 1 : priorityLow++;
+        usleep(45000); //EV 小板通訊 (50 ms)
+    }
+    DEBUG_INFO("Module_EvComm : Can-bus port = %d \n", CanFd);
+    return FAIL;
+}

EVSE/Projects/DD360ComBox/Apps/ReModule_EventLogging.c

@@ -0,0 +1,390 @@
+#include    <sys/time.h>
+#include    <sys/timeb.h>
+#include    <sys/types.h>
+#include    <sys/stat.h>
+#include    <sys/types.h>
+#include    <sys/ioctl.h>
+#include    <sys/socket.h>
+#include    <sys/ipc.h>
+#include    <sys/shm.h>
+#include    <sys/shm.h>
+#include    <sys/mman.h>
+#include    <linux/wireless.h>
+#include    <arpa/inet.h>
+#include    <netinet/in.h>
+
+#include    <unistd.h>
+#include    <stdarg.h>
+#include    <stdio.h>      /*標準輸入輸出定義*/
+#include    <stdlib.h>     /*標準函數庫定義*/
+#include    <unistd.h>     /*Unix 標準函數定義*/
+#include    <fcntl.h>      /*檔控制定義*/
+#include    <termios.h>    /*PPSIX 終端控制定義*/
+#include    <errno.h>      /*錯誤號定義*/
+#include    <errno.h>
+#include    <string.h>
+#include    <time.h>
+#include    <ctype.h>
+#include    <ifaddrs.h>
+#include    "../../define.h"
+
+#define ARRAY_SIZE(A)       (sizeof(A) / sizeof(A[0]))
+#define PASS                1
+#define FAIL                -1
+#define YES                 1
+#define NO                  0
+
+struct SysConfigAndInfo         *ShmSysConfigAndInfo;
+struct StatusCodeData           *ShmStatusCodeData;
+
+sqlite3 *localDb; //DS60-120 add
+#define DB_FILE             "/Storage/ChargeLog/localCgargingRecord.db" //DS60-120 add
+
+void PRINTF_FUNC(char *string, ...);
+
+int StoreLogMsg(const char *fmt, ...);
+#define DEBUG_INFO(format, args...) StoreLogMsg("[%s:%d][%s][Info] "format, __FILE__, __LINE__, __FUNCTION__, ##args)
+#define DEBUG_WARN(format, args...) StoreLogMsg("[%s:%d][%s][Warn] "format, __FILE__, __LINE__, __FUNCTION__, ##args)
+#define DEBUG_ERROR(format, args...) StoreLogMsg("[%s:%d][%s][Error] "format, __FILE__, __LINE__, __FUNCTION__, ##args)
+#define EVENT_INFO(format, args...) StoreEventLogMsg("[%s:%d][%s][Info] "format, __FILE__, __LINE__, __FUNCTION__, ##args) //DS60-120 add
+
+int StoreLogMsg(const char *fmt, ...)
+{
+    char Buf[4096 + 256];
+    char buffer[4096];
+    va_list args;
+    struct timeb  SeqEndTime;
+    struct tm *tm;
+
+    va_start(args, fmt);
+    int rc = vsnprintf(buffer, sizeof(buffer), fmt, args);
+    va_end(args);
+
+    memset(Buf, 0, sizeof(Buf));
+    ftime(&SeqEndTime);
+    SeqEndTime.time = time(NULL);
+    tm = localtime(&SeqEndTime.time);
+
+    if (ShmSysConfigAndInfo->SysConfig.SwitchDebugFlag == YES) {
+        sprintf(Buf, "%02d:%02d:%02d:%03d - %s",
+                tm->tm_hour, tm->tm_min, tm->tm_sec, SeqEndTime.millitm, buffer);
+        printf("%s \n", Buf);
+    } else {
+        sprintf(Buf, "echo \"%04d-%02d-%02d %02d:%02d:%02d:%03d - %s\" >> /Storage/SystemLog/[%04d.%02d]SystemLog",
+                tm->tm_year + 1900, tm->tm_mon + 1, tm->tm_mday, tm->tm_hour, tm->tm_min, tm->tm_sec, SeqEndTime.millitm,
+                buffer,
+                tm->tm_year + 1900, tm->tm_mon + 1);
+        system(Buf);
+    }
+
+    return rc;
+}
+
+int StoreEventLogMsg(const char *fmt, ...)
+{
+    char Buf[4096 + 256];
+    char buffer[4096];
+    time_t CurrentTime;
+    struct tm *tm;
+    struct timeval tv;
+    va_list args;
+
+    va_start(args, fmt);
+    int rc = vsnprintf(buffer, sizeof(buffer), fmt, args);
+    va_end(args);
+
+    memset(Buf, 0, sizeof(Buf));
+    CurrentTime = time(NULL);
+    tm = localtime(&CurrentTime);
+    gettimeofday(&tv, NULL); // get microseconds, 10^-6
+
+    if ((ShmSysConfigAndInfo->SysConfig.ModelName != NULL) && (ShmSysConfigAndInfo->SysConfig.SerialNumber != NULL) && (strlen((char *)ShmSysConfigAndInfo->SysConfig.ModelName) >= 14)) {
+        sprintf(Buf, "echo -n \"[%04d.%02d.%02d %02d:%02d:%02d.%06ld]%s\" >> /Storage/EventLog/[%04d.%02d]%s_%s_EventLog",
+                tm->tm_year + 1900, tm->tm_mon + 1, tm->tm_mday, tm->tm_hour, tm->tm_min, tm->tm_sec, tv.tv_usec,
+                buffer,
+                tm->tm_year + 1900, tm->tm_mon + 1,
+                ShmSysConfigAndInfo->SysConfig.ModelName,
+                ShmSysConfigAndInfo->SysConfig.SerialNumber);
+    } else {
+        sprintf(Buf, "echo -n \"[%04d.%02d.%02d %02d:%02d:%02d.%06ld]%s\" >> /Storage/EventLog/[%04d.%02d]EventLog",
+                tm->tm_year + 1900, tm->tm_mon + 1, tm->tm_mday, tm->tm_hour, tm->tm_min, tm->tm_sec, tv.tv_usec,
+                buffer,
+                tm->tm_year + 1900, tm->tm_mon + 1);
+    }
+
+#ifdef SystemLogMessage
+    system(Buf);
+
+#endif
+
+#ifdef ConsloePrintLog
+    printf("[%04d.%02d.%02d %02d:%02d:%02d.%06ld]%s", tm->tm_year + 1900, tm->tm_mon + 1, tm->tm_mday, tm->tm_hour, tm->tm_min, tm->tm_sec, tv.tv_usec, buffer);
+#endif
+
+    return rc;
+}
+
+int DiffTimeb(struct timeb ST, struct timeb ET)
+{
+    //return milli-second
+    unsigned int StartTime, StopTime;
+
+    StartTime = (unsigned int)ST.time;
+    StopTime = (unsigned int)ET.time;
+    return (StopTime - StartTime) * 1000 + ET.millitm - ST.millitm;
+}
+
+void PRINTF_FUNC(char *string, ...)
+{
+    va_list args;
+    char buffer[4096];
+    va_start(args, string);
+    vsnprintf(buffer, sizeof(buffer), string, args);
+    va_end(args);
+
+    DEBUG_INFO("%s \n", buffer);
+}
+
+//=================================
+// Common routine
+//=================================
+char *getTimeString(void)
+{
+    char *result = malloc(21);
+    time_t timep;
+    struct tm *p;
+    time(&timep);
+    p = gmtime(&timep);
+
+    sprintf(result, "[%04d-%02d-%02d %02d:%02d:%02d]", (1900 + p->tm_year), (1 + p->tm_mon), p->tm_mday, p->tm_hour, p->tm_hour, p->tm_sec);
+
+    return result;
+}
+
+//==========================================
+// Init all share memory
+//==========================================
+int InitShareMemory()
+{
+    int result = PASS;
+    int MeterSMId;
+
+    //creat ShmSysConfigAndInfo
+    if ((MeterSMId = shmget(ShmSysConfigAndInfoKey, sizeof(struct SysConfigAndInfo),  0777)) < 0) {
+        result = FAIL;
+    } else if ((ShmSysConfigAndInfo = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+        result = FAIL;
+    }
+
+    //creat ShmStatusCodeData
+    if ((MeterSMId = shmget(ShmStatusCodeKey, sizeof(struct StatusCodeData),  0777)) < 0) {
+        result = FAIL;
+    } else if ((ShmStatusCodeData = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+        result = FAIL;
+    }
+
+    return result;
+}
+
+//================================================
+// Main process
+//================================================
+void AddFaultCodeToBuf(unsigned char *Code)
+{
+    if (ShmSysConfigAndInfo->SysWarningInfo.WarningCount < 10) {
+        memcpy(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[ShmSysConfigAndInfo->SysWarningInfo.WarningCount][0], Code, 7);
+        ShmSysConfigAndInfo->SysWarningInfo.WarningCount++;
+    }
+}
+
+void RemoveFaultCodeToBuf(unsigned char *Code)
+{
+    unsigned char find = 0x01;
+    char _code[7];
+    sprintf(_code, "%s", Code);
+
+    // 把相關的錯誤碼一次移除，避免重複顯示
+    while (find) {
+        find = 0x00;
+        for (unsigned char i = 0; i < ShmSysConfigAndInfo->SysWarningInfo.WarningCount; i++) {
+            if (find == 0x00) {
+                if (memcmp(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i][0], _code, 7) == 0) {
+                    find = 0x01;
+                }
+            } else {
+                memcpy(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i - 1][0],
+                       &ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i][0], 7);
+            }
+        }
+
+        if (find) {
+            ShmSysConfigAndInfo->SysWarningInfo.WarningCount--;
+        }
+    }
+}
+
+//==========================================
+// SQLite routne
+//==========================================
+int DB_Open(sqlite3 *db) //DS60-120 add
+{
+    int result = PASS;
+    char *errMsg = NULL;
+    char *createRecordSql = "CREATE TABLE IF NOT EXISTS event_record("
+                            "idx integer primary key AUTOINCREMENT, "
+                            "occurDatetime text NOT NULL, "
+                            "statusCode text NOT NULL"
+                            ");";
+
+    if (sqlite3_open(DB_FILE, &db)) {
+        result = FAIL;
+        DEBUG_ERROR( "Can't open database: %s\n", sqlite3_errmsg(db));
+        sqlite3_close(db);
+    } else {
+        DEBUG_INFO( "Local event record database open successfully.\n");
+
+        if (sqlite3_exec(db, createRecordSql, 0, 0, &errMsg) != SQLITE_OK) {
+            result = FAIL;
+            DEBUG_ERROR( "Create local event record table error message: %s\n", errMsg);
+        } else {
+            DEBUG_INFO( "Opened local event record table successfully\n");
+        }
+
+        sqlite3_close(db);
+    }
+
+    return result;
+}
+
+int DB_Insert_Record(sqlite3 *db, uint8_t *statusCode) //DS60-120 add
+{
+    int result = PASS;
+    char *errMsg = NULL;
+    char sqlStr[1024];
+
+    sprintf(sqlStr, "insert into event_record(occurDatetime, statusCode) values(CURRENT_TIMESTAMP, '%s');", statusCode);
+
+    if (sqlite3_open(DB_FILE, &db)) {
+        result = FAIL;
+        DEBUG_INFO( "Can't open database: %s\n", sqlite3_errmsg(db));
+        sqlite3_close(db);
+    } else {
+        DEBUG_INFO( "Local event record database open successfully.\n");
+        if (sqlite3_exec(db, sqlStr, 0, 0, &errMsg) != SQLITE_OK) {
+            result = FAIL;
+            DEBUG_INFO( "Insert local event record error message: %s\n", errMsg);
+        } else {
+            DEBUG_INFO( "Insert local event record successfully\n");
+        }
+
+        sprintf(sqlStr, "delete from event_record where idx < (select idx from event_record order by idx desc limit 1)-2000;");
+        if (sqlite3_exec(db, sqlStr, 0, 0, &errMsg) != SQLITE_OK) {
+            result = FAIL;
+            DEBUG_INFO( "delete local event_record error message: %s\n", errMsg);
+        } else {
+            DEBUG_INFO( "delete local event record successfully\n");
+        }
+
+        sqlite3_close(db);
+    }
+
+    return result;
+}
+
+int main(void)
+{
+    int ByteCount, BitCount;
+    unsigned char tmp, EventCodeTmp[7];
+
+    if (InitShareMemory() == FAIL) {
+        DEBUG_ERROR("InitShareMemory NG\n");
+        if (ShmStatusCodeData != NULL) {
+            ShmStatusCodeData->AlarmCode.AlarmEvents.bits.FailToCreateShareMemory = 1;
+        }
+        sleep(5);
+        return 0;
+    }
+
+    for (;;) {
+        //check Fault Status
+        for (ByteCount = 0; ByteCount < sizeof(ShmStatusCodeData->FaultCode.PreviousFaultVal); ByteCount++) {
+            if (ShmStatusCodeData->FaultCode.FaultEvents.FaultVal[ByteCount] != ShmStatusCodeData->FaultCode.PreviousFaultVal[ByteCount]) {
+                tmp = ShmStatusCodeData->FaultCode.FaultEvents.FaultVal[ByteCount]; //prevent be modified during following process
+                for (BitCount = 0; BitCount < 8; BitCount++) {
+                    if (((tmp >> BitCount) & 0x01) != ((ShmStatusCodeData->FaultCode.PreviousFaultVal[ByteCount] >> BitCount) & 0x01)) {
+                        memset(EventCodeTmp, 0, sizeof(EventCodeTmp));
+                        memcpy(EventCodeTmp, FaultStatusCode[ByteCount * 8 + BitCount], sizeof(EventCodeTmp) - 1);
+                        if (((tmp >> BitCount) & 0x01) == 0) { //Recovered
+                            //EventCodeTmp[0]=1;
+                            DEBUG_INFO("Recovery Fault Code = %s\n", EventCodeTmp);
+                            ShmStatusCodeData->FaultCode.PreviousFaultVal[ByteCount] &= ~(1 << BitCount);
+                            RemoveFaultCodeToBuf(EventCodeTmp);
+                            EventCodeTmp[0] = '1';//DS60-120 add
+                        } else {
+                            DEBUG_INFO("Fault Code = %s\n", EventCodeTmp);
+                            ShmStatusCodeData->FaultCode.PreviousFaultVal[ByteCount] |= (1 << BitCount);
+                            AddFaultCodeToBuf(EventCodeTmp);
+                        }
+                        EVENT_INFO("%s\n", EventCodeTmp); //DS60-120 add
+                        DB_Insert_Record(localDb, EventCodeTmp); //DS60-120 add
+                    }
+                }
+            }
+        }
+
+        //check Alarm Status
+        for (ByteCount = 0; ByteCount < sizeof(ShmStatusCodeData->AlarmCode.PreviousAlarmVal); ByteCount++) {
+            if (ShmStatusCodeData->AlarmCode.AlarmEvents.AlarmVal[ByteCount] != ShmStatusCodeData->AlarmCode.PreviousAlarmVal[ByteCount]) {
+                tmp = ShmStatusCodeData->AlarmCode.AlarmEvents.AlarmVal[ByteCount]; //prevent be modified during following process
+                for (BitCount = 0; BitCount < 8; BitCount++) {
+                    if (((tmp >> BitCount) & 0x01) != ((ShmStatusCodeData->AlarmCode.PreviousAlarmVal[ByteCount] >> BitCount) & 0x01)) {
+                        memset(EventCodeTmp, 0, sizeof(EventCodeTmp));
+                        memcpy(EventCodeTmp, AlarmStatusCode[ByteCount * 8 + BitCount], sizeof(EventCodeTmp) - 1);
+                        if (((tmp >> BitCount) & 0x01) == 0) { //Recovered
+                            //EventCodeTmp[0]=1;
+                            DEBUG_INFO("Recovery Alarm Code = %s\n", EventCodeTmp);
+                            ShmStatusCodeData->AlarmCode.PreviousAlarmVal[ByteCount] &= ~(1 << BitCount);
+                            RemoveFaultCodeToBuf(EventCodeTmp);
+                            EventCodeTmp[0] = '1';//DS60-120 add
+                        } else {
+                            DEBUG_INFO("Alarm Code = %s\n", EventCodeTmp);
+                            ShmStatusCodeData->AlarmCode.PreviousAlarmVal[ByteCount] |= (1 << BitCount);
+                            AddFaultCodeToBuf(EventCodeTmp);
+                        }
+                        EVENT_INFO("%s\n", EventCodeTmp); //DS60-120 add
+                        DB_Insert_Record(localDb, EventCodeTmp); //DS60-120 add
+                    }
+                }
+            }
+        }
+
+        //check Info Status
+        for (ByteCount = 0; ByteCount < sizeof(ShmStatusCodeData->InfoCode.PreviousInfoVal); ByteCount++) {
+            if (ShmStatusCodeData->InfoCode.InfoEvents.InfoVal[ByteCount] != ShmStatusCodeData->InfoCode.PreviousInfoVal[ByteCount]) {
+                tmp = ShmStatusCodeData->InfoCode.InfoEvents.InfoVal[ByteCount]; //prevent be modified during following process
+                for (BitCount = 0; BitCount < 8; BitCount++) {
+                    if (((tmp >> BitCount) & 0x01) != ((ShmStatusCodeData->InfoCode.PreviousInfoVal[ByteCount] >> BitCount) & 0x01)) {
+                        memset(EventCodeTmp, 0, sizeof(EventCodeTmp));
+                        memcpy(EventCodeTmp, InfoStatusCode[ByteCount * 8 + BitCount], sizeof(EventCodeTmp) - 1);
+                        if (((tmp >> BitCount) & 0x01) == 0) { //Recovered
+                            //EventCodeTmp[0]=1;
+                            DEBUG_INFO("Recovery Info Code = %s\n", EventCodeTmp);
+                            ShmStatusCodeData->InfoCode.PreviousInfoVal[ByteCount] &= ~(1 << BitCount);
+                            RemoveFaultCodeToBuf(EventCodeTmp);
+                            EventCodeTmp[0] = '1';//DS60-120 add
+                        } else {
+                            DEBUG_INFO("Info Code = %s\n", EventCodeTmp);
+                            ShmStatusCodeData->InfoCode.PreviousInfoVal[ByteCount] |= (1 << BitCount);
+                            AddFaultCodeToBuf(EventCodeTmp);
+                        }
+                        EVENT_INFO("%s\n", EventCodeTmp); //DS60-120 add
+                        DB_Insert_Record(localDb, EventCodeTmp); //DS60-120 add
+                    }
+                }
+            }
+        }
+        usleep(500000);
+    }
+
+    return FAIL;
+}

EVSE/Projects/DD360ComBox/Apps/ReModule_InternalComm.c

@@ -0,0 +1,2702 @@
+#include <sys/time.h>
+#include <sys/timeb.h>
+#include <sys/types.h>
+#include <sys/stat.h>
+#include <sys/types.h>
+#include <sys/ioctl.h>
+#include <sys/socket.h>
+#include <sys/ipc.h>
+#include <sys/shm.h>
+#include <sys/shm.h>
+#include <sys/mman.h>
+#include <linux/wireless.h>
+#include <arpa/inet.h>
+#include <netinet/in.h>
+
+#include <unistd.h>
+#include <stdarg.h>
+#include <stdio.h>      /*標準輸入輸出定義*/
+#include <stdlib.h>     /*標準函數庫定義*/
+#include <unistd.h>     /*Unix 標準函數定義*/
+#include <fcntl.h>      /*檔控制定義*/
+#include <termios.h>    /*PPSIX 終端控制定義*/
+#include <errno.h>      /*錯誤號定義*/
+#include <errno.h>
+#include <string.h>
+#include <time.h>
+#include <ctype.h>
+#include <ifaddrs.h>
+#include <math.h>
+#include <stdbool.h>
+
+#include "../../define.h"
+#include "internalComm.h"
+#include "Config.h"
+
+#define ARRAY_SIZE(A)       (sizeof(A) / sizeof(A[0]))
+#define PASS                1
+#define FAIL                -1
+#define YES                 1
+#define NO                  0
+#define STOP                0
+#define START               1
+#define RELAY_CHECK_TIME    5       // s
+#define OUTPUT_VOL_CHK_TIME 200     // ms
+#define TEN_MINUTES         600     // s
+//#define TEN_MINUTES           5
+#define ENV_TEMP_MIN        45
+#define ENV_TEMP_MAX        50
+#define DEFAULT_AC_INDEX    2
+#define EQUAL               0
+#define COLOR_MAX_LV        100
+#define COLOR_MIN_LV        0
+
+#define AC_DEFAULT_VOL      220
+
+#define NO_DEFINE           255
+#define NDEFAULT_AC_INDEX   2
+
+#define OVP_UVP_CHK_COUNT   3
+
+struct SysConfigAndInfo         *ShmSysConfigAndInfo;
+struct StatusCodeData           *ShmStatusCodeData;
+struct FanModuleData            *ShmFanModuleData;
+struct RelayModuleData          *ShmRelayModuleData;
+struct LedModuleData            *ShmLedModuleData;
+struct PsuData                  *ShmPsuData;
+struct OCPP16Data               *ShmOCPP16Data;
+struct DcCommonInformation      *ShmDcCommonData;
+
+#define VIN_MAX_VOLTAGE_IEC         285 // 大於該值 : OVP
+#define VIN_MAX_REV_VOLTAGE_IEC     275 // 小於賦歸 OVP
+#define VIN_MIN_VOLTAGE_IEC         160 // 小於該值 : UVP
+#define VIN_MIN_REV_VOLTAGE_IEC     170 // 大於賦歸 UVP
+
+#define VIN_MAX_VOLTAGE_UL          315 // 大於該值 : OVP // 美規 (W)
+#define VIN_MAX_REV_VOLTAGE_UL      305 // 小於賦歸 OVP
+#define VIN_MIN_VOLTAGE_UL          210 // 小於該值 : UVP
+#define VIN_MIN_REV_VOLTAGE_UL      220 // 大於賦歸 UVP
+
+#define VIN_DROP_VOLTAGE    150 // 小於該值 : ac drop
+
+#define VOUT_MAX_VOLTAGE    995
+#define VOUT_MIN_VOLTAGE    150
+#define IOUT_MAX_CURRENT    50
+
+#define MAX_FAN_SPEED       14000
+#define MIN_FAN_SPEED       3000
+#define NORMAL_FAN_SPEED    7000
+
+// GFD Status
+#define GFD_IDLE            0
+#define GFD_CABLECHK        1
+#define GFD_PRECHARGE       2
+#define GFD_CHARGING        3
+
+// LED Intensity (rate)
+#define LED_INTENSITY_DARKEST       0.2
+#define LED_INTENSITY_MEDIUM        0.6
+#define LED_INTENSITY_BRIGHTEST     1
+
+// EE Spec
+#define LED_BRIGHTNESS_LV_HIGH      1
+#define LED_BRIGHTNESS_LV_MID       0.5
+#define LED_BRIGHTNESS_LV_LOW       0.2
+
+// 最小切換 Relay 電壓
+#define SELF_TO_CHANGE_RELAY_STATUS         600
+// 透過電壓確認 Relay 是否搭上的依據電壓
+#define CHECK_RELAY_STATUS                  300
+#define CHECK_RELAY_STATUS_GAP              100
+// 安全在停止充電程序中斷開 Relay 的電流
+#define SEFETY_SWITCH_RELAY_CUR             50//20 DS60-120 modify
+// 確認 Relay Welding 電壓
+#define RELAY_WELDING_DET                   300
+
+byte gunCount;
+byte acgunCount;
+// 槍資訊
+struct ChargingInfoData *_chargingData[CHAdeMO_QUANTITY + CCS_QUANTITY + GB_QUANTITY];
+struct ChargingInfoData *ac_chargingInfo[AC_QUANTITY];
+
+bool _isOutputNoneMatch[CHAdeMO_QUANTITY + CCS_QUANTITY + GB_QUANTITY];
+struct timeval _checkOutputNoneMatchTimer[CHAdeMO_QUANTITY + CCS_QUANTITY + GB_QUANTITY];
+
+#if !defined METER_ENABLE
+bool _isRelayWelding[CHAdeMO_QUANTITY + CCS_QUANTITY + GB_QUANTITY];
+struct timeval _checkRelayWeldingTimer[CHAdeMO_QUANTITY + CCS_QUANTITY + GB_QUANTITY];
+#endif //!defined METER_ENABLE
+bool _isOvpChkTimeFlag[CHAdeMO_QUANTITY + CCS_QUANTITY + GB_QUANTITY]; //DS60-120 add
+struct timeval _checkOutputVolProtectTimer[CHAdeMO_QUANTITY + CCS_QUANTITY + GB_QUANTITY]; //DS60-120 add
+
+// SMR1 *2 + SMR2 * 2 + Parallel * 2
+struct timeval _relayStateChkTimer[6]; //DS60-120 add
+
+byte _threePhaseOvp[3] = {0, 0, 0}; //DS60-120 add
+byte _threePhaseUvp[3] = {0, 0, 0}; //DS60-120 add
+
+bool FindChargingInfoData(byte target, struct ChargingInfoData **chargingData);
+
+int Uart5Fd;
+char *relayRs485PortName = "/dev/ttyS5";
+unsigned short fanSpeedSmoothValue = 500;
+
+bool isStopChargingCount = false;
+struct timeval _close_ac_contactor;
+
+struct timeval _priority_time;
+struct timeval _led_priority_time;
+
+struct timeval  _ac_charging_comp;
+struct timeval  _ac_preparing;
+struct timeb    _ac_startChargingTime;
+struct timeb    _ac_endChargingTime;
+
+unsigned short _setFanSpeed = 0;
+float _beforeChargingTotalEnergy = 0.0;
+byte _checkLedChanged = 3;
+
+Ver ver;
+PresentInputVoltage inputVoltage;
+PresentOutputVoltage outputVoltage;
+FanSpeed fanSpeed;
+Temperature temperature;
+AuxPower auxPower;
+Gfd gfd_adc;
+Gfd_config gfd_config;
+Gpio_in gpio_in;
+Gpio_out gpio_out;
+Relay outputRelay;
+Relay regRelay;
+Rtc rtc;
+Led_Color cur_led_color;
+Led_Color led_color;
+
+Ac_Status acStatus;
+Ac_Led_Status ledStatus;
+Ac_Alarm_code acAlarmCode;
+Ac_Charging_energy acChargingEnergy;
+Ac_Charging_current acChargingCurrent;
+
+#define AC_OVP                      1
+#define AC_UVP                      2
+#define AC_OCP                      4
+#define AC_OTP                      8
+#define AC_GMI_FAULT                16
+#define AC_CP_ERROR                 32
+#define AC_AC_LEAKAGE               64
+#define AC_DC_LEAKAGE               128
+#define AC_SYSTEM_SELFTEST_FAULT    256
+#define AC_HANDSHAKE_TIMEOUT        512
+#define AC_EMC_STOP                 1024
+#define AC_RELAY_WELDING            2048
+#define AC_GF_MODULE_FAULT          4096
+#define AC_SHUTTER_FAULT            8192
+#define AC_LOCKER_FAULT             16384
+#define AC_POWER_DROP               32768
+#define AC_CIRCUIT_SHORT            65536
+#define AC_ROTARY_SWITCH_FAULT      131072
+#define AC_RELAY_DRIVE_FAULT        262144
+
+#define log_info(format, args...) StoreLogMsg("[%s:%d][%s][Info] "format, __FILE__, __LINE__, __FUNCTION__, ##args)
+#define log_warn(format, args...) StoreLogMsg("[%s:%d][%s][Warn] "format, __FILE__, __LINE__, __FUNCTION__, ##args)
+#define log_error(format, args...) StoreLogMsg("[%s:%d][%s][Error] "format, __FILE__, __LINE__, __FUNCTION__, ##args)
+
+int _alarm_code[] = {AC_OVP, AC_UVP, AC_OCP, AC_OTP, AC_GMI_FAULT, AC_CP_ERROR, AC_AC_LEAKAGE
+                     , AC_DC_LEAKAGE, AC_SYSTEM_SELFTEST_FAULT, AC_HANDSHAKE_TIMEOUT, AC_EMC_STOP, AC_RELAY_WELDING
+                     , AC_GF_MODULE_FAULT, AC_SHUTTER_FAULT, AC_LOCKER_FAULT, AC_POWER_DROP, AC_CIRCUIT_SHORT
+                     , AC_ROTARY_SWITCH_FAULT, AC_RELAY_DRIVE_FAULT
+                    };
+
+int StoreLogMsg(const char *fmt, ...);
+unsigned long GetTimeoutValue(struct timeval _sour_time);
+
+unsigned long GetTimeoutValue(struct timeval _sour_time)
+{
+    struct timeval _end_time;
+    gettimeofday(&_end_time, NULL);
+
+    return 1000000 * (_end_time.tv_sec - _sour_time.tv_sec) + _end_time.tv_usec - _sour_time.tv_usec;
+}
+
+int StoreLogMsg(const char *fmt, ...)
+{
+    char Buf[4096 + 256];
+    char buffer[4096];
+    va_list args;
+    struct timeb  SeqEndTime;
+    struct tm *tm;
+
+    va_start(args, fmt);
+    int rc = vsnprintf(buffer, sizeof(buffer), fmt, args);
+    va_end(args);
+
+    memset(Buf, 0, sizeof(Buf));
+    ftime(&SeqEndTime);
+    SeqEndTime.time = time(NULL);
+    tm = localtime(&SeqEndTime.time);
+
+    if (ShmSysConfigAndInfo->SysConfig.SwitchDebugFlag == YES) {
+        sprintf(Buf, "%02d:%02d:%02d:%03d - %s",
+                tm->tm_hour, tm->tm_min, tm->tm_sec, SeqEndTime.millitm, buffer);
+        printf("%s \n", Buf);
+    } else {
+        sprintf(Buf, "echo \"%04d-%02d-%02d %02d:%02d:%02d:%03d - %s\" >> /Storage/SystemLog/[%04d.%02d]SystemLog",
+                tm->tm_year + 1900, tm->tm_mon + 1, tm->tm_mday, tm->tm_hour, tm->tm_min, tm->tm_sec, SeqEndTime.millitm,
+                buffer,
+                tm->tm_year + 1900, tm->tm_mon + 1);
+        system(Buf);
+    }
+
+    return rc;
+}
+
+int DiffTimeb(struct timeb ST, struct timeb ET)
+{
+    //return milli-second
+    unsigned int StartTime, StopTime;
+
+    StartTime = (unsigned int) ST.time;
+    StopTime = (unsigned int) ET.time;
+    //return (StopTime-StartTime)*1000+ET.millitm-ST.millitm;
+    return (StopTime - StartTime);
+}
+
+unsigned short MaxValue(unsigned short value1, unsigned short value2)
+{
+    return value1 >= value2 ? value1 : value2;
+}
+
+//==========================================
+// Communication Function
+//==========================================
+void GetFwAndHwVersion_Fan()
+{
+    if (Query_FW_Ver(Uart5Fd, Addr.Fan, &ver) == PASS) {
+        // FanModuleData
+        strcpy((char *) ShmFanModuleData->version, ver.Version_FW);
+        // SystemInfo
+        strcpy((char *) ShmSysConfigAndInfo->SysInfo.FanModuleFwRev, ver.Version_FW);
+        //log_info("GetFwAndHwVersion_Fan s1 = %s \n", ver.Version_FW);
+    }
+
+    if (Query_HW_Ver(Uart5Fd, Addr.Fan, &ver) == PASS) {
+        // SystemInfo
+        strcpy((char *) ShmSysConfigAndInfo->SysInfo.FanModuleHwRev, ver.Version_FW);
+        //log_info("GetFwAndHwVersion_Fan s2 = %s \n", ver.Version_HW);
+    }
+}
+
+void GetFwAndHwVersion_Relay()
+{
+    if (Query_FW_Ver(Uart5Fd, Addr.Relay, &ver) == PASS) {
+        // RelayModuleData
+        strcpy((char *) ShmRelayModuleData->version, ver.Version_FW);
+        // SystemInfo
+        strcpy((char *) ShmSysConfigAndInfo->SysInfo.RelayModuleFwRev, ver.Version_FW);
+        //log_info("GetFwAndHwVersion_Relay s1 = %s \n", ver.Version_FW);
+    }
+
+    if (Query_HW_Ver(Uart5Fd, Addr.Relay, &ver) == PASS) {
+        // SystemInfo
+        strcpy((char *) ShmSysConfigAndInfo->SysInfo.RelayModuleHwRev, ver.Version_FW);
+        //log_info("GetFwAndHwVersion_Relay s2 = %s \n", ver.Version_HW);
+    }
+}
+
+void GetFwAndHwVersion_Led()
+{
+    if (Query_FW_Ver(Uart5Fd, Addr.Led, &ver) == PASS) {
+        // LedModuleData
+        strcpy((char *) ShmLedModuleData->version, ver.Version_FW);
+        // SystemInfo
+        strcpy((char *) ShmSysConfigAndInfo->SysInfo.LedModuleFwRev, ver.Version_FW);
+        //log_info("GetFwAndHwVersion_Led s1 = %s \n", ver.Version_FW);
+        ShmLedModuleData->SelfTest_Comp = YES;
+    } else {
+        //log_info("GetFwAndHwVersion_Led fail \n");
+    }
+
+//  if (Query_HW_Ver(Uart5Fd, Addr.Led, &ver) == PASS)
+//  {
+//      // SystemInfo
+//      strcpy((char *) ShmSysConfigAndInfo->SysInfo.RelayModuleHwRev, ver.Version_FW);
+//      //log_info("GetFwAndHwVersion_Relay s2 = %s \n", ver.Version_HW);
+//  }
+}
+
+void GetFwVersion_AC()
+{
+    if (Query_FW_Ver(Uart5Fd, Addr.AcPlug, &ver) == PASS) {
+        ac_chargingInfo[0]->SelfTest_Comp = YES;
+        strcpy((char *) ac_chargingInfo[0]->version, ver.Version_FW);
+    }
+}
+
+void GetAcModelName()
+{
+    memset(ShmSysConfigAndInfo->SysConfig.AcModelName, 0x00, sizeof(ShmSysConfigAndInfo->SysConfig.AcModelName));
+    if (Query_Model_Name(Uart5Fd, Addr.AcPlug, ShmSysConfigAndInfo->SysConfig.AcModelName) == PASS) {
+        log_info("ac model name = %s \n", ShmSysConfigAndInfo->SysConfig.AcModelName);
+    }
+}
+
+void SetRtcData_Relay()
+{
+    struct timeb csuTime;
+    struct tm *tmCSU;
+
+    ftime(&csuTime);
+    tmCSU = localtime(&csuTime.time);
+    //  log_info("Time : %04d-%02d-%02d %02d:%02d:%02d \n", tmCSU->tm_year + 1900,
+    //          tmCSU->tm_mon + 1, tmCSU->tm_mday, tmCSU->tm_hour, tmCSU->tm_min,
+    //          tmCSU->tm_sec);
+
+    rtc.RtcData[0] = '0' + (tmCSU->tm_year + 1900) / 1000 % 10;
+    rtc.RtcData[1] = '0' + (tmCSU->tm_year + 1900) / 100 % 10;
+    rtc.RtcData[2] = '0' + (tmCSU->tm_year + 1900) / 10 % 10;
+    rtc.RtcData[3] = '0' + (tmCSU->tm_year + 1900) / 1 % 10;
+
+    rtc.RtcData[4] = '0' + (tmCSU->tm_mon + 1) / 10 % 10;
+    rtc.RtcData[5] = '0' + (tmCSU->tm_mon + 1) / 1 % 10;
+
+    rtc.RtcData[6] = '0' + (tmCSU->tm_mday) / 10 % 10;
+    rtc.RtcData[7] = '0' + (tmCSU->tm_mday) / 1 % 10;
+
+    rtc.RtcData[8] = '0' + (tmCSU->tm_hour) / 10 % 10;
+    rtc.RtcData[9] = '0' + (tmCSU->tm_hour) / 1 % 10;
+
+    rtc.RtcData[10] = '0' + (tmCSU->tm_min) / 10 % 10;
+    rtc.RtcData[11] = '0' + (tmCSU->tm_min) / 1 % 10;
+
+    rtc.RtcData[12] = '0' + (tmCSU->tm_sec) / 10 % 10;
+    rtc.RtcData[13] = '0' + (tmCSU->tm_sec) / 1 % 10;
+
+    if (Config_Rtc_Data(Uart5Fd, Addr.Relay, &rtc) == PASS) {
+        //log_info("SetRtc (RB) sucessfully. \n");
+    }
+}
+
+void SetModelName_Relay()
+{
+    if (Config_Model_Name(Uart5Fd, Addr.Relay, ShmSysConfigAndInfo->SysConfig.ModelName) == PASS) {
+        //log_info("Set Model name (RB) PASS = %s \n", ShmSysConfigAndInfo->SysConfig.ModelName);
+    }
+}
+
+void SetRtcData_Fan()
+{
+    struct timeb csuTime;
+    struct tm *tmCSU;
+
+    ftime(&csuTime);
+    tmCSU = localtime(&csuTime.time);
+    //  log_info("Time : %04d-%02d-%02d %02d:%02d:%02d \n", tmCSU->tm_year + 1900,
+    //          tmCSU->tm_mon + 1, tmCSU->tm_mday, tmCSU->tm_hour, tmCSU->tm_min,
+    //          tmCSU->tm_sec);
+
+    rtc.RtcData[0] = '0' + (tmCSU->tm_year + 1900) / 1000 % 10;
+    rtc.RtcData[1] = '0' + (tmCSU->tm_year + 1900) / 100 % 10;
+    rtc.RtcData[2] = '0' + (tmCSU->tm_year + 1900) / 10 % 10;
+    rtc.RtcData[3] = '0' + (tmCSU->tm_year + 1900) / 1 % 10;
+
+    rtc.RtcData[4] = '0' + (tmCSU->tm_mon + 1) / 10 % 10;
+    rtc.RtcData[5] = '0' + (tmCSU->tm_mon + 1) / 1 % 10;
+
+    rtc.RtcData[6] = '0' + (tmCSU->tm_mday) / 10 % 10;
+    rtc.RtcData[7] = '0' + (tmCSU->tm_mday) / 1 % 10;
+
+    rtc.RtcData[8] = '0' + (tmCSU->tm_hour) / 10 % 10;
+    rtc.RtcData[9] = '0' + (tmCSU->tm_hour) / 1 % 10;
+
+    rtc.RtcData[10] = '0' + (tmCSU->tm_min) / 10 % 10;
+    rtc.RtcData[11] = '0' + (tmCSU->tm_min) / 1 % 10;
+
+    rtc.RtcData[12] = '0' + (tmCSU->tm_sec) / 10 % 10;
+    rtc.RtcData[13] = '0' + (tmCSU->tm_sec) / 1 % 10;
+
+    if (Config_Rtc_Data(Uart5Fd, Addr.Fan, &rtc) == PASS) {
+        //log_info("SetRtc (FB) sucessfully. \n");
+    }
+}
+
+void SetModelName_Fan()
+{
+    if (Config_Model_Name(Uart5Fd, Addr.Fan, ShmSysConfigAndInfo->SysConfig.ModelName) == PASS) {
+        log_info("Set Model name PASS = %s \n", ShmSysConfigAndInfo->SysConfig.ModelName);
+    }
+}
+
+// AC 三相輸入電壓
+void GetPresentInputVol()
+{
+    if (Query_Present_InputVoltage(Uart5Fd, Addr.Relay, &inputVoltage) == PASS) {
+        // resolution : 0.1
+        ShmSysConfigAndInfo->SysInfo.InputVoltageR = ShmRelayModuleData->InputL1Volt = inputVoltage.L1N_L12;
+        ShmSysConfigAndInfo->SysInfo.InputVoltageS = ShmRelayModuleData->InputL2Volt = inputVoltage.L2N_L23;
+        ShmSysConfigAndInfo->SysInfo.InputVoltageT = ShmRelayModuleData->InputL3Volt = inputVoltage.L3N_L31;
+
+        //********************************************************************************************************//
+        // Vin (UVP)
+        if (ShmSysConfigAndInfo->SysInfo.ChargerType == _CHARGER_TYPE_IEC) {
+            if (ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL1InputUVP == NO) {
+                if (inputVoltage.L1N_L12 < VIN_MIN_VOLTAGE_IEC) {
+                    log_info("In Uvp L1N_L12 = %f \n", inputVoltage.L1N_L12);
+                    if (_threePhaseUvp[0] >= OVP_UVP_CHK_COUNT) {
+                        ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL1InputUVP = YES;
+                    } else {
+                        _threePhaseUvp[0] += 1;
+                    }
+                }
+            } else {
+                if (inputVoltage.L1N_L12 > VIN_MIN_REV_VOLTAGE_IEC) {
+                    ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL1InputUVP = NO;
+                    _threePhaseUvp[0] = 0;
+                }
+            }
+
+            if (ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL2InputUVP == NO) {
+                if (inputVoltage.L2N_L23 < VIN_MIN_VOLTAGE_IEC) {
+                    log_info("In Uvp L2N_L23 = %f \n", inputVoltage.L2N_L23);
+                    if (_threePhaseUvp[1] >= OVP_UVP_CHK_COUNT) {
+                        ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL2InputUVP = YES;
+                    } else {
+                        _threePhaseUvp[1] += 1;
+                    }
+                }
+            } else {
+                if (inputVoltage.L2N_L23 > VIN_MIN_REV_VOLTAGE_IEC) {
+                    ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL2InputUVP = NO;
+                    _threePhaseUvp[1] = 0;
+                }
+            }
+
+            if (ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL3InputUVP == NO) {
+                if (inputVoltage.L3N_L31 < VIN_MIN_VOLTAGE_IEC) {
+                    log_info("In Uvp L3N_L31 = %f \n", inputVoltage.L3N_L31);
+                    if (_threePhaseUvp[2] >= OVP_UVP_CHK_COUNT) {
+                        ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL3InputUVP = YES;
+                    } else {
+                        _threePhaseUvp[2] += 1;
+                    }
+                }
+            } else {
+                if (inputVoltage.L3N_L31 > VIN_MIN_REV_VOLTAGE_IEC) {
+                    ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL3InputUVP = NO;
+                    _threePhaseUvp[2] = 0;
+                }
+            }
+        } else if (ShmSysConfigAndInfo->SysInfo.ChargerType == _CHARGER_TYPE_UL) {
+            if (ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL1InputUVP == NO) {
+                if (inputVoltage.L1N_L12 < VIN_MIN_VOLTAGE_UL) {
+                    log_info("In Uvp L1N_L12 = %f \n", inputVoltage.L1N_L12);
+                    if (_threePhaseUvp[0] >= OVP_UVP_CHK_COUNT) {
+                        ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL1InputUVP = YES;
+                    } else {
+                        _threePhaseUvp[0] += 1;
+                    }
+                }
+            } else {
+                if (inputVoltage.L1N_L12 > VIN_MIN_REV_VOLTAGE_UL) {
+                    ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL1InputUVP = NO;
+                    _threePhaseUvp[0] = 0;
+                }
+            }
+
+            if (ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL2InputUVP == NO) {
+                if (inputVoltage.L2N_L23 < VIN_MIN_VOLTAGE_UL) {
+                    log_info("In Uvp L2N_L23 = %f \n", inputVoltage.L2N_L23);
+                    if (_threePhaseUvp[1] >= OVP_UVP_CHK_COUNT) {
+                        ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL2InputUVP = YES;
+                    } else {
+                        _threePhaseUvp[1] += 1;
+                    }
+                }
+            } else {
+                if (inputVoltage.L2N_L23 > VIN_MIN_REV_VOLTAGE_UL) {
+                    ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL2InputUVP = NO;
+                    _threePhaseUvp[1] = 0;
+                }
+            }
+
+            if (ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL3InputUVP == NO) {
+                if (inputVoltage.L3N_L31 < VIN_MIN_VOLTAGE_UL) {
+                    log_info("In Uvp L3N_L31 = %f \n", inputVoltage.L3N_L31);
+                    if (_threePhaseUvp[2] >= OVP_UVP_CHK_COUNT) {
+                        ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL3InputUVP = YES;
+                    } else {
+                        _threePhaseUvp[2] += 1;
+                    }
+                }
+            } else {
+                if (inputVoltage.L3N_L31 > VIN_MIN_REV_VOLTAGE_UL) {
+                    ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL3InputUVP = NO;
+                    _threePhaseUvp[2] = 0;
+                }
+            }
+        }
+
+        //********************************************************************************************************//
+        // Vin (OVP)
+        if (ShmSysConfigAndInfo->SysInfo.ChargerType == _CHARGER_TYPE_IEC) {
+            if (ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL1InputOVP == NO) {
+                if (inputVoltage.L1N_L12 > VIN_MAX_VOLTAGE_IEC) {
+                    log_info("In Ovp L1N_L12 = %f \n", inputVoltage.L1N_L12);
+                    if (_threePhaseOvp[0] >= OVP_UVP_CHK_COUNT) {
+                        ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL1InputOVP = YES;
+                    } else {
+                        _threePhaseOvp[0] += 1;
+                    }
+                }
+            } else {
+                if (inputVoltage.L1N_L12 < VIN_MAX_REV_VOLTAGE_IEC) {
+                    ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL1InputOVP = NO;
+                    _threePhaseOvp[0] = 0;
+                }
+            }
+
+            if (ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL2InputOVP == NO) {
+                if (inputVoltage.L2N_L23 > VIN_MAX_VOLTAGE_IEC) {
+                    log_info("In Ovp L2N_L23 = %f \n", inputVoltage.L2N_L23);
+                    if (_threePhaseOvp[1] >= OVP_UVP_CHK_COUNT) {
+                        ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL2InputOVP = YES;
+                    } else {
+                        _threePhaseOvp[1] += 1;
+                    }
+                }
+            } else {
+                if (inputVoltage.L2N_L23 < VIN_MAX_REV_VOLTAGE_IEC) {
+                    ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL2InputOVP = NO;
+                    _threePhaseOvp[1] = 0;
+                }
+            }
+
+            if (ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL3InputOVP == NO) {
+                if (inputVoltage.L3N_L31 > VIN_MAX_VOLTAGE_IEC) {
+                    log_info("In Ovp L3N_L31 = %f \n", inputVoltage.L3N_L31);
+                    if (_threePhaseOvp[2] >= OVP_UVP_CHK_COUNT) {
+                        ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL3InputOVP = YES;
+                    } else {
+                        _threePhaseOvp[2] += 1;
+                    }
+                }
+            } else {
+                if (inputVoltage.L3N_L31 < VIN_MAX_REV_VOLTAGE_IEC) {
+                    ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL3InputOVP = NO;
+                    _threePhaseOvp[2] = 0;
+                }
+            }
+        } else if (ShmSysConfigAndInfo->SysInfo.ChargerType == _CHARGER_TYPE_UL) {
+            if (ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL1InputOVP == NO) {
+                if (inputVoltage.L1N_L12 > VIN_MAX_VOLTAGE_UL) {
+                    log_info("In Ovp L1N_L12 = %f \n", inputVoltage.L1N_L12);
+                    if (_threePhaseOvp[0] >= OVP_UVP_CHK_COUNT) {
+                        ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL1InputOVP = YES;
+                    } else {
+                        _threePhaseOvp[0] += 0;
+                    }
+                }
+            } else {
+                if (inputVoltage.L1N_L12 < VIN_MAX_REV_VOLTAGE_UL) {
+                    ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL1InputOVP = NO;
+                    _threePhaseOvp[0] = 0;
+                }
+            }
+
+            if (ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL2InputOVP == NO) {
+                if (inputVoltage.L2N_L23 > VIN_MAX_VOLTAGE_UL) {
+                    log_info("In Ovp L2N_L23 = %f \n", inputVoltage.L2N_L23);
+                    if (_threePhaseOvp[1] >= OVP_UVP_CHK_COUNT) {
+                        ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL2InputOVP = YES;
+                    } else {
+                        _threePhaseOvp[1] += 0;
+                    }
+                }
+            } else {
+                if (inputVoltage.L2N_L23 < VIN_MAX_REV_VOLTAGE_UL) {
+                    ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL2InputOVP = NO;
+                    _threePhaseOvp[1] = 0;
+                }
+            }
+
+            if (ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL2InputOVP == NO) {
+                if (inputVoltage.L3N_L31 > VIN_MAX_VOLTAGE_UL) {
+                    log_info("In Ovp L3N_L31 = %f \n", inputVoltage.L3N_L31);
+                    if (_threePhaseOvp[2] >= OVP_UVP_CHK_COUNT) {
+                        ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL3InputOVP = YES;
+                    } else {
+                        _threePhaseOvp[2] += 1;
+                    }
+                }
+            } else {
+                if (inputVoltage.L3N_L31 < VIN_MAX_REV_VOLTAGE_UL) {
+                    ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL3InputOVP = NO;
+                    _threePhaseOvp[2] = 0;
+                }
+            }
+        }
+    }
+}
+
+// 左右槍的 Relay 前後的輸出電壓
+void GetPersentOutputVol()
+{
+    if (Query_Present_OutputVoltage(Uart5Fd, Addr.Relay, &outputVoltage) == PASS) {
+//      log_info("Conn1 fuse 1 = %f \n", outputVoltage.behindFuse_Voltage_C1);
+//      log_info("Conn1 relay 1 = %f \n", outputVoltage.behindRelay_Voltage_C1);
+//      log_info("Conn2 fuse 2 = %f \n", outputVoltage.behindFuse_Voltage_C2);
+//      log_info("Conn2 relay 2 = %f \n", outputVoltage.behindRelay_Voltage_C2);
+
+        //log_info("outputVoltage.behindFuse_Voltage_C1 = %f \n", outputVoltage.behindFuse_Voltage_C1);
+        //log_info("outputVoltage.behindFuse_Voltage_C2 = %f \n", outputVoltage.behindFuse_Voltage_C2);
+
+        ShmRelayModuleData->Gun1FuseOutputVolt = outputVoltage.behindFuse_Voltage_C1;
+        ShmRelayModuleData->Gun1RelayOutputVolt = outputVoltage.behindRelay_Voltage_C1;
+        ShmRelayModuleData->Gun2FuseOutputVolt = outputVoltage.behindFuse_Voltage_C2;
+        ShmRelayModuleData->Gun2RelayOutputVolt = outputVoltage.behindRelay_Voltage_C2;
+
+        for (int index = 0; index < gunCount; index++) {
+            if (index == 0) {
+                //if (_chargingData[index]->Evboard_id == 0x01) {
+                if (index == 0) {
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
+                    _chargingData[index]->FuseChargingVoltage = ShmRelayModuleData->Gun1FuseOutputVolt;
+#else
+                    _chargingData[index]->PresentChargingCurrent = ShmRelayModuleData->Gun1FuseOutputVolt / 10;
+                    _chargingData[index]->PresentChargingVoltage = _chargingData[index]->FireChargingVoltage / 10;
+                    _chargingData[index]->FuseChargingVoltage = _chargingData[index]->FireChargingVoltage;
+#endif //!defined DD360 && !defined DD360Audi
+                    _chargingData[index]->FireChargingVoltage = ShmRelayModuleData->Gun1RelayOutputVolt;
+
+                    //} else if (_chargingData[index]->Evboard_id == 0x02) {
+                } else if (index == 1) {
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
+                    _chargingData[index]->FuseChargingVoltage = ShmRelayModuleData->Gun2FuseOutputVolt;
+#else
+                    _chargingData[index]->PresentChargingCurrent = ShmRelayModuleData->Gun2FuseOutputVolt / 10;
+                    _chargingData[index]->PresentChargingVoltage = _chargingData[index]->FireChargingVoltage / 10;
+                    _chargingData[index]->FuseChargingVoltage = _chargingData[index]->FireChargingVoltage;
+#endif //!defined DD360 && !defined DD360Audi
+                    _chargingData[index]->FireChargingVoltage = ShmRelayModuleData->Gun2RelayOutputVolt;
+                }
+            } else if (index == 1) {
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
+                _chargingData[index]->FuseChargingVoltage = ShmRelayModuleData->Gun2FuseOutputVolt;
+#else
+                _chargingData[index]->PresentChargingCurrent = ShmRelayModuleData->Gun2FuseOutputVolt / 10;
+                _chargingData[index]->PresentChargingVoltage = _chargingData[index]->FireChargingVoltage / 10;
+                _chargingData[index]->FuseChargingVoltage = _chargingData[index]->FireChargingVoltage;
+#endif //!defined DD360 && !defined DD360Audi
+                _chargingData[index]->FireChargingVoltage = ShmRelayModuleData->Gun2RelayOutputVolt;
+            }
+
+            //unsigned short Ovp = 0;
+            //unsigned short Ocp = 0;
+            //Ovp = MIN [VOUT_MAX_VOLTAGE, EV_BATTERY_VOLTAGE]  // 最大輸出電壓與電池電壓最大值
+            //Ocp = MIN [IOUT_MAX_CURRENT, EV_CURRENT_REQ]      // 最大輸出電流與需求電流最小值
+            if (_chargingData[index]->Type == _Type_Chademo) {
+                //Ovp = MaxValue(_chargingData[index]->MaximumChargingVoltage, _chargingData[index]->EvBatteryMaxVoltage);
+                //Ocp = MaxValue(_chargingData[index]->PresentChargingCurrent, ShmCHAdeMOData->ev[_chargingData[index]->type_index].ChargingCurrentRequest);
+            } else if (_chargingData[index]->Type == _Type_CCS_2) {
+
+            }
+        }
+    }
+}
+
+// 風扇速度
+void GetFanSpeed()
+{
+    //log_info("Get fan board speed \n");
+    if (Query_Fan_Speed(Uart5Fd, Addr.Fan, &fanSpeed) == PASS) {
+        ShmFanModuleData->PresentFan1Speed = fanSpeed.speed[0];
+        ShmFanModuleData->PresentFan2Speed = fanSpeed.speed[1];
+        ShmFanModuleData->PresentFan3Speed = fanSpeed.speed[2];
+        ShmFanModuleData->PresentFan4Speed = fanSpeed.speed[3];
+//      log_info("SystemFanRotaSpeed_1 = %d \n", fanSpeed.speed[0]);
+//      log_info("SystemFanRotaSpeed_2 = %d \n", fanSpeed.speed[1]);
+//      log_info("SystemFanRotaSpeed_3 = %d \n", fanSpeed.speed[2]);
+//      log_info("SystemFanRotaSpeed_4 = %d \n", fanSpeed.speed[3]);
+        // Config_Fan_Speed(Uart5Fd, Addr.Fan, &fanSpeed[0]);
+        //SysInfoData (SystemFanRotaSpeed)
+    }
+}
+
+// 讀取 Relay 狀態
+void GetRelayOutputStatus()
+{
+    if (Query_Relay_Output(Uart5Fd, Addr.Relay, &regRelay) == PASS) {
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
+        regRelay.relay_event.bits.AC_Contactor = ShmSysConfigAndInfo->SysInfo.AcContactorStatus;
+#endif //!defined DD360 && !defined DD360Audi
+    }
+}
+
+// 確認 K1 K2 relay 的狀態
+void CheckK1K2RelayOutput(byte index)
+{
+    if (index == 0) {
+        //if (_chargingData[index]->Evboard_id == 0x01) {
+        if (index == 0) {
+            if (regRelay.relay_event.bits.Gun1_N == YES && regRelay.relay_event.bits.Gun1_P == YES) {
+                _chargingData[index]->RelayK1K2Status = YES;
+            } else {
+                _chargingData[index]->RelayK1K2Status = NO;
+            }
+
+            if (_chargingData[index]->Type == _Type_CCS_2) {
+                if (gunCount == 1) {
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
+                    if (regRelay.relay_event.bits.Gun1_N == YES && regRelay.relay_event.bits.CCS_Precharge == YES) {
+                        _chargingData[index]->RelayKPK2Status = YES;
+                    } else {
+                        _chargingData[index]->RelayKPK2Status = NO;
+                    }
+#else
+                    if (_chargingData[index]->SystemStatus == S_CCS_PRECHARGE_ST0) {
+                        _chargingData[index]->RelayKPK2Status = YES;
+                    } else {
+                        _chargingData[index]->RelayKPK2Status = NO;
+                    }
+#endif //!defined DD360 && !defined DD360Audi
+                } else {
+                    if (_chargingData[index]->SystemStatus == S_CCS_PRECHARGE_ST0) {
+                        _chargingData[index]->RelayKPK2Status = YES;
+                    } else {
+                        _chargingData[index]->RelayKPK2Status = NO;
+                    }
+                }
+            }
+            //} else if (_chargingData[index]->Evboard_id == 0x02) {
+        } else if (index == 1) {
+            if (regRelay.relay_event.bits.Gun2_N == YES && regRelay.relay_event.bits.Gun2_P == YES) {
+                _chargingData[index]->RelayK1K2Status = YES;
+            } else {
+                _chargingData[index]->RelayK1K2Status = NO;
+            }
+
+            if (_chargingData[index]->Type == _Type_CCS_2) {
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
+                if (regRelay.relay_event.bits.Gun2_N == YES && regRelay.relay_event.bits.CCS_Precharge == YES) {
+                    _chargingData[index]->RelayKPK2Status = YES;
+                } else {
+                    _chargingData[index]->RelayKPK2Status = NO;
+                }
+#else
+                if (_chargingData[index]->SystemStatus == S_CCS_PRECHARGE_ST0) {
+                    _chargingData[index]->RelayKPK2Status = YES;
+                } else {
+                    _chargingData[index]->RelayKPK2Status = NO;
+                }
+#endif //!defined DD360 && !defined DD360Audi
+            }
+        }
+    } else if (index == 1) {
+        if (regRelay.relay_event.bits.Gun2_N == YES && regRelay.relay_event.bits.Gun2_P == YES) {
+            _chargingData[index]->RelayK1K2Status = YES;
+        } else {
+            _chargingData[index]->RelayK1K2Status = NO;
+        }
+
+        if (_chargingData[index]->Type == _Type_CCS_2) {
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
+            if (regRelay.relay_event.bits.Gun2_N == YES && regRelay.relay_event.bits.CCS_Precharge == YES) {
+                _chargingData[index]->RelayKPK2Status = YES;
+            } else {
+                _chargingData[index]->RelayKPK2Status = NO;
+            }
+#else
+            if (_chargingData[index]->SystemStatus == S_CCS_PRECHARGE_ST0) {
+                _chargingData[index]->RelayKPK2Status = YES;
+            } else {
+                _chargingData[index]->RelayKPK2Status = NO;
+            }
+#endif //!defined DD360 && !defined DD360Audi
+        }
+    }
+
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
+    //DS60-120 add
+    if (ShmSysConfigAndInfo->SysInfo.BridgeRelayStatus == YES) {
+        if (regRelay.relay_event.bits.Gun1_Parallel_N == NO &&
+                regRelay.relay_event.bits.Gun1_Parallel_P == NO) {
+            ShmSysConfigAndInfo->SysInfo.BridgeRelayStatus = NO;
+        }
+    } else if (ShmSysConfigAndInfo->SysInfo.BridgeRelayStatus == NO) {
+        if (regRelay.relay_event.bits.Gun1_Parallel_N == YES &&
+                regRelay.relay_event.bits.Gun1_Parallel_P == YES) {
+            ShmSysConfigAndInfo->SysInfo.BridgeRelayStatus = YES;
+        }
+    }
+#else
+    ShmSysConfigAndInfo->SysInfo.BridgeRelayStatus = YES;
+#endif //!defined DD360 && !defined DD360Audi
+
+//  log_info("Check Relay Output. index = %d, RelayKPK2Status = %d, BridgeRelayStatus = %d \n",
+//          index, _chargingData[index]->RelayKPK2Status, ShmSysConfigAndInfo->SysInfo.BridgeRelayStatus);
+}
+
+void GetGfdAdc()
+{
+    int gunIndex = 0;
+
+    // define : 每 0.2 ~ 1 秒一次
+    // occur : <= 75k 歐姆 @ 150 - 750 Vdc
+    // warning : >= 100 歐姆 && <= 500 歐姆 @ 150-750 Vdc
+    if (Query_Gfd_Adc(Uart5Fd, Addr.Relay, &gfd_adc) == PASS) {
+        for (gunIndex = 0; gunIndex < gunCount; gunIndex++) {
+            if (_chargingData[gunIndex]->Type == 0x09 &&
+                    !ShmSysConfigAndInfo->SysConfig.AlwaysGfdFlag
+               ) {
+                if ((_chargingData[gunIndex]->PresentChargingVoltage * 10) >= VOUT_MIN_VOLTAGE) {
+                    _chargingData[gunIndex]->GroundFaultStatus = GFD_PASS;
+                }
+                continue;
+            }
+
+            if (gunIndex == 0) {
+                if (gfd_adc.result_conn1 == GFD_WARNING) {
+                    gfd_adc.result_conn1 = GFD_PASS;
+                }
+
+                _chargingData[gunIndex]->GroundFaultStatus = gfd_adc.result_conn1;
+                //log_info("GFD ******** Result = %d, Step = %d, R = %d, Vol = %d \n",
+                //            _chargingData[gunIndex]->GroundFaultStatus,
+                //            gfd_adc.rb_step_1,
+                //            gfd_adc.Resister_conn1,
+                //            gfd_adc.voltage_conn1);
+                if (_chargingData[gunIndex]->GroundFaultStatus == GFD_FAIL) {
+                    log_info("GFD Fail. index = %d, Step = %d, R = %d, Vol = %d \n",
+                             gunIndex,
+                             gfd_adc.rb_step_1,
+                             gfd_adc.Resister_conn1,
+                             gfd_adc.voltage_conn1);
+
+                } else if (_chargingData[gunIndex]->GroundFaultStatus == GFD_PASS ||
+                           _chargingData[gunIndex]->GroundFaultStatus == GFD_WARNING
+                          ) {
+                    if (_chargingData[gunIndex]->GroundFaultStatus == GFD_WARNING) {
+                        log_info("GFD Warning. index = %d, Result = %d, R = %d, Vol = %d \n",
+                                 gunIndex,
+                                 _chargingData[gunIndex]->GroundFaultStatus,
+                                 gfd_adc.Resister_conn1,
+                                 gfd_adc.voltage_conn1);
+                    }
+                }
+            } else if (gunIndex == 1) {
+                if (gfd_adc.result_conn2 == GFD_WARNING) {
+                    gfd_adc.result_conn2 = GFD_PASS;
+                }
+                _chargingData[gunIndex]->GroundFaultStatus = gfd_adc.result_conn2;
+                if (_chargingData[gunIndex]->GroundFaultStatus == GFD_FAIL) {
+                    log_info("GFD Fail. index = %d, Step = %d, R = %d, Vol = %d \n",
+                             gunIndex,
+                             gfd_adc.rb_step_2,
+                             gfd_adc.Resister_conn2,
+                             gfd_adc.voltage_conn2);
+                } else if (_chargingData[gunIndex]->GroundFaultStatus == GFD_PASS ||
+                           _chargingData[gunIndex]->GroundFaultStatus == GFD_WARNING
+                          ) {
+                    if (_chargingData[gunIndex]->GroundFaultStatus == GFD_WARNING) {
+                        log_info("GFD Warning. index = %d, Result = %d, R = %d, Vol = %d \n",
+                                 gunIndex,
+                                 _chargingData[gunIndex]->GroundFaultStatus,
+                                 gfd_adc.Resister_conn1,
+                                 gfd_adc.voltage_conn1);
+                    }
+                }
+            }
+        }
+    }
+}
+
+void GetGpioInput()
+{
+    if (Query_Gpio_Input(Uart5Fd, Addr.Aux, &gpio_in) == PASS) {
+        // AC Contactor Status
+        if (gpio_in.AC_MainBreaker == 1) {
+            // AC Main Breaker ON
+            log_info("RB AC Main Breaker. \n");
+        }
+
+        if (gpio_in.SPD == 1) {
+            // SPD (雷擊保護) ON
+            log_info("RB SPD. \n");
+        }
+
+        if (gpio_in.Door_Open == 1) {
+            // Door Open
+            log_info("RB Door Open. \n");
+        }
+
+        if (gpio_in.GFD[0] == 1) {
+            // GFD_1 Trigger
+        }
+
+        if (gpio_in.GFD[1] == 1) {
+            // GFD_2 Trigger
+        }
+
+        if (gpio_in.AC_Drop == 1) {
+            // AC Drop
+            log_info("RB AC Drop. \n");
+        }
+
+        if (gpio_in.Emergency_IO == 1) {
+            // Emergency IO ON
+            log_info("RB Emergency IO ON. \n");
+        }
+
+        if (gpio_in.Button_Emergency_Press == 1) {
+            // Emergency button Press
+        }
+
+        if (gpio_in.Button_On_Press == 1) {
+            // On button Press
+        }
+
+        if (gpio_in.Button_Off_Press == 1) {
+            // Off button Press
+        }
+
+        if (gpio_in.Key_1_Press == 1) {
+            // key 1 press
+        }
+
+        if (gpio_in.Key_2_Press == 1) {
+            // key 2 press
+        }
+
+        if (gpio_in.Key_3_Press == 1) {
+            // key 3 press
+        }
+
+        if (gpio_in.Key_4_Press == 1) {
+            // key 4 press
+        }
+    }
+}
+
+// 5V 12V 24V 48V
+void GetAuxPower()
+{
+    if (Query_Aux_PowerVoltage(Uart5Fd, Addr.Fan, &auxPower) == PASS) {
+        ShmSysConfigAndInfo->SysInfo.AuxPower48V = auxPower.voltage[0];
+        ShmSysConfigAndInfo->SysInfo.AuxPower24V = auxPower.voltage[1];
+        //ShmSysConfigAndInfo->SysInfo.AuxPower12V = auxPower.voltage[4];
+        //ShmSysConfigAndInfo->SysInfo.AuxPower5V = auxPower.voltage[6];
+        // aux power voltage
+        //log_info("aux1 = %x, \n", auxPower.voltage[0]);
+        //log_info("aux2 = %x, \n", auxPower.voltage[1]);
+    }
+}
+
+void SetFanModuleSpeed()
+{
+    {
+        FanSpeed _fanSpeed;
+
+        _setFanSpeed += fanSpeedSmoothValue;
+
+        if (_setFanSpeed >= ShmFanModuleData->SetFan1Speed) {
+            _setFanSpeed = ShmFanModuleData->SetFan1Speed;
+        }
+
+        //printf("_setFanSpeed = %d \n", _setFanSpeed);
+        _fanSpeed.speed[0] = _setFanSpeed;
+
+        _fanSpeed.speed[1] = _setFanSpeed;
+
+        _fanSpeed.speed[2] = _setFanSpeed;
+
+        _fanSpeed.speed[3] = _setFanSpeed;
+
+        if (Config_Fan_Speed(Uart5Fd, Addr.Fan, &_fanSpeed) == PASS) {
+            //log_info("successfully Fan\n");
+        }
+    }
+}
+
+//==========================================
+// Common Function
+//==========================================
+void SetK1K2RelayStatus(byte index)
+{
+    if (ShmPsuData->Work_Step >= _TEST_MODE && ShmPsuData->Work_Step <= _TEST_MODE) {
+        if (regRelay.relay_event.bits.Gun1_N == NO) {
+            outputRelay.relay_event.bits.Gun1_N = YES;
+        } else if (regRelay.relay_event.bits.Gun1_P == NO) {
+            outputRelay.relay_event.bits.Gun1_P = YES;
+        }
+        return;
+    }
+
+    if (_chargingData[index]->SystemStatus < S_PREPARING_FOR_EVSE) {
+        //if (_chargingData[index]->Evboard_id == 0x01) {
+        if (index == 0) {
+            if (regRelay.relay_event.bits.Gun1_P == YES) {
+                outputRelay.relay_event.bits.Gun1_P = NO;
+            } else if (regRelay.relay_event.bits.Gun1_N == YES) {
+                outputRelay.relay_event.bits.Gun1_N = NO;
+            }
+
+            if (gunCount == 1 && _chargingData[index]->Type == _Type_CCS_2) {
+                if (regRelay.relay_event.bits.CCS_Precharge == YES) {
+                    outputRelay.relay_event.bits.CCS_Precharge = NO;
+                }
+            }
+            //} else if (_chargingData[index]->Evboard_id == 0x02) {
+        } else if (index == 1) {
+            if (regRelay.relay_event.bits.Gun2_P == YES) {
+                outputRelay.relay_event.bits.Gun2_P = NO;
+            } else if (regRelay.relay_event.bits.Gun2_N == YES) {
+                outputRelay.relay_event.bits.Gun2_N = NO;
+            }
+
+            if (_chargingData[index]->Type == _Type_CCS_2) {
+                if (regRelay.relay_event.bits.CCS_Precharge == YES) {
+                    outputRelay.relay_event.bits.CCS_Precharge = NO;
+                }
+            }
+        }
+    } else if ((_chargingData[index]->SystemStatus >= S_PREPARING_FOR_EVSE &&
+                _chargingData[index]->SystemStatus <= S_CHARGING)) {
+#if !defined METER_ENABLE
+        if (_chargingData[index]->RelayWeldingCheck == YES)
+#endif //!defined METER_ENABLE
+        {
+            //if (_chargingData[index]->Evboard_id == 0x01) {
+            if (index == 0) {
+                if (regRelay.relay_event.bits.Gun1_N == NO) {
+                    outputRelay.relay_event.bits.Gun1_N = YES;
+                } else if (regRelay.relay_event.bits.Gun1_P == NO) {
+                    outputRelay.relay_event.bits.Gun1_P = YES;
+                }
+                //} else if (_chargingData[index]->Evboard_id == 0x02) {
+            } else if (index == 1) {
+                if (regRelay.relay_event.bits.Gun2_N == NO) {
+                    outputRelay.relay_event.bits.Gun2_N = YES;
+                } else if (regRelay.relay_event.bits.Gun2_P == NO) {
+                    outputRelay.relay_event.bits.Gun2_P = YES;
+                }
+            }
+        }
+    } else if ((_chargingData[index]->SystemStatus >= S_TERMINATING &&
+                _chargingData[index]->SystemStatus <= S_COMPLETE) ||
+               _chargingData[index]->SystemStatus == S_ALARM) {
+        if ((_chargingData[index]->PresentChargingCurrent * 10) <= SEFETY_SWITCH_RELAY_CUR) {
+            //if (_chargingData[index]->Evboard_id == 0x01) {
+            if (index == 0) {
+                if (regRelay.relay_event.bits.Gun1_P == YES) {
+                    outputRelay.relay_event.bits.Gun1_P = NO;
+                } else if (regRelay.relay_event.bits.Gun1_N == YES) {
+                    outputRelay.relay_event.bits.Gun1_N = NO;
+                }
+                //} else if (_chargingData[index]->Evboard_id == 0x02) {
+            } else if (index == 1) {
+                if (regRelay.relay_event.bits.Gun2_P == YES) {
+                    outputRelay.relay_event.bits.Gun2_P = NO;
+                } else if (regRelay.relay_event.bits.Gun2_N == YES) {
+                    outputRelay.relay_event.bits.Gun2_N = NO;
+                }
+            }
+        }
+    } else if (_chargingData[index]->SystemStatus == S_CCS_PRECHARGE_ST0) {
+        //if (_chargingData[index]->Evboard_id == 0x01) {
+        if (index == 0) {
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
+            if (_chargingData[index]->Type == _Type_CCS_2) {
+                if (gunCount == 1) {
+                    if (regRelay.relay_event.bits.CCS_Precharge == NO) {
+                        outputRelay.relay_event.bits.CCS_Precharge = YES;
+                    } else if (regRelay.relay_event.bits.CCS_Precharge == YES) {
+                        outputRelay.relay_event.bits.Gun1_P = NO;
+                    }
+                }
+            }
+#endif //!defined DD360 && !defined DD360Audi
+            //} else if (_chargingData[index]->Evboard_id == 0x02) {
+        } else if (index == 1) {
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
+            if (_chargingData[index]->Type == _Type_CCS_2) {
+                if (regRelay.relay_event.bits.CCS_Precharge == NO) {
+                    outputRelay.relay_event.bits.CCS_Precharge = YES;
+                } else if (regRelay.relay_event.bits.CCS_Precharge == YES) {
+                    outputRelay.relay_event.bits.Gun2_P = NO;
+                }
+            }
+#endif //!defined DD360 && !defined DD360Audi
+        }
+    } else if (_chargingData[index]->SystemStatus == S_CCS_PRECHARGE_ST1) {
+        //if (_chargingData[index]->Evboard_id == 0x01) {
+        if (index == 0) {
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
+            if (_chargingData[index]->Type == _Type_CCS_2) {
+                if (gunCount == 1) {
+                    if (regRelay.relay_event.bits.Gun1_P == NO) {
+                        outputRelay.relay_event.bits.Gun1_P = YES;
+                    } else if (regRelay.relay_event.bits.Gun1_P == YES) {
+                        outputRelay.relay_event.bits.CCS_Precharge = NO;
+                    }
+                }
+            }
+#endif //!defined DD360 && !defined DD360Audi
+            //} else if (_chargingData[index]->Evboard_id == 0x02) {
+        } else if (index == 1) {
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
+            if (_chargingData[index]->Type == _Type_CCS_2) {
+                if (regRelay.relay_event.bits.Gun2_P == NO) {
+                    outputRelay.relay_event.bits.Gun2_P = YES;
+                } else if (regRelay.relay_event.bits.Gun2_P == YES) {
+                    outputRelay.relay_event.bits.CCS_Precharge = NO;
+                }
+            }
+#endif //!defined DD360 && !defined DD360Audi
+        }
+    }
+}
+
+void CheckAcInputOvpStatus(byte index)
+{
+    if (ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL1InputOVP == YES ||
+            ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL2InputOVP == YES ||
+            ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL3InputOVP == YES) {
+//      if ((_chargingData[index]->SystemStatus >= S_PREPARNING && _chargingData[index]->SystemStatus <= S_CHARGING) ||
+//              (_chargingData[index]->SystemStatus >= S_CCS_PRECHARGE_ST0 && _chargingData[index]->SystemStatus <= S_CCS_PRECHARGE_ST1))
+//      {
+//          if (ShmSysConfigAndInfo->SysInfo.ChargerType == _CHARGER_TYPE_IEC)
+//          {
+//              if (_psuInputVolR > VIN_MAX_VOLTAGE_IEC ||
+//                      _psuInputVolS > VIN_MAX_VOLTAGE_IEC ||
+//                      _psuInputVolT > VIN_MAX_VOLTAGE_IEC)
+//              {
+//                  log_info("IEC _psuInputVolR = %f, _psuInputVolS = %f, _psuInputVolT = %f \n",
+//                          _psuInputVolR, _psuInputVolS, _psuInputVolT);
+//                  _chargingData[index]->StopChargeFlag = YES;
+//              }
+//
+//          }
+//          else if (ShmSysConfigAndInfo->SysInfo.ChargerType == _CHARGER_TYPE_UL)
+//          {
+//              if (_psuInputVolR > VIN_MAX_VOLTAGE_UL ||
+//                      _psuInputVolS > VIN_MAX_VOLTAGE_UL ||
+//                      _psuInputVolT > VIN_MAX_VOLTAGE_UL)
+//              {
+//                  log_info("UL _psuInputVolR = %f, _psuInputVolS = %f, _psuInputVolT = %f \n",
+//                          _psuInputVolR, _psuInputVolS, _psuInputVolT);
+//                  _chargingData[index]->StopChargeFlag = YES;
+//              }
+//          }
+//      }
+//      else
+        //log_info("CheckAcInputOvpStatus\r\n");
+        _chargingData[index]->StopChargeFlag = YES;
+    }
+}
+
+void CheckPhaseLossStatus(byte index)
+{
+    if (ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL1InputUVP == YES ||
+            ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL2InputUVP == YES ||
+            ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL3InputUVP == YES) {
+        //log_info("CheckPhaseLossStatus\r\n");
+        _chargingData[index]->StopChargeFlag = YES;
+    }
+}
+
+void SetParalleRelayStatus()
+{
+    // 之後雙槍單模機種，橋接都會上
+    if (gunCount >= 2) {
+        if (_chargingData[0]->SystemStatus == S_BOOTING || _chargingData[1]->SystemStatus == S_BOOTING ||
+                (_chargingData[0]->SystemStatus == S_IDLE && _chargingData[1]->SystemStatus == S_IDLE)) {
+            // 初始化~ 不搭橋接
+            if (regRelay.relay_event.bits.Gun1_Parallel_P == YES) {
+                outputRelay.relay_event.bits.Gun1_Parallel_P = NO;
+            } else if (regRelay.relay_event.bits.Gun1_Parallel_N == YES) {
+                outputRelay.relay_event.bits.Gun1_Parallel_N = NO;
+            }
+        } else {
+            if (_chargingData[0]->IsReadyToCharging == YES ||
+                    _chargingData[1]->IsReadyToCharging == YES) {
+                // ************需考慮在切換中 - 切開 relay 與搭回 relay 的時機點************
+                if (ShmSysConfigAndInfo->SysInfo.MainChargingMode == _MAIN_CHARGING_MODE_MAX) {
+                    if (ShmSysConfigAndInfo->SysInfo.ReAssignedFlag < _REASSIGNED_RELAY_M_TO_A) {
+                        // 最大充 - 搭上橋接
+                        if (regRelay.relay_event.bits.Gun1_Parallel_N == NO) {
+                            outputRelay.relay_event.bits.Gun1_Parallel_N = YES;
+                        } else if (regRelay.relay_event.bits.Gun1_Parallel_P == NO) {
+                            outputRelay.relay_event.bits.Gun1_Parallel_P = YES;
+                        }
+                    } else {
+                        // 平均充 - 不搭
+                        if (regRelay.relay_event.bits.Gun1_Parallel_P == YES) {
+                            outputRelay.relay_event.bits.Gun1_Parallel_P = NO;
+                        } else if (regRelay.relay_event.bits.Gun1_Parallel_N == YES) {
+                            outputRelay.relay_event.bits.Gun1_Parallel_N = NO;
+                        }
+                    }
+                } else if (ShmSysConfigAndInfo->SysInfo.MainChargingMode == _MAIN_CHARGING_MODE_AVER) {
+                    if (ShmSysConfigAndInfo->SysInfo.ReAssignedFlag < _REASSIGNED_RELAY_A_TO_M) {
+                        // 平均充 - 不搭
+                        if (regRelay.relay_event.bits.Gun1_Parallel_P == YES) {
+                            outputRelay.relay_event.bits.Gun1_Parallel_P = NO;
+                        } else if (regRelay.relay_event.bits.Gun1_Parallel_N == YES) {
+                            outputRelay.relay_event.bits.Gun1_Parallel_N = NO;
+                        }
+                    } else {
+                        // 最大充 - 搭上橋接
+                        if (regRelay.relay_event.bits.Gun1_Parallel_N == NO) {
+                            outputRelay.relay_event.bits.Gun1_Parallel_N = YES;
+                        } else if (regRelay.relay_event.bits.Gun1_Parallel_P == NO) {
+                            outputRelay.relay_event.bits.Gun1_Parallel_P = YES;
+                        }
+                    }
+                }
+            }
+        }
+    }
+}
+
+void CheckAlarmOccur()
+{
+    bool isErr = false;
+    for (byte count = 0; count < sizeof(_alarm_code) / sizeof(_alarm_code[0]); count++) {
+        if (acAlarmCode.AcAlarmCode & _alarm_code[count]) {
+            isErr = true;
+            switch (_alarm_code[count]) {
+            case AC_OVP: ShmStatusCodeData->AlarmCode.AlarmEvents.bits.AcSystemInputOVP = YES; break;
+            case AC_UVP: ShmStatusCodeData->AlarmCode.AlarmEvents.bits.AcSystemInputUVP = YES; break;
+            case AC_OCP: ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemAcOutputOCP = YES; break;
+            case AC_OTP: ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemAmbientOTP = YES; break;
+            case AC_GMI_FAULT: ShmStatusCodeData->AlarmCode.AlarmEvents.bits.AcGroundfaultFail = YES; break;
+            case AC_CP_ERROR: ShmStatusCodeData->InfoCode.InfoEvents.bits.PilotFault = YES; break;
+            case AC_AC_LEAKAGE: ShmStatusCodeData->AlarmCode.AlarmEvents.bits.RcdTrip = YES; break;
+            case AC_DC_LEAKAGE: ShmStatusCodeData->AlarmCode.AlarmEvents.bits.RcdTrip = YES; break;
+            case AC_SYSTEM_SELFTEST_FAULT: ShmStatusCodeData->AlarmCode.AlarmEvents.bits.McuSelftestFail = YES; break;
+            case AC_HANDSHAKE_TIMEOUT: break;
+            //case AC_EMC_STOP: ShmStatusCodeData->AlarmCode.AlarmEvents.bits.EmergencyStopTrip = YES; break;
+            case AC_RELAY_WELDING: ShmStatusCodeData->FaultCode.FaultEvents.bits.AcOutputRelayWelding = YES; break;
+            case AC_GF_MODULE_FAULT: ShmStatusCodeData->FaultCode.FaultEvents.bits.RcdSelfTestFail = YES; break;
+            case AC_SHUTTER_FAULT: break;
+            case AC_LOCKER_FAULT: ShmStatusCodeData->FaultCode.FaultEvents.bits.AcConnectorLockFail = YES; break;
+            case AC_POWER_DROP: ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL1InputDrop = YES; break;
+            case AC_CIRCUIT_SHORT: ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CircuitShort = YES; break;
+            case AC_ROTARY_SWITCH_FAULT: break;
+            case AC_RELAY_DRIVE_FAULT: ShmStatusCodeData->FaultCode.FaultEvents.bits.AcOutputRelayDrivingFault = YES; break;
+            }
+        } else {
+            switch (_alarm_code[count]) {
+            case AC_OVP: ShmStatusCodeData->AlarmCode.AlarmEvents.bits.AcSystemInputOVP = NO; break;
+            case AC_UVP: ShmStatusCodeData->AlarmCode.AlarmEvents.bits.AcSystemInputUVP = NO; break;
+            case AC_OCP: ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemAcOutputOCP = NO; break;
+            case AC_OTP: ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemAmbientOTP = NO; break;
+            case AC_GMI_FAULT: ShmStatusCodeData->AlarmCode.AlarmEvents.bits.AcGroundfaultFail = NO; break;
+            case AC_CP_ERROR: ShmStatusCodeData->InfoCode.InfoEvents.bits.PilotFault = NO; break;
+            case AC_AC_LEAKAGE: ShmStatusCodeData->AlarmCode.AlarmEvents.bits.RcdTrip = NO; break;
+            case AC_DC_LEAKAGE: ShmStatusCodeData->AlarmCode.AlarmEvents.bits.RcdTrip = NO; break;
+            case AC_SYSTEM_SELFTEST_FAULT: ShmStatusCodeData->AlarmCode.AlarmEvents.bits.McuSelftestFail = NO; break;
+            case AC_HANDSHAKE_TIMEOUT: break;
+            //case AC_EMC_STOP: ShmStatusCodeData->AlarmCode.AlarmEvents.bits.EmergencyStopTrip = NO; break;
+            case AC_RELAY_WELDING: ShmStatusCodeData->FaultCode.FaultEvents.bits.AcOutputRelayWelding = NO; break;
+            case AC_GF_MODULE_FAULT: ShmStatusCodeData->FaultCode.FaultEvents.bits.RcdSelfTestFail = NO; break;
+            case AC_SHUTTER_FAULT: break;
+            case AC_LOCKER_FAULT: ShmStatusCodeData->FaultCode.FaultEvents.bits.AcConnectorLockFail = NO; break;
+            case AC_POWER_DROP: ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL1InputDrop = NO; break;
+            case AC_CIRCUIT_SHORT: ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CircuitShort = NO; break;
+            case AC_ROTARY_SWITCH_FAULT:  break;
+            case AC_RELAY_DRIVE_FAULT: ShmStatusCodeData->FaultCode.FaultEvents.bits.AcOutputRelayDrivingFault = NO; break;
+            }
+        }
+    }
+
+    ac_chargingInfo[0]->IsErrorOccur = isErr;
+}
+
+bool IsNoneMatchLedColor()
+{
+    bool result = false;
+
+    if (cur_led_color.Connect_1_Red != led_color.Connect_1_Red ||
+            cur_led_color.Connect_1_Green != led_color.Connect_1_Green ||
+            cur_led_color.Connect_1_Blue != led_color.Connect_1_Blue ||
+            cur_led_color.Connect_2_Red != led_color.Connect_2_Red ||
+            cur_led_color.Connect_2_Green != led_color.Connect_2_Green ||
+            cur_led_color.Connect_2_Blue != led_color.Connect_2_Blue) {
+        result = true;
+    }
+
+    return result;
+}
+
+void SetLedColor(struct ChargingInfoData *chargingData_1, struct ChargingInfoData *chargingData_2)
+{
+    byte _colorBuf = COLOR_MAX_LV * LED_INTENSITY_BRIGHTEST;
+
+    if (ShmSysConfigAndInfo->SysConfig.LedInfo.Intensity == _LED_INTENSITY_DARKEST) {
+        _colorBuf = COLOR_MAX_LV * LED_INTENSITY_DARKEST;
+    } else if (ShmSysConfigAndInfo->SysConfig.LedInfo.Intensity == _LED_INTENSITY_MEDIUM) {
+        _colorBuf = COLOR_MAX_LV * LED_INTENSITY_MEDIUM;
+    }
+
+    //printf("chargingData_1->SystemStatus=%d\n",chargingData_1->SystemStatus);
+    //printf("chargingData_2->SystemStatus=%d\n",chargingData_2->SystemStatus);
+    //printf("ShmSysConfigAndInfo->SysWarningInfo.Level=%d\n",ShmSysConfigAndInfo->SysWarningInfo.Level);
+    if (ShmSysConfigAndInfo->SysWarningInfo.Level == 2) {
+        led_color.Connect_1_Green = COLOR_MIN_LV;
+        led_color.Connect_1_Blue = COLOR_MIN_LV;
+        led_color.Connect_1_Red = _colorBuf;
+        led_color.Connect_2_Green = COLOR_MIN_LV;
+        led_color.Connect_2_Blue = COLOR_MIN_LV;
+        led_color.Connect_2_Red = _colorBuf;
+    } else {
+        if (ShmSysConfigAndInfo->SysInfo.IsAlternatvieConf) {
+            if ((chargingData_1->SystemStatus == S_BOOTING ||
+                    chargingData_1->SystemStatus == S_IDLE ||
+                    chargingData_1->SystemStatus == S_RESERVATION) &&
+                    (chargingData_2->SystemStatus == S_BOOTING ||
+                     chargingData_2->SystemStatus == S_IDLE ||
+                     chargingData_2->SystemStatus == S_RESERVATION)) {
+#if defined DD360Audi
+                led_color.Connect_1_Green = _colorBuf;
+                led_color.Connect_1_Blue = _colorBuf;
+                led_color.Connect_1_Red = _colorBuf;
+
+                led_color.Connect_2_Green = _colorBuf;
+                led_color.Connect_2_Blue = _colorBuf;
+                led_color.Connect_2_Red = _colorBuf;
+#else
+                led_color.Connect_1_Green = _colorBuf;
+                led_color.Connect_1_Blue = COLOR_MIN_LV;
+                led_color.Connect_1_Red = COLOR_MIN_LV;
+
+                led_color.Connect_2_Green = _colorBuf;
+                led_color.Connect_2_Blue = COLOR_MIN_LV;
+                led_color.Connect_2_Red = COLOR_MIN_LV;
+#endif
+            } else if ((chargingData_1->SystemStatus >= S_AUTHORIZING &&
+                        chargingData_1->SystemStatus <= S_COMPLETE) ||
+                       (chargingData_1->SystemStatus >= S_CCS_PRECHARGE_ST0 &&
+                        chargingData_1->SystemStatus <= S_CCS_PRECHARGE_ST1) ||
+                       (chargingData_2->SystemStatus >= S_AUTHORIZING &&
+                        chargingData_2->SystemStatus <= S_COMPLETE) ||
+                       (chargingData_2->SystemStatus >= S_CCS_PRECHARGE_ST0 &&
+                        chargingData_2->SystemStatus <= S_CCS_PRECHARGE_ST1)) {
+                led_color.Connect_1_Green = COLOR_MIN_LV;
+                led_color.Connect_1_Blue = _colorBuf;
+                led_color.Connect_1_Red = COLOR_MIN_LV;
+                led_color.Connect_2_Green = COLOR_MIN_LV;
+                led_color.Connect_2_Blue = _colorBuf;
+                led_color.Connect_2_Red = COLOR_MIN_LV;
+            }
+        } else {
+            if (chargingData_1->SystemStatus == S_BOOTING ||
+                    chargingData_1->SystemStatus == S_IDLE ||
+                    chargingData_1->SystemStatus == S_RESERVATION ||
+                    chargingData_1->SystemStatus == S_MAINTAIN) {
+
+                if (chargingData_1->IsAvailable == NO) { //For Audi
+                    led_color.Connect_1_Green = COLOR_MIN_LV;
+                    led_color.Connect_1_Blue = COLOR_MIN_LV;
+                    led_color.Connect_1_Red = _colorBuf;
+                } else {
+#if defined DD360Audi
+                    led_color.Connect_1_Green = _colorBuf;
+                    led_color.Connect_1_Blue = _colorBuf;
+                    led_color.Connect_1_Red = _colorBuf;
+#else
+                    led_color.Connect_1_Green = _colorBuf;
+                    led_color.Connect_1_Blue = COLOR_MIN_LV;
+                    led_color.Connect_1_Red = COLOR_MIN_LV;
+#endif
+                }
+            } else if ((chargingData_1->SystemStatus >= S_AUTHORIZING &&
+                        chargingData_1->SystemStatus <= S_COMPLETE) ||
+                       (chargingData_1->SystemStatus >= S_CCS_PRECHARGE_ST0 &&
+                        chargingData_1->SystemStatus <= S_CCS_PRECHARGE_ST1)) {
+                led_color.Connect_1_Green = COLOR_MIN_LV;
+                led_color.Connect_1_Blue = _colorBuf;
+                led_color.Connect_1_Red = COLOR_MIN_LV;
+            }
+
+            // --------------------------------------------------------------------------
+            if (chargingData_2->SystemStatus == S_BOOTING ||
+                    chargingData_2->SystemStatus == S_IDLE ||
+                    chargingData_2->SystemStatus == S_RESERVATION ||
+                    chargingData_2->SystemStatus == S_MAINTAIN) {
+                if (chargingData_2->IsAvailable == NO) {
+                    led_color.Connect_2_Green = COLOR_MIN_LV;
+                    led_color.Connect_2_Blue = COLOR_MIN_LV;
+                    led_color.Connect_2_Red = _colorBuf;
+                } else {
+#if defined DD360Audi
+                    led_color.Connect_2_Green = _colorBuf;
+                    led_color.Connect_2_Blue = _colorBuf;
+                    led_color.Connect_2_Red = _colorBuf;
+#else
+                    led_color.Connect_2_Green = _colorBuf;
+                    led_color.Connect_2_Blue = COLOR_MIN_LV;
+                    led_color.Connect_2_Red = COLOR_MIN_LV;
+#endif
+                }
+            } else if ((chargingData_2->SystemStatus >= S_AUTHORIZING &&
+                        chargingData_2->SystemStatus <= S_COMPLETE) ||
+                       (chargingData_2->SystemStatus >= S_CCS_PRECHARGE_ST0 &&
+                        chargingData_2->SystemStatus <= S_CCS_PRECHARGE_ST1)) {
+                led_color.Connect_2_Green = COLOR_MIN_LV;
+                led_color.Connect_2_Blue = _colorBuf;
+                led_color.Connect_2_Red = COLOR_MIN_LV;
+            }
+        }
+    }
+
+    if (_checkLedChanged > 0) {
+        if (Config_Led_Color(Uart5Fd, Addr.Led, &led_color) == PASS) {
+            _checkLedChanged--;
+
+            cur_led_color.Connect_1_Red     = led_color.Connect_1_Red;
+            cur_led_color.Connect_1_Green   = led_color.Connect_1_Green;
+            cur_led_color.Connect_1_Blue    = led_color.Connect_1_Blue;
+            cur_led_color.Connect_2_Red     = led_color.Connect_2_Red;
+            cur_led_color.Connect_2_Green   = led_color.Connect_2_Green;
+            cur_led_color.Connect_2_Blue    = led_color.Connect_2_Blue;
+        }
+    } else if (IsNoneMatchLedColor()) {
+        _checkLedChanged = 3;
+    }
+}
+//==========================================
+// Init all share memory
+//==========================================
+int InitShareMemory()
+{
+    int result = PASS;
+    int MeterSMId;
+
+    if ((MeterSMId = shmget(ShmSysConfigAndInfoKey, sizeof(struct SysConfigAndInfo),  0777)) < 0) {
+        result = FAIL;
+    } else if ((ShmSysConfigAndInfo = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+        result = FAIL;
+    }
+
+    if ((MeterSMId = shmget(ShmStatusCodeKey, sizeof(struct StatusCodeData),  0777)) < 0) {
+        result = FAIL;
+    } else if ((ShmStatusCodeData = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+        result = FAIL;
+    }
+
+    if ((MeterSMId = shmget(ShmFanBdKey, sizeof(struct FanModuleData),  0777)) < 0) {
+        result = FAIL;
+    } else if ((ShmFanModuleData = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+        result = FAIL;
+    }
+    memset(ShmFanModuleData, 0, sizeof(struct FanModuleData));
+
+    if ((MeterSMId = shmget(ShmRelayBdKey, sizeof(struct RelayModuleData),  0777)) < 0) {
+        result = FAIL;
+    } else if ((ShmRelayModuleData = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+        result = FAIL;
+    }
+    memset(ShmRelayModuleData, 0, sizeof(struct RelayModuleData));
+
+    if ((MeterSMId = shmget(ShmLedBdKey, sizeof(struct LedModuleData),  0777)) < 0) {
+        result = FAIL;
+    } else if ((ShmLedModuleData = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+        result = FAIL;
+    }
+    memset(ShmLedModuleData, 0, sizeof(struct LedModuleData));
+
+    if ((MeterSMId = shmget(ShmPsuKey, sizeof(struct PsuData),  0777)) < 0) {
+        result = FAIL;
+    } else if ((ShmPsuData = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+        result = FAIL;
+    }
+
+    if ((MeterSMId = shmget(ShmOcppModuleKey, sizeof(struct OCPP16Data), 0777)) < 0) {
+        result = FAIL;
+    } else if ((ShmOCPP16Data = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+        result = FAIL;
+    }
+
+#if defined METER_ENABLE
+    if ((MeterSMId = shmget(ShmCommonKey, sizeof(struct DcCommonInformation), IPC_CREAT | 0777)) < 0) {
+        result = FAIL;
+    } else if ((ShmDcCommonData = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+        result = FAIL;
+    }
+#endif//defined METER_ENABLE
+
+    return result;
+}
+
+int InitComPort()
+{
+    int fd;
+    struct termios tios;
+
+    fd = open(relayRs485PortName, O_RDWR);
+    if (fd <= 0) {
+#ifdef SystemLogMessage
+        log_error("Module_InternalComm. InitComPort NG\n");
+#endif
+        if (ShmStatusCodeData != NULL) {
+            ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CsuInitFailed = 1;
+        }
+        sleep(5);
+        return -1;
+    }
+    ioctl (fd, TCGETS, &tios);
+    tios.c_cflag = B115200 | CS8 | CLOCAL | CREAD;
+    tios.c_lflag = 0;
+    tios.c_iflag = 0;
+    tios.c_oflag = 0;
+    tios.c_cc[VMIN] = 0;
+    tios.c_cc[VTIME] = (byte)0;     // timeout 0.5 second
+    tios.c_lflag = 0;
+    tcflush(fd, TCIFLUSH);
+    ioctl (fd, TCSETS, &tios);
+
+    return fd;
+}
+
+//================================================
+// Main process
+//================================================
+bool FindChargingInfoData(byte target, struct ChargingInfoData **chargingData)
+{
+    for (byte index = 0; index < CHAdeMO_QUANTITY; index++) {
+        if (ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].Index
+                == target) {
+            chargingData[target] =
+                &ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index];
+            return true;
+        }
+    }
+
+    for (byte index = 0; index < CCS_QUANTITY; index++) {
+        if (ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].Index
+                == target) {
+            chargingData[target] =
+                &ShmSysConfigAndInfo->SysInfo.CcsChargingData[index];
+            return true;
+        }
+    }
+
+    for (byte index = 0; index < GB_QUANTITY; index++) {
+        if (ShmSysConfigAndInfo->SysInfo.GbChargingData[index].Index
+                == target) {
+            chargingData[target] =
+                &ShmSysConfigAndInfo->SysInfo.GbChargingData[index];
+            return true;
+        }
+    }
+
+    return false;
+}
+
+bool FindAcChargingInfoData(byte target, struct ChargingInfoData **acChargingData)
+{
+    if (target < AC_QUANTITY) {
+        acChargingData[target] = &ShmSysConfigAndInfo->SysInfo.AcChargingData[target];
+        return true;
+    }
+
+    return false;
+}
+
+void Initialization()
+{
+    bool isPass = false;
+
+    for (byte index = 0; index < ARRAY_SIZE(outputRelay.relay_event.relay_status); index++) {
+        outputRelay.relay_event.relay_status[index] = 0x00;
+    }
+
+    while (!isPass) {
+        isPass = true;
+        for (byte _index = 0; _index < gunCount; _index++) {
+            if (!FindChargingInfoData(_index, &_chargingData[0])) {
+                log_error("InternalComm : FindChargingInfoData false \n");
+                isPass = false;
+                break;
+            }
+        }
+
+        sleep(1);
+    }
+
+    isPass = false;
+
+    if (acgunCount > 0) {
+        while (!isPass) {
+            isPass = true;
+            for (byte _index = 0; _index < acgunCount; _index++) {
+                if (!FindAcChargingInfoData(_index, &ac_chargingInfo[0])) {
+                    log_error("EvComm : FindAcChargingInfoData false \n");
+                    isPass = false;
+                    break;
+                }
+            }
+
+            sleep(1);
+        }
+    }
+}
+
+#if defined METER_ENABLE
+void StartCheckRelayInfo(byte _chkIndex, byte toState)
+{
+    if (ShmDcCommonData->RelayCheckStatus[_chkIndex] == STOP) {
+        gettimeofday(&_relayStateChkTimer[_chkIndex], NULL);
+        ShmDcCommonData->RelayCheckStatus[_chkIndex] = START;
+    } else {
+        if ((GetTimeoutValue(_relayStateChkTimer[_chkIndex]) / 1000) > RELAY_CHECK_TIME * 1000) {
+            //log_info ("relay welding or driving fault = %d \n", _chkIndex);
+            if (toState == 1) {
+                ShmDcCommonData->RelayCheckStatus[_chkIndex] = RELAY_STATUS_ERROR_DRIVING;
+            } else {
+                ShmDcCommonData->RelayCheckStatus[_chkIndex] = RELAY_STATUS_ERROR_WELDING;
+            }
+        }
+    }
+}
+
+void StopCheckRelayInfo(byte _chkIndex)
+{
+    if (ShmDcCommonData->RelayCheckStatus[_chkIndex] != STOP) {
+        ShmDcCommonData->RelayCheckStatus[_chkIndex] = STOP;
+    }
+}
+#endif //defined METER_ENABLE
+
+bool IsNoneMatchRelayStatus()
+{
+    bool result = false;
+
+    if (
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
+        (regRelay.relay_event.bits.AC_Contactor != outputRelay.relay_event.bits.AC_Contactor) ||
+        (regRelay.relay_event.bits.CCS_Precharge != outputRelay.relay_event.bits.CCS_Precharge) ||
+#endif //!defined DD360 && !defined DD360Audi
+        (regRelay.relay_event.bits.Gun1_P != outputRelay.relay_event.bits.Gun1_P) ||
+        (regRelay.relay_event.bits.Gun1_N != outputRelay.relay_event.bits.Gun1_N) ||
+        (regRelay.relay_event.bits.Gun2_P != outputRelay.relay_event.bits.Gun2_P) ||
+        (regRelay.relay_event.bits.Gun2_N != outputRelay.relay_event.bits.Gun2_N)
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
+        ||
+        (regRelay.relay_event.bits.Gun1_Parallel_P != outputRelay.relay_event.bits.Gun1_Parallel_P) ||
+        (regRelay.relay_event.bits.Gun1_Parallel_N != outputRelay.relay_event.bits.Gun1_Parallel_N)
+#endif //!defined DD360 && !defined DD360Audi
+    ) {
+        /*if (regRelay.relay_event.bits.AC_Contactor != outputRelay.relay_event.bits.AC_Contactor) {
+            log_info("AC Contact Relay none match. \n");
+        }
+        if (regRelay.relay_event.bits.CCS_Precharge != outputRelay.relay_event.bits.CCS_Precharge) {
+            log_info("CCS Precharge Relay none match. \n");
+        }
+        if (regRelay.relay_event.bits.Gun1_P != outputRelay.relay_event.bits.Gun1_P) {
+            log_info("SMR1:D+ Relay none match. \n");
+        }
+        if (regRelay.relay_event.bits.Gun1_N != outputRelay.relay_event.bits.Gun1_N) {
+            log_info("SMR1:D- Relay none match. \n");
+        }
+        if (regRelay.relay_event.bits.Gun2_P != outputRelay.relay_event.bits.Gun2_P) {
+            log_info("SMR2:D+ Relay none match. \n");
+        }
+        if (regRelay.relay_event.bits.Gun2_N != outputRelay.relay_event.bits.Gun2_N) {
+            log_info("SMR2:D- Relay none match. \n");
+        }
+        if (regRelay.relay_event.bits.Gun1_Parallel_P != outputRelay.relay_event.bits.Gun1_Parallel_P) {
+            log_info("Parallel:D+ Relay none match. \n");
+        }
+        if (regRelay.relay_event.bits.Gun1_Parallel_N != outputRelay.relay_event.bits.Gun1_Parallel_N) {
+            log_info("Parallel:D- Relay none match. \n");
+        }*/
+
+        result = true;
+    }
+
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
+    if (regRelay.relay_event.bits.AC_Contactor != outputRelay.relay_event.bits.AC_Contactor) {
+        //log_info("AC Contact Relay none match, try to switch to %d \n", outputRelay.relay_event.bits.AC_Contactor);
+    }
+
+    if (regRelay.relay_event.bits.CCS_Precharge != outputRelay.relay_event.bits.CCS_Precharge) {
+        //log_info("CCS Precharge Relay none match, try to switch to %d \n", outputRelay.relay_event.bits.CCS_Precharge);
+    }
+#endif //!defined DD360 && !defined DD360Audi
+
+    if (regRelay.relay_event.bits.Gun1_P != outputRelay.relay_event.bits.Gun1_P) {
+        //StartCheckRelayInfo(RELAY_SMR1_P_STATUS, outputRelay.relay_event.bits.Gun1_P);
+        //log_info("SMR1:D+ Relay none match, try to switch to %d \n", outputRelay.relay_event.bits.Gun1_P);
+    } else {
+        //StopCheckRelayInfo(RELAY_SMR1_P_STATUS);
+        //log_info("SMR1:D+ Release %d \n");
+    }
+
+    if (regRelay.relay_event.bits.Gun1_N != outputRelay.relay_event.bits.Gun1_N) {
+        //StartCheckRelayInfo(RELAY_SMR1_N_STATUS, outputRelay.relay_event.bits.Gun1_N);
+        //log_info("SMR1:D- Relay none match, try to switch to %d \n", outputRelay.relay_event.bits.Gun1_N);
+    } else {
+        //StopCheckRelayInfo(RELAY_SMR1_N_STATUS);
+    }
+
+    if (regRelay.relay_event.bits.Gun2_P != outputRelay.relay_event.bits.Gun2_P) {
+        //StartCheckRelayInfo(RELAY_SMR2_P_STATUS, outputRelay.relay_event.bits.Gun2_P);
+        //log_info("SMR2:D+ Relay none match, try to switch to %d \n", outputRelay.relay_event.bits.Gun2_P);
+    } else {
+        //StopCheckRelayInfo(RELAY_SMR2_P_STATUS);
+    }
+
+    if (regRelay.relay_event.bits.Gun2_N != outputRelay.relay_event.bits.Gun2_N) {
+        //StartCheckRelayInfo(RELAY_SMR2_N_STATUS, outputRelay.relay_event.bits.Gun2_N);
+        //log_info("SMR2:D- Relay none match, try to switch to %d \n", outputRelay.relay_event.bits.Gun2_N);
+    } else {
+        //StopCheckRelayInfo(RELAY_SMR2_N_STATUS);
+    }
+
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
+    if (regRelay.relay_event.bits.Gun1_Parallel_P != outputRelay.relay_event.bits.Gun1_Parallel_P) {
+        //StartCheckRelayInfo(RELAY_PARA_P_STATUS, outputRelay.relay_event.bits.Gun1_Parallel_P);
+        //log_info("Parallel:D+ Relay none match, try to switch to %d \n", outputRelay.relay_event.bits.Gun1_Parallel_P);
+    } else {
+        //StopCheckRelayInfo(RELAY_PARA_P_STATUS);
+    }
+
+    if (regRelay.relay_event.bits.Gun1_Parallel_N != outputRelay.relay_event.bits.Gun1_Parallel_N) {
+        //StartCheckRelayInfo(RELAY_PARA_N_STATUS, outputRelay.relay_event.bits.Gun1_Parallel_N);
+        //log_info("Parallel:D- Relay none match, try to switch to %d \n", outputRelay.relay_event.bits.Gun1_Parallel_N);
+    } else {
+        //StopCheckRelayInfo(RELAY_PARA_N_STATUS);
+    }
+#endif //!defined DD360 && !defined DD360Audi
+
+    return result;
+}
+
+void MatchRelayStatus()
+{
+    // 因為 AC Contactor 沒有 Feedback，所以暫時先這樣處理
+    //regRelay.relay_event.bits.AC_Contactor = outputRelay.relay_event.bits.AC_Contactor;
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
+    ShmSysConfigAndInfo->SysInfo.AcContactorStatus  = regRelay.relay_event.bits.AC_Contactor = outputRelay.relay_event.bits.AC_Contactor;
+#endif //!defined DD360 && !defined DD360Audi
+
+    regRelay.relay_event.bits.CCS_Precharge = outputRelay.relay_event.bits.CCS_Precharge;
+    regRelay.relay_event.bits.Gun1_P = outputRelay.relay_event.bits.Gun1_P;
+    regRelay.relay_event.bits.Gun1_N = outputRelay.relay_event.bits.Gun1_N;
+    regRelay.relay_event.bits.Gun2_P = outputRelay.relay_event.bits.Gun2_P;
+    regRelay.relay_event.bits.Gun2_N = outputRelay.relay_event.bits.Gun2_N;
+    regRelay.relay_event.bits.Gun1_Parallel_P = outputRelay.relay_event.bits.Gun1_Parallel_P;
+    regRelay.relay_event.bits.Gun1_Parallel_N = outputRelay.relay_event.bits.Gun1_Parallel_N;
+}
+
+void CheckRelayStatusByADC()
+{
+    if (ShmRelayModuleData->Gun1FuseOutputVolt > 0 && ShmRelayModuleData->Gun1RelayOutputVolt > 0 &&
+            (ShmRelayModuleData->Gun1FuseOutputVolt == ShmRelayModuleData->Gun1RelayOutputVolt)) {
+        // Relay 前後電壓一致
+        _chargingData[0]->RelayK1K2Status = 0x01;
+    } else {
+        _chargingData[0]->RelayK1K2Status = 0x00;
+    }
+
+    if (ShmRelayModuleData->Gun2FuseOutputVolt > 0 && ShmRelayModuleData->Gun2RelayOutputVolt > 0 &&
+            (ShmRelayModuleData->Gun2FuseOutputVolt == ShmRelayModuleData->Gun2RelayOutputVolt)) {
+        // Relay 前後電壓一致
+        _chargingData[1]->RelayK1K2Status = 0x01;
+    } else {
+        _chargingData[1]->RelayK1K2Status = 0x00;
+    }
+}
+
+void SetGfdConfig(byte index, byte resister)
+{
+    gfd_config.index = index;
+    gfd_config.state = resister;
+
+    //log_info("************************GFD Vol = %d, GFD Res = %d \n", gfd_config.reqVol, gfd_config.resister);
+    if (Config_Gfd_Value(Uart5Fd, Addr.Relay, &gfd_config) == PASS) {
+//      log_info("Set reqVol = %f, resister = %d \n",
+//              gfd_config.reqVol,
+//              gfd_config.resister);
+    }
+}
+
+void CableCheckDetected(byte index)
+{
+    // Cable Check
+    // 當火線上的電壓 = 車端要求的電壓電流
+    // _chargingData[targetGun]->EvBatterytargetVoltage
+    // 才可以開始偵測 1s
+    // Warning : Rgfd <= 150 歐/V 假設電壓為 500V 則~ Rgfd <= 75000 歐
+    // Pre-Warning : 150 歐/V < Rgfd <= 500 歐/V 假設電壓為 500V 則 75000 歐 < Rgfd <= 250000
+    // SO Normal : Rgfd > 500 歐/V 假設電壓為 500 V 則 Rgfd > 250000 歐
+    if ((_chargingData[index]->Type >= _Type_Chademo && _chargingData[index]->Type <= _Type_GB) ||
+            (_chargingData[index]->Type == 0x09 && ShmSysConfigAndInfo->SysConfig.AlwaysGfdFlag)) {
+        if ((_chargingData[index]->SystemStatus >= S_PREPARING_FOR_EVSE && _chargingData[index]->SystemStatus <= S_TERMINATING) ||
+                (_chargingData[index]->SystemStatus >= S_CCS_PRECHARGE_ST0 && _chargingData[index]->SystemStatus <= S_CCS_PRECHARGE_ST1)) {
+            if (_chargingData[index]->SystemStatus == S_PREPARING_FOR_EVSE &&
+                    _chargingData[index]->RelayWeldingCheck == YES) {
+                SetGfdConfig(index, GFD_CABLECHK);
+            } else if (_chargingData[index]->SystemStatus >= S_CCS_PRECHARGE_ST0 &&
+                       _chargingData[index]->SystemStatus <= S_CCS_PRECHARGE_ST1) {
+                SetGfdConfig(index, GFD_PRECHARGE);
+            } else if (_chargingData[index]->SystemStatus >= S_CHARGING &&
+                       _chargingData[index]->SystemStatus <= S_TERMINATING) {
+                if (_chargingData[index]->Type == _Type_GB || _chargingData[index]->Type == _Type_Chademo) {
+                    SetGfdConfig(index, GFD_IDLE);
+                } else {
+                    SetGfdConfig(index, GFD_CHARGING);
+                }
+            }
+        } else if (_chargingData[index]->SystemStatus == S_COMPLETE || _chargingData[index]->SystemStatus == S_PREPARNING
+                   || _chargingData[index]->SystemStatus == S_IDLE) {
+            SetGfdConfig(index, GFD_IDLE);
+        }
+    }
+}
+
+void CheckOutputPowerOverCarReq(byte index)
+{
+    float fireV = _chargingData[index]->FireChargingVoltage;
+    float carV = _chargingData[index]->EvBatteryMaxVoltage * 10;
+
+    if ((_chargingData[index]->EvBatterytargetVoltage * 10) > 1500 &&
+            (_chargingData[index]->Type == _Type_Chademo ||
+             _chargingData[index]->Type == _Type_CCS_2 ||
+             _chargingData[index]->Type == _Type_GB)) {
+        if (fireV >= (carV + (carV * 0.02))) {
+            if (!_isOvpChkTimeFlag[index]) {
+                if ((_chargingData[index]->PresentChargingVoltage * 10) >= VOUT_MIN_VOLTAGE * 10) {
+                    gettimeofday(&_checkOutputVolProtectTimer[index], NULL);
+                    _isOvpChkTimeFlag[index] = YES;
+                }
+            } else {
+                log_info("[Module_InternalComm]CheckOutputPowerOverCarReq NG : fire = %f, battery = %f \n",
+                         _chargingData[index]->FireChargingVoltage, (_chargingData[index]->EvBatterytargetVoltage * 10));
+                log_error("[Module_InternalComm]CheckOutputPowerOverCarReq NG : fire = %f, battery = %f \n",
+                          _chargingData[index]->FireChargingVoltage, (_chargingData[index]->EvBatterytargetVoltage * 10));
+                if ((GetTimeoutValue(_checkOutputVolProtectTimer[index]) / 1000) >= OUTPUT_VOL_CHK_TIME) {
+                    if (_chargingData[index]->Type == _Type_Chademo) {
+                        ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemChademoOutputOVP = YES;
+                    } else if (_chargingData[index]->Type == _Type_CCS_2) {
+                        ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemCcsOutputOVP = YES;
+                    } else if (_chargingData[index]->Type == _Type_GB) {
+                        ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemGbOutputOVP = YES;
+                    }
+                    _chargingData[index]->StopChargeFlag = YES;
+                }
+            }
+        } else {
+            if (_isOvpChkTimeFlag[index] == YES) {
+                _isOvpChkTimeFlag[index] = NO;
+            }
+        }
+    }
+}
+
+void CheckOutputVolNoneMatchFire(byte index)
+{
+    if ((_chargingData[index]->EvBatterytargetVoltage * 10) > 1500 &&
+            (_chargingData[index]->Type == _Type_Chademo ||
+             _chargingData[index]->Type == _Type_CCS_2 ||
+             _chargingData[index]->Type == _Type_GB)) {
+        if (((_chargingData[index]->PresentChargingVoltage * 10) < _chargingData[index]->FireChargingVoltage - 300) ||
+                ((_chargingData[index]->PresentChargingVoltage * 10) > _chargingData[index]->FireChargingVoltage + 300)) {
+            if (!_isOutputNoneMatch[index]) {
+                _isOutputNoneMatch[index] = YES;
+                gettimeofday(&_checkOutputNoneMatchTimer[index], NULL);
+            } else {
+                if ((GetTimeoutValue(_checkOutputNoneMatchTimer[index]) / 1000) >= 5000) {
+                    /*log_info("[Module_InternalComm]CheckOutputVolNoneMatchFire NG (%d) : pre = %f, fire = %f \n",
+                            index, (_chargingData[index]->PresentChargingVoltage * 10), _chargingData[index]->FireChargingVoltage);
+                    log_error("[Module_InternalComm]CheckOutputVolNoneMatchFire NG (%d): pre = %f, fire = %f \n",
+                            index, (_chargingData[index]->PresentChargingVoltage * 10), _chargingData[index]->FireChargingVoltage);
+                    _chargingData[index]->StopChargeFlag = YES;*/
+                }
+            }
+        } else {
+            _isOutputNoneMatch[index] = NO;
+        }
+    }
+}
+
+void CheckRelayWeldingStatus(byte index)
+{
+#if !defined METER_ENABLE
+    if (!_isRelayWelding[index]) {
+        if ((_chargingData[index]->PresentChargingVoltage * 10) >= VOUT_MIN_VOLTAGE * 10) {
+            gettimeofday(&_checkRelayWeldingTimer[index], NULL);
+            _isRelayWelding[index] = YES;
+        }
+    } else {
+        if ((GetTimeoutValue(_checkRelayWeldingTimer[index]) / 1000) >= 1000) {
+            _chargingData[index]->RelayWeldingCheck = YES;
+            return;
+        }
+
+        if (_chargingData[index]->FireChargingVoltage >= VOUT_MIN_VOLTAGE) {
+            if (_chargingData[index]->Type == _Type_Chademo) {
+                ShmStatusCodeData->FaultCode.FaultEvents.bits.ChademoOutputRelayWelding = YES;
+            } else if (_chargingData[index]->Type == _Type_GB) {
+                ShmStatusCodeData->FaultCode.FaultEvents.bits.GbOutputRelayWelding = YES;
+            } else if (_chargingData[index]->Type == _Type_CCS_2) {
+                ShmStatusCodeData->FaultCode.FaultEvents.bits.CcsOutputRelayWelding = YES;
+            }
+
+            log_info("CheckRelayWeldingStatus : fail \n");
+            _chargingData[index]->StopChargeFlag = YES;
+        }
+    }
+#endif //!defined METER_ENABLE
+}
+
+void GetPsuTempForFanSpeed()
+{
+    char temp = 0;
+
+    for (byte index = 0; index < ShmPsuData->GroupCount; index++) {
+        for (byte count = 0; count < ShmPsuData->PsuGroup[index].GroupPresentPsuQuantity; count++) {
+            if (temp < ShmPsuData->PsuGroup[index].PsuModule[count].ExletTemp) {
+                temp = ShmPsuData->PsuGroup[index].PsuModule[count].ExletTemp;
+            }
+        }
+    }
+
+    ShmSysConfigAndInfo->SysInfo.SystemAmbientTemp = temp;
+
+    if (ShmSysConfigAndInfo->SysConfig.SwitchDebugFlag == NO) {
+        if (ShmFanModuleData->TestFanSpeed == NORMAL_FAN_SPEED) {
+            if (temp >= ENV_TEMP_MAX) {
+                ShmFanModuleData->TestFanSpeed = MAX_FAN_SPEED;
+            }
+        } else if (ShmFanModuleData->TestFanSpeed == MAX_FAN_SPEED) {
+            if (temp <= ENV_TEMP_MIN) {
+                ShmFanModuleData->TestFanSpeed = NORMAL_FAN_SPEED;
+            }
+        } else {
+            ShmFanModuleData->TestFanSpeed = NORMAL_FAN_SPEED;
+        }
+    }
+}
+
+void GetFanSpeedByFunction()
+{
+    if (ShmSysConfigAndInfo->SysConfig.SwitchDebugFlag == YES) {
+        return;
+    }
+
+    // 風控修改 :
+    // ******************************************************* //
+    //
+    //       當前PSU輸出總 KW       PSU Temp
+    // 30 x -------------------- x ---------- + 14 x (PSU Temp - 45)
+    //       當前樁最大功率 KW         45
+    //
+    // ******************************************************* //
+
+    // 當前樁最大功率 KW : ShmPsuData->SystemAvailablePower
+    unsigned int _maxPower = ShmPsuData->SystemAvailablePower;
+    // 當前PSU輸出總 KW & PSU Temp :
+    unsigned char temp = 0;
+    float power = 0;
+
+    for (byte index = 0; index < ShmPsuData->GroupCount; index++) {
+        for (byte count = 0; count < ShmPsuData->PsuGroup[index].GroupPresentPsuQuantity; count++) {
+            if (temp < ShmPsuData->PsuGroup[index].PsuModule[count].ExletTemp) {
+                temp = ShmPsuData->PsuGroup[index].PsuModule[count].ExletTemp;
+            }
+        }
+    }
+
+    for (byte gunIndex = 0; gunIndex < gunCount; gunIndex++) {
+        power += (_chargingData[gunIndex]->PresentChargingPower * 10);
+    }
+
+    double _pw_rate = 0;
+    if (_maxPower > 0) {
+        _pw_rate = power / (double)_maxPower;
+    }
+    double _temp_rate = 0;
+    if (temp > 0) {
+        _temp_rate = (double)temp / 50;
+    }
+    unsigned char _temp_diff = 0;
+    if (temp > 45) {
+        _temp_diff = temp - 70;
+    }
+
+    ShmFanModuleData->TestFanSpeed = (((50 * _pw_rate * _temp_rate) + (0.5 * _temp_diff)) / 100) * MAX_FAN_SPEED;
+
+    if (ShmFanModuleData->TestFanSpeed > MAX_FAN_SPEED) {
+        ShmFanModuleData->TestFanSpeed = MAX_FAN_SPEED;
+    }
+
+    if (ShmFanModuleData->TestFanSpeed < 0) {
+        ShmFanModuleData->TestFanSpeed = 0;
+    }
+//
+//  printf("power = %f \n", power);
+//  printf("_maxPower = %d \n", _maxPower);
+//  printf("temp = %d \n", temp);
+//
+//  printf("_pw_rate = %f \n", _pw_rate);
+//  printf("_temp_rate = %f \n", _temp_rate);
+//  printf("_temp_diff = %d \n", _temp_diff);
+//  printf("fan rate = %f \n", (30 * _pw_rate * _temp_rate + 14 * _temp_diff));
+//  printf("ShmFanModuleData->TestFanSpeed = %d \n", ShmFanModuleData->TestFanSpeed);
+}
+
+void GetAcStatus()
+{
+    if (Query_AC_Status(Uart5Fd, Addr.AcPlug, &acStatus) == PASS) {
+        ShmSysConfigAndInfo->SysConfig.AcRatingCurrent = acStatus.MaxCurrent;
+
+        if (ShmSysConfigAndInfo->SysConfig.AcMaxChargingCurrent == 0) {
+            ShmSysConfigAndInfo->SysConfig.AcMaxChargingCurrent = ShmSysConfigAndInfo->SysConfig.AcRatingCurrent;
+        }
+
+        ac_chargingInfo[0]->ConnectorPlugIn = acStatus.CpStatus;
+        //  log_info("CpStatus = %d \n", acStatus.CpStatus);
+        //              printf("CurLimit = %d \n", acStatus.CurLimit);
+        //              printf("PilotVol_P = %d \n", acStatus.PilotVol_P);
+        //              printf("PilotVol_N = %d \n", acStatus.PilotVol_N);
+        //              printf("LockStatus = %d \n", acStatus.LockStatus);
+        //              printf("RelayStatus = %d \n", acStatus.RelayStatus);
+        //              printf("ShutterStatus = %d \n", acStatus.ShutterStatus);
+        //              printf("MeterStatus = %d \n", acStatus.MeterStatus);
+        //              printf("PpStatus = %d \n", acStatus.PpStatus);
+        //              printf("MaxCurrent = %d \n", acStatus.MaxCurrent);
+        //              printf("RotateSwitchStatus = %d \n", acStatus.RelayStatus);
+        //              printf("============================== \n");
+        //
+        //              ac_chargingInfo[0]->SystemStatus = acStatus.CpStatus;
+    }
+//  else
+//      log_info("GetAcStatus return fail. \n");
+}
+
+void GetAcAlarmCode()
+{
+    if (Query_AC_Alarm_Code(Uart5Fd, Addr.AcPlug, &acAlarmCode) == PASS) {
+        CheckAlarmOccur();
+    }
+}
+
+unsigned char GetChargingEnergy()
+{
+    return Query_Charging_Energy(Uart5Fd, Addr.AcPlug, &acChargingEnergy);
+}
+
+unsigned char GetChargingCurrent()
+{
+    return Query_Charging_Current(Uart5Fd, Addr.AcPlug, &acChargingCurrent);
+}
+
+void ChangeLedStatus()
+{
+    if (ac_chargingInfo[0]->SystemStatus == S_IDLE) {
+        ledStatus.ActionMode = 1;
+    } else if (ac_chargingInfo[0]->SystemStatus == S_PREPARNING) {
+        ledStatus.ActionMode = 3;
+    } else if (ac_chargingInfo[0]->SystemStatus == S_CHARGING) {
+        ledStatus.ActionMode = 4;
+    }
+
+    Config_LED_Status(Uart5Fd, Addr.AcPlug, &ledStatus);
+}
+
+void SetLegacyReq(byte _switch)
+{
+    Config_Legacy_Req(Uart5Fd, Addr.AcPlug, _switch);
+}
+
+void SetCpDuty(byte _value)
+{
+    Config_Ac_Duty(Uart5Fd, Addr.AcPlug, _value);
+}
+
+void ChangeToCsuMode()
+{
+    ac_chargingInfo[0]->IsModeChagned = Config_CSU_Mode(Uart5Fd, Addr.AcPlug);
+
+//  if (ac_chargingInfo[0]->IsModeChagned == PASS)
+//  {
+//      Config_Reset_MCU(Uart5Fd, Addr.AcPlug);
+//  }
+}
+
+void ChangeStartOrStopDateTime(byte isStart)
+{
+    char cmdBuf[32];
+    struct timeb csuTime;
+    struct tm *tmCSU;
+
+    ftime(&csuTime);
+    tmCSU = localtime(&csuTime.time);
+
+    sprintf(cmdBuf, "%04d-%02d-%02d %02d:%02d:%02d", tmCSU->tm_year + 1900,
+            tmCSU->tm_mon + 1, tmCSU->tm_mday, tmCSU->tm_hour, tmCSU->tm_min,
+            tmCSU->tm_sec);
+    if (isStart) {
+        strcpy((char *)ac_chargingInfo[0]->StartDateTime, cmdBuf);
+    } else {
+        strcpy((char *)ac_chargingInfo[0]->StopDateTime, cmdBuf);
+    }
+}
+
+void OcppStartTransation(byte gunIndex)
+{
+    if (strcmp((char *)ac_chargingInfo[0]->StartUserId, "") == EQUAL) {
+        strcpy((char *)ShmOCPP16Data->StartTransaction[gunIndex].IdTag, (char *)ShmOCPP16Data->StartTransaction[gunIndex].IdTag);
+    } else {
+        strcpy((char *)ShmOCPP16Data->StartTransaction[gunIndex].IdTag, (char *)ac_chargingInfo[0]->StartUserId);
+    }
+
+    log_info("AC IdTag = %s \n", ShmOCPP16Data->StartTransaction[gunIndex].IdTag);
+    ShmOCPP16Data->CpMsg.bits[gunIndex].StartTransactionReq = YES;
+}
+
+void OcppStopTransation(byte gunIndex)
+{
+    if (strcmp((char *)ac_chargingInfo[0]->StartUserId, "") == EQUAL) {
+        strcpy((char *)ShmOCPP16Data->StopTransaction[gunIndex].IdTag, (char *)ShmOCPP16Data->StopTransaction[gunIndex].IdTag);
+    } else {
+        strcpy((char *)ShmOCPP16Data->StopTransaction[gunIndex].IdTag, (char *)ac_chargingInfo[0]->StartUserId);
+    }
+
+    log_info("AC IdTag = %s \n", ShmOCPP16Data->StopTransaction[gunIndex].IdTag);
+    ShmOCPP16Data->CpMsg.bits[gunIndex].StopTransactionReq = YES;
+}
+
+bool OcppRemoteStop(byte gunIndex)
+{
+    bool result = ShmOCPP16Data->CsMsg.bits[gunIndex].RemoteStopTransactionReq;
+
+    if (ShmOCPP16Data->CsMsg.bits[gunIndex].RemoteStopTransactionReq == YES) {
+        strcpy((char *)ShmOCPP16Data->StopTransaction[gunIndex].StopReason, "Remote");
+        ShmOCPP16Data->CsMsg.bits[gunIndex].RemoteStopTransactionReq = NO;
+    }
+
+    return result;
+}
+
+unsigned char isModeChange()
+{
+    unsigned char result = NO;
+
+    if (ac_chargingInfo[0]->SystemStatus != ac_chargingInfo[0]->PreviousSystemStatus) {
+        result = YES;
+        ac_chargingInfo[0]->PreviousSystemStatus = ac_chargingInfo[0]->SystemStatus;
+    }
+
+    return result;
+}
+
+void AcChargeTypeProcess()
+{
+    if (acgunCount > 0) {
+        //ac_chargingInfo[0]->SelfTest_Comp = YES;
+        //ac_chargingInfo[0]->IsModeChagned = PASS;
+        //---------------------------------------------
+        if (ac_chargingInfo[0]->SelfTest_Comp == NO) {
+            ac_chargingInfo[0]->IsModeChagned = NO;
+            GetFwVersion_AC();
+            GetAcModelName();
+        } else if (ac_chargingInfo[0]->SelfTest_Comp == YES) {
+            if (ac_chargingInfo[0]->IsModeChagned != PASS) {
+                ChangeToCsuMode();
+                return;
+            }
+            GetAcStatus();
+            GetAcAlarmCode();
+
+            byte _status = S_NONE;
+
+            if (ac_chargingInfo[0]->SystemStatus == S_IDLE && ac_chargingInfo[0]->IsErrorOccur) {
+                _status = S_ALARM;
+            } else if (acStatus.CpStatus == AC_SYS_A || ac_chargingInfo[0]->IsErrorOccur) {
+                if (ac_chargingInfo[0]->SystemStatus == S_CHARGING) {
+                    _status = S_TERMINATING;
+                } else if (ac_chargingInfo[0]->SystemStatus >= S_TERMINATING) {
+                    if (GetTimeoutValue(_ac_charging_comp) >= 10000000 && acStatus.CpStatus == AC_SYS_A) {
+                        _status = S_IDLE;
+                    }
+                } else {
+                    _status = S_IDLE;
+                }
+            } else if (ac_chargingInfo[0]->SystemStatus >= S_PREPARNING &&
+                       ac_chargingInfo[0]->SystemStatus < S_CHARGING) {
+                if (acStatus.CpStatus == AC_SYS_C && acStatus.RelayStatus == YES) {
+                    _status = S_CHARGING;
+                } else if (GetTimeoutValue(_ac_preparing) >= 30000000) {
+                    _status = S_IDLE;
+                }
+            } else if ((acStatus.CpStatus == AC_SYS_B || ac_chargingInfo[0]->ConnectorPlugIn == AC_SYS_B) &&
+                       ac_chargingInfo[0]->IsAvailable &&
+                       !ac_chargingInfo[0]->IsErrorOccur &&
+                       (ShmSysConfigAndInfo->SysInfo.WaitForPlugit == YES ||
+                        ShmSysConfigAndInfo->SysConfig.AuthorisationMode == AUTH_MODE_DISABLE)) {
+                if (ac_chargingInfo[0]->RemoteStartFlag == YES) {
+                    log_info("** AC Remote \n");
+                    ac_chargingInfo[0]->RemoteStartFlag = NO;
+                    strcpy((char *)ac_chargingInfo[0]->StartUserId, "");
+                    ShmSysConfigAndInfo->SysInfo.WaitForPlugit = NO;
+                    _status = S_PREPARNING;
+                } else if (ShmSysConfigAndInfo->SysInfo.OrderCharging == NO_DEFINE) {
+                    log_info("** UserId = %s \n", ShmSysConfigAndInfo->SysConfig.UserId);
+                    strcpy((char *)ac_chargingInfo[0]->StartUserId, (char *)ShmSysConfigAndInfo->SysConfig.UserId);
+                    log_info("** CardNumber = %s \n", ac_chargingInfo[0]->StartUserId);
+                    strcpy((char *)ShmSysConfigAndInfo->SysConfig.UserId, "");
+                    ShmSysConfigAndInfo->SysInfo.WaitForPlugit = NO;
+                    _status = S_PREPARNING;
+                }
+            } else if (ac_chargingInfo[0]->SystemStatus == S_CHARGING) {
+                if (OcppRemoteStop(1)) {
+                    _status = S_TERMINATING;
+                }
+            }
+
+            //printf("_status = %d \n", _status);
+
+            if (_status != S_NONE && ac_chargingInfo[0]->SystemStatus != _status) {
+                ac_chargingInfo[0]->SystemStatus = _status;
+            }
+
+            // 設定限制最大充電電流 >= 6 ~ <= 32
+            switch (ac_chargingInfo[0]->SystemStatus) {
+            case S_IDLE:
+            case S_ALARM: {
+                if (isModeChange()) {
+                    ac_chargingInfo[0]->PresentChargedEnergy = 0.0;
+                    ac_chargingInfo[0]->PresentChargingVoltage = 0;
+                    ac_chargingInfo[0]->ChargingFee = 0.0;
+                    strcpy((char *)ac_chargingInfo[0]->StartDateTime, "");
+                    strcpy((char *)ac_chargingInfo[0]->StopDateTime, "");
+                    _beforeChargingTotalEnergy = 0.0;
+                }
+
+                ChangeLedStatus();
+            }
+            break;
+            case S_PREPARNING: {
+                if (isModeChange()) {
+                    ShmSysConfigAndInfo->SysInfo.SystemPage = _LCM_NONE;
+                    ShmSysConfigAndInfo->SysInfo.CurGunSelectedByAc = DEFAULT_AC_INDEX;
+                    if (ShmSysConfigAndInfo->SysInfo.OrderCharging != NO_DEFINE) {
+                        ShmSysConfigAndInfo->SysInfo.OrderCharging = NO_DEFINE;
+                    }
+                    gettimeofday(&_ac_preparing, NULL);
+                }
+
+                if (GetChargingEnergy() == PASS) {
+                    //ac_chargingInfo[0]->PresentChargedEnergy = acChargingEnergy.Energy / 100;
+                    _beforeChargingTotalEnergy = acChargingEnergy.Energy;
+                }
+
+                SetLegacyReq(YES);
+                ChangeLedStatus();
+            }
+            break;
+            case S_CHARGING: {
+                if (isModeChange()) {
+                    ftime(&_ac_startChargingTime);
+                    OcppStartTransation(1);
+                    ChangeStartOrStopDateTime(YES);
+                    ShmSysConfigAndInfo->SysInfo.CurGunSelectedByAc = DEFAULT_AC_INDEX;
+                }
+
+                if (GetChargingEnergy() == PASS) {
+                    if ((acChargingEnergy.Energy - _beforeChargingTotalEnergy) > 0) {
+                        ac_chargingInfo[0]->PresentChargedEnergy += (acChargingEnergy.Energy - _beforeChargingTotalEnergy) / 100;
+                        if (ShmSysConfigAndInfo->SysConfig.BillingData.isBilling) {
+                            ac_chargingInfo[0]->ChargingFee += ac_chargingInfo[0]->PresentChargedEnergy * ShmSysConfigAndInfo->SysConfig.BillingData.Cur_fee;
+                        }
+                    }
+
+                    _beforeChargingTotalEnergy = acChargingEnergy.Energy;
+                }
+
+                if (GetChargingCurrent() == PASS) {
+                    ac_chargingInfo[0]->PresentChargingPower = (((float)(AC_DEFAULT_VOL * acChargingCurrent.OuputCurrentL1) / 10) / 1000);
+                }
+
+                ftime(&_ac_endChargingTime);
+                ac_chargingInfo[0]->PresentChargedDuration = DiffTimeb(_ac_startChargingTime, _ac_endChargingTime);
+                ac_chargingInfo[0]->PresentChargingVoltage = AC_DEFAULT_VOL;
+                ac_chargingInfo[0]->PresentChargingCurrent = ((float)acChargingCurrent.OuputCurrentL1 / 10);
+
+                // 用以判斷是否有在輸出
+                ac_chargingInfo[0]->IsCharging = acStatus.RelayStatus;
+
+                SetCpDuty(ShmSysConfigAndInfo->SysConfig.AcMaxChargingCurrent);
+                ChangeLedStatus();
+            }
+            break;
+            case S_TERMINATING: {
+                if (isModeChange()) {
+                    ChangeStartOrStopDateTime(NO);
+                    gettimeofday(&_ac_charging_comp, NULL);
+                }
+
+                SetLegacyReq(NO);
+                if (acStatus.RelayStatus == NO) {
+                    ac_chargingInfo[0]->SystemStatus = S_COMPLETE;
+                }
+            }
+            break;
+            case S_COMPLETE: {
+                if (isModeChange()) {
+                    gettimeofday(&_ac_charging_comp, NULL);
+                    ftime(&_ac_endChargingTime);
+                    if (strcmp((char *)ac_chargingInfo[0]->StartDateTime, "") != EQUAL) {
+                        // AC 固定為第2把槍
+                        OcppStopTransation(1);
+                    }
+
+                    ChangeStartOrStopDateTime(NO);
+                    ac_chargingInfo[0]->PresentChargedDuration = DiffTimeb(_ac_startChargingTime, _ac_endChargingTime);
+                }
+            }
+            break;
+            }
+        }
+    }
+}
+
+void ResetDetAlarmStatus(byte gun)
+{
+    if (_chargingData[gun]->Type == _Type_Chademo) {
+        if (ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemChademoOutputOVP == YES) {
+            ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemChademoOutputOVP = NO;
+        }
+    } else if (_chargingData[gun]->Type == _Type_GB) {
+        if (ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemGbOutputOVP == YES) {
+            ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemGbOutputOVP = NO;
+        }
+    } else if (_chargingData[gun]->Type == _Type_CCS_2) {
+        if (ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemCcsOutputOVP == YES) {
+            ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemCcsOutputOVP = NO;
+        }
+    }
+}
+
+int main(void)
+{
+    byte relayMatchFlag = NO;
+
+    if (InitShareMemory() == FAIL) {
+        log_error("InitShareMemory NG\n");
+        if (ShmStatusCodeData != NULL) {
+            ShmStatusCodeData->AlarmCode.AlarmEvents.bits.FailToCreateShareMemory = 1;
+        }
+        sleep(5);
+        return 0;
+    }
+
+    gunCount = ShmSysConfigAndInfo->SysConfig.TotalConnectorCount;
+    acgunCount = ShmSysConfigAndInfo->SysConfig.AcConnectorCount;
+    // Open Uart5 for RB
+    Uart5Fd = InitComPort();
+    Initialization();
+    sleep(1);
+
+    if (Uart5Fd < 0) {
+        log_info("(Internal) open port error. \n");
+        return 0;
+    }
+
+    outputRelay.relay_event.bits.AC_Contactor = 0x00;
+    outputRelay.relay_event.bits.CCS_Precharge = 0x00;
+    outputRelay.relay_event.bits.Gun1_Parallel_P = 0x00;
+    outputRelay.relay_event.bits.Gun1_Parallel_N = 0x00;
+    outputRelay.relay_event.bits.Gun1_P = 0x00;
+    outputRelay.relay_event.bits.Gun1_N = 0x00;
+    outputRelay.relay_event.bits.Gun2_N = 0x00;
+    outputRelay.relay_event.bits.Gun2_P = 0x00;
+    if (Config_Relay_Output(Uart5Fd, Addr.Relay, &outputRelay) != PASS) {
+        log_info("Config_Relay_Output fail \n");
+
+    }
+
+    cur_led_color.Connect_1_Red = COLOR_MIN_LV;
+    cur_led_color.Connect_1_Green = COLOR_MIN_LV;
+    cur_led_color.Connect_1_Blue = COLOR_MIN_LV;
+    cur_led_color.Connect_2_Red = COLOR_MIN_LV;
+    cur_led_color.Connect_2_Green = COLOR_MIN_LV;
+    cur_led_color.Connect_2_Blue = COLOR_MIN_LV;
+
+    //bool printRelayStatus = true;
+    for (;;) {
+        bool isCharging = false;
+
+        // 程序開始之前~ 必須先確定 FW 版本與硬體版本，確認後!!~ 該模組才算是真正的 Initial Comp.
+        if (ShmRelayModuleData->SelfTest_Comp == NO) {
+            GetFwAndHwVersion_Relay();
+            SetModelName_Relay(); //DS60-120 add
+            SetRtcData_Relay();
+            sleep(1);
+        }
+
+#if !defined NO_FAN_BOARD && !defined DD360ComBox
+        if (ShmFanModuleData->SelfTest_Comp == NO) {
+            GetFwAndHwVersion_Fan();
+            SetModelName_Fan();
+            SetRtcData_Fan();
+            sleep(1);
+            gettimeofday(&_priority_time, NULL);
+        }
+#endif //NO_FAN_BOARD
+
+#if !defined DD360ComBox
+        // 自檢階段處理，自檢階段如果讀不到版號則代表該系統沒有掛燈板
+        if (ShmLedModuleData->SelfTest_Comp == NO) {
+#if defined DD360 ||defined DD360Audi
+            GetFwAndHwVersion_Led();
+            sleep(1);
+            gettimeofday(&_led_priority_time, NULL);
+#else
+            // 自檢階段
+            if (ShmSysConfigAndInfo->SysInfo.SelfTestSeq <= _STEST_PSU_CAP) {
+                GetFwAndHwVersion_Led();
+                sleep(1);
+                gettimeofday(&_led_priority_time, NULL);
+            } else {
+                // 自檢階段沒有問到版號
+                if (ShmStatusCodeData->AlarmCode.AlarmEvents.bits.LedboardStestFail == NO) {
+                    ShmStatusCodeData->AlarmCode.AlarmEvents.bits.LedboardStestFail = YES;
+                }
+            }
+#endif //defined DD360 || defined DD360Audi
+        }
+#endif //!defined DD360ComBox
+
+        AcChargeTypeProcess();
+
+        if (ShmRelayModuleData->SelfTest_Comp == YES) {
+            // ==============優先權最高 10 ms ==============
+            // 輸出電壓
+            GetPersentOutputVol();
+
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
+            // 三相輸入電壓
+            GetPresentInputVol();
+            // 讀取當前 AC relay 狀態
+            regRelay.relay_event.bits.AC_Contactor = ShmSysConfigAndInfo->SysInfo.AcContactorStatus;
+
+            GetRelayOutputStatus();
+#endif //!defined DD360 && !defined DD360Audi
+
+            for (int i = 0; i < gunCount; i++) {
+                // Cable check (Set)
+                CableCheckDetected(i);
+
+                // check k1 k2 relay 狀態
+                CheckK1K2RelayOutput(i);
+
+                // 依據當前各槍的狀態選擇 搭上/放開 Relay
+                SetK1K2RelayStatus(i);
+
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
+                if (ShmSysConfigAndInfo->SysConfig.PhaseLossPolicy == YES) {
+                    CheckPhaseLossStatus(i);
+                }
+
+                CheckAcInputOvpStatus(i);
+#endif //!defined DD360 && !defined DD360Audi
+
+                if (_chargingData[i]->SystemStatus == S_IDLE) {
+#if !defined METER_ENABLE
+                    _chargingData[i]->RelayWeldingCheck = NO;
+                    _isRelayWelding[i] = NO;
+#endif //!defined METER_ENABLE
+                    _isOvpChkTimeFlag[i] = NO;
+                    ResetDetAlarmStatus(i); //DS60-120 add
+                }
+
+                if (_chargingData[i]->SystemStatus == S_BOOTING ||
+                        (_chargingData[i]->SystemStatus >= S_REASSIGN_CHECK && _chargingData[i]->SystemStatus <= S_COMPLETE) ||
+                        (_chargingData[i]->SystemStatus >= S_CCS_PRECHARGE_ST0 && _chargingData[i]->SystemStatus <= S_CCS_PRECHARGE_ST1) ||
+                        ShmSysConfigAndInfo->SysInfo.WaitForPlugit == YES ||
+                        (ShmSysConfigAndInfo->SysInfo.PageIndex >= _LCM_AUTHORIZING && ShmSysConfigAndInfo->SysInfo.PageIndex <= _LCM_WAIT_FOR_PLUG)) {
+                    _chargingData[i]->IsReadyToCharging = YES;
+                    isCharging = true;
+
+                    // 限定只有在槍類別為 GBT 的時候才做 relay welding 的判斷
+                    if (_chargingData[i]->Type == _Type_GB) {
+                        if (_chargingData[i]->SystemStatus >= S_PREPARING_FOR_EVSE &&
+                                _chargingData[i]->RelayWeldingCheck == NO) {
+                            CheckRelayWeldingStatus(i);
+                        }
+                    } else {
+                        _chargingData[i]->RelayWeldingCheck = YES;
+                    }
+
+                    if (_chargingData[i]->SystemStatus == S_CHARGING) {
+                        CheckOutputPowerOverCarReq(i);
+                        //CheckOutputVolNoneMatchFire(i);
+                    } else {
+                        _isOutputNoneMatch[i] = NO;
+                    }
+                } else {
+                    _chargingData[i]->IsReadyToCharging = NO;
+                }
+            }
+            // Cable check (Get)
+            GetGfdAdc();
+
+            // 橋接 relay
+            //SetParalleRelayStatus();
+
+            // 搭上 AC Contactor
+//          if (isCharging)
+//              outputRelay.relay_event.bits.AC_Contactor = YES;
+//          else
+//              outputRelay.relay_event.bits.AC_Contactor = NO;
+
+            if (isCharging ||
+                    (ShmPsuData->Work_Step >= _TEST_MODE && ShmPsuData->Work_Step <= _TEST_MODE)) {
+                isStopChargingCount = false;
+                outputRelay.relay_event.bits.AC_Contactor = YES;
+            } else {
+                if (!isStopChargingCount) {
+                    gettimeofday(&_close_ac_contactor, NULL);
+                    isStopChargingCount = true;
+                } else {
+                    if ((outputRelay.relay_event.bits.AC_Contactor == YES && GetTimeoutValue(_close_ac_contactor) / 1000 >= (TEN_MINUTES * 1000))) {
+                        outputRelay.relay_event.bits.AC_Contactor = NO;
+                    }
+                }
+            }
+
+            if (ShmPsuData->Work_Step >= _TEST_MODE && ShmPsuData->Work_Step <= _TEST_MODE) {
+                outputRelay.relay_event.bits.Gun1_N = outputRelay.relay_event.bits.Gun1_P = YES;
+            }
+
+            // 搭上/鬆開 Relay
+            if (IsNoneMatchRelayStatus()) {
+                relayMatchFlag = NO;
+                if (Config_Relay_Output(Uart5Fd, Addr.Relay, &outputRelay)) {
+                    //regRelay.relay_event.bits.AC_Contactor = ShmSysConfigAndInfo->SysInfo.AcContactorStatus;
+#if defined DD360 ||defined DD360Audi || defined DD360ComBox
+                    regRelay.relay_event.bits.CCS_Precharge = outputRelay.relay_event.bits.CCS_Precharge;
+                    regRelay.relay_event.bits.Gun1_P = outputRelay.relay_event.bits.Gun1_P;
+                    regRelay.relay_event.bits.Gun1_N = outputRelay.relay_event.bits.Gun1_N;
+                    regRelay.relay_event.bits.Gun2_P = outputRelay.relay_event.bits.Gun2_P;
+                    regRelay.relay_event.bits.Gun2_N = outputRelay.relay_event.bits.Gun2_N;
+                    regRelay.relay_event.bits.Gun1_Parallel_P = outputRelay.relay_event.bits.Gun1_Parallel_P;
+                    regRelay.relay_event.bits.Gun1_Parallel_N = outputRelay.relay_event.bits.Gun1_Parallel_N;
+#endif //defined DD360 || defined DD360Audi
+                    //log_info("Match Relay, AC = %x, g1_p = %x, g1_n = %x, g2_p = %x, g2_n = %x, pre = %x, bri_p = %x, bri_n = %x \n",
+                    //            regRelay.relay_event.bits.AC_Contactor,
+                    //            regRelay.relay_event.bits.Gun1_P,
+                    //            regRelay.relay_event.bits.Gun1_N,
+                    //            regRelay.relay_event.bits.Gun2_P,
+                    //            regRelay.relay_event.bits.Gun2_N,
+                    //            regRelay.relay_event.bits.CCS_Precharge,
+                    //            regRelay.relay_event.bits.Gun1_Parallel_P,
+                    //            regRelay.relay_event.bits.Gun1_Parallel_N);
+
+                }
+            }
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
+            else if (relayMatchFlag == NO) {
+                relayMatchFlag = YES;
+                log_info("======== Relay Status Start========\n");
+                if (regRelay.relay_event.bits.AC_Contactor == YES) {
+                    log_info("AC Power : ON \n");
+                } else {
+                    log_info("AC Power : OFF \n");
+                }
+
+                if (regRelay.relay_event.bits.Gun1_P == YES) {
+                    log_info("Conn1(+) : ON \n");
+                } else {
+                    log_info("Conn1(+) : OFF \n");
+                }
+
+                if (regRelay.relay_event.bits.Gun1_N == YES) {
+                    log_info("Conn1(-) : ON \n");
+                } else {
+                    log_info("Conn1(-) : OFF \n");
+                }
+
+                if (regRelay.relay_event.bits.Gun2_P == YES) {
+                    log_info("Conn2(+) : ON \n");
+                } else {
+                    log_info("Conn2(+) : OFF \n");
+                }
+
+                if (regRelay.relay_event.bits.Gun2_N == YES) {
+                    log_info("Conn2(-) : ON \n");
+                } else {
+                    log_info("Conn2(-) : OFF \n");
+                }
+
+                if (regRelay.relay_event.bits.CCS_Precharge == YES) {
+                    log_info("Precharge : ON \n");
+                } else {
+                    log_info("Precharge : OFF \n");
+                }
+
+                if (regRelay.relay_event.bits.Gun1_Parallel_P == YES) {
+                    log_info("Parallel(+) : ON \n");
+                } else {
+                    log_info("Parallel(+) : OFF \n");
+                }
+
+                if (regRelay.relay_event.bits.Gun1_Parallel_N == YES) {
+
+                    log_info("Parallel(-) : ON \n");
+                } else {
+                    log_info("Parallel(-) : OFF \n");
+                }
+                log_info("======== Relay Status End========\n");
+            }
+#endif //!defined DD360 && !defined DD360Audi
+        }
+
+#if !defined NO_FAN_BOARD && !defined DD360ComBox
+        if (ShmFanModuleData->SelfTest_Comp == YES ||
+                strlen((char *)ShmSysConfigAndInfo->SysInfo.FanModuleFwRev) != 0 ||
+                ShmSysConfigAndInfo->SysInfo.FanModuleFwRev[0] != '\0') {
+            ShmFanModuleData->SelfTest_Comp = YES;
+
+            if (GetTimeoutValue(_priority_time) / 1000 >= 1000) {
+                //GetPsuTempForFanSpeed();
+                GetFanSpeedByFunction();
+                GetFanSpeed();
+                ShmSysConfigAndInfo->SysInfo.SystemFanRotaSpeed = _setFanSpeed;
+                gettimeofday(&_priority_time, NULL);
+
+                ShmFanModuleData->SetFan1Speed = ShmFanModuleData->TestFanSpeed;
+                ShmFanModuleData->SetFan2Speed = ShmFanModuleData->TestFanSpeed;
+                ShmFanModuleData->SetFan3Speed = ShmFanModuleData->TestFanSpeed;
+                ShmFanModuleData->SetFan4Speed = ShmFanModuleData->TestFanSpeed;
+
+                //log_info("set fan = %d \n", ShmFanModuleData->SetFan1Speed);
+                SetFanModuleSpeed();
+            }
+        }
+#endif //NO_FAN_BOARD
+
+#if defined DD360ComBox
+        if (ShmLedModuleData->SelfTest_Comp == YES) {
+            if (GetTimeoutValue(_led_priority_time) / 1000 >= 1000) {
+                if (gunCount == 1) {
+                    SetLedColor(_chargingData[0], _chargingData[0]);
+                } else if (gunCount == 2) {
+                    SetLedColor(_chargingData[0], _chargingData[1]);
+                }
+
+                gettimeofday(&_led_priority_time, NULL);
+            }
+        }
+#endif //defined DD360ComBox
+
+        usleep(10000);
+    }
+
+    return FAIL;
+}

EVSE/Projects/DD360ComBox/Apps/ReModule_LcmControl.c

@@ -0,0 +1,2047 @@
+#include "ReModule_LcmControl.h"
+#include "Config.h"
+#include "AudiCust.h"
+
+static AudiCustInfo *gAudiCustInfo = NULL;
+bool needReloadQr = true;
+
+bool _isShow = false; //DS60-120 add
+byte _showInformIndex = 0; //DS60-120 add
+
+void PRINTF_FUNC(char *string, ...);
+
+int StoreLogMsg(const char *fmt, ...);
+#define DEBUG_INFO(format, args...) StoreLogMsg("[%s:%d][%s][Info] "format, __FILE__, __LINE__, __FUNCTION__, ##args)
+#define DEBUG_WARN(format, args...) StoreLogMsg("[%s:%d][%s][Warn] "format, __FILE__, __LINE__, __FUNCTION__, ##args)
+#define DEBUG_ERROR(format, args...) StoreLogMsg("[%s:%d][%s][Error] "format, __FILE__, __LINE__, __FUNCTION__, ##args)
+
+char *getTimeString(void);
+
+//=================================
+// Common routine
+//=================================
+int StoreLogMsg(const char *fmt, ...)
+{
+    char Buf[4096 + 256];
+    char buffer[4096];
+    va_list args;
+    struct timeb  SeqEndTime;
+    struct tm *tm;
+
+    va_start(args, fmt);
+    int rc = vsnprintf(buffer, sizeof(buffer), fmt, args);
+    va_end(args);
+
+    memset(Buf, 0, sizeof(Buf));
+    ftime(&SeqEndTime);
+    SeqEndTime.time = time(NULL);
+    tm = localtime(&SeqEndTime.time);
+
+    if (ShmSysConfigAndInfo->SysConfig.SwitchDebugFlag == YES) {
+        sprintf(Buf, "%02d:%02d:%02d:%03d - %s",
+                tm->tm_hour, tm->tm_min, tm->tm_sec, SeqEndTime.millitm, buffer);
+        printf("%s \n", Buf);
+    } else {
+        sprintf(Buf, "echo \"%04d-%02d-%02d %02d:%02d:%02d:%03d - %s\" >> /Storage/SystemLog/[%04d.%02d]SystemLog",
+                tm->tm_year + 1900, tm->tm_mon + 1, tm->tm_mday, tm->tm_hour, tm->tm_min, tm->tm_sec, SeqEndTime.millitm,
+                buffer,
+                tm->tm_year + 1900, tm->tm_mon + 1);
+        system(Buf);
+    }
+
+    return rc;
+}
+
+char *getTimeString(void)
+{
+    char *result = malloc(21);
+    time_t timep;
+    struct tm *p;
+    time(&timep);
+    p = gmtime(&timep);
+
+    sprintf(result, "[%04d-%02d-%02d %02d:%02d:%02d]", (1900 + p->tm_year), (1 + p->tm_mon), p->tm_mday, p->tm_hour, p->tm_hour, p->tm_sec);
+
+    return result;
+}
+
+void PRINTF_FUNC(char *string, ...)
+{
+    va_list args;
+    char buffer[4096];
+    va_start(args, string);
+    vsnprintf(buffer, sizeof(buffer), string, args);
+    va_end(args);
+
+    DEBUG_INFO("%s \n", buffer);
+}
+
+//==========================================
+// Init all share memory
+//==========================================
+int InitShareMemory()
+{
+    int result = PASS;
+    int MeterSMId;
+
+    //creat ShmSysConfigAndInfo
+    if ((MeterSMId = shmget(ShmSysConfigAndInfoKey, sizeof(struct SysConfigAndInfo),  0777)) < 0) {
+#ifdef SystemLogMessage
+        DEBUG_ERROR("shmget ShmSysConfigAndInfo NG\n");
+#endif
+        result = FAIL;
+    } else if ((ShmSysConfigAndInfo = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+#ifdef SystemLogMessage
+        DEBUG_ERROR("shmat ShmSysConfigAndInfo NG\n");
+#endif
+        result = FAIL;
+    } else
+    {}
+
+    //creat ShmStatusCodeData
+    if ((MeterSMId = shmget(ShmStatusCodeKey, sizeof(struct StatusCodeData),  0777)) < 0) {
+#ifdef SystemLogMessage
+        DEBUG_ERROR("shmget ShmStatusCodeData NG\n");
+#endif
+        result = FAIL;
+    } else if ((ShmStatusCodeData = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+#ifdef SystemLogMessage
+        DEBUG_ERROR("shmat ShmStatusCodeData NG\n");
+#endif
+        result = FAIL;
+    } else
+    {}
+
+    //creat Audi customization info
+    if ((MeterSMId = shmget(ShmAudiCustInfoKey, sizeof(AudiCustInfo), IPC_CREAT | 0777)) < 0) {
+        DEBUG_ERROR("[main]CreatShareMemory:shmget select gun info NG \n");
+        return 0;
+    } else if ((gAudiCustInfo = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+        DEBUG_ERROR("[main]CreatShareMemory:shmat shmget select gun info \n");
+        return 0;
+    }
+
+    //creat ShmStatusCodeData
+    if ((MeterSMId = shmget(ShmPrimaryMcuKey, sizeof(struct PrimaryMcuData), 0777)) < 0) {
+#ifdef SystemLogMessage
+        DEBUG_ERROR("shmget ShmPrimaryMcuData NG\n");
+#endif
+        result = FAIL;
+    } else if ((ShmPrimaryMcuData = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+#ifdef ShmPrimaryMcuData
+        DEBUG_ERROR("shmat ShmPrimaryMcuData NG\n");
+#endif
+        result = FAIL;
+    }
+
+    return result;
+}
+
+//==========================================
+// Open and Close RS232 and R/W
+//==========================================
+int CreateCommunicationLcmPort()
+{
+    int fd;
+    struct termios tios;
+
+    fd = open(pPortName, O_RDWR);
+    if (fd <= 0) {
+#ifdef SystemLogMessage
+        DEBUG_ERROR("open /dev/ttyS3 NG \n");
+#endif
+        return -1;
+    }
+    ioctl(fd, TCGETS, &tios);
+    tios.c_cflag = B115200 | CS8 | CLOCAL | CREAD;
+    tios.c_lflag = 0;
+    tios.c_iflag = 0;
+    tios.c_oflag = 0;
+    tios.c_cc[VMIN] = 0;
+    tios.c_cc[VTIME] = (unsigned char) 5;
+    tios.c_lflag = 0;
+    tcflush(fd, TCIFLUSH);
+    ioctl(fd, TCSETS, &tios);
+
+    return fd;
+}
+
+void CloseCommunicationLcmPort()
+{
+    close(_port);
+}
+
+void WriteCmdToLcm(byte *cmd, byte cmdLen)
+{
+    int len = write(_port, cmd, cmdLen);
+    if (len >= sizeof(cmd)) {
+        //PRINTF_FUNC("Write cmd to LCM successfully. \n");
+    }
+}
+
+void ReadMsgFromLcm(byte *msg, byte readLen)
+{
+    read(_port, msg, readLen);
+
+    if (*msg == CMD_TITLE_1 && *(msg + 1) == CMD_TITLE_2) {
+        if (*(msg + 3) == CMD_WRITE) {
+            switch (*(msg + 4)) {
+            case CMD_REGISTER: {
+                // 頁面
+                strcpy((char *)ShmSysConfigAndInfo->SysInfo.LcmHwRev, moduleName);
+            }
+            break;
+            }
+        } else if (*(msg + 3) == CMD_MULTI_READ) {
+//          switch ((unsigned short) (*(msg + 4) << 8) + (unsigned short) *(msg + 5))
+//          {
+//              case BUTTON_GUN_INDEX:
+//              {
+//                  // 當前選的槍號
+//                  _curGunIndex = (*(msg + 8));
+//              }
+//              break;
+//          }
+        }
+    }
+}
+
+//================================================
+// Function
+//================================================
+void ChangeToOtherPage(short newPage)
+{
+    byte cmd[7];
+    memset(cmd, 0x00, sizeof(cmd));
+
+    cmd[0] = CMD_TITLE_1;
+    cmd[1] = CMD_TITLE_2;
+    cmd[2] = 0x02 + sizeof(newPage);
+    cmd[3] = CMD_READ;
+    cmd[4] = CMD_REGISTER;
+    cmd[5] = newPage >> 8;
+    cmd[6] = newPage & 0x00FF;
+
+    WriteCmdToLcm(cmd, ARRAY_SIZE(cmd));
+    usleep(100000);
+}
+
+void ChangeBackLight(bool islight)
+{
+    byte value = 0x01;
+
+    if (islight) {
+        value = 0x20;
+    }
+    byte cmd[7];
+    memset(cmd, 0x00, sizeof(cmd));
+
+    cmd[0] = CMD_TITLE_1;
+    cmd[1] = CMD_TITLE_2;
+    cmd[2] = 0x03;
+    cmd[3] = CMD_READ;
+    cmd[4] = CMD_BACKLIGHT;
+    cmd[5] = value;
+
+    WriteCmdToLcm(cmd, ARRAY_SIZE(cmd));
+    usleep(100000);
+}
+
+void GetCurrentPage()
+{
+    byte cmd[6];
+    memset(cmd, 0x00, sizeof(cmd));
+    byte msg[8];
+    memset(msg, 0x00, sizeof(msg));
+
+    cmd[0] = CMD_TITLE_1;
+    cmd[1] = CMD_TITLE_2;
+    cmd[2] = 0x03;              // 底下總長度
+    cmd[3] = CMD_WRITE;
+    cmd[4] = CMD_REGISTER;
+    cmd[5] = 0x02;
+
+    WriteCmdToLcm(cmd, ARRAY_SIZE(cmd));
+    usleep(100000);
+    ReadMsgFromLcm(msg, ARRAY_SIZE(msg));
+}
+
+void DisplayValueToLcm(short address, byte *data, byte len)
+{
+    byte cmd[256];
+    memset(cmd, 0x00, sizeof(cmd));
+
+    cmd[0] = CMD_TITLE_1;
+    cmd[1] = CMD_TITLE_2;
+    cmd[2] = 0x03 + len;
+    cmd[3] = CMD_MULTI_WRITE;
+    cmd[4] = address >> 8;
+    cmd[5] = address & 0x00FF;
+
+    for (byte count = 0; count < len; count++) {
+        cmd[6 + count] = *(data + count);
+    }
+
+    WriteCmdToLcm(cmd, cmd[2] + 3);
+}
+
+void ChangeDisplay2Value(short address, short value)
+{
+    byte data[2];
+    data[0] = value >> 8;
+    data[1] = value & 0x00FF;
+
+    DisplayValueToLcm(address, data, sizeof(data));
+}
+
+void GetBtnStatus(short address, byte len)
+{
+    byte cmd[8];
+    memset(cmd, 0x00, sizeof(cmd));
+    byte msg[8];
+    memset(msg, 0x00, sizeof(msg));
+
+    cmd[0] = CMD_TITLE_1;
+    cmd[1] = CMD_TITLE_2;
+    cmd[2] = 0x03 + len;
+    cmd[3] = CMD_MULTI_READ;
+    cmd[4] = address >> 8;
+    cmd[5] = address & 0x00FF;
+    cmd[6] = 0x00 + len;
+
+    WriteCmdToLcm(cmd, cmd[2] + 3);
+    usleep(100000);
+    ReadMsgFromLcm(msg, (len * 2) + sizeof(msg));
+}
+
+//================================================
+// Warning process
+//================================================
+void string2ByteArray(unsigned char *input, byte *output)
+{
+    int loop;
+    int i;
+
+    loop = 0;
+    i = 0;
+
+    while (input[loop] != '\0') {
+        output[i++] = input[loop++];
+    }
+    output[loop] = '\0';
+}
+
+void ChangeWarningFunc()
+{
+    byte cmd[7];
+    byte i = 0, j = 0;
+    //PRINTF_FUNC("ChangeWarningFunc \n");
+    // 最多一次五筆
+    //PRINTF_FUNC("LCM PageIndex = %d \n", ShmSysConfigAndInfo->SysWarningInfo.PageIndex);
+    //PRINTF_FUNC("WarningCount = %d \n", ShmSysConfigAndInfo->SysWarningInfo.WarningCount);
+//#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
+    for (i = 0; (i + ShmSysConfigAndInfo->SysWarningInfo.PageIndex * 5) < ShmSysConfigAndInfo->SysWarningInfo.WarningCount; i++) {
+        memset(cmd, 0x00, sizeof(cmd));
+        if ((i) >= 5) {
+            break;
+        }
+
+        //error code
+        string2ByteArray(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i + ShmSysConfigAndInfo->SysWarningInfo.PageIndex * 5][0], cmd);
+        DisplayValueToLcm(0x0010 + ((i) * 6), cmd, sizeof(cmd));
+        //警告標示
+        memset(cmd, 0x00, sizeof(cmd));
+
+        cmd[0] = 0x00;
+        cmd[1] = 0x01;
+        DisplayValueToLcm(0x0002 + ((i) * 2), cmd, 2);
+    }
+
+    memset(cmd, 0x00, sizeof(cmd));
+    for (; i < 5; i++) {
+        DisplayValueToLcm(0x0010 + ((i) * 6), cmd, sizeof(cmd));
+        DisplayValueToLcm(0x0002 + ((i) * 2), cmd, 2);
+    }
+
+    /*#else
+        for (i = 0; (i + ShmSysConfigAndInfo->SysWarningInfo.PageIndex * 5) < ShmSysConfigAndInfo->SysWarningInfo.WarningCount; i++) {
+            memset(cmd, 0x00, sizeof(cmd));
+            if ((i - j) >= 5) {
+                break;
+            }
+            if (
+                (memcmp(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i + ShmSysConfigAndInfo->SysWarningInfo.PageIndex * 5][0], "033900", 6) == 0) ||
+                (memcmp(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i + ShmSysConfigAndInfo->SysWarningInfo.PageIndex * 5][0], "033901", 6) == 0) ||
+                (memcmp(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i + ShmSysConfigAndInfo->SysWarningInfo.PageIndex * 5][0], "033902", 6) == 0) ||
+                (memcmp(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i + ShmSysConfigAndInfo->SysWarningInfo.PageIndex * 5][0], "043627", 6) == 0) ||
+                (memcmp(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i + ShmSysConfigAndInfo->SysWarningInfo.PageIndex * 5][0], "043628", 6) == 0) ||
+                (memcmp(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i + ShmSysConfigAndInfo->SysWarningInfo.PageIndex * 5][0], "043622", 6) == 0) ||
+                (memcmp(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i + ShmSysConfigAndInfo->SysWarningInfo.PageIndex * 5][0], "043623", 6) == 0) ||
+                (memcmp(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i + ShmSysConfigAndInfo->SysWarningInfo.PageIndex * 5][0], "043624", 6) == 0) ||
+                (memcmp(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i + ShmSysConfigAndInfo->SysWarningInfo.PageIndex * 5][0], "043625", 6) == 0) ||
+                (memcmp(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i + ShmSysConfigAndInfo->SysWarningInfo.PageIndex * 5][0], "043626", 6) == 0) ||
+                (memcmp(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i + ShmSysConfigAndInfo->SysWarningInfo.PageIndex * 5][0], "042241", 6) == 0) ||
+                (memcmp(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i + ShmSysConfigAndInfo->SysWarningInfo.PageIndex * 5][0], "042242", 6) == 0)
+            ) {
+                j++;
+                continue;
+            }
+            //error code
+            string2ByteArray(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i + ShmSysConfigAndInfo->SysWarningInfo.PageIndex * 5][0], cmd);
+            DisplayValueToLcm(0x0010 + ((i - j) * 6), cmd, sizeof(cmd));
+            //警告標示
+            memset(cmd, 0x00, sizeof(cmd));
+
+            cmd[0] = 0x00;
+            cmd[1] = 0x01;
+            DisplayValueToLcm(0x0002 + ((i - j) * 2), cmd, 2);
+        }
+
+        memset(cmd, 0x00, sizeof(cmd));
+        i = i - j;
+        for (; (i) < 5; i++) {
+            DisplayValueToLcm(0x0010 + ((i) * 6), cmd, sizeof(cmd));
+            DisplayValueToLcm(0x0002 + ((i) * 2), cmd, 2);
+        }
+
+    #endif //!defined DD360 && !defined DD360Audi
+    */
+}
+
+//================================================
+// QR Code process
+//================================================
+void ChangeQrCode_Idle(char *input)
+{
+#if defined DD360Audi
+    int len = strlen(input) + 3;
+    int loop = 0;
+    int i = 0, j = 0, k = 0, l = 0;
+    uint8_t qrUrl[128] = {0};
+    uint16_t urlLen = 0;
+    uint8_t cmd[len];
+    uint8_t tmpBuf[15] = {0};
+    //uint8_t tmpLen = sizeof(tmpBuf) - 1;
+
+    strncpy((char *)cmd, " ", len);
+
+    while (input[loop] != '\0') {
+        cmd[i++] = input[loop++];
+        l = loop - 1;
+        if (len >= 25) {
+            if (i >= 16 && i <= 19) {
+                tmpBuf[k++] = input[l];
+                //printf("tmpBuf = %s\r\n", tmpBuf);
+            } else if (i >= 21 && i <= 23) {
+                tmpBuf[k++] = input[l];
+            }
+        }
+    }
+    tmpBuf[k] = '\0';
+    //printf("tmpBuf = %s\r\n", tmpBuf);
+    j += sprintf((char *)&cmd[i], ":%d", ShmSysConfigAndInfo->SysInfo.CurGunSelected); ////For Audi
+    cmd[len - 1] = '\0';
+    urlLen = sprintf((char *)qrUrl, "%s%s", NOODOE_QR_CODE_URL, cmd);
+    qrUrl[urlLen] = '\0';
+    //printf("qr url = %s\r\n", qrUrl);
+    DisplayValueToLcm(__qr_code, qrUrl, urlLen);
+
+    j = 0;
+    j += sprintf((char *)&tmpBuf[k], "0%d", ShmSysConfigAndInfo->SysInfo.CurGunSelected); ////For Audi
+    tmpBuf[k + j] = '\0';
+
+    //if (len < 25) {
+    //    strncpy((char *)tmpBuf, (char *)cmd, sizeof(tmpBuf));
+    //}
+    //tmpBuf[tmpLen] = '\0';
+    DisplayValueToLcm(__custStationIdL1, tmpBuf, sizeof(tmpBuf));
+
+    /*if (len > sizeof(tmpBuf)) {
+        strncpy((char *)tmpBuf, (char *)cmd, sizeof(tmpBuf));
+        tmpBuf[tmpLen] = '\0';
+        DisplayValueToLcm(__custStationIdL1, tmpBuf, sizeof(tmpBuf));
+
+        memset(tmpBuf, 0, sizeof(tmpBuf));
+        strncpy((char *)tmpBuf, (char *)&cmd[tmpLen], sizeof(tmpBuf));
+        tmpBuf[tmpLen] = '\0';
+        DisplayValueToLcm(__custStationIdL2, tmpBuf, sizeof(tmpBuf));
+    } else {
+        DisplayValueToLcm(__custStationIdL1, cmd, len);
+
+        strncpy((char *)tmpBuf, " ", sizeof(tmpBuf));
+        tmpBuf[tmpLen] = '\0';
+        DisplayValueToLcm(__custStationIdL2, tmpBuf, sizeof(tmpBuf));
+    }*/
+
+#else
+    int len = strlen(input);
+    byte cmd[len];
+
+    int loop = 0;
+    int i = 0;
+
+    while (input[loop] != '\0') {
+        cmd[i++] = input[loop++];
+    }
+
+    DisplayValueToLcm(__qr_code, cmd, len + 1);
+#endif //defined DD360Audi
+}
+
+void ChangeQrCode_Charge(char *input)
+{
+#if defined DD360Audi
+    int len = strlen(input) + 3;
+    int loop = 0;
+    int i = 0, j = 0, k = 0, l = 0;
+    uint8_t qrUrl[128] = {0};
+    uint16_t urlLen = 0;
+    uint8_t cmd[len];
+    uint8_t tmpBuf[15] = {0};
+    //uint8_t tmpLen = sizeof(tmpBuf) - 1;
+
+    strncpy((char *)cmd, " ", len);
+
+    while (input[loop] != '\0') {
+        cmd[i++] = input[loop++];
+        l = loop - 1;
+        if (len >= 25) {
+            if (i >= 16 && i <= 19) {
+                tmpBuf[k++] = input[l];
+                //printf("tmpBuf = %s\r\n", tmpBuf);
+            } else if (i >= 21 && i <= 23) {
+                tmpBuf[k++] = input[l];
+            }
+        }
+    }
+    tmpBuf[k] = '\0';
+    //printf("tmpBuf = %s\r\n", tmpBuf);
+    j += sprintf((char *)&cmd[i], ":%d", ShmSysConfigAndInfo->SysInfo.CurGunSelected); ////For Audi
+    cmd[len - 1] = '\0';
+    urlLen = sprintf((char *)qrUrl, "%s%s", NOODOE_QR_CODE_URL, cmd);
+    qrUrl[urlLen] = '\0';
+    DisplayValueToLcm(__qr_code, qrUrl, urlLen);
+
+    j = 0;
+    j += sprintf((char *)&tmpBuf[k], "0%d", ShmSysConfigAndInfo->SysInfo.CurGunSelected); ////For Audi
+    tmpBuf[k + j] = '\0';
+
+    if (len < 25) {
+        strncpy((char *)tmpBuf, (char *)cmd, sizeof(tmpBuf));
+    }
+    //tmpBuf[tmpLen] = '\0';
+    DisplayValueToLcm(__custStationIdL1, tmpBuf, sizeof(tmpBuf));
+    /*if (len > sizeof(tmpBuf)) {
+        strncpy((char *)tmpBuf, (char *)cmd, sizeof(tmpBuf));
+        tmpBuf[tmpLen] = '\0';
+        DisplayValueToLcm(__custStationIdL1, tmpBuf, sizeof(tmpBuf));
+
+        memset(tmpBuf, 0, sizeof(tmpBuf));
+        strncpy((char *)tmpBuf, (char *)&cmd[tmpLen], sizeof(tmpBuf));
+        tmpBuf[tmpLen] = '\0';
+        DisplayValueToLcm(__custStationIdL2, tmpBuf, sizeof(tmpBuf));
+    } else {
+        DisplayValueToLcm(__custStationIdL1, cmd, len);
+
+        strncpy((char *)tmpBuf, " ", sizeof(tmpBuf));
+        tmpBuf[tmpLen] = '\0';
+        DisplayValueToLcm(__custStationIdL2, tmpBuf, sizeof(tmpBuf));
+    }*/
+
+#else
+    int len = strlen(input);
+    byte cmd[len];
+
+    int loop = 0;
+    int i = 0;
+
+    while (input[loop] != '\0') {
+        cmd[i++] = input[loop++];
+    }
+
+    DisplayValueToLcm(__qr_code_pre, cmd, len + 1);
+#endif //defined DD360Audi
+}
+
+//================================================
+// Change current page
+//================================================
+void ChangeCurPage()
+{
+    //PRINTF_FUNC("cur = %d, new = %d \n", _currentPage, ShmSysConfigAndInfo->SysInfo.PageIndex);
+    if (_currentPage != ShmSysConfigAndInfo->SysInfo.PageIndex) {
+        _currentPage = ShmSysConfigAndInfo->SysInfo.PageIndex;
+        ChangeToOtherPage(_currentPage);
+        _everyPageRollChange = 0;
+    }
+}
+
+//================================================
+// Main process
+//================================================
+byte demoCount = 0;
+void DemoFunction()
+{
+    if (demoCount == 0) {
+        ShmSysConfigAndInfo->SysWarningInfo.WarningCount = 6;
+        memcpy(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[0][0], "000001", 7);
+        memcpy(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[1][0], "000002", 7);
+        memcpy(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[2][0], "000003", 7);
+        memcpy(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[3][0], "000004", 7);
+        memcpy(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[4][0], "000005", 7);
+        memcpy(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[5][0], "000006", 7);
+    } else {
+        if (demoCount == 20) {
+            ShmSysConfigAndInfo->SysInfo.PageIndex = _LCM_IDLE;
+        } else if (demoCount == 80) {
+            ShmSysConfigAndInfo->SysInfo.PageIndex = _LCM_AUTHORIZING;
+        } else if (demoCount == 100) {
+            ShmSysConfigAndInfo->SysInfo.PageIndex = _LCM_AUTHORIZ_COMP;
+        } else if (demoCount == 120) {
+            ShmSysConfigAndInfo->SysInfo.PageIndex = _LCM_AUTHORIZ_FAIL;
+        } else if (demoCount == 140) {
+            ShmSysConfigAndInfo->SysInfo.PageIndex = _LCM_PRE_CHARGE;
+        } else if (demoCount == 180) {
+            ShmSysConfigAndInfo->SysInfo.PageIndex = _LCM_CHARGING;
+        }
+    }
+
+    if (demoCount < 180) {
+        demoCount++;
+    }
+}
+
+//================================================
+// Main process
+//================================================
+bool FindChargingInfoData(byte target, struct ChargingInfoData **_chargingData)
+{
+    for (byte index = 0; index < CHAdeMO_QUANTITY; index++) {
+        if (ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].Index == target) {
+            _chargingData[target] = &ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index];
+            return true;
+        }
+    }
+
+    for (byte index = 0; index < CCS_QUANTITY; index++) {
+        if (ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].Index == target) {
+            _chargingData[target] = &ShmSysConfigAndInfo->SysInfo.CcsChargingData[index];
+            return true;
+        }
+    }
+
+    for (byte index = 0; index < GB_QUANTITY; index++) {
+        if (ShmSysConfigAndInfo->SysInfo.GbChargingData[index].Index == target) {
+            _chargingData[target] = &ShmSysConfigAndInfo->SysInfo.GbChargingData[index];
+            return true;
+        }
+    }
+
+    return false;
+}
+
+bool FindAcChargingInfoData(byte target, struct ChargingInfoData **acChargingData)
+{
+    if (target < AC_QUANTITY) {
+        acChargingData[target] = &ShmSysConfigAndInfo->SysInfo.AcChargingData[target];
+        return true;
+    }
+
+    return false;
+}
+
+/**
+ * [ChangeBalanceValue :print balance information]
+ * @Author
+ * @DateTime 2020-11-26
+ */
+static void ChangeBalanceValue(uint16_t addr, uint8_t index) ////For Audi
+{
+    byte cmd[10] = {0};
+    byte value[10] = {0};
+    uint8_t len = 0;
+    float balance = gAudiCustInfo->PricesInfo[index].Balance;
+
+    if ((balance) == (FAIL_BALANCE_PRICES)) {
+        balance = 0.00;
+    }
+
+    len += sprintf((char *) value, "%.2f", balance);
+    if (len < 6) {
+        sprintf((char *)&value[len], "%s",
+                (byte *)Currency[ShmSysConfigAndInfo->SysConfig.BillingData.Currency]);
+    }
+
+    value[sizeof(value) - 1] = '\0';
+
+    string2ByteArray(value, cmd);
+    DisplayValueToLcm(addr, cmd, sizeof(cmd));
+}
+
+void ChangeAcBattMapAndValue(short page)
+{
+    if (page == _LCM_CHARGING) {
+        if (isDiffStatus != _battery_display_ani) {
+            isChangeBattMap = false;
+            isDiffStatus = _battery_display_ani;
+        }
+
+        if (ac_chargingInfo[0]->IsCharging && !isChangeBattMap) {
+            isChangeBattMap = true;
+            if (ac_ani_battery_level == _BATTERY_LEVEL_FOR_MAP_LV5) {
+                ChangeDisplay2Value(__batt_map, _battery_empty);
+                ac_ani_battery_level = _BATTERY_LEVEL_FOR_MAP_EMP;
+            } else if (ac_ani_battery_level == _BATTERY_LEVEL_FOR_MAP_EMP) {
+                ChangeDisplay2Value(__batt_map, _battery_cap_20);
+                ac_ani_battery_level = _BATTERY_LEVEL_FOR_MAP_LV1;
+            } else if (ac_ani_battery_level == _BATTERY_LEVEL_FOR_MAP_LV1) {
+                ChangeDisplay2Value(__batt_map, _battery_cap_40);
+                ac_ani_battery_level = _BATTERY_LEVEL_FOR_MAP_LV2;
+            } else if (ac_ani_battery_level == _BATTERY_LEVEL_FOR_MAP_LV2) {
+                ChangeDisplay2Value(__batt_map, _battery_cap_60);
+                ac_ani_battery_level = _BATTERY_LEVEL_FOR_MAP_LV3;
+            } else if (ac_ani_battery_level == _BATTERY_LEVEL_FOR_MAP_LV3) {
+                ChangeDisplay2Value(__batt_map, _battery_cap_80);
+                ac_ani_battery_level = _BATTERY_LEVEL_FOR_MAP_LV4;
+            } else if (ac_ani_battery_level == _BATTERY_LEVEL_FOR_MAP_LV4) {
+                ChangeDisplay2Value(__batt_map, _battery_cap_100);
+                ac_ani_battery_level = _BATTERY_LEVEL_FOR_MAP_LV5;
+            }
+        }
+    } else if (page == _LCM_COMPLETE) {
+        if (ac_ani_battery_level == _BATTERY_LEVEL_FOR_MAP_LV5) {
+            ChangeDisplay2Value(__batt_map, _battery_soc_20);
+        } else if (ac_ani_battery_level == _BATTERY_LEVEL_FOR_MAP_EMP) {
+            ChangeDisplay2Value(__batt_map, _battery_soc_20);
+        } else if (ac_ani_battery_level == _BATTERY_LEVEL_FOR_MAP_LV1) {
+            ChangeDisplay2Value(__batt_map, _battery_soc_40);
+        } else if (ac_ani_battery_level == _BATTERY_LEVEL_FOR_MAP_LV2) {
+            ChangeDisplay2Value(__batt_map, _battery_soc_60);
+        } else if (ac_ani_battery_level == _BATTERY_LEVEL_FOR_MAP_LV3) {
+            ChangeDisplay2Value(__batt_map, _battery_soc_80);
+        } else if (ac_ani_battery_level == _BATTERY_LEVEL_FOR_MAP_LV4) {
+            ChangeDisplay2Value(__batt_map, _battery_soc_100);
+        }
+    }
+
+    ChangeDisplay2Value(__soc_value_charging, _disappear);
+}
+
+void ChangeBattMapAndValue(short page, int soc)
+{
+//  srand(time(NULL));
+//  int min = 10;
+//  int max = 90;
+//  soc = rand() % (max - min + 1) + min;
+
+    if (page == _LCM_PRE_CHARGE) {
+        ChangeDisplay2Value(__batt_map_empty, _battery_empty);
+    } else if (page == _LCM_CHARGING) {
+        if (soc < 20) {
+            if (_battery_display_ani) {
+                ChangeDisplay2Value(__batt_map, _battery_empty);
+            } else {
+                ChangeDisplay2Value(__batt_map, _battery_cap_20);
+            }
+        } else if (soc >= 20 && soc < 40) {
+            if (_battery_display_ani) {
+                ChangeDisplay2Value(__batt_map, _battery_cap_20);
+            } else {
+                ChangeDisplay2Value(__batt_map, _battery_cap_40);
+            }
+        } else if (soc >= 40 && soc < 60) {
+            if (_battery_display_ani) {
+                ChangeDisplay2Value(__batt_map, _battery_cap_40);
+            } else {
+                ChangeDisplay2Value(__batt_map, _battery_cap_60);
+            }
+        } else if (soc >= 60 && soc < 80) {
+            if (_battery_display_ani) {
+                ChangeDisplay2Value(__batt_map, _battery_cap_60);
+            } else {
+                ChangeDisplay2Value(__batt_map, _battery_cap_80);
+            }
+        } else if (soc >= 80 && soc <= 100) {
+            if (_battery_display_ani) {
+                ChangeDisplay2Value(__batt_map, _battery_cap_80); //DS60-120 add
+            } else {
+                ChangeDisplay2Value(__batt_map, _battery_cap_100);
+            }
+        }
+    } else if (page == _LCM_COMPLETE) {
+        if (soc < 20) {
+            ChangeDisplay2Value(__batt_map, _battery_soc_20);
+        } else if (soc >= 20 && soc < 40) {
+            ChangeDisplay2Value(__batt_map, _battery_soc_40);
+        } else if (soc >= 40 && soc < 60) {
+            ChangeDisplay2Value(__batt_map, _battery_soc_60);
+        } else if (soc >= 60 && soc < 80) {
+            ChangeDisplay2Value(__batt_map, _battery_soc_80);
+        } else if (soc >= 80 && soc <= 100) {
+            ChangeDisplay2Value(__batt_map, _battery_soc_100);
+        }
+    }
+
+    byte cmd[5];
+    byte value[5];
+
+    memset(cmd, 0x00, sizeof(cmd));
+    memset(value, 0x00, sizeof(value));
+    sprintf((char *)value, "%d%%", soc);
+    string2ByteArray(value, cmd);
+    DisplayValueToLcm(__soc_value_charging, cmd, sizeof(cmd));
+}
+
+void ChangeRemainTime(int sec)
+{
+    int h, m, s;
+    byte cmd[10];
+    byte value[10];
+
+    memset(cmd, 0x00, sizeof(cmd));
+
+//  srand(time(NULL));
+//  int min = 0;
+//  int max = 65536;
+//  sec = rand() % (max - min + 1) + min;
+
+    h = (sec / 3600);
+    m = (sec - (3600 * h)) / 60;
+    s = (sec - (3600 * h) - (m * 60));
+    sprintf((char *)value, "%02d:%02d:%02d", h, m, s);
+    string2ByteArray(value, cmd);
+    DisplayValueToLcm(__remain_time_tx, cmd, sizeof(cmd));
+}
+
+void ChangeChargingEnergyValue(float energy)
+{
+    byte cmd[10];
+    byte value[10];
+
+    memset(cmd, 0x00, sizeof(cmd));
+    if (energy >= 0.05) {
+        energy -= 0.05;
+    }
+    sprintf((char *) value, "%.1f kWh", energy);
+    string2ByteArray(value, cmd);
+    DisplayValueToLcm(__total_out_eng_tx, cmd, sizeof(cmd));
+}
+
+void ChangeChargingPowerValue(float pow)
+{
+    byte cmd[10];
+    byte value[10];
+
+    memset(cmd, 0x00, sizeof(cmd));
+
+//  float min = 0.0;
+//  float max = 50;
+//  pow = (max - min) * rand() / (RAND_MAX + 1.0) + min;
+    sprintf((char *) value, "%.1f kW", pow);
+    string2ByteArray(value, cmd);
+    DisplayValueToLcm(__output_eng_tx, cmd, sizeof(cmd));
+}
+
+void ChangeChargingFeeValue(float fee)
+{
+    byte cmd[10];
+    byte value[10];
+
+    memset(cmd, 0x00, sizeof(cmd));
+
+    sprintf((char *) value, "%.2f", fee);
+    string2ByteArray(value, cmd);
+    DisplayValueToLcm(__charging_fee_tx, cmd, sizeof(cmd));
+}
+
+void DisplayMoneyRate(float money)
+{
+    byte cmd[8];
+    byte value[8];
+
+    memset(cmd, 0x00, sizeof(cmd));
+
+    sprintf((char *) value, "%.2f", money);
+    string2ByteArray(value, cmd);
+    DisplayValueToLcm(__money_by_rate, cmd, sizeof(cmd));
+}
+
+void DisplayMoneyCur(byte *cur)
+{
+    byte cmd[10] = {0};
+    byte buf[10] = {0};
+    uint8_t len = 0;
+
+    *(cur + 3) = '\0';
+    memset(cmd, 0x00, sizeof(cmd));
+    len = sprintf((char *) buf, "%s/kWh", cur);
+    buf[len] = '\0';
+    string2ByteArray(buf, cmd);
+    DisplayValueToLcm(__money_rate, cmd, sizeof(cmd));
+}
+
+void RefreshPageAnimation(byte value)
+{
+    switch (_currentPage) {
+    case _LCM_IDLE: {
+
+    }
+    break;
+    case _LCM_WAIT_FOR_PLUG: {
+        if (_everyPageRollChange == 0) {
+            ChangeDisplay2Value(__plug_in_arrow, _arrow_dark);
+        } else if (_everyPageRollChange == 15) {
+            ChangeDisplay2Value(__plug_in_arrow, _arrow_light);
+        }
+
+        _everyPageRollChange > 30 ? _everyPageRollChange = 0 : _everyPageRollChange++;
+    }
+    break;
+    case _LCM_PRE_CHARGE:
+    case _LCM_CHARGING:
+    case _LCM_COMPLETE: {
+        if (_currentPage == _LCM_PRE_CHARGE) {
+            if (_everyPageRollChange == 0 || _everyPageRollChange == 22) {
+                ChangeDisplay2Value(__conn_line, _conn_map1);
+            } else if (_everyPageRollChange == 11 || _everyPageRollChange == 33) {
+                ChangeDisplay2Value(__conn_line, _conn_map2);
+            }
+        } else if (_currentPage == _LCM_CHARGING) {
+            if (_everyPageRollChange == 0 || _everyPageRollChange == 22) {
+                ChangeDisplay2Value(__conn_line_chag, _charging_map1);
+            } else if (_everyPageRollChange == 11 || _everyPageRollChange == 33) {
+                ChangeDisplay2Value(__conn_line_chag, _charging_map2);
+            }
+        } else if (_currentPage == _LCM_COMPLETE) {
+            if (_everyPageRollChange == 0) {
+                ChangeDisplay2Value(__conn_line_comp, _complete_map);
+            }
+        }
+
+        _everyPageRollChange >= 45 ? _everyPageRollChange = 0 : _everyPageRollChange++;
+    }
+    break;
+    }
+}
+
+void RefreshConnStatus()
+{
+    // Wifi priority is higher than Ethernet
+#if defined DD360 ||defined DD360Audi || defined DD360ComBox
+    uint8_t i = 0;
+    uint8_t ehtStatus = 0;
+
+    for (i = 0; i < ShmSysConfigAndInfo->SysWarningInfo.WarningCount; i++) {
+        if (memcmp(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i][0], "012304", 6) == 0) {
+            ehtStatus = 1;
+            //if (gAudiCustInfo->EthDevStatus.Ethernet != DEV_ST_DISABLE) {
+            //    gAudiCustInfo->EthDevStatus.Ethernet = DEV_ST_ENABLE_NO_USE;
+            //}
+            break;
+        }
+    }
+
+    if (gAudiCustInfo->EthDevStatus.Backend == DEV_ST_DISABLE) {
+        ChangeDisplay2Value(__conn_status, _disappear);
+    } else if (gAudiCustInfo->EthDevStatus.Backend == DEV_ST_ENABLE_USE) {
+        ChangeDisplay2Value(__conn_status, _connect);
+    } else if (gAudiCustInfo->EthDevStatus.Backend == DEV_ST_ENABLE_NO_USE) {
+        ChangeDisplay2Value(__conn_status, _disconnect);
+    }
+
+    if (ehtStatus == 1) {
+        if (gAudiCustInfo->EthDevStatus.Ethernet != DEV_ST_DISABLE) {
+            ChangeDisplay2Value(__ethernet_status, _eth_disconnect);
+        }
+    } else {
+        if (gAudiCustInfo->EthDevStatus.Ethernet != DEV_ST_DISABLE) {
+            ChangeDisplay2Value(__ethernet_status, _eth_connect);
+        }
+        //if (gAudiCustInfo->EthDevStatus.Ethernet == DEV_ST_DISABLE) {
+        //} else if (gAudiCustInfo->EthDevStatus.Ethernet == DEV_ST_ENABLE_USE) {
+        //    ChangeDisplay2Value(__ethernet_status, _eth_connect);
+        //} else if (gAudiCustInfo->EthDevStatus.Ethernet == DEV_ST_ENABLE_NO_USE) {
+        //    ChangeDisplay2Value(__ethernet_status, _eth_disconnect);
+        //}
+    }
+
+    if (gAudiCustInfo->EthDevStatus.Wifi == DEV_ST_DISABLE) {
+        ChangeDisplay2Value(__wifi_status, _disappear);
+
+        ChangeDisplay2Value(__3G4G_status, _disappear);
+        if (gAudiCustInfo->EthDevStatus.FourG == DEV_ST_DISABLE) {
+            ChangeDisplay2Value(__3G4G_move_status, _disappear);
+        } else if (gAudiCustInfo->EthDevStatus.FourG == DEV_ST_ENABLE_USE) {
+            ChangeDisplay2Value(__3G4G_move_status, __3G4G_connect);
+        } else if (gAudiCustInfo->EthDevStatus.FourG == DEV_ST_ENABLE_NO_USE) {
+            ChangeDisplay2Value(__3G4G_move_status, _3G4G_disconnect);
+        }
+    } else if (gAudiCustInfo->EthDevStatus.Wifi == DEV_ST_ENABLE_USE) {
+        ChangeDisplay2Value(__3G4G_move_status, _disappear);
+        ChangeDisplay2Value(__wifi_status, _wifi_connect);
+    } else if (gAudiCustInfo->EthDevStatus.Wifi == DEV_ST_ENABLE_NO_USE) {
+        ChangeDisplay2Value(__3G4G_move_status, _disappear);
+        ChangeDisplay2Value(__wifi_status, _wifi_disconnect);
+    }
+
+    if (gAudiCustInfo->EthDevStatus.Wifi != DEV_ST_DISABLE) {
+        if (gAudiCustInfo->EthDevStatus.FourG == DEV_ST_DISABLE) {
+            ChangeDisplay2Value(__3G4G_status, _disappear);
+        } else if (gAudiCustInfo->EthDevStatus.FourG == DEV_ST_ENABLE_USE) {
+            ChangeDisplay2Value(__3G4G_status, __3G4G_connect);
+        } else if (gAudiCustInfo->EthDevStatus.FourG == DEV_ST_ENABLE_NO_USE) {
+            ChangeDisplay2Value(__3G4G_status, _3G4G_disconnect);
+        }
+    }
+
+    //unsigned char flag[4] = {0};
+
+    /*for (i = 0; i < ShmSysConfigAndInfo->SysWarningInfo.WarningCount; i++) {
+        //printf("status code = %s\r\n", &ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i][0]);
+        if (memcmp(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i][0], "012304", 6) == 0) {
+            flag[0] = 1;
+            continue;
+        }
+
+        if (memcmp(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i][0], "043625", 6) == 0) {
+            //disconnected from AP through WiFi
+            flag[1] = 1;
+            continue;
+        }
+
+        if (memcmp(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i][0], "043627", 6) == 0) { //wifi disabled
+            flag[1] = 2;
+            continue;
+        }
+
+        if ((memcmp(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i][0], "033900", 6) == 0) ||
+                (memcmp(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i][0], "033901", 6) == 0) ||
+                (memcmp(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i][0], "033902", 6) == 0)) {
+            flag[2] = 1;
+            continue;
+        }
+
+        if (memcmp(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i][0], "043626", 6) == 0) {
+            //disconnected from APN through 3G/4G
+            flag[3] = 1;
+            continue;
+        }
+
+        if (memcmp(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i][0], "043628", 6) == 0) { //4g disabled
+            flag[3] = 2;
+            continue;
+        }
+    }
+
+
+    if (flag[0] == 1) {
+        ChangeDisplay2Value(__ethernet_status, _eth_disconnect);
+    } else {
+        ChangeDisplay2Value(__ethernet_status, _eth_connect);
+    }
+
+    //ChangeDisplay2Value(__wifi_status, _disappear);
+    //ChangeDisplay2Value(__conn_status, _disappear);
+    //ChangeDisplay2Value(__3G4G_status, _disappear);
+
+    if (flag[1] == 1) {
+        ChangeDisplay2Value(__3G4G_move_status, _disappear);
+        ChangeDisplay2Value(__wifi_status, _wifi_disconnect);
+    } else if (flag[1] == 2) {
+        ChangeDisplay2Value(__wifi_status, _disappear);
+    } else {
+        ChangeDisplay2Value(__3G4G_move_status, _disappear);
+        ChangeDisplay2Value(__wifi_status, _wifi_connect);
+    }
+
+    if (flag[2] == 1) {
+        ChangeDisplay2Value(__conn_status, _disconnect);
+    } else {
+        ChangeDisplay2Value(__conn_status, _connect);
+    }
+
+    if (flag[1] == 2) {
+        ChangeDisplay2Value(__3G4G_status, _disappear);
+        if (flag[3] == 1) {
+            ChangeDisplay2Value(__3G4G_move_status, _3G4G_disconnect);
+        } else if (flag[3] == 2) {
+            ChangeDisplay2Value(__3G4G_move_status, _disappear);
+        } else {
+            ChangeDisplay2Value(__3G4G_move_status, __3G4G_connect);
+        }
+    } else {
+        if (flag[3] == 1) {
+            ChangeDisplay2Value(__3G4G_status, _3G4G_disconnect);
+        } else if (flag[3] == 2) {
+            ChangeDisplay2Value(__3G4G_status, _disappear);
+        } else {
+            ChangeDisplay2Value(__3G4G_status, __3G4G_connect);
+        }
+    }
+    */
+#else
+// eth
+    if (ShmSysConfigAndInfo->SysInfo.ethInternetConn == YES) {
+        ChangeDisplay2Value(__ethernet_status, _ethernet_connect);
+    } else {
+        ChangeDisplay2Value(__ethernet_status, _ethernet_disconnect);
+    }
+
+    // Wifi
+    if ((ShmSysConfigAndInfo->SysConfig.ModelName[10] == 'W' ||
+            ShmSysConfigAndInfo->SysConfig.ModelName[10] == 'D') &&
+            ShmSysConfigAndInfo->SysConfig.AthInterface.WifiMode != _SYS_WIFI_MODE_DISABLE) {
+        if (ShmSysConfigAndInfo->SysConfig.AthInterface.WifiNetworkConn == YES ||
+                ShmSysConfigAndInfo->SysConfig.AthInterface.WifiMode == _SYS_WIFI_MODE_AP) {
+            ChangeDisplay2Value(__wifi_status, _wifi_connect);
+        } else {
+            ChangeDisplay2Value(__wifi_status, _wifi_disconnect);
+        }
+    } else {
+        ChangeDisplay2Value(__wifi_status, _disappear);
+    }
+
+    if ((ShmSysConfigAndInfo->SysConfig.ModelName[10] == 'T' ||
+            ShmSysConfigAndInfo->SysConfig.ModelName[10] == 'D') &&
+            ShmSysConfigAndInfo->SysConfig.TelecomInterface.TelcomEnabled != NO) {
+        if (ShmSysConfigAndInfo->SysConfig.AthInterface.WifiMode == _SYS_WIFI_MODE_DISABLE) {
+            ChangeDisplay2Value(__3G4G_status, _disappear);
+            // 3G/4G
+            if (ShmSysConfigAndInfo->SysConfig.TelecomInterface.TelcomNetworkConn == YES)
+            { ChangeDisplay2Value(__3G4G_move_status, _3G4G_disconnect); }
+            else
+            { ChangeDisplay2Value(__3G4G_move_status, _3G4G_disconnect); }
+        } else {
+            ChangeDisplay2Value(__3G4G_move_status, _disappear);
+            // 3G/4G
+            if (ShmSysConfigAndInfo->SysConfig.TelecomInterface.TelcomNetworkConn == YES)
+            { ChangeDisplay2Value(__3G4G_status, _3G4G_disconnect); }
+
+            else
+            { ChangeDisplay2Value(__3G4G_status, _3G4G_disconnect); }
+        }
+    } else {
+        ChangeDisplay2Value(__3G4G_status, _disappear);
+
+        ChangeDisplay2Value(__3G4G_move_status, _disappear);
+    }
+
+    // 連線到後台
+    if (ShmSysConfigAndInfo->SysInfo.OcppConnStatus == YES) {
+        ChangeDisplay2Value(__conn_status, _connect);
+    } else {
+        ChangeDisplay2Value(__conn_status, _disconnect);
+    }
+
+    /*if (ShmSysConfigAndInfo->SysConfig.AthInterface.WifiNetworkConn == YES ||
+            ShmSysConfigAndInfo->SysConfig.AthInterface.WifiMode == _SYS_WIFI_MODE_AP) {
+        _wifi_conn_status = true;
+        ChangeDisplay2Value(__wifi_status, _wifi_connect);
+        ChangeDisplay2Value(__ethernet_status, _disappear);
+    } else {
+        _wifi_conn_status = false;
+        ChangeDisplay2Value(__wifi_status, _disappear);
+    }
+
+    if (!_wifi_conn_status) {
+        if (ShmSysConfigAndInfo->SysConfig.TelecomInterface.TelcomNetworkConn == YES ||
+                ShmSysConfigAndInfo->SysInfo.InternetConn == YES) {
+            ChangeDisplay2Value(__ethernet_status, _ethernet_connect);
+        } else {
+            ChangeDisplay2Value(__ethernet_status, _ethernet_disconnect);
+        }
+    }
+
+    // 連線到後台
+    if (ShmSysConfigAndInfo->SysInfo.OcppConnStatus == YES) {
+        ChangeDisplay2Value(__conn_status, _connect);
+    } else {
+        ChangeDisplay2Value(__conn_status, _disconnect);
+    }
+    */
+#endif //defined DD360 || defined DD360Audi
+}
+
+byte FirstPageChanged()
+{
+    byte result = NO;
+
+    if (_currentPage != _oldPage) {
+        result = YES;
+        _oldPage = _currentPage;
+    }
+
+    return result;
+}
+
+bool IsPageReloadChk()
+{
+    bool result = false;
+
+    if (ShmSysConfigAndInfo->SysInfo.CurGunSelectedByAc == NO_DEFINE) {
+        if (_curPage_index != ShmSysConfigAndInfo->SysInfo.CurGunSelected) {
+            _curPage_index = ShmSysConfigAndInfo->SysInfo.CurGunSelected;
+            result = true;
+        }
+    } else {
+        if (_curPage_index != ShmSysConfigAndInfo->SysInfo.CurGunSelectedByAc) {
+            _curPage_index = ShmSysConfigAndInfo->SysInfo.CurGunSelectedByAc;
+            result = true;
+        }
+    }
+
+    return result;
+}
+
+void ClearDisplayInfo()
+{
+    ChangeDisplay2Value(__csu_ver_string, _disappear);
+    ChangeDisplay2Value(__csu_ver_value, _disappear);
+
+    ChangeDisplay2Value(__eth0_ip_string, _disappear);
+    ChangeDisplay2Value(__eth0_ip_value, _disappear);
+
+    ChangeDisplay2Value(__sn_string, _disappear);
+    ChangeDisplay2Value(__sn_value, _disappear);
+
+    ChangeDisplay2Value(__dc1_ver_string, _disappear);
+    ChangeDisplay2Value(__dc1_ver_value, _disappear);
+
+    ChangeDisplay2Value(__dc2_ver_string, _disappear);
+    ChangeDisplay2Value(__dc2_ver_value, _disappear);
+
+    ChangeDisplay2Value(__fan_speed_string, _disappear);
+    ChangeDisplay2Value(__fan_speed_value, _disappear);
+}
+
+void DisplayInfoCsuVer(bool isShow, unsigned char *modelName)
+{
+    if (isShow) {
+        byte value[10];
+
+        memset(value, 0x00, sizeof(value));
+        strcpy((char *)value, "CSU Ver >");
+        DisplayValueToLcm(__csu_ver_string, value, sizeof(value));
+        memset(value, 0x00, sizeof(value));
+        strncpy((char *)value, (char *)modelName, 5);
+        DisplayValueToLcm(__csu_ver_value, value, sizeof(value));
+    } else {
+        ChangeDisplay2Value(__csu_ver_string, _disappear);
+        ChangeDisplay2Value(__csu_ver_value, _disappear);
+    }
+}
+
+void ShowWifiMode(bool isShow, unsigned char mode)
+{
+    if (isShow) {
+        byte value[20];
+
+        memset(value, 0x00, sizeof(value));
+        strcpy((char *) value, "Wifi Mo. >");
+        DisplayValueToLcm(__csu_ver_string, value, sizeof(value));
+        memset(value, 0x00, sizeof(value));
+        if (mode == 0) {
+            sprintf((char *)value, "disable");
+        } else if (mode == 1) {
+            sprintf((char *)value, "station");
+        } else if (mode == 2) {
+            sprintf((char *)value, "AP");
+        }
+
+        DisplayValueToLcm(__csu_ver_value, value, sizeof(value));
+    } else {
+        ChangeDisplay2Value(__csu_ver_string, _disappear);
+        ChangeDisplay2Value(__csu_ver_value, _disappear);
+    }
+}
+
+void DisplayInfoEthIp(bool isShow, unsigned char *ip)
+{
+    if (isShow) {
+        byte value[20];
+
+        memset(value, 0x00, sizeof(value));
+        strcpy((char *) value, "Eth IP >");
+        DisplayValueToLcm(__eth0_ip_string, value, sizeof(value));
+        memset(value, 0x00, sizeof(value));
+        strcpy((char *) value, (char *) ip);
+        DisplayValueToLcm(__eth0_ip_value, value, sizeof(value));
+    } else {
+        ChangeDisplay2Value(__eth0_ip_string, _disappear);
+        ChangeDisplay2Value(__eth0_ip_value, _disappear);
+    }
+}
+
+void Show4GRssi(bool isShow, int dbValue)
+{
+    if (isShow) {
+        byte value[20];
+
+        memset(value, 0x00, sizeof(value));
+        strcpy((char *) value, "RSSI >");
+        DisplayValueToLcm(__eth0_ip_string, value, sizeof(value));
+        memset(value, 0x00, sizeof(value));
+        sprintf((char *)value, "%d dBm", dbValue);
+        DisplayValueToLcm(__eth0_ip_value, value, sizeof(value));
+    } else {
+        ChangeDisplay2Value(__eth0_ip_string, _disappear);
+        ChangeDisplay2Value(__eth0_ip_value, _disappear);
+    }
+}
+
+void DisplayInfoSN(bool isShow, unsigned char *sn)
+{
+    if (isShow) {
+        byte value[30];
+
+        memset(value, 0x00, sizeof(value));
+        strcpy((char *) value, "SN >");
+        DisplayValueToLcm(__sn_string, value, sizeof(value));
+        memset(value, 0x00, sizeof(value));
+        strcpy((char *) value, (char *) sn);
+        DisplayValueToLcm(__sn_value, value, sizeof(value));
+    } else {
+        ChangeDisplay2Value(__sn_string, _disappear);
+        ChangeDisplay2Value(__sn_value, _disappear);
+    }
+}
+
+void ShowWifiRssi(bool isShow, int dbValue)
+{
+    if (isShow) {
+        byte value[20];
+
+        memset(value, 0x00, sizeof(value));
+        strcpy((char *) value, "RSSI >");
+        DisplayValueToLcm(__sn_string, value, sizeof(value));
+        memset(value, 0x00, sizeof(value));
+        sprintf((char *)value, "%d dBm", dbValue);
+        DisplayValueToLcm(__sn_value, value, sizeof(value));
+    } else {
+        ChangeDisplay2Value(__sn_string, _disappear);
+        ChangeDisplay2Value(__sn_value, _disappear);
+    }
+}
+
+void DisplayInfoGun1Ver(bool isShow, unsigned char *version)
+{
+    if (isShow) {
+        byte value[10];
+
+        memset(value, 0x00, sizeof(value));
+        strcpy((char *) value, "Ct1 Ver >");
+        DisplayValueToLcm(__dc1_ver_string, value, sizeof(value));
+        memset(value, 0x00, sizeof(value));
+        strcpy((char *) value, (char *) version);
+        DisplayValueToLcm(__dc1_ver_value, value, sizeof(value));
+    } else {
+        ChangeDisplay2Value(__dc1_ver_string, _disappear);
+        ChangeDisplay2Value(__dc1_ver_value, _disappear);
+    }
+}
+
+void Show4GMode(bool isShow, unsigned char mode)
+{
+    if (isShow) {
+        byte value[20];
+
+        memset(value, 0x00, sizeof(value));
+        strcpy((char *) value, "3/4G Mo. >");
+        DisplayValueToLcm(__dc1_ver_string, value, sizeof(value));
+        memset(value, 0x00, sizeof(value));
+        if (mode == 0) {
+            sprintf((char *)value, "disable");
+        } else if (mode == 1) {
+            sprintf((char *)value, "enable");
+        }
+
+        DisplayValueToLcm(__dc1_ver_value, value, sizeof(value));
+    } else {
+        ChangeDisplay2Value(__dc1_ver_string, _disappear);
+        ChangeDisplay2Value(__dc1_ver_value, _disappear);
+    }
+}
+
+void DisplayInfoGun2Ver(bool isShow, unsigned char *version)
+{
+    if (isShow) {
+        byte value[10];
+
+        memset(value, 0x00, sizeof(value));
+        strcpy((char *) value, "Ct2 Ver >");
+        DisplayValueToLcm(__dc2_ver_string, value, sizeof(value));
+        memset(value, 0x00, sizeof(value));
+        strcpy((char *) value, (char *) version);
+        DisplayValueToLcm(__dc2_ver_value, value, sizeof(value));
+    } else {
+        ChangeDisplay2Value(__dc2_ver_string, _disappear);
+        ChangeDisplay2Value(__dc2_ver_value, _disappear);
+    }
+}
+
+void Show4GIP(bool isShow, unsigned char *ip)
+{
+    if (isShow) {
+        byte value[20];
+
+        memset(value, 0x00, sizeof(value));
+        strcpy((char *) value, "3/4G IP >");
+        DisplayValueToLcm(__dc2_ver_string, value, sizeof(value));
+        memset(value, 0x00, sizeof(value));
+        strcpy((char *) value, (char *) ip);
+        DisplayValueToLcm(__dc2_ver_value, value, sizeof(value));
+    } else {
+        ChangeDisplay2Value(__dc2_ver_string, _disappear);
+        ChangeDisplay2Value(__dc2_ver_value, _disappear);
+    }
+}
+
+void DisplayInfoSpeed(bool isShow, unsigned int fan)
+{
+    if (isShow) {
+        byte value[10];
+
+        memset(value, 0x00, sizeof(value));
+        strcpy((char *) value, "Fan Spd >");
+        DisplayValueToLcm(__fan_speed_string, value, sizeof(value));
+        memset(value, 0x00, sizeof(value));
+        sprintf((char *)value, "%d", fan);
+        DisplayValueToLcm(__fan_speed_value, value, sizeof(value));
+    } else {
+        ChangeDisplay2Value(__fan_speed_string, _disappear);
+        ChangeDisplay2Value(__fan_speed_value, _disappear);
+    }
+}
+
+void ShowWifiIP(bool isShow, unsigned char *ip)
+{
+    if (isShow) {
+        byte value[20];
+
+        memset(value, 0x00, sizeof(value));
+        strcpy((char *) value, "Wifi IP >");
+        DisplayValueToLcm(__fan_speed_string, value, sizeof(value));
+        memset(value, 0x00, sizeof(value));
+        strcpy((char *) value, (char *) ip);
+        DisplayValueToLcm(__fan_speed_value, value, sizeof(value));
+    } else {
+        ChangeDisplay2Value(__fan_speed_string, _disappear);
+        ChangeDisplay2Value(__fan_speed_value, _disappear);
+    }
+}
+
+void InformationShow()
+{
+    if (ShmSysConfigAndInfo->SysConfig.ShowInformation == YES) {
+        bool show = _isShow = true;
+        if (_showInformIndex == 0) {
+            DisplayInfoCsuVer(show, ShmSysConfigAndInfo->SysInfo.CsuRootFsFwRev);
+            DisplayInfoSpeed(show, ShmSysConfigAndInfo->SysInfo.SystemFanRotaSpeed);
+            DisplayInfoSN(show, ShmSysConfigAndInfo->SysConfig.SerialNumber);
+
+            DisplayInfoEthIp(show, ShmSysConfigAndInfo->SysConfig.Eth0Interface.EthIpAddress);
+            DisplayInfoGun1Ver(show, ShmSysConfigAndInfo->SysInfo.Connector1FwRev);
+            if (_totalCount > 1) {
+                DisplayInfoGun2Ver(show, ShmSysConfigAndInfo->SysInfo.Connector2FwRev);
+            } else {
+                DisplayInfoGun2Ver(false, ShmSysConfigAndInfo->SysInfo.Connector2FwRev);
+            }
+        } else if (_showInformIndex == 1) {
+            ShowWifiMode(show, ShmSysConfigAndInfo->SysConfig.AthInterface.WifiMode);
+            ShowWifiIP(show, ShmSysConfigAndInfo->SysConfig.AthInterface.WifiIpAddress);
+            ShowWifiRssi(show, ShmSysConfigAndInfo->SysConfig.AthInterface.WifiRssi);
+
+            Show4GMode(show, ShmSysConfigAndInfo->SysConfig.TelecomInterface.TelcomEnabled);
+            Show4GIP(show, ShmSysConfigAndInfo->SysConfig.TelecomInterface.TelcomIpAddress);
+            Show4GRssi(show, ShmSysConfigAndInfo->SysConfig.TelecomInterface.TelcomRssi);
+        }
+    } else {
+        ClearDisplayInfo();
+
+        if (_isShow) {
+            _isShow = false;
+            _showInformIndex++;
+            if (_showInformIndex >= 2) {
+                _showInformIndex = 0;
+            }
+        }
+    }
+}
+
+void ProcessPageInfo()
+{
+    _page_reload = IsPageReloadChk();
+
+    // 隨插即充 - 可省略該按鈕 //DS60-120 add
+    if (ShmSysConfigAndInfo->SysConfig.AuthorisationMode == AUTH_MODE_ENABLE) {
+        ChangeDisplay2Value(__ret_home_btn, _back_home_btn);
+        if (_totalCount >= 2 && ShmSysConfigAndInfo->SysInfo.IsAlternatvieConf == NO) {
+            ChangeDisplay2Value(__sel_gun_btn, _sel_gun_btn);
+        } else {
+            ChangeDisplay2Value(__sel_gun_btn, _disappear);
+        }
+    }
+
+    switch (_currentPage) {
+#if defined DD360Audi
+    case _LCM_SELECT_GUN: ////For Audi
+        if (ShmSysConfigAndInfo->SysInfo.CurGunSelected == 0) {
+            ChangeDisplay2Value(__left_gun_map, _left_gun_enable_map);
+            ChangeDisplay2Value(__right_gun_map, _right_gun_disable_map);
+        } else if (ShmSysConfigAndInfo->SysInfo.CurGunSelected == 1) {
+            ChangeDisplay2Value(__left_gun_map, _left_gun_disable_map);
+            ChangeDisplay2Value(__right_gun_map, _right_gun_enable_map);
+        }
+        ChangeDisplay2Value(__add_chk_btn, _select_gun_btn);
+        break;
+#endif //defined DD360Audi
+
+    case _LCM_IDLE: {
+        if (ShmSysConfigAndInfo->SysConfig.isRFID) {
+            ChangeDisplay2Value(__main_rfid, _main_rfid);
+        } else {
+            ChangeDisplay2Value(__main_rfid, _main_none_rfid);
+        }
+
+        if (ShmSysConfigAndInfo->SysConfig.isQRCode) {
+            ChangeDisplay2Value(__main_qr, _main_qr);
+        } else {
+            ChangeDisplay2Value(__qr_code, _disappear);
+            ChangeDisplay2Value(__main_qr, _main_none_qr);
+            needReloadQr = true;
+        }
+
+        if (ShmSysConfigAndInfo->SysConfig.isAPP) {
+            ChangeDisplay2Value(__main_app, _main_app);
+        } else {
+            ChangeDisplay2Value(__main_app, _main_none_app);
+        }
+
+        //if (FirstPageChanged() == YES || needReloadQr || _page_reload) {
+        if (ShmSysConfigAndInfo->SysConfig.isQRCode) {
+            needReloadQr = false;
+            if (ShmSysConfigAndInfo->SysConfig.QRCodeMadeMode == NO) {
+                //byte len = strlen((char *)ShmSysConfigAndInfo->SysConfig.SystemId);
+                ChangeQrCode_Idle((char *)ShmSysConfigAndInfo->SysConfig.SystemId);
+            } else {
+                //byte len = strlen((char *)ShmSysConfigAndInfo->SysConfig.QRCodeContent);
+                ChangeQrCode_Idle((char *)ShmSysConfigAndInfo->SysConfig.QRCodeContent);
+            }
+            //ChangeQrCode_Idle((char *)ShmSysConfigAndInfo->SysConfig.SystemId);
+        }
+        //}
+
+        //DS60-120 add
+        bool isCharging = false;
+        for (byte i = 0; i < _totalCount; i++) {
+            if (_chargingInfoData[i]->SystemStatus == S_IDLE) {
+                continue;
+            }
+
+            isCharging = true;
+            break;
+        }
+        if (isCharging && ShmSysConfigAndInfo->SysInfo.IsAlternatvieConf == NO) {
+            ChangeDisplay2Value(__sel_gun_btn, _sel_gun_btn);
+        } else {
+            ChangeDisplay2Value(__sel_gun_btn, _disappear);
+        }
+    }
+    break;
+    case _LCM_AUTHORIZING:
+    case _LCM_AUTHORIZ_COMP:
+    case _LCM_AUTHORIZ_FAIL: {
+        //case _LCM_WAIT_FOR_PLUG: {
+        FirstPageChanged();
+#if defined DD360Audi
+        if (_currentPage == _LCM_AUTHORIZ_COMP) { ////For Audi
+            ChangeBalanceValue(__balance, ShmSysConfigAndInfo->SysInfo.CurGunSelected);
+        }
+#endif //defined DD360Audi
+    }
+    break;
+    case _LCM_WAIT_FOR_PLUG: {
+        FirstPageChanged();
+        if (ShmSysConfigAndInfo->SysConfig.AuthorisationMode == AUTH_MODE_DISABLE) {
+            // 新增隨插即充功能預設在等待插槍頁面在開啟
+            ChangeDisplay2Value(__ret_home_btn, _disappear);
+            bool isCharging = false;
+            for (byte i = 0; i < _totalCount; i++) {
+                if (_chargingInfoData[i]->SystemStatus == S_IDLE) {
+                    continue;
+                }
+
+                isCharging = true;
+                break;
+            }
+
+            if (isCharging && ShmSysConfigAndInfo->SysInfo.IsAlternatvieConf == NO) {
+                ChangeDisplay2Value(__sel_gun_btn, _sel_gun_btn);
+            } else {
+                ChangeDisplay2Value(__sel_gun_btn, _disappear);
+            }
+        } else {
+            ChangeDisplay2Value(__sel_gun_btn, _disappear);
+        }
+    }
+    break;
+    case _LCM_PRE_CHARGE:
+    case _LCM_CHARGING:
+    case _LCM_COMPLETE: {
+        bool isShowAc = false;
+        byte gunTargetIndex = 0;
+
+        if (acgunCount > 0) {
+            gunTargetIndex = 2;
+            if (ShmSysConfigAndInfo->SysInfo.CurGunSelectedByAc != NO_DEFINE) {
+                isShowAc = true;
+                //ChangeDisplay2Value(__gun_type_index + (2 * 2), _actype_light); //DS60-120 remove
+                if (_currentPage == _LCM_COMPLETE) {
+                    ChangeDisplay2Value(__cmp_gun_type_index + (gunTargetIndex * 2), _actype_light_cmp);
+                } else {
+                    ChangeDisplay2Value(__gun_type_index + (gunTargetIndex * 2), _actype_light);
+                }
+
+                if (_currentPage == _LCM_CHARGING) {
+                    ChangeAcBattMapAndValue(_LCM_CHARGING);
+                    if (ac_chargingInfo[0]->PresentChargedDuration >= 0 &&
+                            ac_chargingInfo[0]->PresentChargedDuration <= TIME_MAX_SEC) {
+                        ChangeRemainTime(ac_chargingInfo[0]->PresentChargedDuration);
+                    } else {
+                        ChangeRemainTime(0);
+                    }
+
+                    if (ac_chargingInfo[0]->PresentChargingPower >= 0.1 &&
+                            ac_chargingInfo[0]->PresentChargingPower <= POWER_MAX_KW) {
+                        ChangeChargingPowerValue(ac_chargingInfo[0]->PresentChargingPower);
+                    } else {
+                        ChangeChargingPowerValue(0);
+                    }
+
+                    if (ac_chargingInfo[0]->PresentChargedEnergy >= 0.1 &&
+                            ac_chargingInfo[0]->PresentChargedEnergy <= ENERGY_MAX_KWH) {
+                        ChangeChargingEnergyValue(ac_chargingInfo[0]->PresentChargedEnergy);
+                    } else {
+                        ChangeChargingEnergyValue(0);
+                    }
+
+                    if (strcmp((char *)ac_chargingInfo[0]->StartUserId, "") == 0) {
+                        ChangeDisplay2Value(__stop_method_btn, _stop_charging_btn);
+                    } else {
+                        ChangeDisplay2Value(__stop_method_btn, _stop_charging_btn_scan);
+                    }
+                } else if (_currentPage == _LCM_COMPLETE) {
+                    ChangeAcBattMapAndValue(_LCM_COMPLETE);
+                    if (ac_chargingInfo[0]->PresentChargedDuration >= 0 &&
+                            ac_chargingInfo[0]->PresentChargedDuration <= TIME_MAX_SEC) {
+                        ChangeRemainTime(ac_chargingInfo[0]->PresentChargedDuration);
+                    } else {
+                        ChangeRemainTime(0);
+                    }
+
+                    if (ac_chargingInfo[0]->PresentChargingPower >= 0.1 &&
+                            ac_chargingInfo[0]->PresentChargingPower <= POWER_MAX_KW) {
+                        ChangeChargingPowerValue(ac_chargingInfo[0]->PresentChargingPower);
+                    } else {
+                        ChangeChargingPowerValue(0);
+                    }
+
+                    if (ac_chargingInfo[0]->PresentChargedEnergy >= 0.1 &&
+                            ac_chargingInfo[0]->PresentChargedEnergy <= ENERGY_MAX_KWH) {
+                        ChangeChargingEnergyValue(ac_chargingInfo[0]->PresentChargedEnergy);
+
+                        if (ShmSysConfigAndInfo->SysConfig.BillingData.isBilling &&
+                                ac_chargingInfo[0]->ChargingFee >= 0) {
+                            ChangeChargingFeeValue(ac_chargingInfo[0]->ChargingFee);
+                        }
+                    } else {
+                        ChangeChargingEnergyValue(0);
+                        if (ShmSysConfigAndInfo->SysConfig.BillingData.isBilling) {
+                            ChangeChargingFeeValue(0);
+                        }
+                    }
+
+                    if (!ShmSysConfigAndInfo->SysConfig.BillingData.isBilling) {
+                        ChangeDisplay2Value(__charging_fee_map, _disappear);
+                        ChangeDisplay2Value(__charging_fee_tx, _disappear);
+                    } else {
+                        ChangeDisplay2Value(__charging_fee_map, _money_map);
+                    }
+                }
+            } else {
+                //ChangeDisplay2Value(__gun_type_index + (2 * 2), _actype_dark); //DS60-120 remove
+                if (_currentPage == _LCM_COMPLETE) {
+                    ChangeDisplay2Value(__cmp_gun_type_index + (gunTargetIndex * 2), _actype_dark_cmp);
+                } else {
+                    ChangeDisplay2Value(__gun_type_index + (gunTargetIndex * 2), _actype_dark);
+                }
+            }
+        } else {
+            //ChangeDisplay2Value(__gun_type_index + (2 * 2), _disappear); //DS60-120 remove
+            if (_totalCount > 1) {
+                gunTargetIndex = 2;
+                ChangeDisplay2Value(__cmp_gun_type_index + (gunTargetIndex * 2), _disappear);
+                ChangeDisplay2Value(__gun_type_index + (gunTargetIndex * 2), _disappear);
+            }
+        }
+
+        gunTargetIndex = 0; //DS60-120 add
+        for (byte i = 0; i < _totalCount; i++) {
+            if (_totalCount == 1 && acgunCount <= 0) { //DS60-120 add
+                gunTargetIndex = 2;
+            } else {
+                gunTargetIndex = i;
+            }
+
+            switch (_chargingInfoData[i]->Type) {
+            case _Type_Chademo: {
+                if (ShmSysConfigAndInfo->SysInfo.CurGunSelected == i && !isShowAc) {
+                    if (_currentPage == _LCM_COMPLETE) {
+                        ChangeDisplay2Value(__cmp_gun_type_index + (i * 2), _chademo_light_cmp);
+                    } else {
+                        ChangeDisplay2Value(__gun_type_index + (i * 2), _chademo_light);
+                    }
+                } else {
+                    if (_currentPage == _LCM_COMPLETE) {
+                        ChangeDisplay2Value(__cmp_gun_type_index + (i * 2), _chademo_dark_cmp);
+                    } else {
+                        ChangeDisplay2Value(__gun_type_index + (i * 2), _chademo_dark);
+                    }
+                }
+            }
+            break;
+            case _Type_GB: {
+                if (ShmSysConfigAndInfo->SysInfo.CurGunSelected == i && !isShowAc) {
+                    if (_currentPage == _LCM_COMPLETE) {
+                        ChangeDisplay2Value(__cmp_gun_type_index + (i * 2), _gbt_light_cmp);
+                    } else {
+                        ChangeDisplay2Value(__gun_type_index + (i * 2), _gbt_light);
+                    }
+                } else {
+                    if (_currentPage == _LCM_COMPLETE) {
+                        ChangeDisplay2Value(__cmp_gun_type_index + (i * 2), _gbt_dark_cmp);
+                    } else {
+                        ChangeDisplay2Value(__gun_type_index + (i * 2), _gbt_dark);
+                    }
+                }
+            }
+            break;
+            case _Type_CCS_2: {
+                if (ShmSysConfigAndInfo->SysInfo.CurGunSelected == i && !isShowAc) {
+                    if (_currentPage == _LCM_COMPLETE) {
+                        ChangeDisplay2Value(__cmp_gun_type_index + (i * 2), _ccs_light_cmp);
+                    } else {
+                        ChangeDisplay2Value(__gun_type_index + (i * 2), _ccs_light);
+                    }
+                } else {
+                    if (_currentPage == _LCM_COMPLETE) {
+                        ChangeDisplay2Value(__cmp_gun_type_index + (i * 2), _ccs_dark_cmp);
+                    } else {
+                        ChangeDisplay2Value(__gun_type_index + (i * 2), _ccs_dark);
+                    }
+                }
+            }
+            break;
+            }
+
+            if (_currentPage == _LCM_PRE_CHARGE && !isShowAc) {
+                if (ShmSysConfigAndInfo->SysInfo.CurGunSelected == i) {
+                    ChangeBattMapAndValue(_currentPage, _chargingInfoData[i]->EvBatterySoc);
+                }
+            } else if (_currentPage == _LCM_CHARGING && !isShowAc) {
+                if (ShmSysConfigAndInfo->SysInfo.CurGunSelected == i) {
+                    ChangeBattMapAndValue(_LCM_CHARGING, _chargingInfoData[i]->EvBatterySoc);
+                    if (_chargingInfoData[i]->PresentChargedDuration >= 0 &&
+                            _chargingInfoData[i]->PresentChargedDuration <= TIME_MAX_SEC) {
+                        ChangeRemainTime(_chargingInfoData[i]->PresentChargedDuration);
+                    } else {
+                        ChangeRemainTime(0);
+                    }
+
+                    if (_chargingInfoData[i]->PresentChargingPower >= 0 &&
+                            _chargingInfoData[i]->PresentChargingPower <= POWER_MAX_KW) {
+                        ChangeChargingPowerValue(_chargingInfoData[i]->PresentChargingPower);
+                    } else {
+                        ChangeChargingPowerValue(0);
+                    }
+
+                    if (_chargingInfoData[i]->PresentChargedEnergy >= 0.1 &&
+                            _chargingInfoData[i]->PresentChargedEnergy <= ENERGY_MAX_KWH) {
+                        ChangeChargingEnergyValue(_chargingInfoData[i]->PresentChargedEnergy);
+                    } else {
+                        ChangeChargingEnergyValue(0);
+                    }
+
+                    if (strcmp((char *)_chargingInfoData[i]->StartUserId, "") == 0) {
+                        ChangeDisplay2Value(__stop_method_btn, _stop_charging_btn);
+                    } else {
+                        ChangeDisplay2Value(__stop_method_btn, _stop_charging_btn_scan);
+                    }
+                }
+            } else if (_currentPage == _LCM_COMPLETE && !isShowAc) {
+                if (ShmSysConfigAndInfo->SysInfo.CurGunSelected == i) {
+                    ChangeBattMapAndValue(_LCM_COMPLETE, _chargingInfoData[i]->EvBatterySoc);
+                    if (_chargingInfoData[i]->PresentChargedDuration >= 0 &&
+                            _chargingInfoData[i]->PresentChargedDuration <= TIME_MAX_SEC) {
+                        ChangeRemainTime(_chargingInfoData[i]->PresentChargedDuration);
+                    } else {
+                        ChangeRemainTime(0);
+                    }
+
+                    if (_chargingInfoData[i]->PresentChargingPower >= 0 &&
+                            _chargingInfoData[i]->PresentChargingPower <= POWER_MAX_KW) {
+                        ChangeChargingPowerValue(_chargingInfoData[i]->PresentChargingPower);
+                    } else {
+                        ChangeChargingPowerValue(0);
+                    }
+#if 1
+                    if (_chargingInfoData[i]->PresentChargedEnergy >= 0.1 &&
+                            _chargingInfoData[i]->PresentChargedEnergy <= ENERGY_MAX_KWH) {
+                        ChangeChargingEnergyValue(_chargingInfoData[i]->PresentChargedEnergy);
+
+                        if (ShmSysConfigAndInfo->SysConfig.BillingData.isBilling &&
+                                _chargingInfoData[i]->ChargingFee >= 0) {
+                            ChangeChargingFeeValue(_chargingInfoData[i]->ChargingFee);
+                            ChangeBalanceValue(__remain_balance, i);
+                        }
+                    } else {
+                        ChangeChargingEnergyValue(0);
+                        if (ShmSysConfigAndInfo->SysConfig.BillingData.isBilling) {
+                            ChangeChargingFeeValue(0);
+                            ChangeBalanceValue(__remain_balance, i);
+                        }
+                    }
+#else
+                    ChangeChargingEnergyValue(_chargingInfoData[i]->PresentChargedEnergy);
+
+                    if (ShmSysConfigAndInfo->SysConfig.BillingData.isBilling &&
+                            _chargingInfoData[i]->ChargingFee >= 0) {
+                        ChangeChargingFeeValue(_chargingInfoData[i]->ChargingFee);
+                        ChangeBalanceValue(__remain_balance, i);
+                    }
+#endif // 0
+                    if (!ShmSysConfigAndInfo->SysConfig.BillingData.isBilling) {
+                        ChangeDisplay2Value(__charging_fee_map, _disappear);
+                        ChangeDisplay2Value(__charging_fee_tx, _disappear);
+                    } else {
+                        ChangeDisplay2Value(__charging_fee_map, _money_map);
+                    }
+                }
+            }
+        }
+
+        // gun btn and QR code
+        if (_totalCount + acgunCount >= 2 && _currentPage) {
+            byte index = 0;
+            for (index = 0; index < _totalCount; index++) {
+                if (ShmSysConfigAndInfo->SysInfo.CurGunSelected != index) {
+                    break;
+                }
+            }
+
+            if (_chargingInfoData[index]->SystemStatus == S_IDLE ||
+                    _chargingInfoData[index]->SystemStatus == S_RESERVATION ||
+                    _chargingInfoData[index]->SystemStatus == S_BOOTING) {
+                if (FirstPageChanged() == YES || needReloadQr || _page_reload) {
+                    if (ShmSysConfigAndInfo->SysConfig.isQRCode) {
+                        needReloadQr = false;
+                        //ChangeQrCode_Charge((char *)ShmSysConfigAndInfo->SysConfig.SystemId); //DS60-120 remove
+                        if (ShmSysConfigAndInfo->SysConfig.QRCodeMadeMode == NO) {
+                            //byte len = strlen((char *)ShmSysConfigAndInfo->SysConfig.SystemId);
+                            ChangeQrCode_Charge((char *)ShmSysConfigAndInfo->SysConfig.SystemId);
+                        } else {
+                            //byte len = strlen((char *)ShmSysConfigAndInfo->SysConfig.QRCodeContent);
+                            ChangeQrCode_Charge((char *)ShmSysConfigAndInfo->SysConfig.QRCodeContent);
+                        }
+                    }
+                }
+            }
+        }
+    }
+    break;
+
+    case _LCM_FIX:
+        if (ShmPrimaryMcuData->InputDet.bits.EmergencyButton == 1) {
+            ChangeDisplay2Value(_emergency_map, _emergency_disable_map);
+        } else {
+            ChangeDisplay2Value(_emergency_map, _disappear);
+        }
+        break;
+    }
+}
+
+void ChangeDisplayMoneyInfo()
+{
+    uint8_t curGun = ShmSysConfigAndInfo->SysInfo.CurGunSelected;
+
+    if (ShmSysConfigAndInfo->SysConfig.BillingData.isBilling) {
+        struct timeb csuTime;
+        struct tm *tmCSU;
+
+        ftime(&csuTime);
+        tmCSU = localtime(&csuTime.time);
+
+        ChangeDisplay2Value(__money_rate_map, _charging_money);
+#if defined DD360Audi
+        if (gAudiCustInfo->PricesInfo[curGun].UserPrices != 0.00) { //Jerry add
+            DisplayMoneyRate(gAudiCustInfo->PricesInfo[curGun].UserPrices);
+        } else {
+#endif //defined DD360Audi
+            if (tmCSU->tm_hour <= 23) {
+                ShmSysConfigAndInfo->SysConfig.BillingData.Cur_fee = ShmSysConfigAndInfo->SysConfig.BillingData.Fee[tmCSU->tm_hour];
+                DisplayMoneyRate(ShmSysConfigAndInfo->SysConfig.BillingData.Cur_fee);
+            }
+
+            if (ShmSysConfigAndInfo->SysConfig.BillingData.Currency <= 53) {
+                DisplayMoneyCur((byte *)Currency[ShmSysConfigAndInfo->SysConfig.BillingData.Currency]);
+            }
+#if defined DD360Audi
+        }
+#endif //defined DD360Audi
+    } else {
+        ChangeDisplay2Value(__money_rate_map, _disappear);
+        ChangeDisplay2Value(__money_by_rate, _disappear);
+        ChangeDisplay2Value(__money_rate, _disappear);
+    }
+}
+
+void Initialization()
+{
+    bool isPass = false;
+    byte count = 5;
+    while (!isPass && count > 0) {
+        isPass = true;
+        for (byte _index = 0; _index < _totalCount; _index++) {
+            if (!FindChargingInfoData(_index, &_chargingInfoData[0])) {
+                DEBUG_ERROR("LcmComm (main) : FindChargingInfoData false \n");
+                isPass = false;
+                count--;
+                break;
+            }
+        }
+
+        sleep(1);
+    }
+
+    isPass = false;
+
+    if (acgunCount > 0) {
+        while (!isPass) {
+            isPass = true;
+            for (byte _index = 0; _index < acgunCount; _index++) {
+                if (!FindAcChargingInfoData(_index, &ac_chargingInfo[0])) {
+                    DEBUG_ERROR("LcmComm : FindAcChargingInfoData false \n");
+                    isPass = false;
+                    break;
+                }
+            }
+
+            sleep(1);
+        }
+    }
+
+    if (count == 0) {
+        PRINTF_FUNC("LCM Initialization Gun Fail.............\n");
+    }
+}
+
+//DS60-120 add
+void DefaultIconStatus()
+{
+    for (byte i = 0; i < 3; i++) {
+        ChangeDisplay2Value(__gun_type_index + (i * 2), _disappear);
+    }
+
+    if (ShmSysConfigAndInfo->SysInfo.IsAlternatvieConf == YES || _totalCount == 1) {
+        ChangeDisplay2Value(__sel_gun_btn, _disappear);
+    } else {
+        ChangeDisplay2Value(__sel_gun_btn, _sel_gun_btn);
+    }
+}
+
+int main(void)
+{
+    if (InitShareMemory() == FAIL) {
+#ifdef SystemLogMessage
+        DEBUG_ERROR("InitShareMemory NG\n");
+#endif
+        if (ShmStatusCodeData != NULL) {
+            ShmStatusCodeData->AlarmCode.AlarmEvents.bits.FailToCreateShareMemory = 1;
+        }
+        sleep(5);
+        return 0;
+    }
+
+    _port = CreateCommunicationLcmPort();
+    byte changeWarningPriority = 0;
+    byte curWarningCount = 255;
+    ChangeBackLight(true);
+    _totalCount = ShmSysConfigAndInfo->SysConfig.TotalConnectorCount;
+    acgunCount = ShmSysConfigAndInfo->SysConfig.AcConnectorCount;
+    Initialization();
+
+    //printf("_LCM_COMPLETE \r\n");
+    //ChangeToOtherPage(_LCM_COMPLETE);
+    //return 0;
+
+    for (byte i = 0; i < 3; i++) {
+        ChangeDisplay2Value(__gun_type_index + (i * 2), _disappear);
+    }
+
+    DefaultIconStatus(); //DS60-120 add
+
+    while (_port != -1) {
+        if (strcmp((char *)ShmSysConfigAndInfo->SysInfo.LcmHwRev, moduleName) != 0x00) {
+            GetCurrentPage();
+            sleep(1);
+        } else {
+            //DemoFunction();
+
+            // Warning 處理
+            if (curWarningCount != ShmSysConfigAndInfo->SysWarningInfo.WarningCount) {
+                changeWarningPriority = 0;
+                ShmSysConfigAndInfo->SysWarningInfo.PageIndex = 0;
+                curWarningCount = ShmSysConfigAndInfo->SysWarningInfo.WarningCount;
+                ChangeWarningFunc();
+            } else if (ShmSysConfigAndInfo->SysWarningInfo.WarningCount > 5 && changeWarningPriority == 0) {
+                // 當有兩頁 Warning 則每隔三秒改變一次
+                if (ShmSysConfigAndInfo->SysWarningInfo.PageIndex == 0) {
+                    ShmSysConfigAndInfo->SysWarningInfo.PageIndex = 1;
+                } else {
+                    ShmSysConfigAndInfo->SysWarningInfo.PageIndex = 0;
+                }
+
+                ChangeWarningFunc();
+            }
+
+            // 頁面資訊處理
+            ProcessPageInfo();
+
+            // 網路 - wifi - 連線訊號處理
+            RefreshConnStatus();
+
+            // 換頁處理
+            GetCurrentPage(); //DS60-120 add
+            ChangeCurPage();
+
+            RefreshPageAnimation(_everyPageRollChange);
+
+#if defined DD360Audi
+            ChangeDisplayMoneyInfo();
+#else
+            if (changeWarningPriority == 0) { ////For Audi
+                ChangeDisplayMoneyInfo();
+                InformationShow();
+            }
+#endif //defined DD360Audi
+
+            changeWarningPriority >= 15 ? (_battery_display_ani = true) : (_battery_display_ani = false);
+            changeWarningPriority >= 30 ? changeWarningPriority = 0 : changeWarningPriority++;
+            usleep(100000);
+        }
+    }
+
+    CloseCommunicationLcmPort();
+
+    return FAIL;
+}

EVSE/Projects/DD360ComBox/Apps/ReModule_LcmControl.h

@@ -0,0 +1,262 @@
+#include <sys/time.h>
+#include <sys/timeb.h>
+#include <sys/types.h>
+#include <sys/stat.h>
+#include <sys/types.h>
+#include <sys/ioctl.h>
+#include <sys/socket.h>
+#include <sys/ipc.h>
+#include <sys/shm.h>
+#include <sys/shm.h>
+#include <sys/mman.h>
+#include <linux/wireless.h>
+#include <arpa/inet.h>
+#include <netinet/in.h>
+
+#include <unistd.h>
+#include <stdarg.h>
+#include <stdio.h>      /*標準輸入輸出定義*/
+#include <stdlib.h>     /*標準函數庫定義*/
+#include <unistd.h>     /*Unix 標準函數定義*/
+#include <fcntl.h>      /*檔控制定義*/
+#include <termios.h>    /*PPSIX 終端控制定義*/
+#include <errno.h>      /*錯誤號定義*/
+#include <errno.h>
+#include <string.h>
+#include <time.h>
+#include <ctype.h>
+#include <ifaddrs.h>
+#include <stdbool.h>
+#include "../../define.h"
+#include "Config.h"
+
+#define ARRAY_SIZE(A)       (sizeof(A) / sizeof(A[0]))
+#define PASS                1
+#define FAIL                -1
+#define YES                 1
+#define NO                  0
+
+typedef unsigned char           byte;
+
+struct SysConfigAndInfo         *ShmSysConfigAndInfo;
+struct StatusCodeData           *ShmStatusCodeData;
+struct FanModuleData            *ShmFanModuleData;
+struct PrimaryMcuData           *ShmPrimaryMcuData;
+
+#define NO_DEFINE               255
+#define DEFAULT_AC_INDEX        2
+
+#define TIME_MAX_SEC            2592000 // 一個月，秒數
+#define POWER_MAX_KW            5000
+#define ENERGY_MAX_KWH          5000
+
+#define CMD_TITLE_1             0x5A
+#define CMD_TITLE_2             0xA5
+#define CMD_READ                0x80
+#define CMD_WRITE               0x81
+#define CMD_MULTI_WRITE         0x82
+#define CMD_MULTI_READ          0x83
+
+#define CMD_BACKLIGHT           0x01
+#define CMD_REGISTER            0x03
+
+//#define NOODOE_QR_CODE_URL      "https://ev-alpha-test.noodoe.com/station?id=" ////For Audi
+#define NOODOE_QR_CODE_URL      "https://ev.noodoe.com/station?id=" ////For Audi
+
+enum _BATTERY_LEVEL_FOR_MAP {
+    _BATTERY_LEVEL_FOR_MAP_EMP = 0x00,
+    _BATTERY_LEVEL_FOR_MAP_LV1 = 0x01,
+    _BATTERY_LEVEL_FOR_MAP_LV2 = 0x02,
+    _BATTERY_LEVEL_FOR_MAP_LV3 = 0x03,
+    _BATTERY_LEVEL_FOR_MAP_LV4 = 0x04,
+    _BATTERY_LEVEL_FOR_MAP_LV5 = 0x05,
+};
+
+int _port;
+//char* pPortName         = "/dev/ttyO2";
+char *pPortName           = "/dev/ttyS3";
+char *moduleName          = "DMT80480T070_09WT";
+byte _totalCount;
+byte acgunCount;
+struct ChargingInfoData *_chargingInfoData[CHAdeMO_QUANTITY + CCS_QUANTITY + GB_QUANTITY];
+struct ChargingInfoData *ac_chargingInfo[AC_QUANTITY];
+
+byte ac_ani_battery_level = _BATTERY_LEVEL_FOR_MAP_LV5;
+byte isDiffStatus         = false;
+byte isChangeBattMap      = false;
+// 當前選擇的槍號
+#if defined DD360Audi
+short _currentPage        = _LCM_SELECT_GUN;
+short _oldPage            = _LCM_SELECT_GUN;
+#else
+short _currentPage        = _LCM_NONE;
+short _oldPage            = _LCM_NONE;
+#endif //defined DD360Audi
+byte _gunIndex            = 0;
+bool _wifi_conn_status    = false;
+bool _battery_display_ani = false;
+byte _curPage_index       = 0;
+bool _page_reload         = false;
+
+// LCM - HW
+byte _everyPageRollChange    = 0;
+short __conn_status          = 0x0030;
+short __ethernet_status      = 0x0032;
+short __3G4G_status          = 0x0036;
+short __3G4G_status1         = 0x0037;
+short __3G4G_move_status     = 0x0038;
+short __wifi_status          = 0x003C;
+
+short __sel_gun_btn          = 0x0040;
+short __ret_home_btn         = 0x0042;
+short __stop_method_btn      = 0x0044;
+
+short __qr_code              = 0x0250;
+short __main_rfid            = 0x0052;
+short __main_qr              = 0x0054;
+short __main_app             = 0x0056;
+
+short __plug_in_arrow        = 0x0060;
+
+short __conn_line            = 0x0066;
+
+short __gun_type_index       = 0x0070;
+short __cmp_gun_type_index   = 0x0080; ////For Audi
+short __batt_map_empty       = 0x0090; ////For Audi
+short __qr_code_pre          = 0x0280;
+
+short __side_top             = 0x0090;
+short __side_down            = 0x0092;
+short __side_mid             = 0x0094;
+
+short __conn_line_chag       = 0x0096;
+short __batt_map             = 0x0100;
+short __soc_value_charging   = 0x0102;
+short __remain_time_map      = 0x0106;
+short __power_map            = 0x0108;
+short __energy_map           = 0x010A;
+short __remain_time_tx       = 0x0110;
+
+short __trp_remain_time_map = 0x0116;
+short __trp_power_map = 0x0118;
+short __trp_energy_map = 0x011A;
+
+short __output_eng_tx        = 0x0120;
+short __total_out_eng_tx     = 0x0130;
+short __conn_line_comp       = 0x0140;
+short __charging_fee_map     = 0x0146;
+short __charging_fee_tx      = 0x0150;
+
+short __money_by_rate        = 0x0200;
+short __money_rate           = 0x0220;
+short __money_rate_map       = 0x0230;
+
+//DS60-120 add
+short __csu_ver_string = 0x0300;
+short __csu_ver_value = 0x0310;
+short __fan_speed_string = 0x0390;
+short __fan_speed_value = 0x0400;
+
+short __dc1_ver_string = 0x0320;
+short __dc1_ver_value = 0x0330;
+short __dc2_ver_string = 0x0340;
+short __dc2_ver_value = 0x0350;
+short __eth0_ip_string = 0x0360;
+short __eth0_ip_value = 0x0370;
+short __sn_string = 0x0410;
+short __sn_value = 0x0420;
+
+//For Audi, for select gun
+short __left_gun_map         = 0x0260;
+short __right_gun_map        = 0x0262;
+short __add_chk_btn          = 0x0264;
+//short __station_id         = 0x0270;
+short __balance              = 0x0270;
+short __remain_balance       = 0x0280;
+short __custStationIdL1      = 0x0450;
+//short __custStationIdL2      = 0x0470;
+short _emergency_map         = 0x011C;
+
+// ICON ID
+byte _disappear              = 0;
+byte _disconnect             = 1;
+byte _connect                = 2;
+byte _warning                = 3;
+byte _arrow_dark             = 4;
+byte _arrow_light            = 5;
+byte _3G4G_disconnect        = 6;
+byte __3G4G_connect          = 7;
+byte _wifi_disconnect        = 8;
+byte _wifi_connect           = 9;
+byte _logo                   = 10;
+byte _conn_map1              = 11;
+byte _conn_map2              = 12;
+byte _sel_gun_btn            = 13;
+byte _back_home_btn          = 14;
+byte _stop_charging_btn      = 15;
+byte _stop_charging_btn_scan = 16;
+byte _chademo_dark           = 17;
+byte _ccs_dark               = 18;
+byte _gbt_dark               = 19;
+byte _actype_dark            = 20;
+byte _chademo_light          = 21;
+byte _ccs_light              = 22;
+byte _gbt_light              = 23;
+byte _actype_light           = 24;
+byte _main_none_rfid         = 25;
+byte _main_rfid              = 26;
+byte _main_none_app          = 27;
+byte _main_app               = 28;
+byte _main_none_qr           = 29;
+byte _main_qr                = 30;
+byte _charging_map1          = 31;
+byte _charging_map2          = 32;
+byte _battery_empty          = 33;
+byte _battery_cap_20         = 34;
+byte _battery_cap_40         = 35;
+byte _battery_cap_60         = 36;
+byte _battery_cap_80         = 37;
+byte _battery_cap_100        = 38;
+byte _battery_map            = 39;
+byte _power_map              = 40;
+byte _time_map               = 41;
+byte _complete_map           = 42;
+byte _battery_soc_20         = 43;
+byte _battery_soc_40         = 44;
+byte _battery_soc_60         = 45;
+byte _battery_soc_80         = 46;
+byte _battery_soc_100        = 47;
+byte _battery_eng_map        = 48;
+byte _money_map              = 49;
+byte _elapse_time_map        = 50;
+byte _charging_money         = 51;
+//byte _side_none_rfid       = 52;
+//byte _side_rfid            = 53;
+//byte _side_none_app        = 54;
+//byte _side_app             = 55;
+//byte _side_none_qr         = 56;
+//byte _side_qr              = 57;
+byte _eth_disconnect         = 52; //58;
+byte _eth_connect            = 53; //59;
+
+byte _chademo_dark_cmp       = 54;
+byte _ccs_dark_cmp           = 55;
+byte _gbt_dark_cmp           = 56;
+byte _actype_dark_cmp        = 57;
+byte _chademo_light_cmp      = 58;
+byte _ccs_light_cmp          = 59;
+byte _gbt_light_cmp          = 60;
+byte _actype_light_cmp       = 61;
+
+byte _logo_cmp = 62;
+byte _battery_eng_trp_map = 63;
+byte _money_trp_map = 64;
+byte _elapse_time_trp_map = 65;
+
+////For Audi
+byte _left_gun_disable_map   = 66;
+byte _left_gun_enable_map    = 67;
+byte _right_gun_disable_map  = 68;
+byte _right_gun_enable_map   = 69;
+byte _select_gun_btn         = 70;
+byte _emergency_disable_map  = 72;

EVSE/Projects/DD360ComBox/Apps/ReModule_PrimaryComm.c

@@ -0,0 +1,693 @@
+#include    <sys/time.h>
+#include    <sys/timeb.h>
+#include    <sys/types.h>
+#include    <sys/stat.h>
+#include    <sys/types.h>
+#include    <sys/ioctl.h>
+#include    <sys/socket.h>
+#include    <sys/ipc.h>
+#include    <sys/shm.h>
+#include    <sys/shm.h>
+#include    <sys/mman.h>
+#include    <linux/wireless.h>
+#include    <arpa/inet.h>
+#include    <netinet/in.h>
+
+#include    <unistd.h>
+#include    <stdarg.h>
+#include    <stdio.h>      /*標準輸入輸出定義*/
+#include    <stdlib.h>     /*標準函數庫定義*/
+#include    <unistd.h>     /*Unix 標準函數定義*/
+#include    <fcntl.h>      /*檔控制定義*/
+#include    <termios.h>    /*PPSIX 終端控制定義*/
+#include    <errno.h>      /*錯誤號定義*/
+#include    <errno.h>
+#include    <string.h>
+#include    <time.h>
+#include    <ctype.h>
+#include    <ifaddrs.h>
+#include    <math.h>
+#include    "../../define.h"
+#include    "PrimaryComm.h"
+#include    <stdbool.h>
+
+#define ARRAY_SIZE(A)       (sizeof(A) / sizeof(A[0]))
+#define PASS                1
+#define FAIL                -1
+#define YES                 1
+#define NO                  0
+
+typedef struct StChillerInfo {
+    uint8_t ChillerSwitch;
+    uint32_t ChillerOnTime;
+    uint8_t Reserved[3];
+} ChillerInfo;
+
+typedef struct StLedConfig {
+    //OutputDrvValue[0]
+    uint8_t LeftButtonLed: 1;                   //bit 0,    H: ON,      L:OFF
+    uint8_t RightButtonLed: 1;                  //bit 1,    H: ON,      L:OFF
+    uint8_t GreenLED: 1;                          //bit 2,    H: ON,      L:OFF
+    uint8_t YellowLED: 1;                       //bit 3,    H: ON,      L:OFF
+    uint8_t RedLED: 1;                        //bit 4,    H: ON,      L:OFF
+    uint8_t SystemLed4: 1;                      //bit 5,    H: ON,      L:OFF
+    uint8_t AcContactor: 1;                     //bit 6,    H: ON,      L:OFF
+    uint8_t Reserved: 1;                        //bit 7 reserved
+} LedConfig;
+
+typedef unsigned char       byte;
+
+struct SysConfigAndInfo         *ShmSysConfigAndInfo;
+struct StatusCodeData           *ShmStatusCodeData;
+struct PrimaryMcuData           *ShmPrimaryMcuData;
+#if defined METER_ENABLE //DS60-120 add
+struct MeterInformation         *ShmCsuMeterData;
+#endif //defined METER_ENABLE
+
+void trim(char *s);
+int mystrcmp(char *p1, char *p2);
+void substr(char *dest, const char *src, unsigned int start, unsigned int cnt);
+void split(char **arr, char *str, const char *del);
+
+int Uart1Fd;
+char *priPortName = "/dev/ttyS1";
+Ver ver;
+Gpio_in gpio_in;
+Rtc rtc;
+
+struct timeval _flash_time;
+byte flash = NO;
+byte gun_count; //DS60-120 add
+
+byte _curDeviceStatus[3] = {0, 0, 0}; //DS60-120 add
+byte _reCheckCount[3] = {0, 0, 0}; //DS60-120 add
+struct ChargingInfoData *ChargingData[CHAdeMO_QUANTITY + CCS_QUANTITY + GB_QUANTITY];
+
+#if defined DD360 ||defined DD360Audi || defined DD360ComBox
+unsigned char ChillerSwitch; //DS60-120 remove
+unsigned int ChillerOnTime; //DS60-120 remove
+#endif //defined DD360 || defined DD360Audi
+
+int StoreLogMsg(const char *fmt, ...);
+#define log_info(format, args...) StoreLogMsg("[%s:%d][%s][Info] "format, __FILE__, __LINE__, __FUNCTION__, ##args)
+#define log_warn(format, args...) StoreLogMsg("[%s:%d][%s][Warn] "format, __FILE__, __LINE__, __FUNCTION__, ##args)
+#define log_error(format, args...) StoreLogMsg("[%s:%d][%s][Error] "format, __FILE__, __LINE__, __FUNCTION__, ##args)
+
+int StoreLogMsg(const char *fmt, ...)
+{
+    char Buf[4096 + 256];
+    char buffer[4096];
+    va_list args;
+    struct timeb  SeqEndTime;
+    struct tm *tm;
+
+    va_start(args, fmt);
+    int rc = vsnprintf(buffer, sizeof(buffer), fmt, args);
+    va_end(args);
+
+    memset(Buf, 0, sizeof(Buf));
+    ftime(&SeqEndTime);
+    SeqEndTime.time = time(NULL);
+    tm = localtime(&SeqEndTime.time);
+
+    if (ShmSysConfigAndInfo->SysConfig.SwitchDebugFlag == YES) {
+        sprintf(Buf, "%02d:%02d:%02d:%03d - %s",
+                tm->tm_hour, tm->tm_min, tm->tm_sec, SeqEndTime.millitm, buffer);
+        printf("%s \n", Buf);
+    } else {
+        sprintf(Buf, "echo \"%04d-%02d-%02d %02d:%02d:%02d:%03d - %s\" >> /Storage/SystemLog/[%04d.%02d]SystemLog",
+                tm->tm_year + 1900, tm->tm_mon + 1, tm->tm_mday, tm->tm_hour, tm->tm_min, tm->tm_sec, SeqEndTime.millitm,
+                buffer,
+                tm->tm_year + 1900, tm->tm_mon + 1);
+        system(Buf);
+    }
+
+    return rc;
+}
+
+int DiffTimeb(struct timeb ST, struct timeb ET)
+{
+    //return milli-second
+    unsigned int StartTime, StopTime;
+
+    StartTime = (unsigned int)ST.time;
+    StopTime = (unsigned int)ET.time;
+    return (StopTime - StartTime) * 1000 + ET.millitm - ST.millitm;
+}
+
+//=================================
+// Common routine
+//=================================
+char *getTimeString(void)
+{
+    char *result = malloc(21);
+    time_t timep;
+    struct tm *p;
+    time(&timep);
+    p = gmtime(&timep);
+
+    sprintf(result, "[%04d-%02d-%02d %02d:%02d:%02d]", (1900 + p->tm_year), (1 + p->tm_mon), p->tm_mday, p->tm_hour, p->tm_hour, p->tm_sec);
+
+    return result;
+}
+
+void trim(char *s)
+{
+    int i = 0, j, k, l = 0;
+
+    while ((s[i] == ' ') || (s[i] == '\t') || (s[i] == '\n')) {
+        i++;
+    }
+
+    j = strlen(s) - 1;
+    while ((s[j] == ' ') || (s[j] == '\t') || (s[j] == '\n')) {
+        j--;
+    }
+
+    if (i == 0 && j == strlen(s) - 1) { }
+    else if (i == 0) { s[j + 1] = '\0'; }
+    else {
+        for (k = i; k <= j; k++) { s[l++] = s[k]; }
+        s[l] = '\0';
+    }
+}
+
+int mystrcmp(char *p1, char *p2)
+{
+    while (*p1 == *p2) {
+        if (*p1 == '\0' || *p2 == '\0') {
+            break;
+        }
+        p1++;
+        p2++;
+    }
+    if (*p1 == '\0' && *p2 == '\0') {
+        return (PASS);
+    } else {
+        return (FAIL);
+    }
+}
+
+void substr(char *dest, const char *src, unsigned int start, unsigned int cnt)
+{
+    strncpy(dest, src + start, cnt);
+    dest[cnt] = 0;
+}
+
+void split(char **arr, char *str, const char *del)
+{
+    char *s = strtok(str, del);
+
+    while (s != NULL) {
+        *arr++ = s;
+        s = strtok(NULL, del);
+    }
+}
+
+//==========================================
+// Init all share memory
+//==========================================
+int InitShareMemory()
+{
+    int result = PASS;
+    int MeterSMId;
+
+    //creat ShmSysConfigAndInfo
+    if ((MeterSMId = shmget(ShmSysConfigAndInfoKey, sizeof(struct SysConfigAndInfo),  0777)) < 0) {
+        result = FAIL;
+    } else if ((ShmSysConfigAndInfo = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+        result = FAIL;
+    }
+
+    //creat ShmStatusCodeData
+    if ((MeterSMId = shmget(ShmStatusCodeKey, sizeof(struct StatusCodeData),  0777)) < 0) {
+        result = FAIL;
+    } else if ((ShmStatusCodeData = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+        result = FAIL;
+    }
+
+    //creat ShmStatusCodeData
+    if ((MeterSMId = shmget(ShmPrimaryMcuKey, sizeof(struct PrimaryMcuData), 0777)) < 0) {
+        result = FAIL;
+    } else if ((ShmPrimaryMcuData = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+        result = FAIL;
+    }
+
+#if defined METER_ENABLE //DS60-120 add
+    if ((MeterSMId = shmget(ShmCsuMeterKey, sizeof(struct MeterInformation), IPC_CREAT | 0777)) < 0) {
+        result = FAIL;
+    } else if ((ShmCsuMeterData = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+        result = FAIL;
+    }
+#endif //defined METER_ENABLE
+
+    return result;
+}
+
+//================================================
+// Function
+//================================================
+void GetFwAndHwVersion()
+{
+    if (Query_FW_Ver(Uart1Fd, Addr.IoExtend, &ver) == PASS) {
+        //log_info("Primary FW Rev = %s \n", ver.Version_FW);
+        strcpy((char *)ShmPrimaryMcuData->version, ver.Version_FW);
+        strcpy((char *) ShmSysConfigAndInfo->SysInfo.CsuPrimFwRev, ver.Version_FW);
+    }
+
+    //if (Query_HW_Ver(Uart1Fd, Addr.IoExtend, &ver) == PASS)
+    //    ;//log_info("Primary HW Rev  = %s \n", ver.Version_HW);
+}
+
+void GetInputGpioStatus()
+{
+    uint8_t dispenserSwTmp = 0;
+    static uint8_t dispenserSw = 0;
+
+    //log_info("GetInputGpioStatus \n");
+    if (Query_Gpio_Input(Uart1Fd, Addr.IoExtend, &gpio_in) == PASS) {
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
+        //DS60-120 add
+        if (_curDeviceStatus[_PRIMARY_CHECK_TAG_AC_CONTACT] != gpio_in.AC_Connector) {
+            if (_reCheckCount[_PRIMARY_CHECK_TAG_AC_CONTACT] >= 3) {
+                _curDeviceStatus[_PRIMARY_CHECK_TAG_AC_CONTACT] = gpio_in.AC_Connector;
+                ShmSysConfigAndInfo->SysInfo.AcContactorStatus =
+                    ShmPrimaryMcuData->InputDet.bits.AcContactorDetec =
+                        gpio_in.AC_Connector;
+            } else {
+                _reCheckCount[_PRIMARY_CHECK_TAG_AC_CONTACT]++;
+            }
+        } else {
+            _reCheckCount[_PRIMARY_CHECK_TAG_AC_CONTACT] = 0;
+        }
+
+        if (_curDeviceStatus[_PRIMARY_CHECK_TAG_MAIN_BREAKER] != gpio_in.AC_MainBreaker) {
+            if (_reCheckCount[_PRIMARY_CHECK_TAG_MAIN_BREAKER] >= 3) {
+                _curDeviceStatus[_PRIMARY_CHECK_TAG_MAIN_BREAKER] = gpio_in.AC_MainBreaker;
+                ShmPrimaryMcuData->InputDet.bits.AcMainBreakerDetec = gpio_in.AC_MainBreaker;
+            } else {
+                _reCheckCount[_PRIMARY_CHECK_TAG_MAIN_BREAKER]++;
+            }
+        } else {
+            _reCheckCount[_PRIMARY_CHECK_TAG_MAIN_BREAKER] = 0;
+        }
+        //ShmSysConfigAndInfo->SysInfo.AcContactorStatus = ShmPrimaryMcuData->InputDet.bits.AcContactorDetec = gpio_in.AC_Connector;
+        //ShmPrimaryMcuData->InputDet.bits.AcMainBreakerDetec = gpio_in.AC_MainBreaker;
+#else
+        if ((strncmp((char *)&ShmSysConfigAndInfo->SysConfig.ModelName[7], "V", 1) == 0) ||
+                (strncmp((char *)&ShmSysConfigAndInfo->SysConfig.ModelName[9], "V", 1) == 0) ||
+                (strncmp((char *)&ShmSysConfigAndInfo->SysConfig.ModelName[7], "F", 1) == 0) ||
+                (strncmp((char *)&ShmSysConfigAndInfo->SysConfig.ModelName[9], "F", 1) == 0)
+
+           ) {
+            ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CcsLiquidChillerWaterLevelWarning = ~gpio_in.AC_Connector;
+            ShmStatusCodeData->FaultCode.FaultEvents.bits.CcsLiquidChillerWaterLevelFault = ~gpio_in.AC_MainBreaker;
+        } else {
+            ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CcsLiquidChillerWaterLevelWarning = gpio_in.AC_Connector;
+            ShmStatusCodeData->FaultCode.FaultEvents.bits.CcsLiquidChillerWaterLevelFault = gpio_in.AC_MainBreaker;
+        }
+#endif //!defined DD360 && !defined DD360Audi
+
+        ShmPrimaryMcuData->InputDet.bits.SpdDetec = gpio_in.SPD;
+#if defined DD360 ||defined DD360Audi || defined DD360ComBox
+
+#if defined DD360ComBox
+        ShmPrimaryMcuData->InputDet.bits.DoorOpen = gpio_in.Door_Open;
+#else
+        ShmPrimaryMcuData->InputDet.bits.DoorOpen = ~gpio_in.Door_Open;
+#endif //
+
+        ShmPrimaryMcuData->InputDet.bits.Key0 = ~gpio_in.Key[0] & 0x01;
+        ShmPrimaryMcuData->InputDet.bits.Key1 = ~gpio_in.Key[1] & 0x01;
+        ShmPrimaryMcuData->InputDet.bits.Key2 = ~gpio_in.Key[2] & 0x01;
+        ShmPrimaryMcuData->InputDet.bits.Key3 = ~gpio_in.Key[3] & 0x01;
+        //ShmPrimaryMcuData->InputDet.bits.EmergencyButton = gpio_in.Emergency_Btn;
+#else
+
+        ShmPrimaryMcuData->InputDet.bits.Key0 = gpio_in.Key[0] & 0x01;
+        ShmPrimaryMcuData->InputDet.bits.Key1 = gpio_in.Key[1] & 0x01;
+        ShmPrimaryMcuData->InputDet.bits.Key2 = gpio_in.Key[2] & 0x01;
+        ShmPrimaryMcuData->InputDet.bits.Key3 = gpio_in.Key[3] & 0x01;
+        //ShmPrimaryMcuData->InputDet.bits.EmergencyButton = ~gpio_in.Emergency_Btn;
+        ShmPrimaryMcuData->InputDet.bits.DoorOpen = gpio_in.Door_Open;
+#endif //defined DD360 ||defined DD360Audi
+
+#if defined DD360ComBox
+        ShmPrimaryMcuData->InputDet.bits.EmergencyButton = ~gpio_in.Emergency_Btn;
+#else
+        ShmPrimaryMcuData->InputDet.bits.EmergencyButton = gpio_in.Emergency_Btn;
+#endif //
+
+        dispenserSwTmp |= (ShmPrimaryMcuData->InputDet.bits.Key0);
+        dispenserSwTmp |= (ShmPrimaryMcuData->InputDet.bits.Key1 << 1);
+        dispenserSwTmp |= (ShmPrimaryMcuData->InputDet.bits.Key2 << 2);
+        dispenserSwTmp |= (ShmPrimaryMcuData->InputDet.bits.Key3 << 3);
+
+        if (dispenserSwTmp != dispenserSw) {
+            dispenserSw = dispenserSwTmp;
+            log_info("Dispenser switch number =  %d, bit = %d, %d, %d, %d\r\n",
+                     dispenserSw,
+                     ShmPrimaryMcuData->InputDet.bits.Key3,
+                     ShmPrimaryMcuData->InputDet.bits.Key2,
+                     ShmPrimaryMcuData->InputDet.bits.Key1,
+                     ShmPrimaryMcuData->InputDet.bits.Key0);
+        }
+
+        ShmPrimaryMcuData->InputDet.bits.Button1 = gpio_in.Button[0];
+        ShmPrimaryMcuData->InputDet.bits.Button2 = gpio_in.Button[1];
+
+        /*printf(" gpio_in.Key[0]~ gpio_in.Key[3]=%d, %d, %d, %d\n",
+        ShmPrimaryMcuData->InputDet.bits.Key0 , ShmPrimaryMcuData->InputDet.bits.Key1,
+        ShmPrimaryMcuData->InputDet.bits.Key2,ShmPrimaryMcuData->InputDet.bits.Key3);
+        printf("ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CcsLiquidChillerWaterLevelWarning=%d\n", ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CcsLiquidChillerWaterLevelWarning);
+        printf("ShmStatusCodeData->FaultCode.FaultEvents.bits.CcsLiquidChillerWaterLevelFault=%d\n", ShmStatusCodeData->FaultCode.FaultEvents.bits.CcsLiquidChillerWaterLevelFault);
+        */
+        //log_info("left = %d \n", ShmPrimaryMcuData->InputDet.bits.Button1);
+        //log_info("right = %d \n", ShmPrimaryMcuData->InputDet.bits.Button2);
+        //log_info("ShmSysConfigAndInfo->SysInfo.AcContactorStatus = %d \n", ShmSysConfigAndInfo->SysInfo.AcContactorStatus);
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
+        if (ShmPrimaryMcuData->InputDet.bits.AcMainBreakerDetec == YES) {
+            log_error("AC Mainbreaker occur. \n");
+        }
+#endif //!defined DD360 && !defined DD360Audi
+    }
+}
+
+#if defined METER_ENABLE //DS60-120 add
+void GetMeterConsumption(byte index)
+{
+    if (Query_Meter_value(Uart1Fd, Addr.IoExtend, &ShmCsuMeterData->_meter[index], &ShmCsuMeterData->isWorking, index) == PASS) {
+        // meter value (Resolution) : 10
+        if (!ShmCsuMeterData->isWorking) {
+            //ShmStatusCodeData->AlarmCode.AlarmEvents.bits.MeterCommTimeout = YES;
+            return;
+        }
+
+        if (ShmCsuMeterData->_meter[index].isCalculation == YES) {
+//          printf("Meter%d, Comsumption = %.1f, curMeterValue = %.1f \n",
+//                  index,
+//                  ShmCsuMeterData->_meter[index].newMeterValue,
+//                  ShmCsuMeterData->_meter[index].curMeterValue);
+
+            if (ShmCsuMeterData->_meter[index].curMeterValue == 0) {
+                ShmCsuMeterData->_meter[index].curMeterValue = ShmCsuMeterData->_meter[index].newMeterValue;
+            } else {
+                // 最大充時，兩個都會累加，但只輸出給一槍使用
+                ShmCsuMeterData->_meter[index]._chargingValue += ShmCsuMeterData->_meter[index].newMeterValue - ShmCsuMeterData->_meter[index].curMeterValue;
+
+                if (ShmSysConfigAndInfo->SysInfo.MainChargingMode == _MAIN_CHARGING_MODE_MAX ||
+                        (ShmSysConfigAndInfo->SysInfo.MainChargingMode == _MAIN_CHARGING_MODE_AVER &&
+                         ShmSysConfigAndInfo->SysInfo.ReAssignedFlag >= _REASSIGNED_RELAY_A_TO_M)) {
+                    for (byte subIndex = 0; subIndex < gun_count; subIndex++) {
+                        if (ChargingData[subIndex]->SystemStatus == S_CHARGING) {
+                            ShmCsuMeterData->_meter[subIndex]._curTotalCharging += ShmCsuMeterData->_meter[index].newMeterValue - ShmCsuMeterData->_meter[index].curMeterValue;
+                            break;
+                        }
+                    }
+                } else {
+                    ShmCsuMeterData->_meter[index]._curTotalCharging += ShmCsuMeterData->_meter[index].newMeterValue - ShmCsuMeterData->_meter[index].curMeterValue;
+                }
+
+                ShmCsuMeterData->_meter[index].curMeterValue = ShmCsuMeterData->_meter[index].newMeterValue;
+            }
+        }
+    }
+}
+#endif //defined METER_ENABLE
+
+static void checkChillerStatus(Gpio_out *gpio)
+{
+    uint8_t gunIndex = 0;
+    uint8_t chillerCount = 0;
+    static ChillerInfo fChillerInfo[2] = {0};
+    Gpio_out *pGpio = (Gpio_out *)gpio;
+
+    if ((strncmp((char *)&ShmSysConfigAndInfo->SysConfig.ModelName[7], "V", 1) == 0) ||
+            (strncmp((char *)&ShmSysConfigAndInfo->SysConfig.ModelName[7], "F", 1) == 0)) {
+        chillerCount++;
+    }
+
+    if ((strncmp((char *)&ShmSysConfigAndInfo->SysConfig.ModelName[9], "V", 1) == 0) ||
+            (strncmp((char *)&ShmSysConfigAndInfo->SysConfig.ModelName[9], "F", 1) == 0)) {
+        chillerCount++;
+    }
+
+    if (chillerCount == 0) {
+        pGpio->AC_Connector = 0x00;
+        return;
+    }
+
+    for (gunIndex = 0; gunIndex < chillerCount; gunIndex++) {
+        if ((ChargingData[gunIndex]->PresentChargingCurrent) >= 150) {
+            fChillerInfo[gunIndex].ChillerSwitch = YES;
+            fChillerInfo[gunIndex].ChillerOnTime = time((time_t *)NULL);
+        } else {
+            if (fChillerInfo[gunIndex].ChillerSwitch == YES) {
+                if ((ChargingData[gunIndex]->PresentChargingCurrent) >= 100) {
+                    fChillerInfo[gunIndex].ChillerSwitch = YES;
+                    fChillerInfo[gunIndex].ChillerOnTime = time((time_t *)NULL);
+                } else {
+                    if ((time((time_t *)NULL) - fChillerInfo[gunIndex].ChillerOnTime) >= 600) {
+                        fChillerInfo[gunIndex].ChillerSwitch = NO;
+                    } else {
+                        fChillerInfo[gunIndex].ChillerSwitch = YES;
+                    }
+                }
+            } else {
+                fChillerInfo[gunIndex].ChillerSwitch = NO;
+            }
+        }
+    }
+
+    pGpio->AC_Connector = fChillerInfo[gunIndex].ChillerSwitch;//Chiller ON/OFF Control, "0: Chiller disable, 1: Chiller enable"
+}
+
+void SetOutputGpio(uint8_t outputValue)
+{
+    Gpio_out gpio;
+    LedConfig *pLedConfig = (LedConfig *)&outputValue;
+
+    if (strcmp((char *)ShmSysConfigAndInfo->SysInfo.LcmHwRev, " ") == 0x00) {
+        if (flash == NO) {
+            flash = YES;
+        } else {
+            flash = NO;
+        }
+    } else {
+        if (flash == NO) {
+            flash = YES;
+        }
+    }
+
+    pLedConfig->LeftButtonLed = flash;
+    pLedConfig->RightButtonLed = flash;
+
+    gpio.Button_LED[0] = pLedConfig->LeftButtonLed;
+    gpio.Button_LED[1] = pLedConfig->RightButtonLed;
+
+    gpio.System_LED[0] = pLedConfig->GreenLED;
+    gpio.System_LED[1] = pLedConfig->YellowLED;
+    gpio.System_LED[2] = pLedConfig->RedLED;
+    gpio.System_LED[3] = 0x00;
+
+    checkChillerStatus(&gpio);
+
+    gpio.AC_Breaker = 0x00;
+
+    Config_Gpio_Output(Uart1Fd, Addr.IoExtend, &gpio);
+}
+
+void SetRtcData()
+{
+    struct timeb csuTime;
+    struct tm *tmCSU;
+
+    ftime(&csuTime);
+    tmCSU = localtime(&csuTime.time);
+//  log_info("Time : %04d-%02d-%02d %02d:%02d:%02d \n", tmCSU->tm_year + 1900,
+//          tmCSU->tm_mon + 1, tmCSU->tm_mday, tmCSU->tm_hour, tmCSU->tm_min,
+//          tmCSU->tm_sec);
+
+    rtc.RtcData[0] = '0' + (tmCSU->tm_year + 1900) / 1000 % 10;
+    rtc.RtcData[1] = '0' + (tmCSU->tm_year + 1900) / 100 % 10;
+    rtc.RtcData[2] = '0' + (tmCSU->tm_year + 1900) / 10 % 10;
+    rtc.RtcData[3] = '0' + (tmCSU->tm_year + 1900) / 1 % 10;
+
+    rtc.RtcData[4] = '0' + (tmCSU->tm_mon + 1) / 10 % 10;
+    rtc.RtcData[5] = '0' + (tmCSU->tm_mon + 1) / 1 % 10;
+
+    rtc.RtcData[6] = '0' + (tmCSU->tm_mday) / 10 % 10;
+    rtc.RtcData[7] = '0' + (tmCSU->tm_mday) / 1 % 10;
+
+    rtc.RtcData[8] = '0' + (tmCSU->tm_hour) / 10 % 10;
+    rtc.RtcData[9] = '0' + (tmCSU->tm_hour) / 1 % 10;
+
+    rtc.RtcData[10] = '0' + (tmCSU->tm_min) / 10 % 10;
+    rtc.RtcData[11] = '0' + (tmCSU->tm_min) / 1 % 10;
+
+    rtc.RtcData[12] = '0' + (tmCSU->tm_sec) / 10 % 10;
+    rtc.RtcData[13] = '0' + (tmCSU->tm_sec) / 1 % 10;
+
+    if (Config_Rtc_Data(Uart1Fd, Addr.IoExtend, &rtc) == PASS) {
+        //log_info("SetRtc sucessfully. \n");
+    } else {
+        //log_info("SetRtc fail. \n");
+    }
+}
+
+void SetModelName()
+{
+    if (Config_Model_Name(Uart1Fd, Addr.IoExtend, ShmSysConfigAndInfo->SysConfig.ModelName) == PASS) {
+    }
+}
+
+//================================================
+// Main process
+//================================================
+int InitComPort()
+{
+    int fd;
+    struct termios tios;
+
+    fd = open(priPortName, O_RDWR);
+    if (fd <= 0) {
+#ifdef SystemLogMessage
+        log_error("open 407 Communication port NG \n");
+#endif
+        return -1;
+    }
+    ioctl (fd, TCGETS, &tios);
+    tios.c_cflag = B115200 | CS8 | CLOCAL | CREAD;
+    tios.c_lflag = 0;
+    tios.c_iflag = 0;
+    tios.c_oflag = 0;
+    tios.c_cc[VMIN] = 0;
+    tios.c_cc[VTIME] = (unsigned char)1;
+    tios.c_lflag = 0;
+    tcflush(fd, TCIFLUSH);
+    ioctl (fd, TCSETS, &tios);
+
+    return fd;
+}
+
+unsigned long GetTimeoutValue(struct timeval _sour_time)
+{
+    struct timeval _end_time;
+    gettimeofday(&_end_time, NULL);
+
+    return 1000000 * (_end_time.tv_sec - _sour_time.tv_sec) + _end_time.tv_usec - _sour_time.tv_usec;
+}
+
+int FindChargingInfoData(byte target, struct ChargingInfoData **chargingData)
+{
+    for (byte index = 0; index < CHAdeMO_QUANTITY; index++) {
+        if (ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].Index == target) {
+            chargingData[target] = &ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index];
+            return 1;
+        }
+    }
+
+    for (byte index = 0; index < CCS_QUANTITY; index++) {
+        if (ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].Index == target) {
+            chargingData[target] = &ShmSysConfigAndInfo->SysInfo.CcsChargingData[index];
+            return 1;
+        }
+    }
+
+    for (byte index = 0; index < GB_QUANTITY; index++) {
+        if (ShmSysConfigAndInfo->SysInfo.GbChargingData[index].Index == target) {
+            chargingData[target] = &ShmSysConfigAndInfo->SysInfo.GbChargingData[index];
+            return 1;
+        }
+    }
+
+    return 0;
+}
+
+void Initialization() //DS60-120 add
+{
+    bool isPass = false;
+    while (!isPass) {
+        isPass = true;
+        for (byte _index = 0; _index < gun_count; _index++) {
+            if (!FindChargingInfoData(_index, &ChargingData[0])) {
+                log_error("EvComm (main) : FindChargingInfoData false \n");
+                isPass = false;
+                break;
+            }
+        }
+        sleep(1);
+    }
+}
+
+int main(void)
+{
+    if (InitShareMemory() == FAIL) {
+        log_error("InitShareMemory NG\r\n");
+        if (ShmStatusCodeData != NULL) {
+            ShmStatusCodeData->AlarmCode.AlarmEvents.bits.FailToCreateShareMemory = 1;
+        }
+        sleep(5);
+        return 0;
+    }
+
+    //DS60-120 remove
+    //for (byte _index = 0; _index < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; _index++) {
+    //    if (!FindChargingInfoData(_index, &ChargingData[0])) {
+    //        log_error("FindChargingInfoData false \n");
+    //        break;
+    //    }
+    //}
+    ChillerSwitch = 0;
+    Uart1Fd = InitComPort();
+    //log_info("407 Port id = %d \n", Uart1Fd);
+
+    if (Uart1Fd < 0) {
+#ifdef SystemLogMessage
+        log_error("InitComPort (Uart1 : AM3352 - STM32) NG");
+#endif
+        if (ShmStatusCodeData != NULL) {
+            ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CsuInitFailed = 1;
+        }
+        sleep(5);
+        return 0;
+    }
+
+    SetRtcData();
+    SetModelName();//DS60-120 add
+    gettimeofday(&_flash_time, NULL);
+    //DS60-120 add
+    gun_count = ShmSysConfigAndInfo->SysConfig.TotalConnectorCount;
+    Initialization();
+    byte _count = 0;
+
+    for (;;) {
+        // 程序開始之前~ 必須先確定 FW 版本與硬體版本，確認後!!~ 該模組才算是真正的 Initial Comp.
+        // 模組更新 FW 後，需重新做
+        if (ShmPrimaryMcuData->SelfTest_Comp != PASS) {
+            //log_info("(407) Get Fw and Hw Ver. \n");
+            GetFwAndHwVersion();
+            sleep(1);
+            ShmPrimaryMcuData->SelfTest_Comp = PASS;
+        } else {
+            SetOutputGpio(ShmPrimaryMcuData->OutputDrv.OutputDrvValue[0]);
+
+            GetInputGpioStatus();
+
+#if defined METER_ENABLE //DS60-120 add
+            if (ShmSysConfigAndInfo->SysConfig.ModelName[3] == 'M' ||
+                    ShmSysConfigAndInfo->SysConfig.ModelName[3] == 'L') {
+                GetMeterConsumption(_count);
+                _count++;
+                if (_count >= gun_count) {
+                    _count = 0;
+                }
+            }
+#endif //defined METER_ENABLE
+        }
+
+        usleep(50000);
+    }
+
+    return FAIL;
+}

EVSE/Projects/DD360ComBox/Apps/ReadCmdline.c

@@ -0,0 +1,1109 @@
+/*
+ * Main.c
+ *
+ *  Created on: 2019年8月6日
+ *      Author: 7564
+ */
+
+
+#include    <sys/time.h>
+#include    <sys/timeb.h>
+#include    <sys/types.h>
+#include    <sys/stat.h>
+#include    <sys/types.h>
+#include    <sys/ioctl.h>
+#include    <sys/socket.h>
+#include    <sys/ipc.h>
+#include    <sys/shm.h>
+#include    <sys/shm.h>
+#include    <sys/mman.h>
+#include    <linux/wireless.h>
+#include    <arpa/inet.h>
+#include    <netinet/in.h>
+
+#include    <unistd.h>
+#include    <stdarg.h>
+#include    <stdio.h>      /*標準輸入輸出定義*/
+#include    <stdlib.h>     /*標準函數庫定義*/
+#include    <unistd.h>     /*Unix 標準函數定義*/
+#include    <fcntl.h>      /*檔控制定義*/
+#include    <termios.h>    /*PPSIX 終端控制定義*/
+#include    <errno.h>      /*錯誤號定義*/
+#include    <errno.h>
+#include    <string.h>
+#include    <time.h>
+#include    <ctype.h>
+#include    <ifaddrs.h>
+#include    <math.h>
+#include    <stdbool.h>
+#include    "../../define.h"
+
+typedef unsigned char           byte;
+#define PASS                1
+#define FAIL                -1
+#define EQUAL               0
+#define ARRAY_SIZE(A)       (sizeof(A) / sizeof(A[0]))
+#define NO_DEFINE           255
+#define DEFAULT_AC_INDEX    2
+
+#define AUTORUN_STEP1_TIME_START            140             // Minutes
+#define AUTORUN_STEP1_TIME_END              150
+#define AUTORUN_STEP2_TIME_START            210
+#define AUTORUN_STEP2_TIME_END              410
+#define AUTORUN_END_TIME                    480
+#define AUTORUN_CYCLE_COUNT                 30
+
+#define TTY_PATH            "/dev/tty"
+#define STTY_US             "stty raw -echo -F "
+#define STTY_DEF            "stty -raw echo -F "
+
+byte _curAutoRunCount = 0;
+byte _usingAutoRun = 0;
+struct timeval _autoTime;
+
+struct SysConfigAndInfo         *ShmSysConfigAndInfo;
+struct StatusCodeData           *ShmStatusCodeData;
+struct PrimaryMcuData           *ShmPrimaryMcuData;
+struct CHAdeMOData              *ShmCHAdeMOData;
+struct CcsData                  *ShmCcsData;
+struct GBTData                  *ShmGBTData;
+struct FanModuleData            *ShmFanModuleData;
+struct RelayModuleData          *ShmRelayModuleData;
+struct LedModuleData            *ShmLedModuleData;
+struct PsuData                  *ShmPsuData;
+struct OCPP16Data               *ShmOCPP16Data;
+
+struct ChargingInfoData         *_chargingData[CHAdeMO_QUANTITY + CCS_QUANTITY + GB_QUANTITY];
+struct ChargingInfoData         *ac_chargingInfo[AC_QUANTITY];
+
+char *msg = "state : get gun state (index) \n"
+            "card : scanning card (x) : \n"
+            "gun : get gun plugit state (index) \n"
+            "lock : get gun locked state (index) \n"
+            "self : self test state (x) \n"
+            "ver : ver of board (407 or index or rb or fan) \n"
+            "ac : get ac relay state (x) \n";
+
+bool FindChargingInfoData(byte target, struct ChargingInfoData **chargingData)
+{
+    for (byte index = 0; index < CHAdeMO_QUANTITY; index++) {
+        if (ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].Index == target) {
+            chargingData[target] = &ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index];
+            return true;
+        }
+    }
+
+    for (byte index = 0; index < CCS_QUANTITY; index++) {
+        if (ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].Index == target) {
+            chargingData[target] = &ShmSysConfigAndInfo->SysInfo.CcsChargingData[index];
+            return true;
+        }
+    }
+
+    for (byte index = 0; index < GB_QUANTITY; index++) {
+        if (ShmSysConfigAndInfo->SysInfo.GbChargingData[index].Index == target) {
+            chargingData[target] = &ShmSysConfigAndInfo->SysInfo.GbChargingData[index];
+            return true;
+        }
+    }
+
+    return false;
+}
+
+bool FindAcChargingInfoData(byte target, struct ChargingInfoData **acChargingData)
+{
+    if (target < AC_QUANTITY) {
+        acChargingData[target] = &ShmSysConfigAndInfo->SysInfo.AcChargingData[target];
+        return true;
+    }
+
+    return false;
+}
+
+int InitShareMemory()
+{
+    int result = PASS;
+    int MeterSMId;
+
+    //initial ShmSysConfigAndInfo
+    if ((MeterSMId = shmget(ShmSysConfigAndInfoKey, sizeof(struct SysConfigAndInfo),  0777)) < 0) {
+        result = FAIL;
+    } else if ((ShmSysConfigAndInfo = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+        result = FAIL;
+    } else
+    {}
+
+    //initial ShmStatusCodeData
+    if ((MeterSMId = shmget(ShmStatusCodeKey, sizeof(struct StatusCodeData),  0777)) < 0) {
+        result = FAIL;
+    } else if ((ShmStatusCodeData = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+        result = FAIL;
+    } else
+    {}
+
+    if (CHAdeMO_QUANTITY > 0) {
+        if ((MeterSMId = shmget(ShmCHAdeMOCommKey, sizeof(struct CHAdeMOData),
+                                IPC_CREAT | 0777)) < 0) {
+            result = FAIL;
+        } else if ((ShmCHAdeMOData = shmat(MeterSMId, NULL, 0))
+                   == (void *) - 1) {
+            result = FAIL;
+        } else {
+        }
+    }
+
+    if (CCS_QUANTITY > 0) {
+        if ((MeterSMId = shmget(ShmCcsCommKey, sizeof(struct CcsData),
+                                IPC_CREAT | 0777)) < 0) {
+            result = FAIL;
+        } else if ((ShmCcsData = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+            result = FAIL;
+        } else {
+        }
+    }
+
+    if (GB_QUANTITY > 0) {
+        if ((MeterSMId = shmget(ShmGBTCommKey, sizeof(struct GBTData),
+                                IPC_CREAT | 0777)) < 0) {
+            return 0;
+        } else if ((ShmGBTData = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+            return 0;
+        }
+        memset(ShmGBTData, 0, sizeof(struct GBTData));
+    }
+
+    if ((MeterSMId = shmget(ShmPrimaryMcuKey, sizeof(struct PrimaryMcuData), IPC_CREAT | 0777)) < 0) {
+        result = FAIL;
+    } else if ((ShmPrimaryMcuData = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+        result = FAIL;
+    }
+
+    if ((MeterSMId = shmget(ShmFanBdKey, sizeof(struct FanModuleData),  IPC_CREAT | 0777)) < 0) {
+        result = FAIL;
+    } else if ((ShmFanModuleData = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+        result = FAIL;
+    }
+
+    if ((MeterSMId = shmget(ShmRelayBdKey, sizeof(struct RelayModuleData),  IPC_CREAT | 0777)) < 0) {
+        result = FAIL;
+    } else if ((ShmRelayModuleData = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+        result = FAIL;
+    }
+
+    if ((MeterSMId = shmget(ShmLedBdKey, sizeof(struct LedModuleData),  0777)) < 0) {
+        result = FAIL;
+    } else if ((ShmLedModuleData = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+        result = FAIL;
+    }
+
+    if ((MeterSMId = shmget(ShmPsuKey, sizeof(struct PsuData),  IPC_CREAT | 0777)) < 0) {
+        result = FAIL;
+    } else if ((ShmPsuData = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+        result = FAIL;
+    }
+
+    //creat ShmOCPP16Data
+    if ((MeterSMId = shmget(ShmOcppModuleKey, sizeof(struct OCPP16Data), IPC_CREAT | 0777)) < 0) {
+        return FAIL;
+    } else if ((ShmOCPP16Data = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+        return FAIL;
+    }
+
+    return result;
+}
+
+unsigned long GetTimeoutValue(struct timeval _sour_time)
+{
+    struct timeval _end_time;
+    gettimeofday(&_end_time, NULL);
+
+    return (_end_time.tv_sec - _sour_time.tv_sec);
+}
+
+void RunStatusProc(char *v1, char *v2)
+{
+    printf("OrderCharging = %d \n", ShmSysConfigAndInfo->SysInfo.OrderCharging);
+    printf("WaitForPlugit = %d \n", ShmSysConfigAndInfo->SysInfo.WaitForPlugit);
+    if (strcmp(v1, "ac") == 0) {
+        if (!FindAcChargingInfoData(0, &ac_chargingInfo[0])) {
+            printf("FindChargingInfoData (AC) false \n");
+        }
+        printf("AC Status = %d \n", ac_chargingInfo[0]->ConnectorPlugIn);
+        return;
+    }
+
+    int _index = atoi(v1);
+    if (_index <= 1) {
+        if (!FindChargingInfoData(_index, &_chargingData[0])) {
+            printf ("FindChargingInfoData error\n");
+            return;
+        }
+
+        if (strcmp(v2, "-1") == 0 || strcmp(v2, "") == 0) {
+            // get
+            printf ("index = %x, status = %x (%d)\n", _index, _chargingData[_index]->SystemStatus, _chargingData[_index]->IsAvailable);
+            printf ("SystemTimeoutFlag = %d, PageIndex = %d\n",
+                    ShmSysConfigAndInfo->SysInfo.SystemTimeoutFlag, ShmSysConfigAndInfo->SysInfo.PageIndex);
+        } else {
+            // set
+            _chargingData[_index]->SystemStatus = atoi(v2);
+        }
+    } else {
+        if (!FindAcChargingInfoData(0, &ac_chargingInfo[0])) {
+            printf("FindChargingInfoData (AC) false \n");
+        }
+
+        if (strcmp(v2, "-1") == 0 || strcmp(v2, "") == 0) {
+            // get
+            printf ("AC Type, status = %x (%d)\n", ac_chargingInfo[0]->SystemStatus, ac_chargingInfo[0]->IsAvailable);
+        } else {
+            // set
+            ac_chargingInfo[0]->SystemStatus = atoi(v2);
+        }
+    }
+}
+
+void RunCardProc(char *v1, char *v2)
+{
+    if (strcmp(v1, "-1") == 0 || strcmp(v1, "") == 0) {
+        if (ShmSysConfigAndInfo->SysInfo.WaitForPlugit) {
+            ShmSysConfigAndInfo->SysInfo.WaitForPlugit = 0x00;
+            printf ("SysInfo.WaitForPlugit = %x \n", ShmSysConfigAndInfo->SysInfo.WaitForPlugit);
+        } else {
+            ShmSysConfigAndInfo->SysInfo.WaitForPlugit = 0x01;
+            printf ("SysInfo.WaitForPlugit = %x \n", ShmSysConfigAndInfo->SysInfo.WaitForPlugit);
+        }
+    } else {
+        strcpy((char *)ShmSysConfigAndInfo->SysConfig.UserId, "");
+        memcpy((char *)ShmSysConfigAndInfo->SysConfig.UserId, v1, strlen(v1));
+        ShmSysConfigAndInfo->SysConfig.UserId[strlen(v1)] = '\0';
+        printf("StartUserId = %s \n", ShmSysConfigAndInfo->SysConfig.UserId);
+    }
+}
+
+void RunGunPlugitProc(char *v1, char *v2)
+{
+    if (strcmp(v1, "ac") == 0) {
+        if (!FindAcChargingInfoData(0, &ac_chargingInfo[0])) {
+            printf("FindChargingInfoData (AC) false \n");
+        }
+
+        if (strcmp(v2, "-1") == 0 || strcmp(v2, "") == 0) {
+            // get
+            printf("ConnectorPlugIn = %d \n", ac_chargingInfo[0]->ConnectorPlugIn);
+        } else {
+            // set
+            ac_chargingInfo[0]->ConnectorPlugIn = atoi(v2);
+        }
+        return;
+    }
+
+    int _index = atoi(v1);
+    if (!FindChargingInfoData(_index, &_chargingData[0])) {
+        printf("FindChargingInfoData error\n");
+        return;
+    }
+
+    if (strcmp(v2, "-1") == 0 || strcmp(v2, "") == 0) {
+        // get
+        printf("index = %x, plug it = %x\n", _index, _chargingData[_index]->ConnectorPlugIn);
+    } else {
+        // set
+        _chargingData[_index]->ConnectorPlugIn = atoi(v2);
+    }
+}
+
+void GetGunLockStatusProc(char *v1, char *v2)
+{
+    int _index = atoi(v1);
+    if (!FindChargingInfoData(_index, &_chargingData[0])) {
+        printf("FindChargingInfoData error\n");
+        return;
+    }
+    if (strcmp(v2, "-1") != 0 && strcmp(v2, "") != 0) {
+        _chargingData[_index]->GunLocked = atoi(v2);
+    }
+
+    printf("Gun Locked Status = %d \n", _chargingData[_index]->GunLocked);
+}
+
+void SetSystemIDProc()
+{
+    char *systemId = "Alston_Test";
+    memcpy(&ShmSysConfigAndInfo->SysConfig.SystemId, systemId, strlen(systemId));
+}
+
+void RunSelfProc()
+{
+    printf("self test status = %x\n", ShmSysConfigAndInfo->SysInfo.SelfTestSeq);
+}
+
+void GetFwVerProc(char *v1)
+{
+    if (strcmp(v1, "407") == 0) {
+        printf("407 FW Version = %s \n", ShmPrimaryMcuData->version);
+    } else if (strcmp(v1, "0") == 0 || strcmp(v1, "1") == 0) {
+        int _index = atoi(v1);
+
+        if (_index == 0) {
+            printf("Gun 0 FW Version = %s \n", ShmSysConfigAndInfo->SysInfo.Connector1FwRev);
+        } else if (_index == 1) {
+            printf("Gun 1 FW Version = %s \n", ShmSysConfigAndInfo->SysInfo.Connector2FwRev);
+        }
+    } else if (strcmp(v1, "rb") == 0) {
+        printf("RB Version = %s \n", ShmSysConfigAndInfo->SysInfo.RelayModuleFwRev);
+    } else if (strcmp(v1, "fan") == 0) {
+        printf("FAN Version = %s \n", ShmSysConfigAndInfo->SysInfo.FanModuleFwRev);
+    } else if (strcmp(v1, "dc") == 0) {
+        printf("DC Main Version = %s \n", ShmSysConfigAndInfo->SysInfo.CsuRootFsFwRev);
+    } else if (strcmp(v1, "led") == 0) {
+        printf("LED Version = %s \n", ShmSysConfigAndInfo->SysInfo.LedModuleFwRev);
+    } else if (strcmp(v1, "ac") == 0) {
+        if (!FindAcChargingInfoData(0, &ac_chargingInfo[0])) {
+            printf("FindChargingInfoData (AC) false \n");
+        }
+        printf("AC Version = %s \n", ac_chargingInfo[0]->version);
+    }
+}
+
+void CreateOneError(char *v1)
+{
+    int value = atoi(v1);
+
+    ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL1InputOVP = value;
+    ShmSysConfigAndInfo->SysConfig.BillingData.isBilling = value;
+}
+
+void GetAuthorizeFlag(char *v1)
+{
+    if (strcmp(v1, "-1") == 0 || strcmp(v1, "") == 0) {
+        printf("AuthorizeFlag = %d \n", ShmSysConfigAndInfo->SysInfo.AuthorizeFlag);
+    } else {
+        ShmSysConfigAndInfo->SysInfo.AuthorizeFlag = atoi(v1);
+    }
+}
+
+void GetRelayStatus(char *v1)
+{
+    int _index = atoi(v1);
+    if (!FindChargingInfoData(_index, &_chargingData[0])) {
+        printf("FindChargingInfoData error\n");
+        return;
+    }
+
+    printf("RelayK1K2Status = %d \n", _chargingData[_index]->RelayK1K2Status);
+    printf("RelayKPK2Status = %d \n", _chargingData[_index]->RelayKPK2Status);
+}
+
+void FwUpdateFlagProc()
+{
+    ShmSysConfigAndInfo->SysInfo.FirmwareUpdate = 0x01;
+}
+
+void CheckAcStatus(char *v1)
+{
+    if (strcmp(v1, "-1") == 0 || strcmp(v1, "") == 0) {
+        printf("AC Status = %d \n", ShmSysConfigAndInfo->SysInfo.AcContactorStatus);
+    }
+}
+
+void SetCableChkStatus(char *v1, char *v2)
+{
+    int _index = atoi(v1);
+    if (!FindChargingInfoData(_index, &_chargingData[0])) {
+        printf ("FindChargingInfoData error\n");
+        return;
+    }
+
+    _chargingData[_index]->GroundFaultStatus = atoi(v2);
+}
+
+void SetChargingInfoCCID(char *v1, char *v2)
+{
+    int _index = atoi(v1);
+    if (!FindChargingInfoData(_index, &_chargingData[0])) {
+        printf ("FindChargingInfoData error\n");
+        return;
+    }
+
+    memcpy(_chargingData[_index]->EVCCID, v2, 8);
+    _chargingData[_index]->EVCCID[8] = '\0';
+}
+
+void SetPowerValue(char *v1, char *v2)
+{
+    int _index = atoi(v1);
+    float _Current = atof(v2);
+    // 盲沖的時候才允許使用~
+    if (_chargingData[_index]->Type != 9) {
+        return;
+    }
+
+    if (!FindChargingInfoData(_index, &_chargingData[0])) {
+        printf ("FindChargingInfoData error\n");
+        return;
+    }
+
+    _chargingData[_index]->EvBatterytargetCurrent = _Current;
+}
+
+void GetSystemInfo()
+{
+    printf ("ModelName = %s \n", ShmSysConfigAndInfo->SysConfig.ModelName);
+    printf ("SerialNumber = %s \n", ShmSysConfigAndInfo->SysConfig.SerialNumber);
+    printf ("InternetConn = %d \n", ShmSysConfigAndInfo->SysInfo.InternetConn);
+
+    printf ("MaxChargingPower = %d, MaxChargingCurrent = %d \n",
+            ShmSysConfigAndInfo->SysConfig.MaxChargingPower,
+            ShmSysConfigAndInfo->SysConfig.MaxChargingCurrent);
+}
+
+void ChangeGunNum()
+{
+    if (ShmSysConfigAndInfo->SysInfo.CurGunSelected + 1 < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount) {
+        ShmSysConfigAndInfo->SysInfo.CurGunSelected += 1;
+        ShmSysConfigAndInfo->SysInfo.CurGunSelectedByAc = NO_DEFINE;
+    } else if (ShmSysConfigAndInfo->SysConfig.AcConnectorCount > 0 &&
+               ShmSysConfigAndInfo->SysInfo.CurGunSelectedByAc == NO_DEFINE) {
+        ShmSysConfigAndInfo->SysInfo.CurGunSelectedByAc = DEFAULT_AC_INDEX;
+    } else {
+        ShmSysConfigAndInfo->SysInfo.CurGunSelected = 0;
+        ShmSysConfigAndInfo->SysInfo.CurGunSelectedByAc = NO_DEFINE;
+    }
+}
+
+void GetGunSelectedNum(char *v1)
+{
+    if (strcmp(v1, "-1") == 0 || strcmp(v1, "") == 0) {
+        if (AC_QUANTITY > 0 &&
+                ShmSysConfigAndInfo->SysInfo.CurGunSelectedByAc != NO_DEFINE) {
+            printf("connector select changed = AC \n");
+        } else {
+            printf("connector selected = %d \n", ShmSysConfigAndInfo->SysInfo.CurGunSelected);
+        }
+    } else {
+        int _index = atoi(v1);
+        if (_index <= 1) {
+            ShmSysConfigAndInfo->SysInfo.CurGunSelected = _index;
+            ShmSysConfigAndInfo->SysInfo.CurGunSelectedByAc = NO_DEFINE;
+            printf("connector select changed = %d \n", _index);
+        } else if (AC_QUANTITY > 0) {
+            ShmSysConfigAndInfo->SysInfo.CurGunSelectedByAc = DEFAULT_AC_INDEX;
+            printf("connector select changed = AC \n");
+        }
+    }
+}
+
+void SetFanSpeed(char *v1)
+{
+    int speed = atoi(v1);
+
+    ShmFanModuleData->TestFanSpeed = speed;
+}
+
+void GetFanSpeed()
+{
+    printf("ShmFanModuleData->PresentFan1Speed = %d \n", ShmFanModuleData->PresentFan1Speed);
+    printf("ShmFanModuleData->PresentFan2Speed = %d \n", ShmFanModuleData->PresentFan2Speed);
+    printf("ShmFanModuleData->PresentFan3Speed = %d \n", ShmFanModuleData->PresentFan3Speed);
+    printf("ShmFanModuleData->PresentFan4Speed = %d \n", ShmFanModuleData->PresentFan4Speed);
+}
+
+void SetDebugMode(char *v1)
+{
+    int mode = atoi(v1);
+
+    ShmSysConfigAndInfo->SysConfig.SwitchDebugFlag = mode;
+}
+
+void SetGFDMode(char *v1)
+{
+    int mode = atoi(v1);
+
+    ShmSysConfigAndInfo->SysConfig.AlwaysGfdFlag = mode;
+}
+
+void GetPsuTemp()
+{
+    for (byte index = 0; index < ShmPsuData->GroupCount; index++) {
+        for (byte count = 0; count < ShmPsuData->PsuGroup[index].GroupPresentPsuQuantity; count++) {
+            printf("PSU Temp = %d \n", ShmPsuData->PsuGroup[index].PsuModule[count].ExletTemp);
+        }
+    }
+}
+
+void GetAcInputVol()
+{
+    printf("L1N_L12 = %f, L2N_L23 = %f, L3N_L31 = %f \n",
+           ShmSysConfigAndInfo->SysInfo.InputVoltageR,
+           ShmSysConfigAndInfo->SysInfo.InputVoltageS,
+           ShmSysConfigAndInfo->SysInfo.InputVoltageT);
+}
+
+void GetPsuInformation(char *v1, char *v2, char *v3)
+{
+    printf("**********************AC Contact needed*************************\n");
+    if (strcmp(v1, "count") == 0) {
+        for (int i = 0; i < 4; i++) {
+            printf("Group Index = %d, Module Count = %d \n", i, ShmPsuData->PsuGroup[i].GroupPresentPsuQuantity);
+        }
+    } else if (strcmp(v1, "ver") == 0) {
+        for (int i = 0; i < ShmPsuData->SystemPresentPsuQuantity; i++) {
+            printf("Psu Index = %d, PriVersion = %s, SecVersion = %s \n",
+                   i, ShmPsuData->PsuVersion[i].FwPrimaryVersion, ShmPsuData->PsuVersion[i].FwSecondVersion);
+        }
+
+        for (int i = 0; i < ShmPsuData->GroupCount; i++) {
+            for (int j = 0; j < ShmPsuData->PsuGroup[i].GroupPresentPsuQuantity; j++) {
+                printf("Group Index = %d, Psu Index = %d, Version = %s \n",
+                       i, j, ShmPsuData->PsuGroup[i].PsuModule[j].FwVersion);
+            }
+        }
+    } else if (strcmp(v1, "cap") == 0) {
+        for (int i = 0; i < ShmPsuData->GroupCount; i++) {
+            printf("Group Index = %d, MaxCur = %d, Power = %d \n",
+                   i, ShmPsuData->PsuGroup[i].GroupAvailableCurrent, ShmPsuData->PsuGroup[i].GroupAvailablePower);
+        }
+    } else if (strcmp(v1, "input") == 0) {
+        for (int i = 0; i < ShmPsuData->GroupCount; i++) {
+            for (byte count = 0; count < ShmPsuData->PsuGroup[i].GroupPresentPsuQuantity; count++) {
+                printf("gp = %d, Index = %d, volR = %d, volS = %d, volT = %d \n",
+                       i, count,
+                       ShmPsuData->PsuGroup[i].PsuModule[count].InputVoltageL1,
+                       ShmPsuData->PsuGroup[i].PsuModule[count].InputVoltageL2,
+                       ShmPsuData->PsuGroup[i].PsuModule[count].InputVoltageL3);
+            }
+        }
+    } else if (strcmp(v1, "output") == 0) {
+        for (int i = 0; i < ShmPsuData->GroupCount; i++) {
+            printf("Group Index = %d, OutputV = %d, OutputC = %d \n",
+                   i, ShmPsuData->PsuGroup[i].GroupPresentOutputVoltage, ShmPsuData->PsuGroup[i].GroupPresentOutputCurrent);
+        }
+
+        for (int i = 0; i < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; i++) {
+            if (!FindChargingInfoData(i, &_chargingData[0])) {
+                printf ("FindChargingInfoData error\n");
+                continue;
+            }
+
+            printf("Form RB : Group Index = %d, OutputV = %f \n",
+                   i, _chargingData[i]->FireChargingVoltage);
+        }
+    } else if (strcmp(v1, "test") == 0) {
+        int mode = atoi(v2);
+
+        if (mode >= _TEST_MODE && mode <= _TEST_MODE) {
+            ShmPsuData->Work_Step = mode;
+        }
+    } else if (strcmp(v1, "out") == 0) {
+        float vol = atof(v2);
+        float cur = atof(v3);
+
+        if (ShmPsuData->Work_Step >= _TEST_MODE && ShmPsuData->Work_Step <= _TEST_MODE) {
+            if (!FindChargingInfoData(0, &_chargingData[0])) {
+                printf ("FindChargingInfoData error\n");
+                return;
+            }
+            _chargingData[0]->EvBatterytargetVoltage = vol;
+            _chargingData[0]->EvBatterytargetCurrent = cur;
+        }
+    }
+    printf("*************************************************\n");
+}
+
+void GetConnectorCapInfo(char *v1)
+{
+    int _GunIndex = atoi(v1);
+
+    if (!FindChargingInfoData(_GunIndex, &_chargingData[0])) {
+        printf ("FindChargingInfoData error\n");
+        return;
+    }
+
+    printf ("Charger Max Current = %d, Max Power = %d \n",
+            ShmSysConfigAndInfo->SysConfig.MaxChargingCurrent * 10,
+            ShmSysConfigAndInfo->SysConfig.MaxChargingPower * 10);
+
+    printf ("Index = %d, MaxPow = %f, MaxVol = %f, MaxCur = %f\n",
+            _GunIndex,
+            _chargingData[_GunIndex]->RealMaxPower,
+            _chargingData[_GunIndex]->RealMaxVoltage,
+            _chargingData[_GunIndex]->RealMaxCurrent);
+}
+
+static void get_char(char *word)
+{
+    fd_set rfds;
+    struct timeval tv;
+
+    FD_ZERO(&rfds);
+    FD_SET(0, &rfds);
+    tv.tv_sec = 0;
+    tv.tv_usec = 10; //wait input timout time
+
+    //if input
+    if (select(1, &rfds, NULL, NULL, &tv) > 0) {
+        fgets(word, 128, stdin);
+    }
+}
+
+void RunUnconditionalChargeIndex1(char *v1, char *v2, char *v3)
+{
+    int _GunIndex;
+    float _Voltage;
+    float _Current;
+
+    if (strcmp(v1, "auto") == EQUAL) {
+        _usingAutoRun = 0x01;
+        _GunIndex = 0;
+        _Voltage = 500;
+        _Current = (ShmSysConfigAndInfo->SysConfig.MaxChargingPower * 1000) / _Voltage;
+    } else {
+        _usingAutoRun = 0x00;
+        _GunIndex = atoi(v1);
+        _Voltage = atof(v2);
+        _Current = atof(v3);
+    }
+
+    unsigned char PreviousSystemStatus = 0xff;
+    if (!FindChargingInfoData(_GunIndex, &_chargingData[0])) {
+        printf ("FindChargingInfoData error\n");
+        return;
+    }
+
+    printf ("Power = %d, ReqVoltage = %f, ReqCurrent = %f\n",
+            ShmSysConfigAndInfo->SysConfig.MaxChargingPower, _Voltage, _Current);
+
+    if (_Voltage > 1000 || _Voltage < 50) {
+        printf ("Input Voltage over range\n");
+        return;
+    }
+
+//    if(_Current > 100 || _Current < 2){
+//
+//        printf ("Input Current over range\n");
+//        return;
+//    }
+
+    //測試期間先跳過自我測試 _STEST_COMPLETE = 0xfe
+    //ShmSysConfigAndInfo->SysInfo.SelfTestSeq = 0xfe;
+
+    //kill ev task
+    system("killall Module_EvComm");
+
+    //_Voltage = (_Voltage * 10);
+    //_Current = (_Current * 10);
+
+    //system(STTY_US TTY_PATH);
+
+    while (true) {
+        //fix gun 1
+        ShmSysConfigAndInfo->SysInfo.CurGunSelected = _GunIndex;
+
+        switch (_chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->SystemStatus) {
+        case S_IDLE: {
+            if (PreviousSystemStatus != _chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->SystemStatus) {
+                PreviousSystemStatus = _chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->SystemStatus;
+                strcpy((char *)ShmSysConfigAndInfo->SysConfig.UserId, "AutoStartCharging");
+                _chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->ConnectorPlugIn = 1;
+                printf ("[UnconditionalCharge - S_IDLE]\n");
+
+            }
+            if (ShmOCPP16Data->SpMsg.bits.AuthorizeConf == 1) {
+                ShmSysConfigAndInfo->SysInfo.StartToChargingFlag = 0x01;
+                _chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->SystemStatus = S_PREPARNING;
+            }
+        }
+        break;
+
+        case S_PREPARNING: {
+            if (PreviousSystemStatus != _chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->SystemStatus) {
+                PreviousSystemStatus = _chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->SystemStatus;
+
+                printf ("[UnconditionalCharge - S_PREPARNIN]\n");
+
+                //等待 AC Relay 搭上且找到模組 (main 在此 statue 其它 task 會去做完)
+                printf ("wait find module\n");
+
+            }
+            //main 會在此階段判斷以下資料跳到下一個 state
+            //用來得知 AC 是否有搭上 (搭上模組的資訊才會出來) 因為每次  AC_Contactor
+            //ShmPsuData->SystemPresentPsuQuantity;
+            //ShmPsuData->PsuGroup[gun_index].GroupPresentPsuQuantity;
+            //ShmPsuData->PsuGroup[gun_index].GroupAvailablePower;
+            //_chargingData[gun_index]->AvailableChargingPower;
+
+            //等待 AC Relay 搭上且找到模組 (main 在此 statue 其它 task 會去做完)
+            //sleep(10);
+
+            //清除 main timeout 機制
+            _chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->TimeoutFlag = 0;
+            //不論是什麼 type 的槍都固意設成 Chademo 不跑 Prechage step
+            _chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->Type = 9;
+
+        }
+        break;
+
+        case S_PREPARING_FOR_EV: {
+            if (PreviousSystemStatus != _chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->SystemStatus) {
+                PreviousSystemStatus = _chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->SystemStatus;
+
+                printf ("[UnconditionalCharge - S_PREPARING_FOR_EV]\n");
+                printf ("ReqVoltage = %f, ReqCurrent = %f \n", _Voltage * 10, _Current * 10);
+
+            }
+            //清除 main timeout 機制
+            _chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->TimeoutFlag = 0;
+            //不論是什麼 type 的槍都固意設成 Chademo 不跑 Prechage step
+            _chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->Type = 9;
+
+            //充電電壓電流
+            _chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->EvBatterySoc = 50;
+            _chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->EvBatterytargetVoltage = 500;
+            _chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->EvBatterytargetCurrent = 2;
+            _chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->AvailableChargingCurrent = 1000;
+
+            //****** 注意~此行為是防止 K1K2 先開導到無法升壓 ( Relay Board 在此 state 還未搭上 K1K2 )
+            //確定模組己升壓完成
+            //if(_chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->PresentChargingVoltage <=  (3000+500) &&
+            //  _chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->PresentChargingVoltage >=  (3000-500) )
+            {
+                printf ("Precharge Done = %f \n", _chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->PresentChargingVoltage);
+                //EV done
+                _chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->SystemStatus = S_PREPARING_FOR_EVSE;
+            }
+        }
+        break;
+
+        case S_PREPARING_FOR_EVSE: {
+            if (PreviousSystemStatus != _chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->SystemStatus) {
+                PreviousSystemStatus = _chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->SystemStatus;
+
+                printf ("[UnconditionalCharge - S_PREPARING_FOR_EVSE]\n");
+
+            }
+            //printf ("tar vol = %d \n", _Voltage);
+            //printf ("tar cur = %d \n", _Current);
+
+            //清除 main timeout 機制
+            _chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->TimeoutFlag = 0;
+            //不論是什麼 type 的槍都固意設成 Chademo 不跑 Prechage step
+            _chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->Type = 9;
+
+            //充電電壓電流
+            _chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->EvBatterySoc = 50;
+            _chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->EvBatterytargetVoltage = 500;
+            _chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->EvBatterytargetCurrent = 2;
+            _chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->AvailableChargingCurrent = 1000;
+
+            //printf ("tar vol_ = %d \n", _chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->EvBatterytargetVoltage);
+            // printf ("tar cur_ = %d \n", _chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->EvBatterytargetCurrent);
+
+            //****** 注意~此行為是防止 K1K2 先開導到無法升壓 ( Relay Board 在此 state 還未搭上 K1K2 )
+            //確定模組己升壓完成
+            if (_chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->GroundFaultStatus == 0x01 ||
+                    _chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->GroundFaultStatus == 0x03) {
+                printf ("First Ground Fault State (%d)\n", _chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->GroundFaultStatus);
+                printf ("Wait K1K2 = %f \n", _chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->PresentChargingVoltage);
+                sleep(5);
+                //EV done
+                _chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->SystemStatus = S_CHARGING;
+            } else if (_chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->GroundFaultStatus > 0x02) {
+                printf ("First Ground Fault check Fail (%d)\n", _chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->GroundFaultStatus);
+                _chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->SystemStatus = S_TERMINATING;
+            }
+
+        }
+        break;
+
+        case S_CHARGING: {
+            if (PreviousSystemStatus != _chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->SystemStatus) {
+                PreviousSystemStatus = _chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->SystemStatus;
+
+                if (_usingAutoRun == 0x00) {
+                    //充電電壓電流
+                    _chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->EvBatterytargetVoltage = _Voltage;
+                    _chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->EvBatterytargetCurrent = _Current;
+                } else {
+                    _curAutoRunCount = 0;
+                    gettimeofday(&_autoTime, NULL);
+                }
+
+                _chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->EvBatterySoc = 50;
+                _chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->AvailableChargingCurrent = 1000;
+
+                printf ("[UnconditionalCharge - S_CHARGING]\n");
+            }
+
+            if (_usingAutoRun == 0x01) {
+                if (((GetTimeoutValue(_autoTime)) >= AUTORUN_STEP1_TIME_START * 60 && (GetTimeoutValue(_autoTime)) <= AUTORUN_STEP1_TIME_END * 60) ||
+                        ((GetTimeoutValue(_autoTime)) >= AUTORUN_STEP2_TIME_START * 60 && (GetTimeoutValue(_autoTime)) <= AUTORUN_STEP2_TIME_END * 60)) {
+                    _chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->EvBatterytargetVoltage = _Voltage;
+                    _chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->EvBatterytargetCurrent = _Current;
+                } else if ((GetTimeoutValue(_autoTime)) >= AUTORUN_END_TIME * 60) {
+                    _curAutoRunCount++;
+                    if (_curAutoRunCount >= AUTORUN_CYCLE_COUNT) {
+                        _chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->SystemStatus = S_TERMINATING;
+                    } else {
+                        gettimeofday(&_autoTime, NULL);
+                    }
+                } else {
+                    _chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->EvBatterytargetVoltage = 0;
+                    _chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->EvBatterytargetCurrent = 0;
+                }
+            }
+
+//              printf("out : vol = %f, cur = %f \n",
+//                      _chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->EvBatterytargetVoltage,
+//                      _chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->EvBatterytargetCurrent);
+            //ev task do this
+            _chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->PresentChargingPower =
+                ((float)((_chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->PresentChargingVoltage) * (_chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->PresentChargingCurrent)) / 1000);
+
+            if (_chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->GroundFaultStatus == 0x02) {
+                printf ("Charging Ground Fault check Fail (%d)\n", _chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->GroundFaultStatus);
+                _chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->SystemStatus = S_TERMINATING;
+            }
+        }
+        break;
+
+        case S_TERMINATING: {
+            if (PreviousSystemStatus != _chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->SystemStatus) {
+                PreviousSystemStatus = _chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->SystemStatus;
+                system("/root/Module_EvComm &");
+
+                printf ("[UnconditionalCharge - S_TERMINATING]\n");
+                //無阻塞偵測 keybaord 結束
+                system(STTY_DEF TTY_PATH);
+            }
+
+            sleep(3);
+            _chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->SystemStatus = S_COMPLETE;
+            return;
+        }
+        break;
+
+        case S_COMPLETE: {
+            if (PreviousSystemStatus != _chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->SystemStatus) {
+                PreviousSystemStatus = _chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->SystemStatus;
+
+                printf ("[UnconditionalCharge - S_COMPLETE]\n");
+            }
+
+            _chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->PresentChargingPower = 0;
+            sleep(3);
+            return;
+        }
+        break;
+        }
+
+        char word[128];
+        char newString[7][10];
+        int i, j, ctr;
+
+        memset(word, 0x00, sizeof(word));
+        get_char(word);
+
+        if (strlen(word) == 0) {
+            continue;
+        }
+
+        j = 0; ctr = 0;
+        strcpy(newString[1], "-1");
+        strcpy(newString[2], "-1");
+        for (i = 0; i <= (strlen(word)); i++) {
+            if (word[i] == ' ' || word[i] == '\0' || word[i] == 10) {
+                newString[ctr][j] = '\0';
+                ctr++;
+                j = 0;
+            } else {
+                newString[ctr][j] = word[i];
+                j++;
+            }
+        }
+
+        if (strcmp(newString[0], "chg") == 0) {
+            if (strcmp(newString[1], "-1") == 0 || strcmp(newString[1], "") == 0) {
+                continue;
+            }
+            if (strcmp(newString[2], "-1") == 0 || strcmp(newString[2], "") == 0) {
+                continue;
+            }
+
+            float _vol = atof(newString[1]);
+            float _cur = atof(newString[2]);
+
+            if (_cur <= 0 || _cur <= 0) {
+                continue;
+            }
+
+            printf("vol = %f, cur = %f \n", _vol, _cur);
+            _chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->EvBatterytargetVoltage = _vol;
+            _chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->EvBatterytargetCurrent = _cur;
+        } else if (strcmp(newString[0], "c") == 0) {
+            printf("stop \n\r");
+            ShmSysConfigAndInfo->SysInfo.StartToChargingFlag = 0x00;
+            _chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->SystemStatus = S_TERMINATING;
+        }
+
+        usleep(100000);
+    }
+}
+
+int main(void)
+{
+    if (InitShareMemory() == FAIL) {
+        printf ("InitShareMemory = FAIL \n");
+        if (ShmStatusCodeData != NULL) {
+            ShmStatusCodeData->AlarmCode.AlarmEvents.bits.FailToCreateShareMemory = 1;
+        }
+        sleep(5);
+        return 0;
+    }
+
+    for (;;) {
+        char word[128];
+        char newString[7][10];
+        int i, j, ctr;
+
+        fgets(word, sizeof(word), stdin);
+
+        j = 0; ctr = 0;
+        strcpy(newString[1], "-1");
+        strcpy(newString[2], "-1");
+        for (i = 0; i <= (strlen(word)); i++) {
+            if (word[i] == ' ' || word[i] == '\0' || word[i] == 10) {
+                newString[ctr][j] = '\0';
+                ctr++;
+                j = 0;
+            } else {
+                newString[ctr][j] = word[i];
+                j++;
+            }
+        }
+
+        if (strcmp(newString[0], "state") == 0) {
+            if (strcmp(newString[1], "-1") == 0 || strcmp(newString[1], "") == 0) {
+                continue;
+            }
+
+            // 槍狀態
+            RunStatusProc(newString[1], newString[2]);
+        } else if (strcmp(newString[0], "card") == 0) {
+            // 刷卡狀態
+            RunCardProc(newString[1], newString[2]);
+        } else if (strcmp(newString[0], "gun") == 0) {
+            if (strcmp(newString[1], "-1") == 0 || strcmp(newString[1], "") == 0) {
+                continue;
+            }
+
+            // 插槍狀態
+            RunGunPlugitProc(newString[1], newString[2]);
+        } else if (strcmp(newString[0], "lock") == 0) {
+            if (strcmp(newString[1], "-1") == 0 || strcmp(newString[1], "") == 0) {
+                continue;
+            }
+
+            // 插槍狀態
+            GetGunLockStatusProc(newString[1], newString[2]);
+        } else if (strcmp(newString[0], "sysid") == 0) {
+            // 測試 sys id
+            SetSystemIDProc();
+        } else if (strcmp(newString[0], "self") == 0) {
+            // CSU 自我檢測狀態
+            RunSelfProc(newString[1]);
+        } else if (strcmp(newString[0], "ver") == 0) {
+            if (strcmp(newString[1], "-1") == 0 || strcmp(newString[1], "") == 0) {
+                continue;
+            }
+            // 取 FW 版號
+            GetFwVerProc(newString[1]);
+        } else if (strcmp(newString[0], "update") == 0) {
+            // 更新
+            FwUpdateFlagProc(newString[1]);
+        } else if (strcmp(newString[0], "ac") == 0) {
+            // AC contactor 狀態
+            CheckAcStatus(newString[1]);
+        } else if (strcmp(newString[0], "cable") == 0) {
+            if (strcmp(newString[1], "-1") == 0 || strcmp(newString[1], "") == 0) {
+                continue;
+            }
+            // cable check pass
+            SetCableChkStatus(newString[1], newString[2]);
+        } else if (strcmp(newString[0], "pow") == 0) {
+            if (strcmp(newString[1], "-1") == 0 || strcmp(newString[1], "") == 0) {
+                continue;
+            }
+            // cable check pass
+            SetPowerValue(newString[1], newString[2]);
+        } else if (strcmp(newString[0], "model") == 0) {
+            GetSystemInfo();
+        } else if (strcmp(newString[0], "select") == 0) {
+            // 取得 / 設定 當前選的槍號
+            GetGunSelectedNum(newString[1]);
+        } else if (strcmp(newString[0], "change") == 0) {
+            // 模擬按鈕改變選槍
+            ChangeGunNum();
+        } else if (strcmp(newString[0], "fan") == 0) {
+            // 設定風扇速度
+            SetFanSpeed(newString[1]);
+        } else if (strcmp(newString[0], "speed") == 0) {
+            // 取得風扇速度
+            GetFanSpeed();
+        } else if (strcmp(newString[0], "debug") == 0) {
+            // 設定 debug mode
+            SetDebugMode(newString[1]);
+        } else if (strcmp(newString[0], "gfd") == 0) {
+            // 設定盲沖使用 GFD 功能
+            SetGFDMode(newString[1]);
+        } else if (strcmp(newString[0], "temp") == 0) {
+            // 取得 PSU 溫度
+            GetPsuTemp();
+        } else if (strcmp(newString[0], "acin") == 0) {
+            // 取得三向輸入電壓
+            GetAcInputVol();
+        } else if (strcmp(newString[0], "psu") == 0) {
+            //如果連一個參數都沒有 (此命令不理會) 加上判斷第二參數
+            if (strcmp(newString[1], "-1") == 0 || strcmp(newString[1], "") == 0) {
+                printf ("PSU : Param fail..Please retry again......\n");
+                continue;
+            }
+
+            // 取得 PSU 資訊
+            GetPsuInformation(newString[1], newString[2], newString[3]);
+        } else if (strcmp(newString[0], "cap") == 0) {
+            GetConnectorCapInfo(newString[1]);
+        } else if (strcmp(newString[0], "error") == 0) {
+            CreateOneError(newString[1]);
+        } else if (strcmp(newString[0], "auth") == 0) {
+            GetAuthorizeFlag(newString[1]);
+        } else if (strcmp(newString[0], "relay") == 0) {
+            GetRelayStatus(newString[1]);
+        } else if (strcmp(newString[0], "ccid") == 0) {
+            if (strcmp(newString[1], "-1") == 0 || strcmp(newString[1], "") == 0 ||
+                    strcmp(newString[2], "-1") == 0 || strcmp(newString[2], "") == 0) {
+                printf ("Input ccid fail.\n");
+                continue;
+            }
+            SetChargingInfoCCID(newString[1], newString[2]);
+        } else if (strcmp(newString[0], "strchg") == 0) {
+            //如果連一個參數都沒有 (此命令不理會) 加上判斷第二參數
+            if (strcmp(newString[1], "auto") == 0) {
+                newString[2][0] = 0;
+                newString[3][0] = 0;
+            } else if (strcmp(newString[1], "-1") == 0 || strcmp(newString[1], "") == 0 ||
+                       strcmp(newString[2], "-1") == 0 || strcmp(newString[2], "") == 0) {
+                printf ("Input cmd fail ------  strchg [vol 150-1000] [cru 2-100]\n");
+                continue;
+            }
+
+            // 槍狀態
+            RunUnconditionalChargeIndex1(newString[1], newString[2], newString[3]);
+        } else {
+            printf ("%s\n", msg);
+        }
+        usleep(100000);
+    }
+
+    return 0;
+}

EVSE/Projects/DD360ComBox/Apps/init.sh

@@ -0,0 +1,11 @@
+chmod 777 Module_CSU
+chmod 777 Module_PrimaryComm
+chmod 777 Module_LcmControl
+chmod 777 Module_InternalComm
+chmod 777 Module_EventLogging
+chmod 777 Module_EvComm
+chmod 777 Module_PsuComm
+chmod 777 OcppBackend
+chmod 777 kill.sh
+chmod 777 ReadCmdline
+

EVSE/Projects/DD360ComBox/Apps/internalComm.c

@@ -0,0 +1,1203 @@
+/*
+ * internalComm.c
+ *
+ *  Created on: 2019年5月7日
+ *      Author: foluswen
+ */
+#include    <sys/time.h>
+#include    <sys/timeb.h>
+#include    <sys/types.h>
+#include    <sys/stat.h>
+#include    <sys/types.h>
+#include    <sys/ioctl.h>
+#include    <sys/socket.h>
+#include    <sys/ipc.h>
+#include    <sys/shm.h>
+#include    <sys/shm.h>
+#include    <sys/mman.h>
+#include    <linux/wireless.h>
+#include    <arpa/inet.h>
+#include    <netinet/in.h>
+
+#include    <unistd.h>
+#include    <stdarg.h>
+#include    <stdio.h>      /*標準輸入輸出定義*/
+#include    <stdlib.h>     /*標準函數庫定義*/
+#include    <unistd.h>     /*Unix 標準函數定義*/
+#include    <fcntl.h>      /*檔控制定義*/
+#include    <termios.h>    /*PPSIX 終端控制定義*/
+#include    <errno.h>      /*錯誤號定義*/
+#include    <errno.h>
+#include    <string.h>
+#include    <time.h>
+#include    <ctype.h>
+#include    <ifaddrs.h>
+#include    <math.h>
+#include    "internalComm.h"
+
+#define PASS                1
+#define FAIL                -1
+
+#if !defined DD360 && !defined DD360Audi && !defined DD360ComBox
+struct Address Addr = {0x01, 0x02, 0x03, 0x05, 0x06, 0xFF};
+#else
+struct Address Addr = {0x01, 0x02, 0x09, 0x05, 0x06, 0xFF};
+#endif //!defined DD360 || !define DD360Audi
+
+struct Command Cmd = {0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08, 0x09, 0x0a, 0x24, 0x27, 0x28, 0x29, 0x2C, 0x81, 0x83,
+           0x85, 0x86, 0x87, 0x88, 0x089, 0x8A, 0x8B, 0x8C, 0x90, 0x93, 0xe0, 0xe1, 0xe2, 0xe3
+};
+
+int tranceiveRelDelayTime(int fd, unsigned char *cmd, unsigned char cmd_len, unsigned char *rx, unsigned short _delay)
+{
+    int len;
+    //sleep(2); //required to make flush work, for some reason
+    tcflush(fd, TCIOFLUSH);
+
+    if (write(fd, cmd, cmd_len) >= cmd_len) {
+        usleep(_delay * 1000);
+        len = read(fd, rx, 512);
+    } else {
+#ifdef SystemLogMessage
+        DEBUG_ERROR("Serial command %s response fail.\n", cmd);
+#endif
+    }
+
+    return len;
+}
+
+int tranceive(int fd, unsigned char *cmd, unsigned char cmd_len, unsigned char *rx)
+{
+    int len;
+    //sleep(2); //required to make flush work, for some reason
+    tcflush(fd, TCIOFLUSH);
+
+    if (write(fd, cmd, cmd_len) >= cmd_len) {
+        usleep(15000);
+        len = read(fd, rx, 512);
+    } else {
+#ifdef SystemLogMessage
+        DEBUG_ERROR("Serial command %s response fail.\n", cmd);
+#endif
+    }
+
+    return len;
+}
+
+unsigned char Query_FW_Ver(unsigned char fd, unsigned char targetAddr, Ver *Ret_Buf)
+{
+    unsigned char result = FAIL;
+    unsigned char tx[7] = {0xaa, 0x00, targetAddr, Cmd.query_FW_Ver, 0x00, 0x00, 0x00};
+    unsigned char rx[512];
+    unsigned char chksum = 0x00;
+    unsigned char len = tranceive(fd, tx, sizeof(tx), rx);
+
+//      for (int i = 0; i < 7; i++)
+//          printf("tx = %x \n", tx[i]);
+//      for (int i = 0; i < len; i++)
+//          printf("rx = %x \n", rx[i]);
+
+    if (len > 6) {
+        if (len < 6 + (rx[4] | rx[5] << 8)) {
+            return result;
+        }
+
+        for (int idx = 0; idx < (rx[4] | rx[5] << 8); idx++) {
+            chksum ^= rx[6 + idx];
+        }
+
+        if ((chksum == rx[6 + (rx[4] | rx[5] << 8)]) &&
+                (rx[2] == tx[1]) &&
+                (rx[1] == tx[2]) &&
+                (rx[3] == tx[3])) {
+            memcpy(Ret_Buf->Version_FW, (char *)rx + 6, (rx[4] | rx[5] << 8));
+            *(Ret_Buf->Version_FW + 8) = 0x00;
+            result = PASS;
+        }
+    }
+
+    return result;
+}
+
+unsigned char Query_HW_Ver(unsigned char fd, unsigned char targetAddr, Ver *Ret_Buf)
+{
+    unsigned char result = FAIL;
+    unsigned char tx[7] = {0xaa, 0x00, targetAddr, Cmd.query_HW_Ver, 0x00, 0x00, 0x00};
+    unsigned char rx[512];
+    unsigned char chksum = 0x00;
+    unsigned char len = tranceive(fd, tx, sizeof(tx), rx);
+
+    if (len > 6) {
+        if (len < 6 + (rx[4] | rx[5] << 8)) {
+            return result;
+        }
+
+        for (int idx = 0; idx < (rx[4] | rx[5] << 8); idx++) {
+            chksum ^= rx[6 + idx];
+        }
+
+        if ((chksum == rx[6 + (rx[4] | rx[5] << 8)]) &&
+                (rx[2] == tx[1]) &&
+                (rx[1] == tx[2]) &&
+                (rx[3] == tx[3])) {
+            memcpy(Ret_Buf->Version_HW, (char *)rx + 6, (rx[4] | rx[5] << 8));
+            *(Ret_Buf->Version_HW + 8) = 0x00;
+            result = PASS;
+        }
+    }
+
+    return result;
+}
+
+unsigned char Query_Present_InputVoltage(unsigned char fd, unsigned char targetAddr, PresentInputVoltage *Ret_Buf)
+{
+    unsigned char result = FAIL;
+    unsigned char tx[7] = {0xaa, 0x00, targetAddr, Cmd.query_Present_InputVoltage, 0x00, 0x00, 0x00};
+    unsigned char rx[512];
+    unsigned char chksum = 0x00;
+    unsigned char len = tranceive(fd, tx, sizeof(tx), rx);
+
+    if (len > 13) {
+        if (len < 6 + (rx[4] | rx[5] << 8)) {
+            return result;
+        }
+
+        for (int idx = 0; idx < (rx[4] | rx[5] << 8); idx++) {
+            chksum ^= rx[6 + idx];
+        }
+        if ((chksum == rx[6 + (rx[4] | rx[5] << 8)]) &&
+                (rx[2] == tx[1]) &&
+                (rx[1] == tx[2]) &&
+                (rx[3] == tx[3]) &&
+                chksum != 0) {
+            Ret_Buf->inputType = rx[6];
+            Ret_Buf->L1N_L12 = (rx[7] | (rx[8] << 8)) / 10.0;
+            Ret_Buf->L2N_L23 = (rx[9] | (rx[10] << 8)) / 10.0;
+            Ret_Buf->L3N_L31 = (rx[11] | (rx[12] << 8)) / 10.0;
+
+            if (Ret_Buf->L1N_L12 >= 320 ||
+                    Ret_Buf->L2N_L23 >= 320 ||
+                    Ret_Buf->L3N_L31 >= 320) {
+                result = FAIL;
+            } else {
+                result = PASS;
+            }
+        }
+    }
+
+    return result;
+}
+
+unsigned char Query_Present_OutputVoltage(unsigned char fd, unsigned char targetAddr, PresentOutputVoltage *Ret_Buf)
+{
+    unsigned char result = FAIL;
+    unsigned char tx[7] = {0xaa, 0x00, targetAddr, Cmd.query_Present_OutputVoltage, 0x00, 0x00, 0x00};
+    unsigned char rx[512];
+    unsigned char chksum = 0x00;
+    unsigned char len = tranceive(fd, tx, sizeof(tx), rx);
+
+    if (len > 6) {
+        if (len < 6 + (rx[4] | rx[5] << 8)) {
+            return result;
+        }
+
+        for (int idx = 0; idx < (rx[4] | rx[5] << 8); idx++) {
+            chksum ^= rx[6 + idx];
+        }
+
+        if ((chksum == rx[6 + (rx[4] | rx[5] << 8)]) &&
+                (rx[2] == tx[1]) &&
+                (rx[1] == tx[2]) &&
+                (rx[3] == tx[3])) {
+
+            Ret_Buf->behindFuse_Voltage_C1 = (rx[6] | (rx[7] << 8));
+            Ret_Buf->behindRelay_Voltage_C1 = (rx[8] | (rx[9] << 8));
+            if ((rx[4] | rx[5] << 8) > 4) {
+                Ret_Buf->behindFuse_Voltage_C2 = (rx[10] | (rx[11] << 8));
+                Ret_Buf->behindRelay_Voltage_C2 = (rx[12] | (rx[13] << 8));
+            }
+            result = PASS;
+        }
+    }
+
+    return result;
+}
+
+unsigned char Query_Fan_Speed(unsigned char fd, unsigned char targetAddr, FanSpeed *Ret_Buf)
+{
+    unsigned char result = FAIL;
+    unsigned char tx[7] = {0xaa, 0x00, targetAddr, Cmd.query_Fan_Speed, 0x00, 0x00, 0x00};
+    unsigned char rx[512];
+    unsigned char chksum = 0x00;
+    unsigned char len = tranceive(fd, tx, sizeof(tx), rx);
+
+    if (len > 6) {
+        if (len < 6 + (rx[4] | rx[5] << 8)) {
+            return result;
+        }
+
+        for (int idx = 0; idx < (rx[4] | rx[5] << 8); idx++) {
+            chksum ^= rx[6 + idx];
+        }
+
+        if ((chksum == rx[6 + (rx[4] | rx[5] << 8)]) &&
+                (rx[2] == tx[1]) &&
+                (rx[1] == tx[2]) &&
+                (rx[3] == tx[3])) {
+            for (int idx = 0; idx < 4; idx++) {
+                Ret_Buf->speed[idx] = (rx[6 + (2 * idx)] | (rx[6 + (2 * idx) + 1] << 8));
+            }
+
+            result = PASS;
+        }
+    }
+
+    return result;
+}
+
+unsigned char Query_Temperature(unsigned char fd, unsigned char targetAddr, Temperature *Ret_Buf)
+{
+    unsigned char result = FAIL;
+    unsigned char tx[7] = {0xaa, 0x00, targetAddr, Cmd.query_Temperature, 0x00, 0x00, 0x00};
+    unsigned char rx[512];
+    unsigned char chksum = 0x00;
+    unsigned char len = tranceive(fd, tx, sizeof(tx), rx);
+
+    if (len > 6) {
+        if (len < 6 + (rx[4] | rx[5] << 8)) {
+            return result;
+        }
+
+        for (int idx = 0; idx < (rx[4] | rx[5] << 8); idx++) {
+            chksum ^= rx[6 + idx];
+        }
+
+        if ((chksum == rx[6 + (rx[4] | rx[5] << 8)]) &&
+                (rx[2] == tx[1]) &&
+                (rx[1] == tx[2]) &&
+                (rx[3] == tx[3])) {
+            for (int idx = 0; idx < 4; idx++) {
+                Ret_Buf->temperature[idx] = rx[6 + idx] - 60;
+            }
+
+            result = PASS;
+        }
+    }
+
+
+    return result;
+}
+
+unsigned char Query_Aux_PowerVoltage(unsigned char fd, unsigned char targetAddr, AuxPower *Ret_Buf)
+{
+    unsigned char result = FAIL;
+    unsigned char tx[7] = {0xaa, 0x00, targetAddr, Cmd.query_Aux_PowerVoltage, 0x00, 0x00, 0x00};
+    unsigned char rx[512];
+    unsigned char chksum = 0x00;
+    unsigned char len = tranceive(fd, tx, sizeof(tx), rx);
+
+    if (len > 6) {
+        if (len < 6 + (rx[4] | rx[5] << 8)) {
+            return result;
+        }
+
+        for (int idx = 0; idx < (rx[4] | rx[5] << 8); idx++) {
+            chksum ^= rx[6 + idx];
+        }
+
+        if ((chksum == rx[6 + (rx[4] | rx[5] << 8)]) &&
+                (rx[2] == tx[1]) &&
+                (rx[1] == tx[2]) &&
+                (rx[3] == tx[3])) {
+            for (int idx = 0; idx < (rx[4] | rx[5] << 8); idx++) {
+                Ret_Buf->voltage[idx] = rx[6 + idx];
+            }
+
+            result = PASS;
+        }
+    }
+
+    return result;
+}
+
+unsigned char Query_Relay_Output(unsigned char fd, unsigned char targetAddr, Relay *Ret_Buf)
+{
+    unsigned char result = FAIL;
+    unsigned char tx[7] = {0xaa, 0x00, targetAddr, Cmd.query_Relay_Output, 0x00, 0x00, 0x00};
+    unsigned char rx[512];
+    unsigned char chksum = 0x00;
+    unsigned char len = tranceive(fd, tx, sizeof(tx), rx);
+
+//  for (int i = 0; i < 7; i++)
+//      printf("tx = %x \n", tx[i]);
+//  for (int i = 0; i < len; i++)
+//      printf("rx = %x \n", rx[i]);
+
+    if (len > 6) {
+        if (len < 6 + (rx[4] | rx[5] << 8)) {
+            return result;
+        }
+
+        for (int idx = 0; idx < (rx[4] | rx[5] << 8); idx++) {
+            chksum ^= rx[6 + idx];
+        }
+
+        if ((chksum == rx[6 + (rx[4] | rx[5] << 8)]) &&
+                (rx[2] == tx[1]) &&
+                (rx[1] == tx[2]) &&
+                (rx[3] == tx[3])) {
+            Ret_Buf->relay_event.bits.AC_Contactor = (rx[6] >> 0) & 0x01;
+            Ret_Buf->relay_event.bits.CCS_Precharge = (rx[6] >> 1) & 0x01;
+
+            Ret_Buf->relay_event.bits.Gun1_N = (rx[7] >> 0) & 0x01;
+            Ret_Buf->relay_event.bits.Gun1_P = (rx[7] >> 1) & 0x01;
+            Ret_Buf->relay_event.bits.Gun1_Parallel_N = (rx[7] >> 2) & 0x01;
+            Ret_Buf->relay_event.bits.Gun1_Parallel_P = (rx[7] >> 3) & 0x01;
+
+            Ret_Buf->relay_event.bits.Gun2_N = (rx[8] >> 0) & 0x01;
+            Ret_Buf->relay_event.bits.Gun2_P = (rx[8] >> 1) & 0x01;
+            result = PASS;
+        }
+    }
+
+    return result;
+}
+
+unsigned char Query_Gfd_Adc(unsigned char fd, unsigned char targetAddr, Gfd *Ret_Buf)
+{
+    unsigned char result = FAIL;
+    unsigned char tx[7] = {0xaa, 0x00, targetAddr, Cmd.query_Gfd_Adc, 0x00, 0x00, 0x00};
+    unsigned char rx[512];
+    unsigned char chksum = 0x00;
+    unsigned char len = tranceive(fd, tx, sizeof(tx), rx);
+
+//  for(int i = 0; i < 7; i++)
+//      printf ("tx = %d \n", tx[i]);
+    if (len > 6) {
+        if (len < 6 + (rx[4] | rx[5] << 8)) {
+            //printf("Query_Gfd_Adc fail \n");
+            return result;
+        }
+
+//      for(int i = 0; i < len; i++)
+//          printf ("rx = %d \n", rx[i]);
+
+        for (int idx = 0; idx < (rx[4] | rx[5] << 8); idx++) {
+            chksum ^= rx[6 + idx];
+        }
+
+        if ((chksum == rx[6 + (rx[4] | rx[5] << 8)]) &&
+                (rx[2] == tx[1]) &&
+                (rx[1] == tx[2]) &&
+                (rx[3] == tx[3])) {
+            Ret_Buf->Resister_conn1 = (rx[6] | (rx[7] << 8));
+            Ret_Buf->voltage_conn1 = (rx[8] | (rx[9] << 8));
+            Ret_Buf->result_conn1 = rx[10];
+            Ret_Buf->rb_step_1 = rx[11];
+
+            Ret_Buf->Resister_conn2 = (rx[12] | (rx[13] << 8));
+            Ret_Buf->voltage_conn2 = (rx[14] | (rx[15] << 8));
+            Ret_Buf->result_conn2 = rx[16];
+            Ret_Buf->rb_step_2 = rx[17];
+
+            result = PASS;
+        }
+    }
+
+    return result;
+}
+
+unsigned char Query_Gpio_Input(unsigned char fd, unsigned char targetAddr, Gpio_in *Ret_Buf)
+{
+    unsigned char result = FAIL;
+    unsigned char tx[7] = {0xaa, 0x00, targetAddr, Cmd.query_Gpio_In, 0x00, 0x00, 0x00};
+    unsigned char rx[512];
+    unsigned char chksum = 0x00;
+    unsigned char len = tranceive(fd, tx, sizeof(tx), rx);
+
+    if (len > 6) {
+        if (len < 6 + (rx[4] | rx[5] << 8)) {
+            return result;
+        }
+
+        for (int idx = 0; idx < (rx[4] | rx[5] << 8); idx++) {
+            chksum ^= rx[6 + idx];
+        }
+
+        if ((chksum == rx[6 + (rx[4] | rx[5] << 8)]) &&
+                (rx[2] == tx[1]) &&
+                (rx[1] == tx[2]) &&
+                (rx[3] == tx[3])) {
+            Ret_Buf->AC_Connector       = (rx[6] >> 0) & 0x01;
+            Ret_Buf->AC_MainBreaker     = (rx[6] >> 1) & 0x01;
+            Ret_Buf->SPD                = (rx[6] >> 2) & 0x01;
+            Ret_Buf->Door_Open          = ((rx[6] >> 3) & 0x01);
+            Ret_Buf->GFD[0]             = (rx[6] >> 4) & 0x01;
+            Ret_Buf->GFD[1]             = (rx[6] >> 5) & 0x01;
+            Ret_Buf->AC_Drop            = (rx[6] >> 6) & 0x01;
+
+            Ret_Buf->Emergency_IO       = (rx[7] >> 0) & 0x01;
+
+            Ret_Buf->Button_Emergency_Press = (rx[8] >> 0) & 0x01;
+            Ret_Buf->Button_On_Press    = (rx[8] >> 1) & 0x01;
+            Ret_Buf->Button_Off_Press   = (rx[8] >> 2) & 0x01;
+            Ret_Buf->Key_1_Press        = (rx[8] >> 3) & 0x01;
+            Ret_Buf->Key_2_Press        = (rx[8] >> 4) & 0x01;
+            Ret_Buf->Key_3_Press        = (rx[8] >> 5) & 0x01;
+            Ret_Buf->Key_4_Press        = (rx[8] >> 6) & 0x01;
+
+            result = PASS;
+        }
+    }
+
+    return result;
+}
+
+unsigned char Query_Model_Name(unsigned char fd, unsigned char targetAddr, unsigned char *modelname)
+{
+    unsigned char result = FAIL;
+    unsigned char tx[7] = {0xaa, 0x00, targetAddr, Cmd.query_Model_Name, 0x00, 0x00, 0x00};
+    unsigned char rx[512];
+    unsigned char chksum = 0x00;
+    unsigned char len = tranceive(fd, tx, sizeof(tx), rx);
+
+    if (len > 6) {
+        if (len < 6 + (rx[4] | rx[5] << 8)) {
+            return result;
+        }
+
+        for (int idx = 0; idx < (rx[4] | rx[5] << 8); idx++) {
+            chksum ^= rx[6 + idx];
+        }
+
+        if ((chksum == rx[6 + (rx[4] | rx[5] << 8)]) &&
+                (rx[2] == tx[1]) &&
+                (rx[1] == tx[2]) &&
+                (rx[3] == tx[3])) {
+            strncpy((char *)modelname, (char *)(rx + 6), (rx[4] | rx[5] << 8));
+            result = PASS;
+        }
+    }
+
+    return result;
+}
+
+unsigned char Config_Fan_Speed(unsigned char fd, unsigned char targetAddr, FanSpeed *Set_Buf)
+{
+    unsigned char result = FAIL;
+    unsigned char tx[15] = {0xaa, 0x00, targetAddr, Cmd.config_Fan_Speed, 0x08, 0x00, Set_Buf->speed[0] & 0xff, (Set_Buf->speed[0] >> 8) & 0xff, Set_Buf->speed[1] & 0xff, (Set_Buf->speed[1] >> 8) & 0xff, Set_Buf->speed[2] & 0xff, (Set_Buf->speed[2] >> 8) & 0xff, Set_Buf->speed[3] & 0xff, (Set_Buf->speed[3] >> 8) & 0xff, 0x00};
+    unsigned char rx[512];
+    unsigned char chksum = 0x00;
+
+    for (int idx = 0; idx < (tx[4] | tx[5] << 8); idx++) {
+        chksum ^= tx[6 + idx];
+    }
+    tx[14] = chksum;
+
+    unsigned char len = tranceive(fd, tx, sizeof(tx), rx);
+    if (len > 6) {
+        if (len < 6 + (rx[4] | rx[5] << 8)) {
+            return result;
+        }
+
+        chksum = 0x00;
+        for (int idx = 0; idx < (rx[4] | rx[5] << 8); idx++) {
+            chksum ^= rx[6 + idx];
+        }
+
+        if ((chksum == rx[6 + (rx[4] | rx[5] << 8)]) &&
+                (rx[2] == tx[1]) &&
+                (rx[1] == tx[2]) &&
+                (rx[3] == tx[3]) &&
+                rx[6] == PASS) {
+            result = PASS;
+        }
+    }
+
+    return result;
+}
+
+unsigned char Config_Relay_Output(unsigned char fd, unsigned char targetAddr, Relay *Set_Buf)
+{
+    unsigned char result = FAIL;
+    unsigned char tx[10] = {0xaa, 0x00, targetAddr, Cmd.config_Relay_Output, 0x03, 0x00, Set_Buf->relay_event.relay_status[0], Set_Buf->relay_event.relay_status[1], Set_Buf->relay_event.relay_status[2]};
+    unsigned char rx[512];
+    unsigned char chksum = 0x00;
+
+    for (int idx = 0; idx < (tx[4] | tx[5] << 8); idx++) {
+        chksum ^= tx[6 + idx];
+    }
+    tx[9] = chksum;
+
+//  for (int i = 0; i < 10; i++)
+//      printf("set relay cmd : tx = %x \n", tx[i]);
+
+    unsigned char len = tranceive(fd, tx, sizeof(tx), rx);
+
+    if (len > 6) {
+        if (len < 6 + (rx[4] | rx[5] << 8)) {
+            return result;
+        }
+
+//      for (int i = 0; i < len; i++)
+//          printf("set relay cmd : rx = %x \n", rx[i]);
+
+        chksum = 0x00;
+        for (int idx = 0; idx < (rx[4] | rx[5] << 8); idx++) {
+            chksum ^= rx[6 + idx];
+        }
+
+        if ((chksum == rx[6 + (rx[4] | rx[5] << 8)]) &&
+                (rx[2] == tx[1]) &&
+                (rx[1] == tx[2]) &&
+                (rx[3] == tx[3]) &&
+                rx[6] == PASS) {
+            result = PASS;
+        }
+    }
+
+    return result;
+}
+
+unsigned char Config_Gpio_Output(unsigned char fd, unsigned char targetAddr, Gpio_out *Set_Buf)
+{
+    unsigned char result = FAIL;
+    unsigned char tx[9] = {0xaa, 0x00, targetAddr, Cmd.config_Gpio_Output, 0x01, 0x00, 0x00, 0x00};
+    unsigned char rx[512];
+    unsigned char chksum = 0x00;
+
+    tx[6] |= (Set_Buf->AC_Connector ? 0x01 : 0x00);
+
+    for (int idx = 0; idx < 2; idx++) {
+        tx[6] |= (Set_Buf->Button_LED[idx] ? 0x01 : 0x00) << (1 + idx);
+    }
+
+    for (int idx = 0; idx < 4; idx++) {
+        tx[6] |= (Set_Buf->System_LED[idx] ? 0x01 : 0x00) << (3 + idx);
+    }
+
+    for (int idx = 0; idx < (tx[4] | tx[5] << 8); idx++) {
+        chksum ^= tx[6 + idx];
+    }
+    tx[14] = chksum;
+
+    unsigned char len = tranceive(fd, tx, sizeof(tx), rx);
+
+    if (len > 6) {
+        if (len < 6 + (rx[4] | rx[5] << 8)) {
+            return result;
+        }
+
+        chksum = 0x00;
+        for (int idx = 0; idx < (rx[4] | rx[5] << 8); idx++) {
+            chksum ^= rx[6 + idx];
+        }
+
+        if ((chksum == rx[6 + (rx[4] | rx[5] << 8)]) &&
+                (rx[2] == tx[1]) &&
+                (rx[1] == tx[2]) &&
+                (rx[3] == tx[3])) {
+            result = PASS;
+        }
+    }
+
+    return result;
+}
+
+unsigned char Config_Gfd_Value(unsigned char fd, unsigned char targetAddr, Gfd_config *Set_Buf)
+{
+    unsigned char result = FAIL;
+    unsigned char tx[9] = {0xaa, 0x00, targetAddr, Cmd.config_Gfd_Value, 0x02, 0x00, 0x00, 0x00, 0x00};
+    unsigned char rx[512];
+    unsigned char chksum = 0x00;
+
+    tx[6] = Set_Buf->index;
+    tx[7] = Set_Buf->state;
+
+    for (int idx = 0; idx < (tx[4] | tx[5] << 8); idx++) {
+        chksum ^= tx[6 + idx];
+    }
+    tx[8] = chksum;
+
+    unsigned char len = tranceive(fd, tx, sizeof(tx), rx);
+
+    if (len > 6) {
+        if (len < 6 + (rx[4] | rx[5] << 8)) {
+            return result;
+        }
+
+        chksum = 0x00;
+        for (int idx = 0; idx < (rx[4] | rx[5] << 8); idx++) {
+            chksum ^= rx[6 + idx];
+        }
+
+        if ((chksum == rx[6 + (rx[4] | rx[5] << 8)]) &&
+                (rx[2] == tx[1]) &&
+                (rx[1] == tx[2]) &&
+                (rx[3] == tx[3])) {
+            result = PASS;
+        }
+    }
+
+    return result;
+}
+
+unsigned char Config_Model_Name(unsigned char fd, unsigned char targetAddr, unsigned char *modelname)
+{
+    unsigned char result = FAIL;
+    unsigned char tx[21] = {0xaa, 0x00, targetAddr, Cmd.config_Model_Name, 0x0E, 0x00,
+                            0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00
+                           };
+    unsigned char rx[512];
+    unsigned char chksum = 0x00;
+
+    memcpy(tx + 6, modelname, 14);
+
+    for (int idx = 0; idx < (tx[4] | tx[5] << 8); idx++) {
+        chksum ^= tx[6 + idx];
+    }
+    tx[20] = chksum;
+
+//  for(int i = 0; i < 21; i++)
+//              printf ("tx = %x \n", tx[i]);
+    unsigned char len = tranceive(fd, tx, sizeof(tx), rx);
+//  for(int i = 0; i < len; i++)
+//                  printf ("rx = %x \n", rx[i]);
+    if (len > 6) {
+        if (len < 6 + (rx[4] | rx[5] << 8)) {
+            return result;
+        }
+
+        chksum = 0x00;
+        for (int idx = 0; idx < (rx[4] | rx[5] << 8); idx++) {
+            chksum ^= rx[6 + idx];
+        }
+
+        if ((chksum == rx[6 + (rx[4] | rx[5] << 8)]) &&
+                (rx[2] == tx[1]) &&
+                (rx[1] == tx[2]) &&
+                (rx[3] == tx[3]) &&
+                rx[6] == PASS) {
+            result = PASS;
+        }
+    }
+
+    return result;
+}
+
+unsigned char Config_Rtc_Data(unsigned char fd, unsigned char targetAddr, Rtc *Set_Buf)
+{
+    unsigned char result = FAIL;
+    unsigned char tx[21] = { 0xaa, 0x00, targetAddr, Cmd.config_Rtc_Data, 0x0E, 0x00, Set_Buf->RtcData[0], Set_Buf->RtcData[1],
+                             Set_Buf->RtcData[2], Set_Buf->RtcData[3], Set_Buf->RtcData[4], Set_Buf->RtcData[5], Set_Buf->RtcData[6], Set_Buf->RtcData[7],
+                             Set_Buf->RtcData[8], Set_Buf->RtcData[9], Set_Buf->RtcData[10], Set_Buf->RtcData[11], Set_Buf->RtcData[12], Set_Buf->RtcData[13]
+                           };
+    unsigned char rx[512];
+    unsigned char chksum = 0x00;
+
+    for (int idx = 0; idx < (tx[4] | tx[5] << 8); idx++) {
+        chksum ^= tx[6 + idx];
+    }
+    tx[20] = chksum;
+
+    if (tranceive(fd, tx, sizeof(tx), rx) > 0) {
+        chksum = 0x00;
+        for (int idx = 0; idx < (rx[4] | rx[5] << 8); idx++) {
+            chksum ^= rx[6 + idx];
+        }
+
+        if ((chksum == rx[6 + (rx[4] | rx[5] << 8)]) &&
+                (rx[2] == tx[1]) &&
+                (rx[1] == tx[2]) &&
+                (rx[3] == tx[3]) &&
+                rx[6] == PASS) {
+            result = PASS;
+        }
+    }
+
+    return result;
+}
+
+unsigned char Update_Start(unsigned char fd, unsigned char targetAddr, unsigned int crc32)
+{
+    unsigned char result = FAIL;
+    unsigned char tx[11] = {0xaa, 0x00, targetAddr, Cmd.update_Start, 0x04, 0x00, (crc32 >> 0) & 0xff, (crc32 >> 8) & 0xff, (crc32 >> 16) & 0xff, (crc32 >> 24) & 0xff, 0x00};
+    unsigned char rx[512];
+    unsigned char chksum = 0x00;
+
+    for (int idx = 0; idx < (tx[4] | tx[5] << 8); idx++) {
+        chksum ^= tx[6 + idx];
+    }
+    tx[10] = chksum;
+
+    unsigned char len = tranceive(fd, tx, sizeof(tx), rx);
+    if (len > 6) {
+        if (len < 6 + (rx[4] | rx[5] << 8)) {
+            return result;
+        }
+
+        chksum = 0x00;
+        for (int idx = 0; idx < (rx[4] | rx[5] << 8); idx++) {
+            chksum ^= rx[6 + idx];
+        }
+
+        if ((chksum == rx[6 + (rx[4] | rx[5] << 8)]) &&
+                (rx[2] == tx[1]) &&
+                (rx[1] == tx[2]) &&
+                (rx[3] == tx[3]) &&
+                (rx[6] == 0x00)) {
+            result = PASS;
+        }
+    }
+
+    return result;
+}
+
+unsigned char Update_Abord(unsigned char fd, unsigned char targetAddr)
+{
+    unsigned char result = FAIL;
+    unsigned char tx[7] = {0xaa, 0x00, targetAddr, Cmd.update_Start, 0x04, 0x00, 0x00};
+    unsigned char rx[512];
+    unsigned char chksum = 0x00;
+    unsigned char len = tranceive(fd, tx, sizeof(tx), rx);
+
+    if (len > 6) {
+        if (len < 6 + (rx[4] | rx[5] << 8)) {
+            return result;
+        }
+
+        for (int idx = 0; idx < (rx[4] | rx[5] << 8); idx++) {
+            chksum ^= rx[6 + idx];
+        }
+
+        if ((chksum == rx[6 + (rx[4] | rx[5] << 8)]) &&
+                (rx[2] == tx[1]) &&
+                (rx[1] == tx[2]) &&
+                (rx[3] == tx[3]) &&
+                (rx[6] == 0x00)) {
+            result = PASS;
+        }
+    }
+
+    return result;
+}
+
+unsigned char Update_Transfer(unsigned char fd, unsigned char targetAddr, unsigned int startAddr, unsigned char *data, unsigned short int length)
+{
+    unsigned char result = FAIL;
+    unsigned char tx[11 + length];
+    unsigned char rx[512];
+    unsigned char chksum = 0x00;
+
+    tx[0] = 0xaa;
+    tx[1] = 0x00;
+    tx[2] = targetAddr;
+    tx[3] = Cmd.update_Transfer;
+    tx[4] = (4 + length) & 0xff;
+    tx[5] = ((4 + length) >> 8) & 0xff;
+    tx[6] = (startAddr >> 0) & 0xff;
+    tx[7] = (startAddr >> 8) & 0xff;
+    tx[8] = (startAddr >> 16) & 0xff;
+    tx[9] = (startAddr >> 24) & 0xff;
+    memcpy(tx + 10, data, length);
+
+    for (int idx = 0; idx < (tx[4] | tx[5] << 8); idx++) {
+        chksum ^= tx[6 + idx];
+    }
+    tx[sizeof(tx) - 1] = chksum;
+
+    unsigned char len = tranceive(fd, tx, sizeof(tx), rx);
+
+    if (len > 6) {
+        if (len < 6 + (rx[4] | rx[5] << 8)) {
+            return result;
+        }
+
+        for (int idx = 0; idx < (rx[4] | rx[5] << 8); idx++) {
+            chksum ^= rx[6 + idx];
+        }
+
+        if ((chksum == rx[6 + (rx[4] | rx[5] << 8)]) &&
+                (rx[2] == tx[1]) &&
+                (rx[1] == tx[2]) &&
+                (rx[3] == tx[3]) &&
+                (rx[6] == 0x00)) {
+            result = PASS;
+        }
+    }
+
+    return result;
+}
+
+unsigned char Update_Finish(unsigned char fd, unsigned char targetAddr)
+{
+    unsigned char result = FAIL;
+    unsigned char tx[7] = {0xaa, 0x00, targetAddr, Cmd.update_Finish, 0x04, 0x00, 0x00};
+    unsigned char rx[512];
+    unsigned char chksum = 0x00;
+    unsigned char len = tranceive(fd, tx, sizeof(tx), rx);
+
+    if (len > 6) {
+        if (len < 6 + (rx[4] | rx[5] << 8)) {
+            return result;
+        }
+
+        for (int idx = 0; idx < (rx[4] | rx[5] << 8); idx++) {
+            chksum ^= rx[6 + idx];
+        }
+
+        if ((chksum == rx[6 + (rx[4] | rx[5] << 8)]) &&
+                (rx[2] == tx[1]) &&
+                (rx[1] == tx[2]) &&
+                (rx[3] == tx[3]) &&
+                (rx[6] == 0x00)) {
+            result = PASS;
+        }
+    }
+
+    return result;
+}
+
+unsigned char Query_AC_Status(unsigned char fd, unsigned char targetAddr, Ac_Status *Ret_Buf)
+{
+    unsigned char result = FAIL;
+    unsigned char tx[7] = {0xaa, 0x00, targetAddr, Cmd.query_ac_status, 0x00, 0x00, 0x00};
+    unsigned char rx[512];
+    unsigned char chksum = 0x00;
+    unsigned char len = tranceiveRelDelayTime(fd, tx, sizeof(tx), rx, 100);
+
+    if (len > 6) {
+        if (len < 6 + (rx[4] | rx[5] << 8)) {
+            return result;
+        }
+
+        for (int idx = 0; idx < (rx[4] | rx[5] << 8); idx++) {
+            chksum ^= rx[6 + idx];
+        }
+
+        if ((chksum == rx[6 + (rx[4] | rx[5] << 8)]) &&
+                (rx[2] == tx[1]) &&
+                (rx[1] == tx[2]) &&
+                (rx[3] == tx[3])) {
+            Ret_Buf->CpStatus = rx[6];
+            Ret_Buf->CurLimit = (rx[7] | (rx[8] << 8));
+            Ret_Buf->PilotVol_P = (rx[9] | (rx[10] << 8));
+            Ret_Buf->PilotVol_N = (rx[11] | (rx[12] << 8));
+            Ret_Buf->LockStatus = rx[13];
+            Ret_Buf->RelayStatus = rx[14];
+            Ret_Buf->ShutterStatus = rx[15];
+            Ret_Buf->MeterStatus = rx[16];
+            Ret_Buf->PpStatus = rx[17];
+            Ret_Buf->MaxCurrent = rx[18];
+            Ret_Buf->RotateSwitchStatus = rx[19];
+//
+//          Ret_Buf->AC_Connector       = (rx[6] >> 0) & 0x01;
+//          Ret_Buf->AC_MainBreaker     = (rx[6] >> 1) & 0x01;
+//          Ret_Buf->SPD                = (rx[6] >> 2) & 0x01;
+//          Ret_Buf->Door_Open          = (rx[6] >> 3) & 0x01;
+//          Ret_Buf->GFD[0]             = (rx[6] >> 4) & 0x01;
+//          Ret_Buf->GFD[1]             = (rx[6] >> 5) & 0x01;
+//          Ret_Buf->AC_Drop            = (rx[6] >> 6) & 0x01;
+//
+//          Ret_Buf->Emergency_IO       = (rx[7] >> 0) & 0x01;
+//
+//          Ret_Buf->Button_Emergency_Press = (rx[8] >> 0) & 0x01;
+//          Ret_Buf->Button_On_Press    = (rx[8] >> 1) & 0x01;
+//          Ret_Buf->Button_Off_Press   = (rx[8] >> 2) & 0x01;
+//          Ret_Buf->Key_1_Press        = (rx[8] >> 3) & 0x01;
+//          Ret_Buf->Key_2_Press        = (rx[8] >> 4) & 0x01;
+//          Ret_Buf->Key_3_Press        = (rx[8] >> 5) & 0x01;
+//          Ret_Buf->Key_4_Press        = (rx[8] >> 6) & 0x01;
+
+            result = PASS;
+        }
+    }
+
+    return result;
+}
+
+unsigned char Query_AC_Alarm_Code(unsigned char fd, unsigned char targetAddr, Ac_Alarm_code *Ret_Buf)
+{
+    unsigned char result = FAIL;
+    unsigned char tx[7] = {0xaa, 0x00, targetAddr, Cmd.query_ac_alarm_code, 0x00, 0x00};
+    unsigned char rx[512];
+    unsigned char chksum = 0x00;
+    unsigned char len = tranceiveRelDelayTime(fd, tx, sizeof(tx), rx, 100);
+
+    if (len > 6) {
+        if (len < 6 + (rx[4] | rx[5] << 8)) {
+            return result;
+        }
+
+        for (int idx = 0; idx < (rx[4] | rx[5] << 8); idx++) {
+            chksum ^= rx[6 + idx];
+        }
+
+        if ((chksum == rx[6 + (rx[4] | rx[5] << 8)]) &&
+                (rx[2] == tx[1]) &&
+                (rx[1] == tx[2]) &&
+                (rx[3] == tx[3])) {
+            Ret_Buf->AcAlarmCode = rx[6] + (rx[7] << 8) + (rx[8] << 16) + (rx[9] << 24);
+            result = PASS;
+        }
+    }
+
+    return result;
+}
+
+unsigned char Query_Charging_Energy(unsigned char fd, unsigned char targetAddr, Ac_Charging_energy *Ret_Buf)
+{
+    unsigned char result = FAIL;
+    unsigned char tx[7] = {0xaa, 0x00, targetAddr, Cmd.query_ac_output_energy, 0x00, 0x00, 0x00};
+    unsigned char rx[512];
+    unsigned char chksum = 0x00;
+    unsigned char len = tranceiveRelDelayTime(fd, tx, sizeof(tx), rx, 100);
+
+    if (len > 6) {
+        if (len < 6 + (rx[4] | rx[5] << 8)) {
+            return result;
+        }
+
+        for (int idx = 0; idx < (rx[4] | rx[5] << 8); idx++) {
+            chksum ^= rx[6 + idx];
+        }
+
+        if ((chksum == rx[6 + (rx[4] | rx[5] << 8)]) &&
+                (rx[2] == tx[1]) &&
+                (rx[1] == tx[2]) &&
+                (rx[3] == tx[3])) {
+            Ret_Buf->Energy = rx[6] + (rx[7] << 8) + (rx[8] << 16) + (rx[9] << 24);
+            result = PASS;
+        }
+    }
+
+    return result;
+}
+
+unsigned char Query_Charging_Current(unsigned char fd, unsigned char targetAddr, Ac_Charging_current *Ret_Buf)
+{
+    unsigned char result = FAIL;
+    unsigned char tx[7] = {0xaa, 0x00, targetAddr, Cmd.query_ac_output_current, 0x00, 0x00, 0x00};
+    unsigned char rx[512];
+    unsigned char chksum = 0x00;
+    unsigned char len = tranceiveRelDelayTime(fd, tx, sizeof(tx), rx, 100);
+
+    if (len > 6) {
+        if (len < 6 + (rx[4] | rx[5] << 8)) {
+            return result;
+        }
+
+        for (int idx = 0; idx < (rx[4] | rx[5] << 8); idx++) {
+            chksum ^= rx[6 + idx];
+        }
+
+        if ((chksum == rx[6 + (rx[4] | rx[5] << 8)]) &&
+                (rx[2] == tx[1]) &&
+                (rx[1] == tx[2]) &&
+                (rx[3] == tx[3])) {
+            Ret_Buf->OuputCurrentL1 = rx[6] + (rx[7] << 8);
+            Ret_Buf->OuputCurrentL2 = rx[8] + (rx[9] << 8);
+            Ret_Buf->OuputCurrentL3 = rx[10] + (rx[11] << 8);
+            result = PASS;
+        }
+    }
+
+    return result;
+}
+
+unsigned char Config_LED_Status(unsigned char fd, unsigned char targetAddr, Ac_Led_Status *Ret_Buf)
+{
+    unsigned char result = FAIL;
+    unsigned char tx[12] = {0xaa, 0x00, targetAddr, Cmd.config_ac_led_status, 0x05, 0x00, Ret_Buf->ActionMode, (Ret_Buf->AcAlarmCode >> 0) & 0xFF,
+                            (Ret_Buf->AcAlarmCode >> 8) & 0xFF, (Ret_Buf->AcAlarmCode >> 16) & 0xFF, (Ret_Buf->AcAlarmCode >> 24) & 0xFF
+                           };
+    unsigned char rx[512];
+    unsigned char chksum = 0x00;
+
+    for (int idx = 0; idx < (tx[4] | tx[5] << 8); idx++) {
+        chksum ^= tx[6 + idx];
+    }
+    tx[11] = chksum;
+
+    if (tranceiveRelDelayTime(fd, tx, sizeof(tx), rx, 100) > 0) {
+        chksum = 0x00;
+        for (int idx = 0; idx < (rx[4] | rx[5] << 8); idx++) {
+            chksum ^= rx[6 + idx];
+        }
+
+        if ((chksum == rx[6 + (rx[4] | rx[5] << 8)]) &&
+                (rx[2] == tx[1]) &&
+                (rx[1] == tx[2]) &&
+                (rx[3] == tx[3]) &&
+                rx[6] == PASS) {
+            result = PASS;
+        }
+    }
+
+    return result;
+}
+
+unsigned char Config_Legacy_Req(unsigned char fd, unsigned char targetAddr, unsigned char _switch)
+{
+    unsigned char result = FAIL;
+    unsigned char tx[9] = {0xaa, 0x00, targetAddr, Cmd.config_Legacy_Req, 0x02, 0x00, _switch, 0x00};
+    unsigned char rx[512];
+    unsigned char chksum = 0x00;
+
+    for (int idx = 0; idx < (tx[4] | tx[5] << 8); idx++) {
+        chksum ^= tx[6 + idx];
+    }
+    tx[8] = chksum;
+
+    if (tranceiveRelDelayTime(fd, tx, sizeof(tx), rx, 100) > 0) {
+        chksum = 0x00;
+        for (int idx = 0; idx < (rx[4] | rx[5] << 8); idx++) {
+            chksum ^= rx[6 + idx];
+        }
+
+        if ((chksum == rx[6 + (rx[4] | rx[5] << 8)]) &&
+                (rx[2] == tx[1]) &&
+                (rx[1] == tx[2]) &&
+                (rx[3] == tx[3]) &&
+                rx[6] == PASS) {
+            result = PASS;
+        }
+    }
+
+    return result;
+}
+
+unsigned char Config_Ac_Duty(unsigned char fd, unsigned char targetAddr, unsigned char _value)
+{
+    unsigned char result = FAIL;
+    unsigned char tx[8] = {0xaa, 0x00, targetAddr, Cmd.config_ac_duty, 0x01, 0x00, _value};
+    unsigned char rx[512];
+    unsigned char chksum = 0x00;
+
+    for (int idx = 0; idx < (tx[4] | tx[5] << 8); idx++) {
+        chksum ^= tx[6 + idx];
+    }
+    tx[7] = chksum;
+
+    if (tranceiveRelDelayTime(fd, tx, sizeof(tx), rx, 100) > 0) {
+        chksum = 0x00;
+        for (int idx = 0; idx < (rx[4] | rx[5] << 8); idx++) {
+            chksum ^= rx[6 + idx];
+        }
+
+        if ((chksum == rx[6 + (rx[4] | rx[5] << 8)]) &&
+                (rx[2] == tx[1]) &&
+                (rx[1] == tx[2]) &&
+                (rx[3] == tx[3]) &&
+                rx[6] == PASS) {
+            result = PASS;
+        }
+    }
+
+    return result;
+}
+
+unsigned char Config_CSU_Mode(unsigned char fd, unsigned char targetAddr)
+{
+    unsigned char result = FAIL;
+    unsigned char tx[9] = {0xaa, 0x00, targetAddr, Cmd.config_csu_mode, 0x02, 0x00, 0x01, 0x00};
+    unsigned char rx[512];
+    unsigned char chksum = 0x00;
+
+    for (int idx = 0; idx < (tx[4] | tx[5] << 8); idx++) {
+        chksum ^= tx[6 + idx];
+    }
+    tx[7] = chksum;
+
+    if (tranceiveRelDelayTime(fd, tx, sizeof(tx), rx, 100) > 0) {
+        chksum = 0x00;
+        for (int idx = 0; idx < (rx[4] | rx[5] << 8); idx++) {
+            chksum ^= rx[6 + idx];
+        }
+
+        if ((chksum == rx[6 + (rx[4] | rx[5] << 8)]) &&
+                (rx[2] == tx[1]) &&
+                (rx[1] == tx[2]) &&
+                (rx[3] == tx[3]) &&
+                rx[6] == PASS) {
+            result = PASS;
+        }
+    }
+
+    return result;
+}
+
+unsigned char Config_Reset_MCU(unsigned char fd, unsigned char targetAddr)
+{
+    unsigned char result = FAIL;
+    unsigned char tx[9] = {0xaa, 0x00, targetAddr, Cmd.config_reset_mcu, 0x02, 0x00, 0x01, 0x00};
+    unsigned char rx[512];
+    unsigned char chksum = 0x00;
+
+    for (int idx = 0; idx < (tx[4] | tx[5] << 8); idx++) {
+        chksum ^= tx[6 + idx];
+    }
+    tx[7] = chksum;
+
+    if (tranceiveRelDelayTime(fd, tx, sizeof(tx), rx, 100) > 0) {
+        chksum = 0x00;
+        for (int idx = 0; idx < (rx[4] | rx[5] << 8); idx++) {
+            chksum ^= rx[6 + idx];
+        }
+
+        if ((chksum == rx[6 + (rx[4] | rx[5] << 8)]) &&
+                (rx[2] == tx[1]) &&
+                (rx[1] == tx[2]) &&
+                (rx[3] == tx[3]) &&
+                rx[6] == PASS) {
+            result = PASS;
+        }
+    }
+
+    return result;
+}
+
+unsigned char Config_Led_Color(unsigned char fd, unsigned char targetAddr, Led_Color *Ret_Buf)
+{
+    unsigned char result = FAIL;
+    unsigned char tx[13] = {0xaa, 0x00, targetAddr, Cmd.config_led_color, 0x06, 0x00,
+                            Ret_Buf->Connect_1_Red, Ret_Buf->Connect_1_Green, Ret_Buf->Connect_1_Blue,
+                            Ret_Buf->Connect_2_Red, Ret_Buf->Connect_2_Green, Ret_Buf->Connect_2_Blue
+                           };
+    unsigned char rx[512];
+    unsigned char chksum = 0x00;
+
+    for (int idx = 0; idx < (tx[4] | tx[5] << 8); idx++) {
+        chksum ^= tx[6 + idx];
+    }
+    tx[13] = chksum;
+
+//  for(int i = 0; i < 13; i++)
+//          printf ("tx = %x \n", tx[i]);
+
+    unsigned char len = tranceive(fd, tx, sizeof(tx), rx);
+
+//  for(int i = 0; i < len; i++)
+//      printf ("rx = %x \n", rx[i]);
+
+    if (len > 6) {
+        if (len < 6 + (rx[4] | rx[5] << 8)) {
+            return result;
+        }
+
+        for (int idx = 0; idx < (rx[4] | rx[5] << 8); idx++) {
+            chksum ^= rx[6 + idx];
+        }
+
+        if ((chksum == rx[6 + (rx[4] | rx[5] << 8)]) &&
+                (rx[2] == tx[1]) &&
+                (rx[1] == tx[2]) &&
+                (rx[3] == tx[3]) &&
+                (rx[6] == PASS)) {
+            result = PASS;
+        }
+    }
+
+    return result;
+}
+

EVSE/Projects/DD360ComBox/Apps/internalComm.h

@@ -0,0 +1,276 @@
+/*
+ * internalComm.h
+ *
+ *  Created on: 2019¦~5¤ë7¤é
+ *      Author: foluswen
+ */
+
+#ifndef INTERNALCOMM_H_
+#define INTERNALCOMM_H_
+
+extern struct Address
+{
+	unsigned char Aux;
+	unsigned char Fan;
+	unsigned char Relay;
+	unsigned char AcPlug;
+	unsigned char Led;
+	unsigned char Broadcast;
+}Addr;
+
+extern struct Command
+{
+	unsigned char query_FW_Ver; 				//0x01
+	unsigned char query_HW_Ver; 				//0x02
+	unsigned char query_Present_InputVoltage;	//0x03
+	unsigned char query_Present_OutputVoltage;	//0x04
+	unsigned char query_Fan_Speed;				//0x05
+	unsigned char query_Temperature;			//0x06
+	unsigned char query_Aux_PowerVoltage;		//0x07
+	unsigned char query_Relay_Output;			//0x08
+	unsigned char query_Gfd_Adc;				//0x09
+	unsigned char query_Gpio_In;				//0x0a
+
+	unsigned char query_Model_Name;				//0x24
+	unsigned char query_ac_output_current;		//0x27
+	unsigned char query_ac_status;				//0x28
+	unsigned char query_ac_alarm_code;			//0x29
+
+	unsigned char query_ac_output_energy;		//0x2C
+
+	unsigned char config_Fan_Speed;			//0x81
+	unsigned char config_Model_Name;			//0x83
+	unsigned char config_Relay_Output;			//0x85
+	unsigned char config_Gpio_Output;			//0x86
+	unsigned char config_Rtc_Data;				//0x87
+	unsigned char config_ac_led_status;			//0x88
+
+	unsigned char config_ac_duty;			//0x89
+	unsigned char config_Legacy_Req;		//0x8A
+	unsigned char config_Gfd_Value;			//0x8B
+	unsigned char config_reset_mcu;			//0x8C
+
+	unsigned char config_csu_mode;			//0x90
+
+	unsigned char config_led_color;			//0x93
+
+	unsigned char update_Start;				//0xe0
+	unsigned char update_Abort;				//0xe1
+	unsigned char update_Transfer;				//0xe2
+	unsigned char update_Finish;				//0xe3
+
+}Cmd;
+
+typedef struct Verion
+{
+	char Version_FW[9];
+	char Version_HW[9];
+}Ver;
+
+typedef struct PRESENTINPUTVOLTAGE
+{
+	unsigned char inputType;	// 0x00: Line to Line       0x01: Line to Neutral
+	double L1N_L12;
+	double L2N_L23;
+	double L3N_L31;
+}PresentInputVoltage;
+
+typedef struct PRESENTOUTPUTVOLTAGE
+{
+	double behindFuse_Voltage_C1;
+	double behindRelay_Voltage_C1;
+	double behindFuse_Voltage_C2;
+	double behindRelay_Voltage_C2;
+}PresentOutputVoltage;
+
+typedef struct FANSPEED
+{
+	unsigned short int speed[8];
+}FanSpeed;
+
+typedef struct TEMPERATURE
+{
+	unsigned char temperature[8];
+}Temperature;
+
+typedef struct AUXPOWER
+{
+	unsigned char voltage[8];
+}AuxPower;
+
+typedef struct RELAY
+{
+	union
+	{
+		unsigned char relay_status[8];
+		struct
+		{
+			unsigned char AC_Contactor :1;		//bit 0
+			unsigned char CCS_Precharge :1;	//bit 1
+			unsigned char :1;  				//bit 2 reserved
+			unsigned char :1;					//bit 3 reserved
+			unsigned char :1;					//bit 4 reserved
+			unsigned char :1;					//bit 5 reserved
+			unsigned char :1;					//bit 6 reserved
+			unsigned char :1;					//bit 7 reserved
+
+			unsigned char Gun1_N :1;			//bit 0
+			unsigned char Gun1_P :1;			//bit 1
+			unsigned char Gun1_Parallel_N :1;  //bit 2
+			unsigned char Gun1_Parallel_P :1;	//bit 3
+			unsigned char :1;					//bit 4 reserved
+			unsigned char :1;					//bit 5 reserved
+			unsigned char :1;					//bit 6 reserved
+			unsigned char :1;					//bit 7 reserved
+
+			unsigned char Gun2_N :1;			//bit 0
+			unsigned char Gun2_P :1;			//bit 1
+			unsigned char :1; 					//bit 2 reserved
+			unsigned char :1;					//bit 3 reserved
+			unsigned char :1;					//bit 4 reserved
+			unsigned char :1;					//bit 5 reserved
+			unsigned char :1;					//bit 6 reserved
+			unsigned char :1;					//bit 7 reserved
+		}bits;
+	}relay_event;
+}Relay;
+
+typedef struct GFD
+{
+	unsigned short Resister_conn1;
+	unsigned short voltage_conn1;
+	unsigned char result_conn1;
+	unsigned char rb_step_1;
+
+	unsigned short Resister_conn2;
+	unsigned short voltage_conn2;
+	unsigned char result_conn2;
+	unsigned char rb_step_2;
+}Gfd;
+
+typedef struct Gfd_CONFIG
+{
+	unsigned char index;
+	unsigned char state;
+}Gfd_config;
+
+typedef struct GPIO_IN
+{
+	unsigned char AC_Connector;			// bit 0
+	unsigned char AC_MainBreaker;			// bit 1
+	unsigned char SPD;						// bit 2
+	unsigned char Door_Open;				// bit 3
+	unsigned char GFD[2];					// bit 4,5
+	unsigned char AC_Drop;					// bit 6
+
+	unsigned char Emergency_IO;			// bit 0
+
+	unsigned char Button_Emergency_Press;	// bit 0
+	unsigned char Button_On_Press;			// bit 1
+	unsigned char Button_Off_Press;		// bit 2
+	unsigned char Key_1_Press;				// bit 3
+	unsigned char Key_2_Press;				// bit 4
+	unsigned char Key_3_Press;				// bit 5
+	unsigned char Key_4_Press;				// bit 6
+}Gpio_in;
+
+typedef struct GPIO_OUT
+{
+	unsigned char AC_Connector;
+	unsigned char Button_LED[2];
+	unsigned char System_LED[4];
+}Gpio_out;
+
+typedef struct RTC
+{
+	unsigned char RtcData[14];
+}Rtc;
+
+typedef struct LED_Color
+{
+	unsigned char Connect_1_Red;
+	unsigned char Connect_1_Green;
+	unsigned char Connect_1_Blue;
+	unsigned char Connect_2_Red;
+	unsigned char Connect_2_Green;
+	unsigned char Connect_2_Blue;
+}Led_Color;
+
+typedef struct AC_Status
+{
+	unsigned char 		CpStatus;
+	unsigned short 		CurLimit;
+	short				PilotVol_P;
+	short				PilotVol_N;
+	unsigned char		LockStatus;
+	unsigned char		RelayStatus;
+	unsigned char		ShutterStatus;
+	unsigned char 		MeterStatus;
+	unsigned char 		PpStatus;
+	unsigned char 		MaxCurrent;
+	unsigned char		RotateSwitchStatus;
+}
+Ac_Status;
+
+typedef struct AC_LED_Status
+{
+	unsigned char 		ActionMode;
+	unsigned long		AcAlarmCode;
+}
+Ac_Led_Status;
+
+typedef struct AC_Alarm_Code
+{
+	unsigned int		AcAlarmCode;
+}
+Ac_Alarm_code;
+
+typedef struct AC_Charging_Energy
+{
+	unsigned int		Energy;
+}
+Ac_Charging_energy;
+
+typedef struct AC_Charging_Current
+{
+	unsigned short		OuputCurrentL1;
+	unsigned short		OuputCurrentL2;
+	unsigned short		OuputCurrentL3;
+}
+Ac_Charging_current;
+
+extern unsigned char Query_FW_Ver(unsigned char fd, unsigned char targetAddr, Ver *Ret_Buf);
+extern unsigned char Query_HW_Ver(unsigned char fd, unsigned char targetAddr, Ver *Ret_Buf);
+extern unsigned char Query_Present_InputVoltage(unsigned char fd, unsigned char targetAddr, PresentInputVoltage *Ret_Buf);
+extern unsigned char Query_Present_OutputVoltage(unsigned char fd, unsigned char targetAddr, PresentOutputVoltage *Ret_Buf);
+extern unsigned char Query_Fan_Speed(unsigned char fd, unsigned char targetAddr, FanSpeed *Ret_Buf);
+extern unsigned char Query_Temperature(unsigned char fd, unsigned char targetAddr, Temperature *Ret_Buf);
+extern unsigned char Query_Aux_PowerVoltage(unsigned char fd, unsigned char targetAddr, AuxPower *Ret_Buf);
+extern unsigned char Query_Relay_Output(unsigned char fd, unsigned char targetAddr, Relay *Ret_Buf);
+extern unsigned char Query_Gfd_Adc(unsigned char fd, unsigned char targetAddr, Gfd *Ret_Buf);
+extern unsigned char Query_Gpio_Input(unsigned char fd, unsigned char targetAddr, Gpio_in *Ret_Buf);
+extern unsigned char Query_Model_Name(unsigned char fd, unsigned char targetAddr, unsigned char *modelname);
+
+extern unsigned char Config_Fan_Speed(unsigned char fd, unsigned char targetAddr, FanSpeed *Set_Buf);
+extern unsigned char Config_Relay_Output(unsigned char fd, unsigned char targetAddr, Relay *Set_Buf);
+extern unsigned char Config_Gpio_Output(unsigned char fd, unsigned char targetAddr, Gpio_out *Set_Buf);
+extern unsigned char Config_Gfd_Value(unsigned char fd, unsigned char targetAddr, Gfd_config *Set_Buf);
+extern unsigned char Config_Model_Name(unsigned char fd, unsigned char targetAddr, unsigned char *modelname);
+extern unsigned char Config_Rtc_Data(unsigned char fd, unsigned char targetAddr, Rtc *Set_Buf);
+
+extern unsigned char Update_Start(unsigned char fd, unsigned char targetAddr, unsigned int crc32);
+extern unsigned char Update_Abord(unsigned char fd, unsigned char targetAddr);
+extern unsigned char Update_Transfer(unsigned char fd, unsigned char targetAddr, unsigned int startAddr, unsigned char *data, unsigned short int length);
+extern unsigned char Update_Finish(unsigned char fd, unsigned char targetAddr);
+
+extern unsigned char Query_AC_Status(unsigned char fd, unsigned char targetAddr, Ac_Status *Ret_Buf);
+extern unsigned char Query_AC_Alarm_Code(unsigned char fd, unsigned char targetAddr, Ac_Alarm_code *Ret_Buf);
+extern unsigned char Query_Charging_Energy(unsigned char fd, unsigned char targetAddr, Ac_Charging_energy *Ret_Buf);
+extern unsigned char Query_Charging_Current(unsigned char fd, unsigned char targetAddr, Ac_Charging_current *Ret_Buf);
+extern unsigned char Config_LED_Status(unsigned char fd, unsigned char targetAddr, Ac_Led_Status *Ret_Buf);
+extern unsigned char Config_Legacy_Req(unsigned char fd, unsigned char targetAddr, unsigned char _switch);
+extern unsigned char Config_Ac_Duty(unsigned char fd, unsigned char targetAddr, unsigned char _value);
+extern unsigned char Config_CSU_Mode(unsigned char fd, unsigned char targetAddr);
+extern unsigned char Config_Reset_MCU(unsigned char fd, unsigned char targetAddr);
+extern unsigned char Config_Led_Color(unsigned char fd, unsigned char targetAddr, Led_Color *Ret_Buf);
+#endif /* INTERNALCOMM_H_ */

EVSE/Projects/DD360ComBox/Apps/kill.sh

@@ -0,0 +1,39 @@
+pkill Module_CSU
+pkill Module_PrimaryComm
+pkill Module_LcmControl
+pkill Module_InternalComm
+pkill Module_EventLogging
+pkill Module_EvComm
+pkill Module_PsuComm
+pkill Module_4g
+pkill Module_Wifi
+pkill OcppBackend
+pkill Module_ProduceUtils
+pkill DoComm
+pkill main
+
+ipcrm -M 0x000003e9
+ipcrm -M 0x000003ed
+ipcrm -M 0x000003ea
+ipcrm -M 0x000003ec
+ipcrm -M 0x000003ee
+ipcrm -M 0x000003ef
+ipcrm -M 0x000003f0
+ipcrm -M 0x000003f3
+ipcrm -M 0x000003f1
+ipcrm -M 0x000003f6
+
+ipcrm -M 0x000003e9
+ipcrm -M 0x000003ed
+ipcrm -M 0x000003ea
+ipcrm -M 0x000003ec
+ipcrm -M 0x000003ee
+ipcrm -M 0x000003ef
+ipcrm -M 0x000003f0
+ipcrm -M 0x000003f3
+ipcrm -M 0x000003f1
+ipcrm -M 0x000003f6
+ipcrm -M 0x000003eb
+ipcrm -M 0x000003f2
+
+ipcs

EVSE/Projects/DD360ComBox/Apps/main.c

@@ -0,0 +1,5050 @@
+#include    <sys/types.h>
+#include    <sys/stat.h>
+#include    <sys/time.h>
+#include    <sys/timeb.h>
+#include    <sys/types.h>
+#include    <sys/ioctl.h>
+#include    <sys/socket.h>
+#include    <sys/ipc.h>
+#include    <sys/shm.h>
+#include    <sys/mman.h>
+#include    <linux/wireless.h>
+#include    <arpa/inet.h>
+#include    <netinet/in.h>
+
+#include    <unistd.h>
+#include    <stdarg.h>
+#include    <stdio.h>      /*標準輸入輸出定義*/
+#include    <stdlib.h>     /*標準函數庫定義*/
+#include    <unistd.h>     /*Unix 標準函數定義*/
+#include    <fcntl.h>      /*檔控制定義*/
+#include    <termios.h>    /*PPSIX 終端控制定義*/
+#include    <errno.h>      /*錯誤號定義*/
+#include    <errno.h>
+#include    <string.h>
+#include    <stdint.h>
+#include    <time.h>
+#include    <ctype.h>
+#include    <ifaddrs.h>
+#include    <math.h>
+#include    "../../define.h"
+#include    "Config.h"
+#include    <stdbool.h>
+#include    <dirent.h>
+#include    "timeout.h"
+
+#define     ARRAY_SIZE(A)       (sizeof(A) / sizeof(A[0]))
+#define     PASS                1
+#define     FAIL                -1
+#define     BUFFER_SIZE         128
+#define     YES                 1
+#define     NO                  0
+#define     NORMAL              0
+#define     ABNORMAL            1
+#define     EQUAL               0
+#define     BTN_RELEASE         0
+#define     BTN_PRESS           1
+#define     MAX_BUF             64
+#define     MtdBlockSize        0x600000
+#define     SYSFS_GPIO_DIR      "/sys/class/gpio"
+#define     UPGRADE_FAN         0x02
+#define     UPGRADE_RB          0x03
+#define     UPGRADE_PRI         0x04
+#define     UPGRADE_AC          0x05
+#define     UPGRADE_LED         0x06
+#define     SYSTEM_MIN_VOL      150
+#define     MIN_OUTPUT_CUR      0
+#define     AC_OUTPUT_VOL       220
+
+#define     NO_DEFINE           255
+#define     DEFAULT_AC_INDEX    2
+#define     PSU_MIN_CUR         100
+
+#define     DB_FILE             "/Storage/ChargeLog/localCgargingRecord.db"
+
+#define     uSEC_VAL                1000000
+#define     SELFTEST_TIMEOUT        45
+#define     AUTHORIZE_TIMEOUT       30
+#define     AUTHORIZE_COMP_TIMEOUT  3
+#define     AUTHORIZE_FAIL_TIMEOUT  3
+#define     AUTHORIZE_STOP_TIMEOUT  30
+#define     RETURN_TO_CHARGING_PAGE 30
+#define     GUN_PREPARE_TIMEOUT     30
+#define     GUN_EV_WAIT_TIMEOUT     120
+#define     GUN_EVSE_WAIT_TIMEOUT   60
+#define     GUN_COMP_WAIT_TIMEOUT   10
+#define     GUN_PRECHARGING_TIMEOUT 60
+
+char    *valid_Internet[2]    = {"8.8.8.8", "180.76.76.76"};
+unsigned char mask_table[] = { 0x01, 0x02, 0x04, 0x08, 0x10, 0x20, 0x40, 0x80 };
+int whileLoopTime = 10000; // 10 ms
+int wtdFd = -1;
+byte _authorizeIndex = NO_DEFINE;
+
+
+bool IsAuthorizingMode();
+void ClearAuthorizedFlag();
+bool isDetectPlugin();
+void ClearDetectPluginFlag();
+int mystrcmp(unsigned char *p1, unsigned char *p2);
+
+long long DiffTimebWithNow(struct timeb ST);
+unsigned char DetectBitValue(unsigned char _byte, unsigned char _bit);
+void SetBitValue(unsigned char *_byte, unsigned char _bit, unsigned char value);
+void ChargingTerminalProcess(byte gunIndex);
+void ChkPrimaryStatus();
+void StartSystemTimeoutDet(unsigned char flag);
+void StopSystemTimeoutDet();
+void StartGunInfoTimeoutDet(unsigned char gunIndex, unsigned char flag);
+void StopGunInfoTimeoutDet(unsigned char gunIndex);
+int StoreLogMsg_1(const char *fmt, ...);
+unsigned long GetTimeoutValue(struct timeval _sour_time);
+void gpio_set_value(unsigned int gpio, unsigned int value);
+void PRINTF_FUNC(char *string, ...);
+void ChangeGunSelectByIndex(byte sel);
+void InformOcppErrOccur(byte codeType);
+
+void RecordAlarmCode(byte gunIndex, char *code);
+void RecordWarningCode(byte gunIndex, char *code);
+void ReleaseWarningCodeByString(byte gunIndex, char *code);
+void ReleaseAlarmCode(byte gunIndex);
+
+int DB_Open(sqlite3 *db);
+int DB_Insert_Record(sqlite3 *db, int gun_index);
+int DB_Update_Operactive(sqlite3 *db, uint8_t gun_index, uint8_t IsAvailable);
+int DB_Get_Operactive(sqlite3 *db, uint8_t gun_index);
+
+#define DEBUG_INFO_MSG(format, args...) StoreLogMsg_1("[%s:%d][%s][Info] "format, __FILE__, __LINE__, __FUNCTION__, ##args)
+#define DEBUG_WARN_MSG(format, args...) StoreLogMsg_1("[%s:%d][%s][Warn] "format, __FILE__, __LINE__, __FUNCTION__, ##args)
+#define DEBUG_ERROR_MSG(format, args...) StoreLogMsg_1("[%s:%d][%s][Error] "format, __FILE__, __LINE__, __FUNCTION__, ##args)
+
+struct SysConfigAndInfo         *ShmSysConfigAndInfo;
+struct StatusCodeData           *ShmStatusCodeData;
+struct PsuData                  *ShmPsuData;
+struct CHAdeMOData              *ShmCHAdeMOData;
+struct GBTData                  *ShmGBTData;
+struct CcsData                  *ShmCcsData;
+struct PrimaryMcuData           *ShmPrimaryMcuData;
+struct FanModuleData            *ShmFanModuleData;
+struct RelayModuleData          *ShmRelayModuleData;
+struct LedModuleData            *ShmLedModuleData;
+struct OCPP16Data               *ShmOCPP16Data;
+
+struct ChargingInfoData         *chargingInfo[CHAdeMO_QUANTITY + CCS_QUANTITY + GB_QUANTITY];
+struct ChargingInfoData         *ac_chargingInfo[AC_QUANTITY];
+struct timeb                    startChargingTime[CHAdeMO_QUANTITY + CCS_QUANTITY + GB_QUANTITY];
+struct timeb                    endChargingTime[CHAdeMO_QUANTITY + CCS_QUANTITY + GB_QUANTITY];
+
+// for initial index to check EV board type is correct
+byte _gunIndex = 0;
+byte _acgunIndex = 0;
+byte _chademoIndex = 0;
+byte _ccsIndex = 0;
+byte _gb_Index = 0;
+byte _ac_Index = 0;
+byte bd0_1_status = 0;
+byte bd0_2_status = 0;
+byte bd1_1_status = 0;
+byte bd1_2_status = 0;
+
+bool isCardScan = false;
+bool isModelNameMatch = true;
+
+int rfidFd = -1;
+char *rfidPortName = "/dev/ttyS2";
+char *fwVersion = "V1.02.00.0000.00"; // "V0.16.00.0000.00";
+
+sqlite3 *localDb;
+bool isDb_ready;
+
+//================================================
+// initial can-bus
+//================================================
+int InitCanBus()
+{
+    int                     s0, nbytes;
+    struct timeval          tv;
+    struct ifreq            ifr0;
+    struct sockaddr_can     addr0;
+
+    system("/sbin/ip link set can0 down");
+    system("/sbin/ip link set can0 type can bitrate 500000 restart-ms 100");
+    system("/sbin/ip link set can0 up");
+
+    s0 = socket(PF_CAN, SOCK_RAW, CAN_RAW);
+
+    tv.tv_sec = 0;
+    tv.tv_usec = 10000;
+    if (setsockopt(s0, SOL_SOCKET, SO_RCVTIMEO, (char *)&tv, sizeof(struct  timeval)) < 0) {
+#ifdef SystemLogMessage
+        DEBUG_ERROR_MSG("Set SO_RCVTIMEO NG");
+#endif
+    }
+    nbytes = 40960;
+    if (setsockopt(s0, SOL_SOCKET,  SO_RCVBUF, &nbytes, sizeof(int)) < 0) {
+#ifdef SystemLogMessage
+        DEBUG_ERROR_MSG("Set SO_RCVBUF NG");
+#endif
+    }
+    nbytes = 40960;
+    if (setsockopt(s0, SOL_SOCKET, SO_SNDBUF, &nbytes, sizeof(int)) < 0) {
+#ifdef SystemLogMessage
+        DEBUG_ERROR_MSG("Set SO_SNDBUF NG");
+#endif
+    }
+
+    strcpy(ifr0.ifr_name, "can0" );
+    ioctl(s0, SIOCGIFINDEX, &ifr0); /* ifr.ifr_ifindex gets filled with that device's index */
+    addr0.can_family = AF_CAN;
+    addr0.can_ifindex = ifr0.ifr_ifindex;
+    bind(s0, (struct sockaddr *)&addr0, sizeof(addr0));
+    return s0;
+}
+
+//================================================
+// initial uart port
+//================================================
+char *_priPortName = "/dev/ttyS1";
+char *_485PortName = "/dev/ttyS5";
+
+int InitComPort(byte target)
+{
+    int fd;
+    struct termios tios;
+
+    if (target == UPGRADE_PRI) {
+        fd = open(_priPortName, O_RDWR);
+    } else if (target == UPGRADE_FAN ||  target == UPGRADE_RB || target == UPGRADE_AC || target == UPGRADE_LED) {
+        fd = open(_485PortName, O_RDWR);
+    }
+
+    if (fd <= 0) {
+#ifdef SystemLogMessage
+        DEBUG_ERROR_MSG("open 407 Communication port NG \n");
+#endif
+        return -1;
+    }
+    ioctl (fd, TCGETS, &tios);
+    tios.c_cflag = B115200 | CS8 | CLOCAL | CREAD;
+    tios.c_lflag = 0;
+    tios.c_iflag = 0;
+    tios.c_oflag = 0;
+    tios.c_cc[VMIN] = 0;
+    tios.c_cc[VTIME] = (unsigned char)1;
+    tios.c_lflag = 0;
+    tcflush(fd, TCIFLUSH);
+    ioctl (fd, TCSETS, &tios);
+
+    return fd;
+}
+
+//=================================
+// Common routine
+//=================================
+void substr(char *dest, const char *src, unsigned int start, unsigned int cnt)
+{
+    strncpy(dest, src + start, cnt);
+    dest[cnt] = 0;
+}
+
+int InitWatchDog()
+{
+    int fd;
+    system("/usr/bin/fuser -k /dev/watchdog");
+    sleep(1);
+    system("echo V > /dev/watchdog");
+    sleep(1);
+    fd = open("/dev/watchdog", O_RDWR);
+
+    if (fd <= 0) {
+        DEBUG_ERROR_MSG("System watch dog initial fail.\r\n");
+    }
+    return fd;
+}
+
+int StoreLogMsg_1(const char *fmt, ...)
+{
+    char Buf[4096 + 256];
+    char buffer[4096];
+    va_list args;
+    struct timeb  SeqEndTime;
+    struct tm *tm;
+
+    va_start(args, fmt);
+    int rc = vsnprintf(buffer, sizeof(buffer), fmt, args);
+    va_end(args);
+
+    memset(Buf, 0, sizeof(Buf));
+    ftime(&SeqEndTime);
+    SeqEndTime.time = time(NULL);
+    tm = localtime(&SeqEndTime.time);
+
+    if (ShmSysConfigAndInfo->SysConfig.SwitchDebugFlag == YES) {
+        sprintf(Buf, "%02d:%02d:%02d:%03d - %s",
+                tm->tm_hour, tm->tm_min, tm->tm_sec, SeqEndTime.millitm, buffer);
+        printf("%s \n", Buf);
+    } else {
+        sprintf(Buf, "echo \"%04d-%02d-%02d %02d:%02d:%02d:%03d - %s\" >> /Storage/SystemLog/[%04d.%02d]SystemLog",
+                tm->tm_year + 1900, tm->tm_mon + 1, tm->tm_mday, tm->tm_hour, tm->tm_min, tm->tm_sec, SeqEndTime.millitm,
+                buffer,
+                tm->tm_year + 1900, tm->tm_mon + 1);
+        system(Buf);
+    }
+
+    return rc;
+}
+
+unsigned long GetTimeoutValue(struct timeval _sour_time)
+{
+    struct timeval _end_time;
+    gettimeofday(&_end_time, NULL);
+
+    return 1000000 * (_end_time.tv_sec - _sour_time.tv_sec) + _end_time.tv_usec - _sour_time.tv_usec;
+}
+
+int mystrcmp(unsigned char *p1, unsigned char *p2)
+{
+    while (*p1 == *p2) {
+        if (*p1 == '\0' || *p2 == '\0') {
+            break;
+        }
+        p1++;
+        p2++;
+    }
+    if (*p1 == '\0' && *p2 == '\0') {
+        return (PASS);
+    } else {
+        return (FAIL);
+    }
+}
+
+int DiffTimeb(struct timeb ST, struct timeb ET)
+{
+    //return milli-second
+    unsigned int StartTime, StopTime;
+
+    StartTime = (unsigned int)ST.time;
+    StopTime = (unsigned int)ET.time;
+    //return (StopTime-StartTime)*1000+ET.millitm-ST.millitm;
+    return (StopTime - StartTime);
+}
+
+bool CheckTimeOut(struct timeb ST)
+{
+    struct timeb ET;
+    unsigned int StartTime, StopTime;
+
+    ftime(&ET);
+    StartTime = (unsigned int) ST.time;
+    StopTime = (unsigned int) ET.time;
+    return (StopTime > StartTime) ? YES : NO;
+}
+
+void setChargerMode(byte gun_index, byte mode)
+{
+    chargingInfo[gun_index]->SystemStatus = mode;
+}
+
+void PRINTF_FUNC(char *string, ...)
+{
+    va_list args;
+    char buffer[4096];
+    va_start(args, string);
+    vsnprintf(buffer, sizeof(buffer), string, args);
+    va_end(args);
+
+    DEBUG_INFO_MSG("%s \n", buffer);
+}
+
+long long DiffTimebWithNow(struct timeb ST)
+{
+    //return milli-second
+    struct timeb ET;
+    long long StartTime, StopTime;
+
+    ftime(&ET);
+    StartTime = (long long)ST.time;
+    StopTime = (long long)ET.time;
+    return ((StopTime - StartTime) * 1000) + (ET.millitm - ST.millitm);
+}
+
+//==========================================
+// Check interface status
+//==========================================
+int isInterfaceUp(const char *interface)
+{
+    int result = FAIL;
+
+    FILE *fp;
+    char cmd[256];
+    char buf[512];
+
+    strcpy(cmd, "ifconfig");
+    fp = popen(cmd, "r");
+    if (fp != NULL) {
+        while (fgets(buf, sizeof(buf), fp) != NULL) {
+            if (strstr(buf, interface) > 0) {
+                result = PASS;
+            }
+        }
+    }
+    pclose(fp);
+
+    return result;
+}
+
+//=================================
+// Create all share memory
+//=================================
+int CreateShareMemory()
+{
+    int MeterSMId;
+
+    if ((MeterSMId = shmget(ShmSysConfigAndInfoKey, sizeof(struct SysConfigAndInfo), IPC_CREAT | 0777)) < 0) {
+#ifdef SystemLogMessage
+        DEBUG_ERROR_MSG("[main]CreatShareMemory:shmget ShmSysConfigAndInfo NG \n");
+#endif
+        return 0;
+    } else if ((ShmSysConfigAndInfo = shmat(MeterSMId, NULL, 0))  == (void *) - 1) {
+#ifdef SystemLogMessage
+        DEBUG_ERROR_MSG("[main]CreatShareMemory:shmat ShmSysConfigAndInfo NG \n");
+#endif
+        return 0;
+    }
+    memset(ShmSysConfigAndInfo, 0, sizeof(struct SysConfigAndInfo));
+
+    if ((MeterSMId = shmget(ShmStatusCodeKey, sizeof(struct StatusCodeData), IPC_CREAT | 0777)) < 0) {
+#ifdef SystemLogMessage
+        DEBUG_ERROR_MSG("[main]CreatShareMemory:shmget ShmStatusCodeData NG \n");
+#endif
+        return 0;
+    } else if ((ShmStatusCodeData = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+#ifdef SystemLogMessage
+        DEBUG_ERROR_MSG("[main]CreatShareMemory:shmat ShmStatusCodeData NG \n");
+#endif
+        return 0;
+    }
+
+    memset(ShmStatusCodeData, 0, sizeof(struct StatusCodeData));
+
+    //creat ShmPsuData
+    if ((MeterSMId = shmget(ShmPsuKey, sizeof(struct PsuData), IPC_CREAT | 0777)) < 0) {
+#ifdef SystemLogMessage
+        DEBUG_ERROR_MSG("[main]CreatShareMemory:shmget ShmPsuData NG \n");
+#endif
+        return 0;
+    } else if ((ShmPsuData = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+#ifdef SystemLogMessage
+        DEBUG_ERROR_MSG("[main]CreatShareMemory:shmat ShmPsuData NG \n");
+#endif
+        return 0;
+    }
+    memset(ShmPsuData, 0, sizeof(struct PsuData));
+
+    if (CHAdeMO_QUANTITY > 0) {
+        if ((MeterSMId = shmget(ShmCHAdeMOCommKey, sizeof(struct CHAdeMOData),  IPC_CREAT | 0777)) < 0) {
+#ifdef SystemLogMessage
+            DEBUG_ERROR_MSG("[main]CreatShareMemory:shmget ShmCHAdeMOData NG \n");
+#endif
+            return 0;
+        } else if ((ShmCHAdeMOData = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+#ifdef SystemLogMessage
+            DEBUG_ERROR_MSG("[main]CreatShareMemory:shmat ShmCHAdeMOData NG \n");
+#endif
+            return 0;
+        }
+        memset(ShmCHAdeMOData, 0, sizeof(struct CHAdeMOData));
+    }
+
+    if (GB_QUANTITY > 0) {
+        if ((MeterSMId = shmget(ShmGBTCommKey, sizeof(struct GBTData),  IPC_CREAT | 0777)) < 0) {
+#ifdef SystemLogMessage
+            DEBUG_ERROR_MSG("[main]CreatShareMemory:shmget ShmGBTData NG \n");
+#endif
+            return 0;
+        } else if ((ShmGBTData = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+#ifdef SystemLogMessage
+            DEBUG_ERROR_MSG("[main]CreatShareMemory:shmat ShmGBTData NG \n");
+#endif
+            return 0;
+        }
+        memset(ShmGBTData, 0, sizeof(struct GBTData));
+    }
+
+    //creat ShmCcsData
+    if (CCS_QUANTITY > 0) {
+        if ((MeterSMId = shmget(ShmCcsCommKey, sizeof(struct CcsData),  IPC_CREAT | 0777)) < 0) {
+#ifdef SystemLogMessage
+            DEBUG_ERROR_MSG("[main]CreatShareMemory:shmget ShmCcsData NG \n");
+#endif
+            return 0;
+        } else if ((ShmCcsData = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+#ifdef SystemLogMessage
+            DEBUG_ERROR_MSG("[main]CreatShareMemory:shmat ShmCcsData NG \n");
+#endif
+            return 0;
+        }
+        memset(ShmCcsData, 0, sizeof(struct CcsData));
+    }
+
+    //creat ShmPrimaryMcuData
+    if ((MeterSMId = shmget(ShmPrimaryMcuKey, sizeof(struct PrimaryMcuData), IPC_CREAT | 0777)) < 0) {
+#ifdef SystemLogMessage
+        DEBUG_ERROR_MSG("[main]CreatShareMemory:shmget ShmPrimaryMcuData NG \n");
+#endif
+        return 0;
+    } else if ((ShmPrimaryMcuData = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+#ifdef SystemLogMessage
+        DEBUG_ERROR_MSG("[main]CreatShareMemory:shmat ShmPrimaryMcuData NG \n");
+#endif
+        return 0;
+    }
+    memset(ShmPrimaryMcuData, 0, sizeof(struct PrimaryMcuData));
+
+    //creat ShmFanModuleData
+    if ((MeterSMId = shmget(ShmFanBdKey, sizeof(struct FanModuleData),  IPC_CREAT | 0777)) < 0) {
+#ifdef SystemLogMessage
+        DEBUG_ERROR_MSG("[main]CreatShareMemory:shmget ShmFanModuleData NG \n");
+#endif
+        return 0;
+    } else if ((ShmFanModuleData = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+#ifdef SystemLogMessage
+        DEBUG_ERROR_MSG("[main]CreatShareMemory:shmat ShmFanModuleData NG \n");
+#endif
+        return 0;
+    }
+    memset(ShmFanModuleData, 0, sizeof(struct FanModuleData));
+
+    //creat ShmRelayModuleData
+    if ((MeterSMId = shmget(ShmRelayBdKey, sizeof(struct RelayModuleData),  IPC_CREAT | 0777)) < 0) {
+#ifdef SystemLogMessage
+        DEBUG_ERROR_MSG("[main]CreatShareMemory:shmget ShmRelayModuleData NG \n");
+#endif
+        return 0;
+    } else if ((ShmRelayModuleData = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+#ifdef SystemLogMessage
+        DEBUG_ERROR_MSG("[main]CreatShareMemory:shmat ShmRelayModuleData NG \n");
+#endif
+        return 0;
+    }
+    memset(ShmRelayModuleData, 0, sizeof(struct RelayModuleData));
+
+    if ((MeterSMId = shmget(ShmLedBdKey, sizeof(struct LedModuleData), IPC_CREAT | 0777)) < 0) {
+#ifdef SystemLogMessage
+        DEBUG_ERROR_MSG("[main]CreatShareMemory:shmget ShmLedModuleData NG \n");
+#endif
+        return 0;
+    } else if ((ShmLedModuleData = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+#ifdef SystemLogMessage
+        DEBUG_ERROR_MSG("[main]CreatShareMemory:shmat ShmLedModuleData NG \n");
+#endif
+        return 0;
+    }
+    memset(ShmLedModuleData, 0, sizeof(struct LedModuleData));
+
+    //creat ShmOCPP16Data
+    if ((MeterSMId = shmget(ShmOcppModuleKey, sizeof(struct OCPP16Data), IPC_CREAT | 0777)) < 0) {
+#ifdef SystemLogMessage
+        DEBUG_ERROR_MSG("[main]CreatShareMemory:shmget ShmOCPP16Data NG \n");
+#endif
+        return 0;
+    } else if ((ShmOCPP16Data = shmat(MeterSMId, NULL, 0)) == (void *) - 1) {
+#ifdef SystemLogMessage
+        DEBUG_ERROR_MSG("[main]CreatShareMemory:shmat ShmOCPP16Data NG \n");
+#endif
+        return 0;
+    }
+    // memset(ShmOCPP16Data,0,sizeof(struct OCPP16Data));
+    return 1;
+}
+
+//=================================
+// LCM Page
+//=================================
+void ChangeLcmByIndex(byte page_index)
+{
+    if (ShmSysConfigAndInfo->SysWarningInfo.Level != 2 ||
+            page_index == _LCM_COMPLETE || page_index == _LCM_FIX) {
+        ShmSysConfigAndInfo->SysInfo.PageIndex = page_index;
+    }
+}
+
+//======================================================
+// Peripheral initial
+//======================================================
+void InitGPIO()
+{
+    /*****************0~3, 4 bank, bank x 32+ num*********************/
+    /***************************************************************/
+    /*************** GPIO 0 ***************************************/
+    /***************************************************************/
+    /* GPMC_AD8         =>  GPIO0_22 *//*ID BD1_1*/
+    system("echo 22 > /sys/class/gpio/export");
+    system("echo \"in\" > /sys/class/gpio/gpio22/direction");
+    /* GPMC_AD9         =>  GPIO0_23 *//*ID BD1_2*/
+    system("echo 23 > /sys/class/gpio/export");
+    system("echo \"in\" > /sys/class/gpio/gpio23/direction");
+    /* GPMC_AD10        =>  GPIO0_26 *//*IO BD1_1*/
+    system("echo 26 > /sys/class/gpio/export");
+    system("echo \"out\" > /sys/class/gpio/gpio26/direction");
+    system("echo 1 > /sys/class/gpio/gpio26/value");
+    /* GPMC_AD11        =>  GPIO0_27 *//*IO BD1_2*/
+    system("echo 27 > /sys/class/gpio/export");
+    system("echo \"in\" > /sys/class/gpio/gpio27/direction");
+    /* RMII1_REF_CLK        =>  GPIO0_29 *//*USB 0 OCP detection*/
+    system("echo 29 > /sys/class/gpio/export");
+    system("echo \"in\" > /sys/class/gpio/gpio29/direction");
+    /*XDMA_EVENT_INTR0  =>  GPIO0_19 *//*AM_RFID_RST*/
+    system("echo 19 > /sys/class/gpio/export");
+    system("echo \"out\" > /sys/class/gpio/gpio19/direction");
+    system("echo 1 > /sys/class/gpio/gpio19/value");
+    /*XDMA_EVENT_INTR1  =>  GPIO0_20 *//*AM_RFID_ICC*/
+    system("echo 20 > /sys/class/gpio/export");
+    system("echo \"in\" > /sys/class/gpio/gpio20/direction");
+    /***************************************************************/
+    /*************** GPIO 1 ***************************************/
+    /***************************************************************/
+    /* GPMC_AD12    =>  GPIO1_12 *//*ID BD2_1*/
+    system("echo 44 > /sys/class/gpio/export");
+    system("echo \"in\" > /sys/class/gpio/gpio44/direction");
+    /* GPMC_AD13    =>  GPIO1_13 *//*ID BD2_2*/
+    system("echo 45 > /sys/class/gpio/export");
+    system("echo \"in\" > /sys/class/gpio/gpio45/direction");
+    /* GPMC_AD14    =>  GPIO1_14 *//*IO BD2_1*/
+    system("echo 46 > /sys/class/gpio/export");
+    system("echo \"out\" > /sys/class/gpio/gpio46/direction");
+    system("echo 0 > /sys/class/gpio/gpio46/value");
+    /* GPMC_AD15    =>  GPIO1_15 *//*IO BD2_2*/
+    system("echo 47 > /sys/class/gpio/export");
+    system("echo \"in\" > /sys/class/gpio/gpio47/direction");
+    /***************************************************************/
+    /*************** GPIO 2 ***************************************/
+    /***************************************************************/
+    /*LCD_AC_BIAS_EN    =>  GPIO2_25*//*RS-485 for module DE control*/
+    system("echo 89 > /sys/class/gpio/export");
+    system("echo \"out\" > /sys/class/gpio/gpio89/direction");
+    system("echo 1 > /sys/class/gpio/gpio89/value");
+    /*LCD_HSYNC     =>  GPIO2_23*//*RS-485 for module RE control*/
+    system("echo 87 > /sys/class/gpio/export");
+    system("echo \"out\" > /sys/class/gpio/gpio87/direction");
+    system("echo 0 > /sys/class/gpio/gpio87/value");
+    /*LCD_PCLK      =>  GPIO2_24*//*CCS communication board 1 proximity*/
+    system("echo 88 > /sys/class/gpio/export");
+    system("echo \"in\" > /sys/class/gpio/gpio88/direction");
+    /*LCD_VSYNC     =>  GPIO2_22*//*CCS communication board 2 proximity*/
+    system("echo 86 > /sys/class/gpio/export");
+    system("echo \"in\" > /sys/class/gpio/gpio86/direction");
+    /***************************************************************/
+    /*************** GPIO 3 ***************************************/
+    /***************************************************************/
+    /*MCASP0_FSX        =>  GPIO3_15*//*Emergency Stop button detect*/
+    system("echo 111 > /sys/class/gpio/export");
+    system("echo \"in\" > /sys/class/gpio/gpio111/direction");
+    /*MCASP0_ACLKR  =>  GPIO3_18*//*USB1 OCP detect*/
+    system("echo 114 > /sys/class/gpio/export");
+    system("echo \"in\" > /sys/class/gpio/gpio114/direction");
+    /*MCASP0_AHCLKR =>  GPIO3_17*//*Emergency IO for AM3352 and STM32F407*/
+    system("echo 113 > /sys/class/gpio/export");
+    system("echo \"in\" > /sys/class/gpio/gpio113/direction");
+    /*MCASP0_ACLKX  =>  GPIO3_14*//*Ethernet PHY reset*/
+    system("echo 110 > /sys/class/gpio/export");
+    system("echo \"out\" > /sys/class/gpio/gpio110/direction");
+    system("echo 0 > /sys/class/gpio/gpio110/value");
+    /* MCASP0_FSR       =>  GPIO3_19 *//*SMR Enable control_1 for Pskill_1*/
+    system("echo 115 > /sys/class/gpio/export");
+    system("echo \"out\" > /sys/class/gpio/gpio115/direction");
+    system("echo 0 > /sys/class/gpio/gpio115/value");
+    /* MCASP0_AXR0  =>  GPIO3_16 *//*CSU board function OK indicator.*/
+    system("echo 112 > /sys/class/gpio/export");
+    system("echo \"out\" > /sys/class/gpio/gpio112/direction");
+    system("echo 1 > /sys/class/gpio/gpio112/value");
+    /* MCASP0_AXR1  =>  GPIO3_20 *//*SMR Enable control_2 for Pskill_2*/
+    system("echo 116 > /sys/class/gpio/export");
+    system("echo \"out\" > /sys/class/gpio/gpio116/direction");
+    system("echo 0 > /sys/class/gpio/gpio116/value");
+#ifdef SystemLogMessage
+    //DEBUG_INFO_MSG("[main]InitGPIO: Initial GPIO OK");
+#endif
+}
+
+int LoadSysConfigAndInfo(struct SysConfigData *ptr)
+{
+    int fd, wrd;
+    unsigned char *buf;
+    unsigned int ChkSum, ChkSumOrg;
+
+    if ((buf = malloc(MtdBlockSize)) == NULL) {
+        DEBUG_ERROR_MSG("malloc buffer NG,rebooting..\r\n");
+        if (ShmStatusCodeData != NULL) {
+            ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CsuInitFailed = 1;
+        }
+        sleep(5);
+        system("reboot -f");
+        sleep(5);
+        system("reboot -f");
+    }
+    memset(buf, 0, MtdBlockSize);
+
+    //================================================
+    // Load configuration from mtdblock10
+    //================================================
+    fd = open("/dev/mtdblock10", O_RDWR);
+    if (fd < 0) {
+        free(buf);
+        DEBUG_ERROR_MSG("open mtdblock10 NG,rebooting..\r\n");
+        if (ShmStatusCodeData != NULL) {
+            ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CsuInitFailed = 1;
+        }
+        sleep(5);
+        system("reboot -f");
+        sleep(5);
+        system("reboot -f");
+    }
+
+    wrd = read(fd, buf, MtdBlockSize);
+    close(fd);
+    if (wrd < MtdBlockSize) {
+        free(buf);
+        DEBUG_ERROR_MSG("read SysConfigData data NG,rebooting..\r\n");
+        if (ShmStatusCodeData != NULL) {
+            ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CsuInitFailed = 1;
+        }
+        sleep(5);
+        system("reboot -f");
+        sleep(5);
+        system("reboot -f");
+    }
+    ChkSum = 0;
+    for (wrd = 0; wrd < MtdBlockSize - 4; wrd++) {
+        ChkSum += buf[wrd];
+    }
+    memcpy(&ChkSumOrg, buf + (0x00600000 - 4), sizeof(ChkSumOrg));
+
+    //================================================
+    // Load configuration from mtdblock11
+    //================================================
+    if (ChkSum != ChkSumOrg) {
+        DEBUG_ERROR_MSG("Primary SysConfigData checksum NG, read backup\r\n");
+        fd = open("/dev/mtdblock11", O_RDWR);
+        if (fd < 0) {
+            free(buf);
+            DEBUG_ERROR_MSG("open mtdblock11 (backup) NG,rebooting..\r\n");
+            if (ShmStatusCodeData != NULL) {
+                ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CsuInitFailed = 1;
+            }
+            sleep(5);
+            system("reboot -f");
+            sleep(5);
+            system("reboot -f");
+        }
+
+        memset(buf, 0, MtdBlockSize);
+        wrd = read(fd, buf, MtdBlockSize);
+        close(fd);
+        if (wrd < MtdBlockSize) {
+            free(buf);
+            DEBUG_ERROR_MSG("read backup SysConfigData data NG,rebooting..\r\n");
+            if (ShmStatusCodeData != NULL) {
+                ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CsuInitFailed = 1;
+            }
+            sleep(5);
+            system("reboot -f");
+            sleep(5);
+            system("reboot -f");
+        }
+        ChkSum = 0;
+        for (wrd = 0; wrd < MtdBlockSize - 4; wrd++) {
+            ChkSum += buf[wrd];
+        }
+        memcpy(&ChkSumOrg, buf + (0x00600000 - 4), sizeof(ChkSumOrg));
+
+        //================================================
+        // Load configuration from mtdblock12 (Factory default)
+        //================================================
+        if (ChkSum != ChkSumOrg) {
+            DEBUG_ERROR_MSG("backup SysConfigData checksum NG, read Factory default\r\n");
+            fd = open("/dev/mtdblock12", O_RDWR);
+            if (fd < 0) {
+                free(buf);
+                DEBUG_ERROR_MSG("open mtdblock12 (Factory default) NG,rebooting..\r\n");
+                if (ShmStatusCodeData != NULL) {
+                    ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CsuInitFailed = 1;
+                }
+                sleep(5);
+                system("reboot -f");
+                sleep(5);
+                system("reboot -f");
+            }
+            memset(buf, 0, MtdBlockSize);
+            wrd = read(fd, buf, MtdBlockSize);
+            close(fd);
+            if (wrd < MtdBlockSize) {
+                free(buf);
+                DEBUG_ERROR_MSG("read factory default  SysConfigData data NG,rebooting..\r\n");
+                if (ShmStatusCodeData != NULL) {
+                    ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CsuInitFailed = 1;
+                }
+                sleep(5);
+                system("reboot -f");
+                sleep(5);
+                system("reboot -f");
+            }
+            ChkSum = 0;
+            for (wrd = 0; wrd < MtdBlockSize - 4; wrd++) {
+                ChkSum += buf[wrd];
+            }
+            memcpy(&ChkSumOrg, buf + (0x00600000 - 4), sizeof(ChkSumOrg));
+            if (ChkSum != ChkSumOrg) {
+                DEBUG_ERROR_MSG("factory default  SysConfigData checksum NG, restore factory default\r\n");
+                free(buf);
+                system("cd /root;./FactoryConfig -m");
+                system("sync");
+                sleep(5);
+                system("reboot -f");
+                sleep(5);
+                system("reboot -f");
+
+                return FAIL;
+            }
+        }
+    }
+
+    //load OK
+    memcpy((struct SysConfigData *)ptr, buf, sizeof(struct SysConfigData));
+    free(buf);
+    //DEBUG_INFO_MSG("Load SysConfigData OK\n");
+    return PASS;
+}
+
+int isReachableInternet()
+{
+    int result = FAIL;
+    FILE *fp;
+    char cmd[256];
+    char buf[512];
+    char tmp[512];
+
+#ifdef DD360
+    strcpy(cmd, "ifconfig eth0");
+    fp = popen(cmd, "r");
+
+    if (fp != NULL) {
+        while (fgets(buf, sizeof(buf), fp) != NULL) {
+            if (strstr(buf, "inet addr:") > 0) {
+                sscanf(buf, "%*s%s", tmp);
+                substr(tmp, tmp, strspn(tmp, "addr:"), strlen(buf) - strspn(tmp, "addr:"));
+
+                if (strcmp(tmp, (char *)ShmSysConfigAndInfo->SysConfig.Eth0Interface.EthIpAddress) != EQUAL) {
+                    strcpy((char *) ShmSysConfigAndInfo->SysConfig.Eth0Interface.EthIpAddress, tmp);
+                }
+            }
+        }
+    }
+    pclose(fp);
+    if (ShmStatusCodeData->AlarmCode.AlarmEvents.bits.DisconnectedFromDo == 1) {
+        result = FAIL;
+    } else {
+        result = PASS;
+    }
+#else
+    if (ShmOCPP16Data->OcppConnStatus == PASS) {
+        result = PASS;
+    } else {
+        strcpy(cmd, "ifconfig eth0");
+        fp = popen(cmd, "r");
+
+        if (fp != NULL) {
+            while (fgets(buf, sizeof(buf), fp) != NULL) {
+                if (strstr(buf, "inet addr:") > 0) {
+                    sscanf(buf, "%*s%s", tmp);
+                    substr(tmp, tmp, strspn(tmp, "addr:"), strlen(buf) - strspn(tmp, "addr:"));
+
+                    if (strcmp(tmp, (char *)ShmSysConfigAndInfo->SysConfig.Eth0Interface.EthIpAddress) != EQUAL) {
+                        strcpy((char *) ShmSysConfigAndInfo->SysConfig.Eth0Interface.EthIpAddress, tmp);
+                    }
+                }
+            }
+        }
+        pclose(fp);
+        memset(buf, 0x00, sizeof(buf));
+#ifndef DD360
+        for (int idx = 0; idx < ARRAY_SIZE(valid_Internet); idx++) {
+            sprintf(cmd, "ping -c 1 -w 3 -I eth0 %s", valid_Internet[idx]);
+            fp = popen(cmd, "r");
+            if (fp != NULL) {
+                while (fgets(buf, sizeof(buf), fp) != NULL) {
+                    if (strstr(buf, "transmitted") > 0) {
+                        //sscanf(buf, "%*s%*s%*s%*s%*s%*s%s", tmp);
+
+                        if (strstr(buf, "100%") != NULL) {
+                        } else {
+                            result = PASS;
+                        }
+                        //DEBUG_INFO("%s",buf);
+                        //DEBUG_INFO("%s\n",tmp);
+                    }
+                }
+            }
+            pclose(fp);
+        }
+#endif
+    }
+#endif
+    return result;
+}
+
+void InitEthernet()
+{
+    char tmpbuf[256];
+    // /sbin/ifconfig eth0 192.168.1.10 netmask 255.255.255.0 down
+    system("echo 1 > /sys/class/gpio/gpio110/value");//reset PHY
+    sleep(2);
+    //Init Eth0 for internet
+    memset(tmpbuf, 0, 256);
+    sprintf(tmpbuf, "/sbin/ifconfig eth0 %s netmask %s up",
+            ShmSysConfigAndInfo->SysConfig.Eth0Interface.EthIpAddress,
+            ShmSysConfigAndInfo->SysConfig.Eth0Interface.EthSubmaskAddress);
+    //sprintf(tmpbuf,"/sbin/ifconfig eth0 192.168.100.10 netmask 255.255.255.0 up");
+    system(tmpbuf);
+
+    memset(tmpbuf, 0, 256);
+    sprintf(tmpbuf, "route add default gw %s eth0 ",
+            ShmSysConfigAndInfo->SysConfig.Eth0Interface.EthGatewayAddress);
+    //sprintf(tmpbuf,"route add default gw 192.168.100.1 eth0 ");
+    system(tmpbuf);
+    //system("ifconfig lo up");
+    //  /sbin/ifconfig eth0 192.168.1.10 netmask 255.255.255.0 up
+    //Init Eth1 for administrator tool
+    memset(tmpbuf, 0, 256);
+    sprintf(tmpbuf, "/sbin/ifconfig eth1 %s netmask %s up",
+            ShmSysConfigAndInfo->SysConfig.Eth1Interface.EthIpAddress,
+            ShmSysConfigAndInfo->SysConfig.Eth1Interface.EthSubmaskAddress);
+    system(tmpbuf);
+
+    //Run DHCP client if enabled
+    system("killall udhcpc");
+    system("rm -rf /etc/resolv.conf");
+    system("echo nameserver 8.8.8.8 > /etc/resolv.conf");       //Google DNS server
+    system("echo nameserver 180.76.76.76 > /etc/resolv.conf");  //Baidu DNS server
+
+    if (ShmSysConfigAndInfo->SysConfig.Eth0Interface.EthDhcpClient == 0) {
+        sprintf(tmpbuf, "/sbin/udhcpc -i eth0 -x hostname:CSU3_%s -s /root/dhcp_script/eth0.script > /dev/null &", ShmSysConfigAndInfo->SysConfig.SystemId);
+        system(tmpbuf);
+    }
+
+    //Upgrade system id to /etc/hostname
+    sprintf(tmpbuf, "echo %s > /etc/hostname", ShmSysConfigAndInfo->SysConfig.SystemId);
+    system(tmpbuf);
+
+    pid_t pid = fork();
+    uint8_t cnt_pingDNS_Fail;
+
+    if (pid == 0) {
+        for (;;) {
+#ifndef DD360
+            bool ethResult = YES;
+
+            if (ShmStatusCodeData->InfoCode.InfoEvents.bits.InternetDisconnectViaEthernet) {
+                ethResult = NO;
+            }
+
+            if (!ethResult && ShmSysConfigAndInfo->SysConfig.ModelName[10] == 'W') {
+                ethResult = !ShmStatusCodeData->InfoCode.InfoEvents.bits.InternetDisconnectViaWiFi;
+            }
+
+            if (!ethResult && ShmSysConfigAndInfo->SysConfig.ModelName[10] == 'T') {
+                ethResult = !ShmStatusCodeData->InfoCode.InfoEvents.bits.InternetDisconnectVia4Gi;
+            }
+
+            ShmSysConfigAndInfo->SysInfo.InternetConn = ethResult;
+#else
+            isReachableInternet();
+#endif
+            sleep(5);
+        }
+    }
+
+    /*#ifdef SystemLogMessage
+    DEBUG_INFO_MSG("[main]InitEthernet: Initial Ethernet OK");
+    #endif*/
+}
+
+int InitialRfidPort()
+{
+    int uartO2 = open(rfidPortName, O_RDWR);
+    struct termios tios;
+
+    if (uartO2 != FAIL) {
+        ioctl (uartO2, TCGETS, &tios);
+        tios.c_cflag = B19200 | CS8 | CLOCAL | CREAD;
+        tios.c_lflag = 0;
+        tios.c_iflag = 0;
+        tios.c_oflag = 0;
+        tios.c_cc[VMIN] = 0;
+        tios.c_cc[VTIME] = (unsigned char) 1;
+        tios.c_lflag = 0;
+        tcflush(uartO2, TCIFLUSH);
+        ioctl(uartO2, TCSETS, &tios);
+    }
+
+    if (uartO2 < 0) {
+        ShmStatusCodeData->AlarmCode.AlarmEvents.bits.RfidModuleCommFail = 1;
+    }
+
+    return uartO2;
+}
+
+void GetMacAddress()
+{
+    for (byte index = 0; index < 2; index++) {
+        int fd;
+        struct ifreq ifr;
+        char tarEth[5];
+        char Mac[18];
+
+        sprintf(tarEth, "eth%d", index);
+        fd = socket(AF_INET, SOCK_DGRAM, 0);
+
+        ifr.ifr_addr.sa_family = AF_INET;
+        strncpy(ifr.ifr_name, tarEth, IFNAMSIZ - 1);
+
+        ioctl(fd, SIOCGIFHWADDR, &ifr);
+        close(fd);
+
+        sprintf(Mac, "%.2x:%.2x:%.2x:%.2x:%.2x:%.2x",
+                ifr.ifr_hwaddr.sa_data[0], ifr.ifr_hwaddr.sa_data[1], ifr.ifr_hwaddr.sa_data[2],
+                ifr.ifr_hwaddr.sa_data[3], ifr.ifr_hwaddr.sa_data[4], ifr.ifr_hwaddr.sa_data[5]);
+
+        if (index == 0) {
+            strcpy((char *) ShmSysConfigAndInfo->SysConfig.Eth0Interface.EthMacAddress, Mac);
+        } else {
+            strcpy((char *) ShmSysConfigAndInfo->SysConfig.Eth1Interface.EthMacAddress, Mac);
+        }
+    }
+}
+
+void GetFirmwareVersion()
+{
+    // Get CSU root file system version
+    sprintf((char *)ShmSysConfigAndInfo->SysInfo.CsuRootFsFwRev, fwVersion);
+
+    byte count = 0, chademo = 0, ccs = 0, gb = 0;
+    for (uint8_t idx = 0; idx < 3; idx++) {
+        if (ShmSysConfigAndInfo->SysConfig.ModelName[7 + idx] == 'J') {
+            chademo++;
+            count++;
+        } else  if (ShmSysConfigAndInfo->SysConfig.ModelName[7 + idx] == 'G') {
+            gb++;
+            count++;
+        } else  if (ShmSysConfigAndInfo->SysConfig.ModelName[7 + idx] == 'U' ||
+                    ShmSysConfigAndInfo->SysConfig.ModelName[7 + idx] == 'E') {
+            ccs++;
+            count++;
+        }
+    }
+
+    if (count == 1) {
+        if (chademo > 0) {
+            ShmSysConfigAndInfo->SysInfo.CsuRootFsFwRev[7] = '1';
+        } else if (ccs > 0) {
+            ShmSysConfigAndInfo->SysInfo.CsuRootFsFwRev[7] = '2';
+        } else if (gb > 0) {
+            ShmSysConfigAndInfo->SysInfo.CsuRootFsFwRev[7] = '3';
+        }
+    } else {
+        if (chademo > 0 && ccs > 0) {
+            ShmSysConfigAndInfo->SysInfo.CsuRootFsFwRev[7] = '4';
+        } else if (chademo > 0 && gb > 0) {
+            ShmSysConfigAndInfo->SysInfo.CsuRootFsFwRev[7] = '5';
+        } else if (ccs > 0 && gb > 0) {
+            ShmSysConfigAndInfo->SysInfo.CsuRootFsFwRev[7] = '6';
+        }
+    }
+
+    // Get network option from model name
+    switch (ShmSysConfigAndInfo->SysConfig.ModelName[10]) {
+    case 'B':
+    case 'U':
+        //Blue tooth
+        ShmSysConfigAndInfo->SysInfo.CsuRootFsFwRev[9] = '3';
+        break;
+    case 'W':
+        // WIFI
+        ShmSysConfigAndInfo->SysInfo.CsuRootFsFwRev[9] = '1';
+        break;
+    case 'T':
+        // 3G/4G
+        ShmSysConfigAndInfo->SysInfo.CsuRootFsFwRev[9] = '2';
+        break;
+    default:
+        // LAN
+        ShmSysConfigAndInfo->SysInfo.CsuRootFsFwRev[9] = '0';
+        break;
+    }
+    // Get rating power from model name
+    memcpy(&ShmSysConfigAndInfo->SysInfo.CsuRootFsFwRev[10], &ShmSysConfigAndInfo->SysConfig.ModelName[4], 0x03);
+
+    // Get IEC or UL
+    char _buf[3] = {0};
+    memcpy(_buf, &ShmSysConfigAndInfo->SysConfig.ModelName[2], 2);
+
+    if (strcmp(_buf, "YE") == EQUAL || strcmp(_buf, "YC") == EQUAL) {
+        ShmSysConfigAndInfo->SysInfo.ChargerType = _CHARGER_TYPE_IEC;
+        DEBUG_INFO_MSG("IEC model");
+    } else if (strcmp(_buf, "WU") == EQUAL) {
+        ShmSysConfigAndInfo->SysInfo.ChargerType = _CHARGER_TYPE_UL;
+        DEBUG_INFO_MSG("UL model");
+    }
+}
+
+void InitialShareMemoryInfo()
+{
+    FILE *fp;
+    char cmd[512];
+    char buf[512];
+
+    sprintf((char *)ShmSysConfigAndInfo->SysConfig.TelecomInterface.TelcomApn, "Internet");
+    sprintf((char *)ShmSysConfigAndInfo->SysConfig.TelecomInterface.TelcomChapPapId, " ");
+    sprintf((char *)ShmSysConfigAndInfo->SysConfig.TelecomInterface.TelcomChapPapPwd, " ");
+
+    ShmSysConfigAndInfo->SysConfig.TotalConnectorCount = 0;
+    ShmSysConfigAndInfo->SysConfig.AcConnectorCount = 0;
+
+    ShmSysConfigAndInfo->SysInfo.FactoryConfiguration = 0;
+    ShmSysConfigAndInfo->SysInfo.InputVoltageR = 0;
+    ShmSysConfigAndInfo->SysInfo.InputVoltageS = 0;
+    ShmSysConfigAndInfo->SysInfo.InputVoltageT = 0;
+    ShmSysConfigAndInfo->SysInfo.SystemFanRotaSpeed = 0;
+    ShmSysConfigAndInfo->SysInfo.PsuFanRotaSpeed = 0;
+    ShmSysConfigAndInfo->SysInfo.AuxPower5V = 0;
+    ShmSysConfigAndInfo->SysInfo.AuxPower12V = 0;
+    ShmSysConfigAndInfo->SysInfo.AuxPower24V = 0;
+    ShmSysConfigAndInfo->SysInfo.AuxPower48V = 0;
+
+    sprintf((char *)ShmSysConfigAndInfo->SysInfo.CsuHwRev, "REV:5.0");
+    memcpy(ShmSysConfigAndInfo->SysInfo.CsuBootLoadFwRev, ShmSysConfigAndInfo->SysConfig.CsuBootLoadFwRev, ARRAY_SIZE(ShmSysConfigAndInfo->SysConfig.CsuBootLoadFwRev));
+
+    sprintf(cmd, "/bin/uname -r");
+    fp = popen(cmd, "r");
+    if (fp == NULL) {
+        sprintf((char *)ShmSysConfigAndInfo->SysInfo.CsuKernelFwRev, "Unknown version");
+    } else {
+        while (fgets(buf, sizeof(buf), fp) != NULL) {
+            strcpy((char *)ShmSysConfigAndInfo->SysInfo.CsuKernelFwRev, buf);
+        }
+    }
+
+    // 雙槍 CCS + Chademo
+    GetFirmwareVersion();
+    //sprintf((char *) ShmSysConfigAndInfo->SysInfo.CsuRootFsFwRev, fwVersion);
+    sprintf((char *) ShmSysConfigAndInfo->SysInfo.CsuPrimFwRev, " ");
+
+    sprintf((char *) ShmSysConfigAndInfo->SysInfo.LcmHwRev, " ");
+    sprintf((char *) ShmSysConfigAndInfo->SysInfo.LcmFwRev, " ");
+    sprintf((char *) ShmSysConfigAndInfo->SysInfo.PsuHwRev, " ");
+    sprintf((char *) ShmSysConfigAndInfo->SysInfo.PsuPrimFwRev, " ");
+    sprintf((char *) ShmSysConfigAndInfo->SysInfo.PsuSecFwRev, " ");
+    sprintf((char *) ShmSysConfigAndInfo->SysInfo.AuxPwrHwRev, " ");
+    sprintf((char *) ShmSysConfigAndInfo->SysInfo.AuxPwrFwRev, " ");
+    sprintf((char *) ShmSysConfigAndInfo->SysInfo.FanModuleHwRev, " ");
+    sprintf((char *) ShmSysConfigAndInfo->SysInfo.FanModuleFwRev, " ");
+    sprintf((char *) ShmSysConfigAndInfo->SysInfo.RelayModuleHwRev, " ");
+    sprintf((char *) ShmSysConfigAndInfo->SysInfo.RelayModuleFwRev, " ");
+    sprintf((char *) ShmSysConfigAndInfo->SysInfo.TelcomModemFwRev, " ");
+    ShmSysConfigAndInfo->SysInfo.SystemAmbientTemp = 0;
+    ShmSysConfigAndInfo->SysInfo.SystemCriticalTemp = 0;
+    ShmSysConfigAndInfo->SysInfo.PsuAmbientTemp = 0;
+    ShmSysConfigAndInfo->SysInfo.CcsConnectorTemp = 0;
+    ShmSysConfigAndInfo->SysInfo.InternetConn = 0;
+    ShmSysConfigAndInfo->SysInfo.OcppConnStatus = 0;
+    ShmSysConfigAndInfo->SysInfo.OrderCharging = NO_DEFINE;
+
+    strcpy((char *) ShmSysConfigAndInfo->SysConfig.UserId, "");
+
+    ShmStatusCodeData->AlarmCode.AlarmEvents.bits.RelayboardStestFail = NO;
+    ShmStatusCodeData->AlarmCode.AlarmEvents.bits.FanboardStestFail = NO;
+    ShmStatusCodeData->AlarmCode.AlarmEvents.bits.PrimaryStestFail = NO;
+    ShmStatusCodeData->AlarmCode.AlarmEvents.bits.ChademoboardStestFail = NO;
+    ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CCSboardStestFail = NO;
+    ShmStatusCodeData->AlarmCode.AlarmEvents.bits.AcContactStestFail = NO;
+    ShmStatusCodeData->AlarmCode.AlarmEvents.bits.PsuModuleStestFail = NO;
+
+    memset(ShmSysConfigAndInfo->SysInfo.FanModuleFwRev, 0, ARRAY_SIZE(ShmSysConfigAndInfo->SysInfo.FanModuleFwRev));
+    memset(ShmSysConfigAndInfo->SysInfo.RelayModuleFwRev, 0, ARRAY_SIZE(ShmSysConfigAndInfo->SysInfo.RelayModuleFwRev));
+    ShmPrimaryMcuData->SelfTest_Comp = NO;
+    ShmRelayModuleData->SelfTest_Comp = NO;
+    ShmFanModuleData->SelfTest_Comp = NO;
+    ShmLedModuleData->SelfTest_Comp = NO;
+    ShmSysConfigAndInfo->SysInfo.SystemPage = _LCM_NONE;
+    ShmSysConfigAndInfo->SysInfo.MainChargingMode = _MAIN_CHARGING_MODE_MAX;
+    ShmSysConfigAndInfo->SysInfo.ReAssignedFlag = _REASSIGNED_NONE;
+    ShmSysConfigAndInfo->SysInfo.CurGunSelectedByAc = NO_DEFINE;
+
+    ShmFanModuleData->TestFanSpeed = 0;
+
+    ShmStatusCodeData->AlarmCode.AlarmEvents.bits.ModelNameNoneMatchStestFail = NO;
+    ShmStatusCodeData->AlarmCode.AlarmEvents.bits.PsuNoResource = NO;
+
+    char EvsePower[2];
+
+    EvsePower[2] = '\0';
+    unsigned short buf_pow = 0;
+    if (strlen((char *) ShmSysConfigAndInfo->SysConfig.ModelName) >= 6) {
+        strncpy(EvsePower, (char *)(ShmSysConfigAndInfo->SysConfig.ModelName + 4), 2);
+        if (strcmp(EvsePower, "15") == EQUAL) {
+            buf_pow = 150;
+        } else if (strcmp(EvsePower, "30") == EQUAL) {
+            buf_pow = 30;
+        } else if (strcmp(EvsePower, "60") == EQUAL) {
+            buf_pow = 60;
+        } else if (strcmp(EvsePower, "12") == EQUAL) {
+            buf_pow = 120;
+        } else if (strcmp(EvsePower, "18") == EQUAL) {
+            buf_pow = 180;
+        } else if (strcmp(EvsePower, "36") == EQUAL) {
+            buf_pow = 360;
+        }
+
+        ShmSysConfigAndInfo->SysConfig.RatingCurrent = (buf_pow / 30) * PSU_MIN_CUR;
+
+        if (ShmSysConfigAndInfo->SysConfig.MaxChargingPower == 0 ||
+                ShmSysConfigAndInfo->SysConfig.MaxChargingPower > buf_pow) {
+            ShmSysConfigAndInfo->SysConfig.MaxChargingPower = buf_pow;
+        }
+    }
+    ShmSysConfigAndInfo->SysConfig.SwitchDebugFlag = NO;
+    ShmSysConfigAndInfo->SysConfig.AlwaysGfdFlag = NO;
+}
+
+int Initialization()
+{
+    // 初始化卡號驗證的 Flag
+    ClearAuthorizedFlag();
+    // 初始化插槍驗證的 Flag
+    ClearDetectPluginFlag();
+
+    // UART 2 for Rfid
+    rfidFd = InitialRfidPort();
+
+    int pinOut[2] = { 116, 115 };
+    for (byte count = 0; count < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; count++) {
+        chargingInfo[count]->RemoteStartFlag = NO;
+
+        if (chargingInfo[count]->Type == _Type_Chademo) {
+            gpio_set_value(pinOut[count], 0x00);
+            ShmCHAdeMOData->evse[chargingInfo[count]->type_index].SelfTest_Comp = NO;
+        } else if (chargingInfo[count]->Type == _Type_GB) {
+            gpio_set_value(pinOut[count], 0x00);
+            ShmGBTData->evse[chargingInfo[count]->type_index].SelfTest_Comp = NO;
+        } else if (chargingInfo[count]->Type == _Type_CCS_2) {
+            if (ShmCcsData->CommProtocol == _CCS_COMM_V2GMessage_DIN70121) {
+                if (ShmSysConfigAndInfo->SysConfig.TotalConnectorCount == 1) {
+                    gpio_set_value(pinOut[1], 0x01);
+                } else {
+                    gpio_set_value(pinOut[count], 0x01);
+                }
+                ShmCcsData->V2GMessage_DIN70121[chargingInfo[count]->type_index].SelfTest_Comp = NO;
+            }
+        }
+
+        strcpy((char *)ShmOCPP16Data->StatusNotification[count].ErrorCode, "NoError");
+    }
+
+    for (byte count = 0; count < ShmSysConfigAndInfo->SysConfig.AcConnectorCount; count++) {
+        ac_chargingInfo[count]->RemoteStartFlag = NO;
+
+        if (ac_chargingInfo[count]->Type == _Type_AC) {
+            ac_chargingInfo[count]->SelfTest_Comp = NO;
+            strcpy((char *)ShmOCPP16Data->StatusNotification[count + ShmSysConfigAndInfo->SysConfig.TotalConnectorCount].ErrorCode, "NoError");
+        }
+    }
+
+    //PRINTF_FUNC("Initialization OK \n");
+    return PASS;
+}
+
+bool InitialSystemDefaultConfig()
+{
+    bool result = true;
+
+    LoadSysConfigAndInfo(&ShmSysConfigAndInfo->SysConfig);
+    InitGPIO();
+    InitEthernet();
+    GetMacAddress();
+
+//  system("echo 1 > /sys/class/gpio/gpio110/value"); //reset PHY
+//  sleep(3);
+//  system("/sbin/ifconfig eth0 192.168.1.10 netmask 255.255.255.0 down");
+//  sleep(1);
+//  system("/sbin/ifconfig eth1 192.168.0.10 netmask 255.255.255.0 up");
+
+    return result;
+}
+
+void DisplaySelfTestFailReason()
+{
+    // RB、FB、407、EV 小板中有些板子無回應
+    if (ShmRelayModuleData->SelfTest_Comp == NO)
+    { ShmStatusCodeData->AlarmCode.AlarmEvents.bits.RelayboardStestFail = YES; }
+    if (ShmFanModuleData->SelfTest_Comp == NO)
+    { ShmStatusCodeData->AlarmCode.AlarmEvents.bits.FanboardStestFail = YES; }
+    if (ShmPrimaryMcuData->SelfTest_Comp == NO)
+    { ShmStatusCodeData->AlarmCode.AlarmEvents.bits.PrimaryStestFail = YES; }
+    if (ShmLedModuleData->SelfTest_Comp == NO)
+    { ShmStatusCodeData->AlarmCode.AlarmEvents.bits.LedboardStestFail = YES; }
+    for (byte index = 0; index < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; index++) {
+        if (chargingInfo[index]->Type == _Type_Chademo) {
+            if (ShmCHAdeMOData->evse[chargingInfo[index]->type_index].SelfTest_Comp == NO)
+            { ShmStatusCodeData->AlarmCode.AlarmEvents.bits.ChademoboardStestFail = YES; }
+        } else if (chargingInfo[index]->Type == _Type_GB) {
+            if (ShmGBTData->evse[chargingInfo[index]->type_index].SelfTest_Comp == NO)
+            { ShmStatusCodeData->AlarmCode.AlarmEvents.bits.GbtboardStestFail = YES; }
+        } else if (chargingInfo[index]->Type == _Type_CCS_2) {
+            if (ShmCcsData->CommProtocol == _CCS_COMM_V2GMessage_DIN70121) {
+                if (ShmCcsData->V2GMessage_DIN70121[chargingInfo[index]->type_index].SelfTest_Comp == NO)
+                { ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CCSboardStestFail = YES; }
+            }
+        }
+    }
+    for (byte index = 0; index < ShmSysConfigAndInfo->SysConfig.AcConnectorCount; index++) {
+        // 先借 GBT 顯示
+        if (ac_chargingInfo[index]->SelfTest_Comp == NO)
+        { ShmStatusCodeData->AlarmCode.AlarmEvents.bits.AcConnectorStestFail = YES; }
+    }
+
+    if (ShmSysConfigAndInfo->SysInfo.AcContactorStatus == NO) {
+#ifndef DD360
+        // AC Contact 未搭上
+        ShmStatusCodeData->AlarmCode.AlarmEvents.bits.AcContactStestFail = YES;
+#endif
+    } else if (ShmPsuData->SystemAvailablePower <= 0 && ShmPsuData->SystemAvailableCurrent <= 0) {
+        // PSU 通訊問題
+        ShmStatusCodeData->AlarmCode.AlarmEvents.bits.PsuModuleStestFail = YES;
+    }
+}
+
+void SelfTestRun()
+{
+    bool evInitFlag = false;
+
+    StartSystemTimeoutDet(Timeout_SelftestChk);
+    ShmSysConfigAndInfo->SysInfo.SelfTestSeq = _STEST_VERSION;
+    while (ShmSysConfigAndInfo->SysInfo.SelfTestSeq != _STEST_COMPLETE) {
+        ChkPrimaryStatus();
+        if (ShmSysConfigAndInfo->SysWarningInfo.Level == 2) {
+            ShmSysConfigAndInfo->SysInfo.SelfTestSeq = _STEST_FAIL;
+            return;
+        }
+
+        if (ShmSysConfigAndInfo->SysConfig.TotalConnectorCount > 0) {
+            if (ShmPsuData->Work_Step == _NO_WORKING ||
+                    ShmSysConfigAndInfo->SysInfo.SelfTestSeq == _STEST_FAIL) {
+                ShmSysConfigAndInfo->SysInfo.SelfTestSeq = _STEST_FAIL;
+                return;
+            }
+
+            switch (ShmSysConfigAndInfo->SysInfo.SelfTestSeq) {
+            case _STEST_VERSION: {
+                if ((strlen((char *)ShmSysConfigAndInfo->SysInfo.RelayModuleFwRev) != 0 || ShmSysConfigAndInfo->SysInfo.RelayModuleFwRev[0] != '\0')
+                        && (ShmRelayModuleData->SelfTest_Comp != YES)
+                   ) {
+                    DEBUG_INFO_MSG("Relay Board FW Rev = %s", ShmSysConfigAndInfo->SysInfo.RelayModuleFwRev);
+                    ShmRelayModuleData->SelfTest_Comp = YES;
+                }
+#ifndef NO_FAN_BOARD
+                if ((strlen((char *)ShmSysConfigAndInfo->SysInfo.FanModuleFwRev) != 0 || ShmSysConfigAndInfo->SysInfo.FanModuleFwRev[0] != '\0')
+                        && (ShmFanModuleData->SelfTest_Comp != YES)
+                   ) {
+                    DEBUG_INFO_MSG("Fan Board FW Rev = %s", ShmSysConfigAndInfo->SysInfo.FanModuleFwRev);
+                    ShmFanModuleData->SelfTest_Comp = YES;
+                }
+#else
+                ShmFanModuleData->SelfTest_Comp = YES;
+#endif
+                if ((strlen((char *)ShmPrimaryMcuData->version) != 0 || ShmPrimaryMcuData->version[0] != '\0')
+                        && (ShmPrimaryMcuData->SelfTest_Comp != YES)
+                   ) {
+                    DEBUG_INFO_MSG("Primary FW Rev = %s", ShmSysConfigAndInfo->SysInfo.CsuPrimFwRev);
+                    ShmPrimaryMcuData->SelfTest_Comp = YES;
+                }
+                if ((strlen((char *)ShmSysConfigAndInfo->SysInfo.LedModuleFwRev) != 0 || ShmSysConfigAndInfo->SysInfo.LedModuleFwRev[0] != '\0')
+                        && (ShmLedModuleData->SelfTest_Comp != YES)
+                   ) {
+                    DEBUG_INFO_MSG("LED Board FW Rev = %s", ShmSysConfigAndInfo->SysInfo.LedModuleFwRev);
+                    ShmLedModuleData->SelfTest_Comp = YES;
+                }
+                // EV 小板
+                if (!evInitFlag) {
+                    evInitFlag = YES;
+                    for (byte index = 0; index < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; index++) {
+                        if (chargingInfo[index]->Type == _Type_Chademo) {
+                            if ((strlen((char *)ShmCHAdeMOData->evse[chargingInfo[index]->type_index].version) != 0 || ShmCHAdeMOData->evse[chargingInfo[index]->type_index].version[0] != '\0')
+                                    && (ShmCHAdeMOData->evse[chargingInfo[index]->type_index].SelfTest_Comp != YES)
+                               ) {
+                                DEBUG_INFO_MSG("CHAdeMO[%d] FW Rev = %s", chargingInfo[index]->type_index, ShmCHAdeMOData->evse[chargingInfo[index]->type_index].version);
+                                ShmCHAdeMOData->evse[chargingInfo[index]->type_index].SelfTest_Comp = YES;
+                            } else {
+                                //PRINTF_FUNC("chademo fw lose...... %s \n", ShmCHAdeMOData->evse[chargingInfo[index]->type_index].version);
+                                evInitFlag = NO;
+                            }
+                        } else if (chargingInfo[index]->Type == _Type_GB) {
+                            if ((strlen((char *)ShmGBTData->evse[chargingInfo[index]->type_index].version) != 0 || ShmGBTData->evse[chargingInfo[index]->type_index].version[0] != '\0')
+                                    && (ShmGBTData->evse[chargingInfo[index]->type_index].SelfTest_Comp != YES)
+                               ) {
+                                DEBUG_INFO_MSG("GBT[%d] FW Rev = %s", chargingInfo[index]->type_index, ShmGBTData->evse[chargingInfo[index]->type_index].version);
+                                ShmGBTData->evse[chargingInfo[index]->type_index].SelfTest_Comp = YES;
+                            } else {
+                                //PRINTF_FUNC("GBT fw lose...... %s \n", ShmCHAdeMOData->evse[chargingInfo[index]->type_index].version);
+                                evInitFlag = NO;
+                            }
+                        } else if (chargingInfo[index]->Type == _Type_CCS_2) {
+                            if (ShmCcsData->CommProtocol == _CCS_COMM_V2GMessage_DIN70121) {
+                                if ((strlen((char *)ShmCcsData->V2GMessage_DIN70121[chargingInfo[index]->type_index].version) != 0 || ShmCcsData->V2GMessage_DIN70121[chargingInfo[index]->type_index].version[0] != '\0')
+                                        /*&&(ShmCcsData->V2GMessage_DIN70121[chargingInfo[index]->type_index].SelfTest_Comp != YES)*/
+                                   ) {
+                                    DEBUG_INFO_MSG("CCS[%d] FW Rev = %s", chargingInfo[index]->type_index, ShmCcsData->V2GMessage_DIN70121[chargingInfo[index]->type_index].version);
+                                    ShmCcsData->V2GMessage_DIN70121[chargingInfo[index]->type_index].SelfTest_Comp = YES;
+                                } else {
+                                    //PRINTF_FUNC("ccs fw lose...... %s \n", ShmCcsData->V2GMessage_DIN70121[chargingInfo[index]->type_index].version);
+                                    evInitFlag = NO;
+                                }
+                            }
+                        }
+                    }
+
+                    for (byte index = 0; index < ShmSysConfigAndInfo->SysConfig.AcConnectorCount; index++) {
+                        if (ac_chargingInfo[index]->Type == _Type_AC) {
+                            if ((strlen((char *)ac_chargingInfo[index]->version) != 0 || ac_chargingInfo[index]->version[0] != '\0')
+                                    && (ac_chargingInfo[index]->SelfTest_Comp != YES)
+                               ) {
+                                DEBUG_INFO_MSG("AC connector[%d] FW Rev = %s", index, ac_chargingInfo[index]->version);
+                                ac_chargingInfo[index]->SelfTest_Comp = YES;
+                            } else {
+                                evInitFlag = NO;
+                            }
+                        }
+                    }
+                }
+
+                if ( ShmFanModuleData->SelfTest_Comp &&
+                        ShmRelayModuleData->SelfTest_Comp &&
+                        ShmPrimaryMcuData->SelfTest_Comp &&
+                        ShmLedModuleData->SelfTest_Comp &&
+                        evInitFlag
+                   ) {
+                    ShmSysConfigAndInfo->SysInfo.SelfTestSeq = _STEST_AC_CONTACTOR;
+                }
+            }
+            break;
+            case _STEST_AC_CONTACTOR: {
+                //ShmPsuData->Work_Step = _TEST_COMPLETE;
+                // 因為 30KW 以下沒有 Relay feedback 功能，所以暫時先直接跳過
+#ifndef DD360
+                if (ShmSysConfigAndInfo->SysInfo.AcContactorStatus == YES) {
+                    ShmSysConfigAndInfo->SysInfo.SelfTestSeq = _STEST_PSU_DETECT;
+                    DEBUG_INFO_MSG("AC contactor self test OK");
+                }
+#else
+                ShmSysConfigAndInfo->SysInfo.SelfTestSeq = _STEST_PSU_DETECT;
+                DEBUG_INFO_MSG("Waiting for DO communication");
+#endif
+            }
+            break;
+            case _STEST_PSU_DETECT: {
+
+                /*if (ShmPsuData->Work_Step >= GET_SYS_CAP)
+                {
+                    ShmSysConfigAndInfo->SysInfo.SelfTestSeq = _STEST_PSU_CAP;
+                }*/
+                /*+++ 20200908, vern, check ethernet connection between DD and DO +++*/
+                //if connection is establish
+                ShmSysConfigAndInfo->SysInfo.SelfTestSeq = _STEST_PSU_CAP;
+
+            }
+            break;
+            case _STEST_PSU_CAP: {
+                // 此測試是要確認當前總輸出能力
+                // 如果沒有 PSU 模組請 bypass
+                /*if (ShmPsuData->Work_Step == BOOTING_COMPLETE)
+                {
+                    sleep(1);
+                    ShmSysConfigAndInfo->SysInfo.SelfTestSeq = _STEST_COMPLETE;
+                    ShmSysConfigAndInfo->SysInfo.BootingStatus = BOOT_COMPLETE;
+                }*/
+                //check the power limit from DO
+                ShmSysConfigAndInfo->SysInfo.SelfTestSeq = _STEST_COMPLETE;
+                ShmSysConfigAndInfo->SysInfo.BootingStatus = BOOT_COMPLETE;
+                DEBUG_INFO_MSG("Successful Self Test");
+            }
+            break;
+            }
+        } else {
+            break;
+        }
+
+        usleep(100000);
+    }
+}
+
+int SpawnTask()
+{
+    sleep(2);
+    system("/root/Module_EventLogging &");
+    system("/root/Module_PrimaryComm &");
+    system("/root/Module_EvComm &");
+    system("/root/Module_LcmControl &");
+    system("/root/Module_InternalComm &");
+    /*system("/root/Module_PsuComm &");*//*+++ 20200908, vern, disable it for DD360 ---*/
+    system("/root/Module_ProduceUtils &");
+    system("/root/DoComm &");/*+++ 20200908, vern, Add DO communication task ---*/
+    /*+++ 20200908, vern, disable it for DD360 +++*/
+#if 0
+    if (strcmp((char *)ShmSysConfigAndInfo->SysConfig.OcppServerURL, "") != EQUAL &&
+            strcmp((char *)ShmSysConfigAndInfo->SysConfig.ChargeBoxId, "") != EQUAL) {
+        system("/root/OcppBackend &");
+    }
+
+    if (ShmSysConfigAndInfo->SysConfig.ModelName[10] == 'T') {
+        system("/root/Module_4g &");
+    }
+
+    if (ShmSysConfigAndInfo->SysConfig.ModelName[10] == 'W') {
+        system("/root/Module_Wifi &");
+    }
+
+    if (ShmSysConfigAndInfo->SysConfig.ModelName[10] == 'D') {
+        system("/root/Module_4g &");
+        system("/root/Module_Wifi &");
+    }
+#endif
+    /*--- 20200908, vern, disable it for DD360 ---*/
+    return PASS;
+}
+
+int StoreUsrConfigData(struct SysConfigData *UsrData)
+{
+    int result = PASS;
+    int fd, wrd;
+    unsigned int i, Chk;
+    unsigned char *ptr, *BufTmp;
+
+    Chk = 0;
+    ptr = (unsigned char *)UsrData;
+    if ((BufTmp = malloc(MtdBlockSize)) != NULL) {
+        memset(BufTmp, 0, MtdBlockSize);
+        memcpy(BufTmp, ptr, sizeof(struct SysConfigData));
+        for (i = 0; i < MtdBlockSize - 4; i++) {
+            Chk += *(ptr + i);
+        }
+
+        memcpy(BufTmp + MtdBlockSize - 4, &Chk, 4);
+        fd = open("/dev/mtdblock10", O_RDWR);
+        if (fd > 0) {
+            wrd = write(fd, BufTmp, MtdBlockSize);
+            close(fd);
+            if (wrd >= MtdBlockSize) {
+                fd = open("/dev/mtdblock11", O_RDWR);
+                if (fd > 0) {
+                    wrd = write(fd, BufTmp, MtdBlockSize);
+                    close(fd);
+                    if (wrd < MtdBlockSize) {
+                        DEBUG_ERROR_MSG("write /dev/mtdblock11(backup) NG\r\n");
+                        result = FAIL;
+                    }
+                } else {
+                    DEBUG_ERROR_MSG("open /dev/mtdblock11(backup) NG\r\n");
+                    result = FAIL;
+                }
+            } else {
+                DEBUG_ERROR_MSG("write /dev/mtdblock10 NG\r\n");
+                result = FAIL;
+            }
+
+        } else {
+            DEBUG_ERROR_MSG("open /dev/mtdblock10 NG\r\n");
+            result = FAIL;
+        }
+    } else {
+        DEBUG_ERROR_MSG("alloc BlockSize NG\r\n");
+        result = FAIL;
+    }
+
+    if (BufTmp != NULL) {
+        free(BufTmp);
+    }
+
+    return result;
+}
+
+//===============================================
+// Common Detect Chk - Stop Charging ?
+//===============================================
+bool isEvBoardStopChargeFlag(byte gunIndex)
+{
+    return chargingInfo[gunIndex]->StopChargeFlag;
+}
+
+//===============================================
+// 掃描插槍狀況
+//===============================================
+void ClearDetectPluginFlag()
+{
+    ShmSysConfigAndInfo->SysInfo.WaitForPlugit = NO;
+}
+
+void DetectPluginStart()
+{
+    ShmSysConfigAndInfo->SysInfo.WaitForPlugit = YES;
+}
+
+bool isDetectPlugin()
+{
+    if (ShmSysConfigAndInfo->SysInfo.WaitForPlugit == YES) {
+        return YES;
+    }
+
+    return NO;
+}
+
+//===============================================
+// Common Detect Chk - Chademo
+//===============================================
+bool isEvGunLocked_chademo(byte gunIndex)
+{
+    return (DetectBitValue(chargingInfo[gunIndex]->GunLocked , 0) == 0) ? NO : YES;
+}
+
+bool isEvContactorWelding_chademo(byte gunIndex)
+{
+    return DetectBitValue(ShmCHAdeMOData->ev[chargingInfo[gunIndex]->type_index].EvDetection, 3);
+}
+
+bool isEvStopReq_chademo(byte gunIndex)
+{
+    return DetectBitValue(ShmCHAdeMOData->ev[chargingInfo[gunIndex]->type_index].EvDetection, 4);
+}
+
+bool isEvStopCharging_chademo(byte gunIndex)
+{
+    if (isEvGunLocked_chademo(gunIndex) == NO) {
+        // 無鎖槍 = 停止
+        PRINTF_FUNC("gun locked none (%d) \n", gunIndex);
+        return YES;
+    }
+
+    return NO;
+}
+
+byte isPrechargeStatus_chademo(byte gunIndex)
+{
+    byte result = 0x00;
+
+    result = ShmCHAdeMOData->ev[chargingInfo[gunIndex]->type_index].PresentMsgFlowStatus;
+
+    return result;
+}
+//===============================================
+// Common Detect Chk - GB
+//===============================================
+bool isEvGunLocked_gb(byte gunIndex)
+{
+    return (DetectBitValue(chargingInfo[gunIndex]->GunLocked , 0) == 0) ? NO : YES;
+}
+
+bool isEvStopCharging_gb(byte gunIndex)
+{
+    if (isEvGunLocked_gb(gunIndex) == NO) {
+        // 無鎖槍 = 停止
+        PRINTF_FUNC("gun locked none. \n");
+        return YES;
+    }
+
+    return NO;
+}
+
+byte isPrechargeStatus_gb(byte gunIndex)
+{
+    byte result = 0x00;
+
+    result = ShmGBTData->ev[chargingInfo[gunIndex]->type_index].PresentMsgFlowStatus;
+
+    return result;
+}
+
+//===============================================
+// Common Detect Chk - CCS
+//===============================================
+bool isEvGunLocked_ccs(byte gunIndex)
+{
+    return (DetectBitValue(chargingInfo[gunIndex]->GunLocked , 0) == 0) ? NO : YES;
+}
+
+byte isPrechargeStatus_ccs(byte gunIndex)
+{
+    byte result = 0x00;
+
+    if (ShmCcsData->CommProtocol == _CCS_COMM_V2GMessage_DIN70121) {
+        result = ShmCcsData->V2GMessage_DIN70121[chargingInfo[gunIndex]->type_index].PresentMsgFlowStatus;
+    }
+
+    return result;
+}
+
+bool isEvStopCharging_ccs(byte gunIndex)
+{
+    if (isEvGunLocked_ccs(gunIndex) == NO) {
+        // 無鎖槍 = 停止
+        PRINTF_FUNC("gun locked none. \n");
+        return YES;
+    }
+
+    return NO;
+}
+
+//===============================================
+// Callback
+//===============================================
+void DisplayChargingInfo()
+{
+    PRINTF_FUNC("*********** DisplayChargingInfo *********** \n");
+    for (byte i = 0; i < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; i++) {
+        if (chargingInfo[i]->SystemStatus != S_IDLE &&
+                chargingInfo[i]->SystemStatus != S_RESERVATION) {
+            ChangeGunSelectByIndex(i);
+            return;
+        }
+    }
+
+    if (ShmSysConfigAndInfo->SysConfig.AcConnectorCount > 0 &&
+            ShmSysConfigAndInfo->SysInfo.CurGunSelectedByAc == NO_DEFINE &&
+            ac_chargingInfo[0]->SystemStatus >= S_PREPARNING && ac_chargingInfo[0]->SystemStatus <= S_COMPLETE) {
+        ShmSysConfigAndInfo->SysInfo.CurGunSelectedByAc = DEFAULT_AC_INDEX;
+    }
+
+    usleep(50000);
+    ShmSysConfigAndInfo->SysInfo.SystemPage = _LCM_NONE;
+}
+
+void _AutoReturnTimeout()
+{
+    PRINTF_FUNC("*********** _AutoReturnTimeout %d*********** \n", ShmSysConfigAndInfo->SysInfo.PageIndex);
+    if (ShmSysConfigAndInfo->SysInfo.PageIndex == _LCM_WAIT_FOR_PLUG) {
+        ClearDetectPluginFlag();
+    } else if (ShmSysConfigAndInfo->SysInfo.PageIndex == _LCM_AUTHORIZ_COMP) {
+        DetectPluginStart();
+    }
+    usleep(50000);
+    ShmSysConfigAndInfo->SysInfo.SystemPage = _LCM_NONE;
+}
+
+void _SelfTestTimeout()
+{
+    if (ShmSysConfigAndInfo->SysInfo.BootingStatus != BOOT_COMPLETE) {
+        for (byte gun_index = 0; gun_index < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; gun_index++) {
+            setChargerMode(gun_index, MODE_ALARM);
+        }
+    }
+    ShmPsuData->Work_Step = _NO_WORKING;
+    ShmSysConfigAndInfo->SysInfo.SelfTestSeq = _STEST_FAIL;
+    PRINTF_FUNC("Self test timeout. \n");
+}
+
+void _AuthorizedTimeout()
+{
+    if (IsAuthorizingMode()) {
+        PRINTF_FUNC("*********** _AuthorizedTimeout *********** \n");
+        isCardScan = false;
+        ShmSysConfigAndInfo->SysInfo.SystemPage = _LCM_AUTHORIZ_FAIL;
+        //ChangeLcmByIndex(_LCM_AUTHORIZ_FAIL);
+        strcpy((char *)ShmSysConfigAndInfo->SysConfig.UserId, "");
+        ClearAuthorizedFlag();
+    }
+}
+
+void _DetectPlugInTimeout()
+{
+    PRINTF_FUNC("*********** _DetectPlugInTimeout *********** \n");
+    strcpy((char *)ShmSysConfigAndInfo->SysConfig.UserId, "");
+    ClearDetectPluginFlag();
+    usleep(50000);
+    ShmSysConfigAndInfo->SysInfo.SystemPage = _LCM_NONE;
+}
+
+void _DetectEvChargingEnableTimeout(byte gunIndex)
+{
+    if (chargingInfo[gunIndex]->Type == _Type_Chademo) {
+        if (!isEvGunLocked_chademo(gunIndex)) {
+            PRINTF_FUNC("*********** _DetectEvChargingEnableTimeout (chademo) ***********\n");
+        }
+    } else if (chargingInfo[gunIndex]->Type == _Type_GB) {
+        if (!isEvGunLocked_ccs(gunIndex)) {
+            PRINTF_FUNC("*********** _DetectEvChargingEnableTimeout (gb) ***********\n");
+        }
+    } else if (chargingInfo[gunIndex]->Type == _Type_CCS_2) {
+        if (!isEvGunLocked_ccs(gunIndex)) {
+            PRINTF_FUNC("*********** _DetectEvChargingEnableTimeout (ccs) ***********\n");
+        }
+    }
+    ChargingTerminalProcess(gunIndex);
+    _AutoReturnTimeout();
+}
+
+void _DetectEvseChargingEnableTimeout(byte gunIndex)
+{
+    PRINTF_FUNC("*********** _DetectEvseChargingEnableTimeout (GFD timeout) ***********\n");
+    //if (chargingInfo[gunIndex]->GroundFaultStatus != GFD_PASS)
+    {
+        setChargerMode(gunIndex, MODE_IDLE);
+        _AutoReturnTimeout();
+    }
+}
+
+void _PrepareTimeout(byte gunIndex)
+{
+    PRINTF_FUNC("*********** _PrepareTimeout ***********\n");
+    setChargerMode(gunIndex, MODE_IDLE);
+    ShmStatusCodeData->AlarmCode.AlarmEvents.bits.PsuNoResource = YES;
+    _AutoReturnTimeout();
+}
+
+void _CcsPrechargeTimeout(byte gunIndex)
+{
+    PRINTF_FUNC("*********** _CcsPrechargeTimeout ***********\n");
+    setChargerMode(gunIndex, MODE_IDLE);
+}
+
+//===============================================
+// 取得卡號與卡號驗證
+//===============================================
+bool canStartCharging()
+{
+    char buf2[16] = "";
+    memset(buf2, 0, ARRAY_SIZE(buf2));
+
+    for (byte index = 0; index < strlen((char *)ShmOCPP16Data->Authorize.ResponseIdTagInfo.Status); index++) {
+        sprintf(buf2 + (index - 1) * 2, "%02X", ShmOCPP16Data->Authorize.ResponseIdTagInfo.Status[index]);
+    }
+    sprintf(buf2, "%s", ShmOCPP16Data->Authorize.ResponseIdTagInfo.Status);
+
+    // 因為無法得知實際的長度，所以只能用搜尋的方式
+    if (strcmp(buf2, "Accepted") == EQUAL) {
+        return true;
+    } else {
+
+    }
+
+    return false;
+}
+
+void AuthorizingStart()
+{
+    ShmOCPP16Data->SpMsg.bits.AuthorizeReq = YES;
+    ShmSysConfigAndInfo->SysInfo.AuthorizeFlag = YES;
+}
+
+void ClearAuthorizedFlag()
+{
+    ShmOCPP16Data->SpMsg.bits.AuthorizeConf = NO;
+    ShmSysConfigAndInfo->SysInfo.AuthorizeFlag = NO;
+}
+
+bool isAuthorizedComplete()
+{
+    if (ShmSysConfigAndInfo->SysInfo.AuthorizeFlag == YES) {
+        return false;
+    }
+    return true;
+}
+
+bool IsAuthorizingMode()
+{
+    if (ShmSysConfigAndInfo->SysInfo.AuthorizeFlag == NO) {
+        return false;
+    }
+
+    return true;
+}
+
+//===============================================
+// 紀錄 Alarm Code
+//===============================================
+void RecordAlarmCode(byte gunIndex, char *code)
+{
+    memcpy(chargingInfo[gunIndex]->ConnectorAlarmCode, code, 6);
+
+    if (strcmp(code, "012234") == EQUAL) { ShmStatusCodeData->AlarmCode.AlarmEvents.bits.ChademoGfdTrip = YES; }
+    if (strcmp(code, "012235") == EQUAL) { ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CcsGfdTrip = YES; }
+    if (strcmp(code, "012236") == EQUAL) { ShmStatusCodeData->AlarmCode.AlarmEvents.bits.GbGfdTrip = YES; }
+    if (strcmp(code, "012288") == EQUAL) { ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CcsOutputUVPFail = YES; }
+    if (strcmp(code, "012289") == EQUAL) { ShmStatusCodeData->AlarmCode.AlarmEvents.bits.ChademoOutputUVPFail = YES; }
+    if (strcmp(code, "012290") == EQUAL) { ShmStatusCodeData->AlarmCode.AlarmEvents.bits.GbtOutputUVPFail = YES; }
+}
+
+void RecordWarningCode(byte gunIndex, char *code)
+{
+    memcpy(chargingInfo[gunIndex]->ConnectorWarningCode, code, 6);
+
+    if (strcmp(code, "012296") == EQUAL) { ShmStatusCodeData->AlarmCode.AlarmEvents.bits.ChademoGroundWarning = YES; }
+    if (strcmp(code, "012297") == EQUAL) { ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CcsGroundfaultWarning = YES; }
+    if (strcmp(code, "012298") == EQUAL) { ShmStatusCodeData->AlarmCode.AlarmEvents.bits.GbGroundfaultWarning = YES; }
+}
+
+void ReleaseAlarmCode(byte gunIndex)
+{
+    bool isCleanCheck = false;
+    char code[7];
+
+    if (chargingInfo[gunIndex]->Type == _Type_Chademo) {
+        if (strncmp((char *)chargingInfo[gunIndex]->ConnectorAlarmCode, "012234", 6) == EQUAL &&
+                ShmStatusCodeData->AlarmCode.AlarmEvents.bits.ChademoGfdTrip == YES) {
+            memcpy(code, "012234", 6);
+            memcpy(chargingInfo[gunIndex]->ConnectorAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)chargingInfo[gunIndex]->ConnectorAlarmCode, "012289", 6) == EQUAL &&
+                   ShmStatusCodeData->AlarmCode.AlarmEvents.bits.ChademoOutputUVPFail == YES) {
+            memcpy(code, "012289", 6);
+            memcpy(chargingInfo[gunIndex]->ConnectorAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (ShmStatusCodeData->AlarmCode.AlarmEvents.bits.ChademoGroundWarning == YES) {
+            ReleaseWarningCodeByString(gunIndex, "012296");
+        }
+    } else if (chargingInfo[gunIndex]->Type == _Type_GB) {
+        if (strncmp((char *)chargingInfo[gunIndex]->ConnectorAlarmCode, "012236", 6) == EQUAL &&
+                ShmStatusCodeData->AlarmCode.AlarmEvents.bits.GbGfdTrip == YES) {
+            memcpy(code, "012236", 6);
+            memcpy(chargingInfo[gunIndex]->ConnectorAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)chargingInfo[gunIndex]->ConnectorAlarmCode, "012290", 6) == EQUAL &&
+                   ShmStatusCodeData->AlarmCode.AlarmEvents.bits.GbtOutputUVPFail == YES) {
+            memcpy(code, "012290", 6);
+            memcpy(chargingInfo[gunIndex]->ConnectorAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (ShmStatusCodeData->AlarmCode.AlarmEvents.bits.GbGroundfaultWarning == YES) {
+            ReleaseWarningCodeByString(gunIndex, "012298");
+        }
+    } else if (chargingInfo[gunIndex]->Type == _Type_CCS_2) {
+        if (strncmp((char *)chargingInfo[gunIndex]->ConnectorAlarmCode, "012235", 6) == EQUAL &&
+                ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CcsGfdTrip == YES) {
+            memcpy(code, "012235", 6);
+            memcpy(chargingInfo[gunIndex]->ConnectorAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (strncmp((char *)chargingInfo[gunIndex]->ConnectorAlarmCode, "012288", 6) == EQUAL &&
+                   ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CcsOutputUVPFail == YES) {
+            memcpy(code, "012288", 6);
+            memcpy(chargingInfo[gunIndex]->ConnectorAlarmCode, "", 6);
+            isCleanCheck = true;
+        } else if (ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CcsGroundfaultWarning == YES) {
+            ReleaseWarningCodeByString(gunIndex, "012297");
+        }
+    }
+
+    if (isCleanCheck) {
+        for (byte index = 0; index < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; index++) {
+            if (index != gunIndex || ShmSysConfigAndInfo->SysConfig.TotalConnectorCount == 1) {
+                if (strncmp((char *)chargingInfo[index]->ConnectorAlarmCode, code, 6) != EQUAL) {
+                    if (strncmp(code, "012234", 6) == EQUAL) { ShmStatusCodeData->AlarmCode.AlarmEvents.bits.ChademoGfdTrip = NO; }
+                    if (strncmp(code, "012289", 6) == EQUAL) { ShmStatusCodeData->AlarmCode.AlarmEvents.bits.ChademoOutputUVPFail = NO; }
+
+                    if (strncmp(code, "012236", 6) == EQUAL) { ShmStatusCodeData->AlarmCode.AlarmEvents.bits.GbGfdTrip = NO; }
+                    if (strncmp(code, "012290", 6) == EQUAL) { ShmStatusCodeData->AlarmCode.AlarmEvents.bits.GbtOutputUVPFail = NO; }
+
+                    if (strncmp(code, "012235", 6) == EQUAL) { ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CcsGfdTrip = NO; }
+                    if (strncmp(code, "012288", 6) == EQUAL) { ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CcsOutputUVPFail = NO; }
+                }
+            }
+        }
+    }
+}
+
+void ReleaseWarningCodeByString(byte gunIndex, char *code)
+{
+    bool isCleanCheck = false;
+
+    if (strncmp((char *)chargingInfo[gunIndex]->ConnectorWarningCode, code, 6) == EQUAL &&
+            ShmStatusCodeData->AlarmCode.AlarmEvents.bits.ChademoGroundWarning == YES) {
+        memcpy(chargingInfo[gunIndex]->ConnectorWarningCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)chargingInfo[gunIndex]->ConnectorWarningCode, code, 6) == EQUAL &&
+               ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CcsGroundfaultWarning == YES) {
+        memcpy(chargingInfo[gunIndex]->ConnectorWarningCode, "", 6);
+        isCleanCheck = true;
+    } else if (strncmp((char *)chargingInfo[gunIndex]->ConnectorWarningCode, code, 6) == EQUAL &&
+               ShmStatusCodeData->AlarmCode.AlarmEvents.bits.GbGroundfaultWarning == YES) {
+        memcpy(chargingInfo[gunIndex]->ConnectorWarningCode, "", 6);
+        isCleanCheck = true;
+    }
+
+    if (isCleanCheck) {
+        for (byte index = 0; index < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; index++) {
+            if (index != gunIndex || ShmSysConfigAndInfo->SysConfig.TotalConnectorCount == 1) {
+                if (strncmp((char *)chargingInfo[index]->ConnectorWarningCode, code, 6) != EQUAL) {
+                    if (strncmp(code, "012296", 6) == EQUAL) { ShmStatusCodeData->AlarmCode.AlarmEvents.bits.ChademoGroundWarning = NO; }
+                    if (strncmp(code, "012297", 6) == EQUAL) { ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CcsGroundfaultWarning = NO; }
+                    if (strncmp(code, "012298", 6) == EQUAL) { ShmStatusCodeData->AlarmCode.AlarmEvents.bits.GbGroundfaultWarning = NO; }
+                }
+            }
+        }
+    }
+}
+//===============================================
+// EmergencyStop and Charging Stop
+//===============================================
+void ChargingTerminalProcess(byte gunIndex)
+{
+    setChargerMode(gunIndex, MODE_TERMINATING);
+}
+
+void AcChargingTerminalProcess()
+{
+    ac_chargingInfo[0]->SystemStatus = MODE_TERMINATING;
+}
+
+void StopChargingProcessByString(byte level)
+{
+    if (level > ShmSysConfigAndInfo->SysWarningInfo.Level) {
+        ShmSysConfigAndInfo->SysWarningInfo.Level = level;
+    }
+}
+
+void ReleaseChargingProcessByString(byte level)
+{
+    if (level >= ShmSysConfigAndInfo->SysWarningInfo.Level) {
+        ShmSysConfigAndInfo->SysWarningInfo.Level = 0;
+    }
+}
+
+// 一般錯誤停止充電處理函式
+void BoardErrOccurByString(byte index, char *code)
+{
+    byte level = 1;
+    if ((chargingInfo[index]->SystemStatus > S_IDLE && chargingInfo[index]->SystemStatus < S_TERMINATING) ||
+            (chargingInfo[index]->SystemStatus >= S_CCS_PRECHARGE_ST0 && chargingInfo[index]->SystemStatus <= S_CCS_PRECHARGE_ST1)) {
+        if (strncmp(code, "023730", 6) == EQUAL && ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoChargerGetEmergencyStop == NO) {
+            ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoChargerGetEmergencyStop = YES;
+        }
+        ChargingTerminalProcess(index);
+    }
+
+    StopChargingProcessByString(level);
+}
+
+// 急停狀況的停止充電處理函式
+void EmcOccureByString(char *code)
+{
+    byte level = 2;
+    // 嚴重的急停有以下幾種 : EMC 按鈕、Mainbreak、Dooropen
+    // 其錯誤等級為 2
+    if (strncmp(code, "012251", 6) == EQUAL || strncmp(code, "012252", 6) == EQUAL || strncmp(code, "012238", 6) == EQUAL ||
+            strncmp(code, "042251", 6) == EQUAL || strncmp(code, "042252", 6) == EQUAL || strncmp(code, "012304", 6) == EQUAL ||
+            strncmp(code, "042200", 6) == EQUAL || strncmp(code, "042201", 6) == EQUAL || strncmp(code, "042202", 6) == EQUAL) {
+        for (byte gun = 0; gun < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; gun++) {
+            if ((chargingInfo[gun]->SystemStatus > S_IDLE && chargingInfo[gun]->SystemStatus < S_TERMINATING) ||
+                    (chargingInfo[gun]->SystemStatus >= S_CCS_PRECHARGE_ST0 && chargingInfo[gun]->SystemStatus <= S_CCS_PRECHARGE_ST1)) {
+                ChargingTerminalProcess(gun);
+            }
+        }
+
+        StopChargingProcessByString(level);
+        InformOcppErrOccur(4);
+    }
+}
+
+void ReleaseBoardErrOccurByString(byte index, char *code)
+{
+    bool isTrigger = false;
+    byte level = 1;
+
+    if (strncmp(code, "023730", 6) == 0 && ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoChargerGetEmergencyStop == YES) {
+        isTrigger = true;
+        ShmStatusCodeData->InfoCode.InfoEvents.bits.ChademoChargerGetEmergencyStop = NO;
+    }
+
+    if (isTrigger) {
+        ReleaseChargingProcessByString(level);
+    }
+}
+
+void ReleaseEmsOccureByString(byte index, char *code)
+{
+    bool isTrigger = false;
+    byte level = 2;
+
+    if (strncmp(code, "042251", 6) == 0 ) {
+        isTrigger = true;
+    } else if (strncmp(code, "012251", 6) == 0 && ShmStatusCodeData->AlarmCode.AlarmEvents.bits.EmergencyStopTrip == YES) {
+        isTrigger = true;
+        ShmStatusCodeData->AlarmCode.AlarmEvents.bits.EmergencyStopTrip = NO;
+    } else if (strncmp(code, "012252", 6) == 0 && ShmStatusCodeData->AlarmCode.AlarmEvents.bits.DoorOpen == YES) {
+        isTrigger = true;
+        ShmStatusCodeData->AlarmCode.AlarmEvents.bits.DoorOpen = NO;
+    } else if (strncmp(code, "012237", 6) == 0 && ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SpdTrip == YES) {
+        isTrigger = true;
+        ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SpdTrip = NO;
+    } else if (strncmp(code, "012238", 6) == 0 && ShmStatusCodeData->AlarmCode.AlarmEvents.bits.MainPowerBreakerTrip == YES) {
+        isTrigger = true;
+        ShmStatusCodeData->AlarmCode.AlarmEvents.bits.MainPowerBreakerTrip = NO;
+    }
+
+    if (isTrigger) {
+        ReleaseChargingProcessByString(level);
+        InformOcppErrOccur(6);
+    }
+}
+
+//===============================================
+// 確認硬體 (按鈕) 狀態
+//===============================================
+bool leftBtnPush = false;
+bool rightBtnPush = false;
+
+void ChkPrimaryStatus()
+{
+    unsigned char Rtn;
+
+    if (ShmSysConfigAndInfo->SysWarningInfo.WarningCount > 0) {
+        Rtn = 0;
+        for (unsigned char i = 0; i < ShmSysConfigAndInfo->SysWarningInfo.WarningCount; i++) {
+            if (memcmp(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i][0], "042251", 6) == 0) {
+                EmcOccureByString("042251");
+                Rtn = 1;
+            } else if (memcmp(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i][0], "042252", 6) == 0) {
+                EmcOccureByString("042252");
+                Rtn = 1;
+            } else if (memcmp(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i][0], "042200", 6) == 0) {
+                EmcOccureByString("042200");
+                Rtn = 1;
+            } else if (memcmp(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i][0], "042201", 6) == 0) {
+                EmcOccureByString("042201");
+                Rtn = 1;
+            } else if (memcmp(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i][0], "042202", 6) == 0) {
+                EmcOccureByString("042202");
+                Rtn = 1;
+            } else if (memcmp(&ShmSysConfigAndInfo->SysWarningInfo.WarningCode[i][0], "012304", 6) == 0) {
+                EmcOccureByString("012304");
+                Rtn = 1;
+            }
+        }
+        if (Rtn == 0) {
+            ReleaseEmsOccureByString(0, "042251");
+            ReleaseEmsOccureByString(0, "042252");
+            ReleaseEmsOccureByString(0, "042200");
+            ReleaseEmsOccureByString(0, "042201");
+            ReleaseEmsOccureByString(0, "042202");
+            ReleaseEmsOccureByString(0, "012304");
+        }
+    } else {
+        ReleaseEmsOccureByString(0, "042251");
+        ReleaseEmsOccureByString(0, "042252");
+        ReleaseEmsOccureByString(0, "042200");
+        ReleaseEmsOccureByString(0, "042201");
+        ReleaseEmsOccureByString(0, "042202");
+        ReleaseEmsOccureByString(0, "012304");
+    }
+
+    if (ShmPrimaryMcuData->InputDet.bits.EmergencyButton == ABNORMAL) {
+        ShmStatusCodeData->AlarmCode.AlarmEvents.bits.EmergencyStopTrip = YES;
+        EmcOccureByString("012251");
+    } else {
+        ReleaseEmsOccureByString(0, "012251");
+    }
+
+    if (ShmPrimaryMcuData->InputDet.bits.AcMainBreakerDetec == ABNORMAL) {
+        ShmStatusCodeData->AlarmCode.AlarmEvents.bits.MainPowerBreakerTrip = YES;
+        EmcOccureByString("012238");
+    } else {
+        ReleaseEmsOccureByString(0, "012238");
+    }
+
+    if (ShmPrimaryMcuData->InputDet.bits.SpdDetec == ABNORMAL) {
+        ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SpdTrip = YES;
+    } else {
+        ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SpdTrip = NO;
+    }
+
+    if (ShmPrimaryMcuData->InputDet.bits.DoorOpen == ABNORMAL) {
+        ShmStatusCodeData->AlarmCode.AlarmEvents.bits.DoorOpen = YES;
+        EmcOccureByString("012252");
+    } else {
+        ReleaseEmsOccureByString(0, "012252");
+    }
+
+    if (ShmPrimaryMcuData->InputDet.bits.Button1 == BTN_PRESS && !leftBtnPush) {
+        if (!leftBtnPush) {
+            leftBtnPush = true;
+            //PRINTF_FUNC("left btn down............................... \n");
+            if (ShmSysConfigAndInfo->SysInfo.CurGunSelectedByAc != NO_DEFINE) {
+                switch (ac_chargingInfo[0]->SystemStatus) {
+                case S_IDLE: {
+                    if (isDetectPlugin()) {
+                        _DetectPlugInTimeout();
+                        StopSystemTimeoutDet();
+                    }
+                }
+                break;
+                case S_REASSIGN_CHECK:
+                case S_REASSIGN:
+                case S_PREPARNING:
+                case S_PREPARING_FOR_EV:
+                case S_PREPARING_FOR_EVSE:
+                case S_CCS_PRECHARGE_ST0:
+                case S_CCS_PRECHARGE_ST1: {
+                    // 取消充電
+                    AcChargingTerminalProcess();
+                }
+                break;
+                case S_CHARGING: {
+                    if (ShmSysConfigAndInfo->SysConfig.AuthorisationMode == AUTH_MODE_DISABLE) {
+                        // 停止充電
+                        AcChargingTerminalProcess();
+                    }
+                }
+                break;
+                case S_COMPLETE:
+                {}
+                break;
+                }
+            }
+
+            switch (chargingInfo[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->SystemStatus) {
+            case S_IDLE: {
+                if (isDetectPlugin()) {
+                    _DetectPlugInTimeout();
+                    StopSystemTimeoutDet();
+                }
+            }
+            break;
+            case S_REASSIGN_CHECK:
+            case S_REASSIGN:
+            case S_PREPARNING:
+            case S_PREPARING_FOR_EV:
+            case S_PREPARING_FOR_EVSE:
+            case S_CCS_PRECHARGE_ST0:
+            case S_CCS_PRECHARGE_ST1: {
+                // 取消充電
+                if (ShmSysConfigAndInfo->SysInfo.CurGunSelectedByAc != NO_DEFINE) {
+                    AcChargingTerminalProcess();
+                } else {
+                    ChargingTerminalProcess(ShmSysConfigAndInfo->SysInfo.CurGunSelected);
+                }
+            }
+            break;
+            case S_CHARGING: {
+                if (ShmSysConfigAndInfo->SysConfig.AuthorisationMode == AUTH_MODE_DISABLE) {
+                    // 停止充電
+                    ChargingTerminalProcess(ShmSysConfigAndInfo->SysInfo.CurGunSelected);
+                }
+            }
+            break;
+            case S_COMPLETE: {
+                // 回 IDLE
+                //PRINTF_FUNC("right btn down.................S_COMPLETE \n");
+                //chargingInfo[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->SystemStatus = S_IDLE;
+            }
+            break;
+            }
+        }
+    } else if (ShmPrimaryMcuData->InputDet.bits.Button1 == BTN_RELEASE) {
+        if (leftBtnPush) {
+            leftBtnPush = false;
+            //PRINTF_FUNC("left btn up............................... \n");
+        }
+    }
+
+    if (ShmPrimaryMcuData->InputDet.bits.Button2 == BTN_PRESS && !rightBtnPush) {
+        if (!rightBtnPush) {
+            rightBtnPush = true;
+            //PRINTF_FUNC("right btn down............................... %d \n", ShmSysConfigAndInfo->SysInfo.CurGunSelected);
+            if (ShmSysConfigAndInfo->SysInfo.CurGunSelected + 1 < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount &&
+                    ShmSysConfigAndInfo->SysInfo.IsAlternatvieConf == NO) {
+                ShmSysConfigAndInfo->SysInfo.CurGunSelected++;
+                ChangeGunSelectByIndex(ShmSysConfigAndInfo->SysInfo.CurGunSelected);
+            } else if (ShmSysConfigAndInfo->SysConfig.AcConnectorCount > 0 &&
+                       ShmSysConfigAndInfo->SysInfo.CurGunSelectedByAc == NO_DEFINE) {
+                ShmSysConfigAndInfo->SysInfo.CurGunSelectedByAc = DEFAULT_AC_INDEX;
+            } else if (ShmSysConfigAndInfo->SysInfo.IsAlternatvieConf == YES) {
+                for (byte _index = 0; _index < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; _index++) {
+                    if (chargingInfo[_index]->SystemStatus != S_BOOTING &&
+                            chargingInfo[_index]->SystemStatus != S_IDLE &&
+                            chargingInfo[_index]->SystemStatus != S_RESERVATION) {
+                        ShmSysConfigAndInfo->SysInfo.CurGunSelected = _index;
+                        ChangeGunSelectByIndex(ShmSysConfigAndInfo->SysInfo.CurGunSelected);
+                        return;
+                    }
+                }
+
+                ShmSysConfigAndInfo->SysInfo.CurGunSelected = 0;
+                ChangeGunSelectByIndex(ShmSysConfigAndInfo->SysInfo.CurGunSelected);
+            } else {
+                ShmSysConfigAndInfo->SysInfo.CurGunSelected = 0;
+                ChangeGunSelectByIndex(ShmSysConfigAndInfo->SysInfo.CurGunSelected);
+            }
+        }
+    } else if (ShmPrimaryMcuData->InputDet.bits.Button2 == BTN_RELEASE) {
+        if (rightBtnPush) {
+            rightBtnPush = false;
+            //PRINTF_FUNC("right btn up............................... \n");
+        }
+    }
+}
+
+//===============================================
+// 確認各小板偵測的錯誤狀況
+//===============================================
+void CheckErrorOccurStatus(byte index)
+{
+    // 小板
+    if (chargingInfo[index]->Type == _Type_Chademo) {
+        if (ShmStatusCodeData->FaultCode.FaultEvents.bits.ChademoOutputRelayDrivingFault == YES) {
+            BoardErrOccurByString(index, "011012");
+        }
+//      else if (ShmStatusCodeData->AlarmCode.AlarmEvents.bits.ChademoGfdTrip == YES)
+//          BoardErrOccurByString(index, "012234");
+    } else if (chargingInfo[index]->Type == _Type_GB) {
+        if (ShmStatusCodeData->FaultCode.FaultEvents.bits.GbOutputRelayDrivingFault == YES) {
+            BoardErrOccurByString(index, "011016");
+        }
+//      else if (ShmStatusCodeData->AlarmCode.AlarmEvents.bits.GbGfdTrip == YES)
+//          BoardErrOccurByString(index, "012236");
+    } else if (chargingInfo[index]->Type == _Type_CCS_2) {
+        if (ShmStatusCodeData->FaultCode.FaultEvents.bits.CcsOutputRelayDrivingFault == YES) {
+            BoardErrOccurByString(index, "011014");
+        }
+//      else if (ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CcsGfdTrip == YES)
+//          BoardErrOccurByString(index, "012235");
+    }
+
+    // RB
+    if (ShmSysConfigAndInfo->SysConfig.PhaseLossPolicy == YES) {
+        if (ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL1InputUVP == YES ||
+                ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL2InputUVP == YES ||
+                ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL3InputUVP == YES) {
+            if (ShmSysConfigAndInfo->SysWarningInfo.ExtraErrProcess == _EXTRA_ERR_PROCESS_NONE) {
+                ShmSysConfigAndInfo->SysWarningInfo.ExtraErrProcess = _EXTRA_ERR_PROCESS_INUVP;
+                StopChargingProcessByString(2);
+                InformOcppErrOccur(13);
+            }
+        } else {
+            if (ShmSysConfigAndInfo->SysWarningInfo.ExtraErrProcess == _EXTRA_ERR_PROCESS_INUVP) {
+                ShmSysConfigAndInfo->SysWarningInfo.ExtraErrProcess = _EXTRA_ERR_PROCESS_NONE;
+                ReleaseChargingProcessByString(2);
+                InformOcppErrOccur(6);
+            }
+        }
+    } else {
+        if (ShmSysConfigAndInfo->SysWarningInfo.ExtraErrProcess == _EXTRA_ERR_PROCESS_INUVP) {
+            ShmSysConfigAndInfo->SysWarningInfo.ExtraErrProcess = _EXTRA_ERR_PROCESS_NONE;
+            ReleaseChargingProcessByString(2);
+            InformOcppErrOccur(6);
+        }
+    }
+
+    if (ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL1InputOVP == YES ||
+            ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL2InputOVP == YES ||
+            ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL3InputOVP == YES) {
+        if (ShmSysConfigAndInfo->SysWarningInfo.ExtraErrProcess == _EXTRA_ERR_PROCESS_NONE) {
+            ShmSysConfigAndInfo->SysWarningInfo.ExtraErrProcess = _EXTRA_ERR_PROCESS_INOVP;
+            StopChargingProcessByString(2);
+            InformOcppErrOccur(14);
+        }
+    } else {
+        if (ShmSysConfigAndInfo->SysWarningInfo.ExtraErrProcess == _EXTRA_ERR_PROCESS_INOVP) {
+            ShmSysConfigAndInfo->SysWarningInfo.ExtraErrProcess = _EXTRA_ERR_PROCESS_NONE;
+            ReleaseChargingProcessByString(2);
+            InformOcppErrOccur(6);
+        }
+    }
+}
+
+//===============================================
+// 確認 GPIO 狀態
+//===============================================
+void gpio_set_value(unsigned int gpio, unsigned int value)
+{
+    int fd;
+    char buf[MAX_BUF];
+
+    snprintf(buf, sizeof(buf), SYSFS_GPIO_DIR "/gpio%d/value", gpio);
+    fd = open(buf, O_WRONLY);
+    if (fd < 0) {
+        perror("gpio/set-value");
+        return;
+    }
+
+    if (value) {
+        write(fd, "1", 2);
+    } else {
+        write(fd, "0", 2);
+    }
+
+    close(fd);
+}
+
+int gpio_get_value(unsigned int gpio, unsigned int *value)
+{
+    int fd;
+    char buf[MAX_BUF];
+    char ch;
+
+    snprintf(buf, sizeof(buf), SYSFS_GPIO_DIR "/gpio%d/value", gpio);
+
+    fd = open(buf, O_RDONLY);
+    if (fd < 0) {
+        perror("gpio/get-value");
+        return fd;
+    }
+
+    read(fd, &ch, 1);
+
+    if (ch != '0') {
+        *value = 1;
+    } else {
+        *value = 0;
+    }
+
+    close(fd);
+    return 0;
+}
+
+void CheckGunTypeFromHw()
+{
+    int pinIn[4] = { 22, 23, 44, 45 };
+    unsigned int gpioValue = 0;
+    unsigned char tmp[2];
+
+    DEBUG_INFO_MSG("ModelName = %s", ShmSysConfigAndInfo->SysConfig.ModelName);
+    for (int i = 0; i < ARRAY_SIZE(pinIn); i++) {
+        gpio_get_value(pinIn[i], &gpioValue);
+        switch (pinIn[i]) {
+        case 22:
+            bd1_1_status = gpioValue;
+            break;
+        case 23:
+            bd1_2_status = gpioValue;
+            break;
+
+        case 44:
+            bd0_1_status = gpioValue;
+            break;
+        case 45:
+            bd0_2_status = gpioValue;
+            break;
+        }
+    }
+    //BD1(Left-CCS-CND1-SMR2-左槍), BD2(Right-CHADEMO-CND2-SMR1-右槍), CCS: 10 , CHAdeMO: 01 , GBT: 11
+    //CcsChargingData [0至1] 分別為 Right至Left
+    //model name 槍順序左至右分別為Right至Left
+    memset(tmp, 0, sizeof(tmp));
+    tmp[1] = (bd0_1_status << 4 | bd0_2_status);
+    tmp[0] = (bd1_1_status << 4 | bd1_2_status);
+    for (int i = 0; i < 2; i++) {
+        switch (tmp[i]) {
+        case 0x01:
+            DEBUG_INFO_MSG("BD%d(%s) = %s ", i + 1, i + 1 == 1 ? "Right" : "Left", "CHAdeMO");
+            break;
+        case 0x10:
+            DEBUG_INFO_MSG("BD%d(%s) = %s ", i + 1, i + 1 == 1 ? "Right" : "Left", "CCS");
+            break;
+        case 0x11:
+            DEBUG_INFO_MSG("BD%d(%s) = %s ", i + 1, i + 1 == 1 ? "Right" : "Left", "GBT");
+            break;
+        case 0x00:
+            DEBUG_INFO_MSG("BD%d(%s) = %s ", i + 1, i + 1 == 1 ? "Right" : "Left", "None");
+            break;
+        }
+    }
+}
+
+void CheckGpioInStatus()
+{
+    int pinIn[2] = { 27, 47 };//{IO BD1_2, IO BD2_2}
+    unsigned int gpioValue = 0;
+
+    for (int i = 0; i < ARRAY_SIZE(pinIn); i++) {
+        gpio_get_value(pinIn[i], &gpioValue);
+        if (gpioValue == 0x01) {
+            switch (pinIn[i]) {
+            // 小板緊急停止
+            case 47: {
+                for (int i = 0; i < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; i++) {
+                    if (chargingInfo[i]->slotsIndex == 1) {
+                        if (chargingInfo[i]->Type == _Type_Chademo) {
+                            BoardErrOccurByString(i, "023730");
+                        } else if (chargingInfo[i]->Type == _Type_CCS_2) {
+                            BoardErrOccurByString(i, "013627");
+                        }
+                        break;
+                    }
+                }
+            }
+            break;
+            case 27: {
+                for (int i = 0; i < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; i++) {
+                    if (chargingInfo[i]->slotsIndex == 3) {
+                        if (chargingInfo[i]->Type == _Type_Chademo) {
+                            BoardErrOccurByString(i, "023730");
+                        } else if (chargingInfo[i]->Type == _Type_CCS_2) {
+                            BoardErrOccurByString(i, "013627");
+                        }
+                        break;
+                    }
+                }
+            }
+            break;
+            }
+        } else {
+            switch (pinIn[i]) {
+            // 小板解除緊急停止
+            case 47: {
+                for (int i = 0; i < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; i++) {
+                    if (chargingInfo[i]->slotsIndex == 1) {
+                        if (chargingInfo[i]->Type == _Type_Chademo) {
+                            ReleaseBoardErrOccurByString(i, "023730");
+                        } else if (chargingInfo[i]->Type == _Type_CCS_2) {
+                            ReleaseBoardErrOccurByString(i, "013627");
+                        }
+                        break;
+                    }
+                }
+            }
+            break;
+            case 27: {
+                for (int i = 0; i < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; i++) {
+                    if (chargingInfo[i]->slotsIndex == 3) {
+                        if (chargingInfo[i]->Type == _Type_Chademo) {
+                            ReleaseBoardErrOccurByString(i, "023730");
+                        } else if (chargingInfo[i]->Type == _Type_CCS_2) {
+                            ReleaseBoardErrOccurByString(i, "013627");
+                        }
+                        break;
+                    }
+                }
+            }
+            break;
+            }
+        }
+    }
+}
+
+//===============================================
+// Main process
+//===============================================
+// 檢查 Byte 中某個 Bit 的值
+// _byte : 欲改變的 byte
+// _bit : 該 byte 的第幾個 bit
+unsigned char DetectBitValue(unsigned char _byte, unsigned char _bit)
+{
+    return ( _byte & mask_table[_bit] ) != 0x00;
+}
+
+// 設定 Byte 中某個 Biｔ的值
+// _byte : 欲改變的 byte
+// _bit : 該 byte 的第幾個 bit
+// value : 修改的值為 0 or 1
+void SetBitValue(unsigned char *_byte, unsigned char _bit, unsigned char value)
+{
+    if (value == 1) {
+        *_byte |= (1 << _bit);
+    } else if (value == 0) {
+        *_byte ^= (1 << _bit);
+    }
+}
+
+void UserScanFunction()
+{
+    bool idleReq = false;
+    unsigned char stopReq = 255;
+
+    // 當前非驗證的狀態
+    if (!IsAuthorizingMode()) {
+        // 先判斷現在是否可以提供刷卡
+        // 1. 如果當前沒有槍是閒置狀態，則無提供刷卡功能
+        // 2. 停止充電
+        if (ShmSysConfigAndInfo->SysInfo.PageIndex == _LCM_FIX) {
+            strcpy((char *)ShmSysConfigAndInfo->SysConfig.UserId, "");
+            return;
+        }
+
+        for (byte i = 0; i < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; i++) {
+            if (chargingInfo[i]->SystemStatus == S_CHARGING) {
+                stopReq = i;
+            }
+            if ((chargingInfo[i]->SystemStatus == S_IDLE && chargingInfo[i]->IsAvailable) == YES ||
+                    (_acgunIndex > 0 && ac_chargingInfo[0]->SystemStatus == S_IDLE && ac_chargingInfo[0]->IsAvailable)) {
+                idleReq = true;
+            }
+        }
+
+        if (_acgunIndex > 0 && ShmSysConfigAndInfo->SysInfo.CurGunSelectedByAc == DEFAULT_AC_INDEX &&
+                ac_chargingInfo[0]->SystemStatus == S_CHARGING) {
+            stopReq = DEFAULT_AC_INDEX;
+        }
+
+        if (strlen((char *)ShmSysConfigAndInfo->SysConfig.UserId) > 0) {
+            if (_acgunIndex > 0 && stopReq == DEFAULT_AC_INDEX && ShmSysConfigAndInfo->SysInfo.CurGunSelectedByAc == DEFAULT_AC_INDEX) {
+                char value[32];
+
+                PRINTF_FUNC("ac stop charging \n");
+                PRINTF_FUNC("index = %d, card number = %s, UserId = %s \n", ShmSysConfigAndInfo->SysInfo.CurGunSelectedByAc,
+                            ac_chargingInfo[0]->StartUserId, ShmSysConfigAndInfo->SysConfig.UserId);
+                memcpy(value, (unsigned char *)ac_chargingInfo[0]->StartUserId,
+                       ARRAY_SIZE(ac_chargingInfo[0]->StartUserId));
+                if (strcmp((char *)ShmSysConfigAndInfo->SysConfig.UserId, value) == EQUAL) {
+                    AcChargingTerminalProcess();
+                }
+                strcpy((char *)ShmSysConfigAndInfo->SysConfig.UserId, "");
+            } else if (stopReq < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount &&
+                       chargingInfo[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->SystemStatus == S_CHARGING &&
+                       (_acgunIndex <= 0 || (_acgunIndex > 0 && ShmSysConfigAndInfo->SysInfo.CurGunSelectedByAc == NO_DEFINE))) {
+                char value[32];
+
+                PRINTF_FUNC("stop charging \n");
+                PRINTF_FUNC("index = %d, card number = %s, UserId = %s \n", ShmSysConfigAndInfo->SysInfo.CurGunSelected,
+                            chargingInfo[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->StartUserId, ShmSysConfigAndInfo->SysConfig.UserId);
+                memcpy(value, (unsigned char *)chargingInfo[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->StartUserId,
+                       ARRAY_SIZE(chargingInfo[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->StartUserId));
+
+                // 同一張卡直接停掉
+                if (strcmp((char *)ShmSysConfigAndInfo->SysConfig.UserId, value) == EQUAL) {
+                    ChargingTerminalProcess(ShmSysConfigAndInfo->SysInfo.CurGunSelected);
+                    strcpy((char *)ShmSysConfigAndInfo->SysConfig.UserId, "");
+                } else {
+                    // 進驗證
+                    if (_acgunIndex > 0 && ShmSysConfigAndInfo->SysInfo.CurGunSelectedByAc == DEFAULT_AC_INDEX) {
+                        _authorizeIndex = ShmSysConfigAndInfo->SysInfo.CurGunSelectedByAc;
+                    } else {
+                        _authorizeIndex = ShmSysConfigAndInfo->SysInfo.CurGunSelected;
+                    }
+#ifndef DD360
+                    StartSystemTimeoutDet(Timeout_AuthorizingForStop);
+                    AuthorizingStart();
+#else
+                    strcpy((char *)ShmSysConfigAndInfo->SysConfig.UserId, "");
+#endif
+                }
+            } else if (idleReq) {
+                if (ShmSysConfigAndInfo->SysConfig.TotalConnectorCount > 1 &&
+                        stopReq != 255 &&
+                        ShmSysConfigAndInfo->SysInfo.IsAlternatvieConf == YES) {
+                    idleReq = false;
+                    strcpy((char *)ShmSysConfigAndInfo->SysConfig.UserId, "");
+                } else if ((_acgunIndex > 0 && ShmSysConfigAndInfo->SysInfo.CurGunSelectedByAc == DEFAULT_AC_INDEX) ||
+                           chargingInfo[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->SystemStatus == S_IDLE) {
+                    PRINTF_FUNC("// LCM => Authorizing \n");
+                    // LCM => Authorizing
+                    ShmSysConfigAndInfo->SysInfo.SystemPage = _LCM_AUTHORIZING;
+                    // 進入確認卡號狀態
+                    AuthorizingStart();
+                } else {
+                    strcpy((char *)ShmSysConfigAndInfo->SysConfig.UserId, "");
+                }
+            } else {
+                strcpy((char *)ShmSysConfigAndInfo->SysConfig.UserId, "");
+            }
+        }
+    } else {
+        // 透過後臺停止充電的判斷
+        if (isAuthorizedComplete() /*||
+                (ShmSysConfigAndInfo->SysInfo.OcppConnStatus == NO &&
+                    ShmSysConfigAndInfo->SysConfig.OfflinePolicy == _OFFLINE_POLICY_FREE_CHARGING)*/) {
+            // 判斷後台回覆狀態
+            if (canStartCharging() /*||
+                (ShmSysConfigAndInfo->SysInfo.OcppConnStatus == NO &&
+                    ShmSysConfigAndInfo->SysConfig.OfflinePolicy == _OFFLINE_POLICY_FREE_CHARGING)*/) {
+                if (_authorizeIndex != NO_DEFINE) {
+                    // 先找 AC
+                    if (_authorizeIndex == DEFAULT_AC_INDEX) {
+                        if (ShmSysConfigAndInfo->SysConfig.OfflinePolicy == _OFFLINE_POLICY_LOCAL_LIST &&
+                                strcmp((char *)chargingInfo[_authorizeIndex]->StartUserId, "") != EQUAL) {
+                            AcChargingTerminalProcess();
+                        }
+                    } else {
+                        if (ShmSysConfigAndInfo->SysConfig.OfflinePolicy == _OFFLINE_POLICY_LOCAL_LIST &&
+                                strcmp((char *)chargingInfo[_authorizeIndex]->StartUserId, "") != EQUAL) {
+                            ChargingTerminalProcess(_authorizeIndex);
+                        }
+                    }
+                    strcpy((char *)ShmSysConfigAndInfo->SysConfig.UserId, "");
+                    _authorizeIndex = NO_DEFINE;
+                }
+            } else {
+                strcpy((char *)ShmSysConfigAndInfo->SysConfig.UserId, "");
+            }
+            ClearAuthorizedFlag();
+        } else if (ShmSysConfigAndInfo->SysConfig.OfflinePolicy == _OFFLINE_POLICY_LOCAL_LIST) {
+            // 白名單驗證
+            for (int i = 0; i < 10; i++) {
+                if (strcmp((char *)ShmSysConfigAndInfo->SysConfig.LocalWhiteCard[i], "") != EQUAL) {
+                    if (strcmp((char *)ShmSysConfigAndInfo->SysConfig.LocalWhiteCard[i], (char *)ShmSysConfigAndInfo->SysConfig.UserId) == EQUAL) {
+                        ChargingTerminalProcess(_authorizeIndex);
+                        strcpy((char *)ShmSysConfigAndInfo->SysConfig.UserId, "");
+                        ClearAuthorizedFlag();
+                        break;
+                    }
+                }
+            }
+        }
+    }
+}
+
+unsigned char isModeChange(unsigned char gun_index)
+{
+    unsigned char result = NO;
+
+    if (chargingInfo[gun_index]->SystemStatus != chargingInfo[gun_index]->PreviousSystemStatus) {
+        result = YES;
+        chargingInfo[gun_index]->PreviousSystemStatus = chargingInfo[gun_index]->SystemStatus;
+    }
+
+    return result;
+}
+
+void ScannerCardProcess()
+{
+    if (!isDetectPlugin() && !isCardScan && ShmSysConfigAndInfo->SysWarningInfo.Level != 2 &&
+            ShmSysConfigAndInfo->SysConfig.AuthorisationMode == AUTH_MODE_ENABLE) {
+        isCardScan = true;
+        // 處理刷卡及驗證卡號的動作
+        UserScanFunction();
+    }
+
+    if (ShmSysConfigAndInfo->SysInfo.PageIndex == _LCM_AUTHORIZING) {
+        StartSystemTimeoutDet(Timeout_Authorizing);
+
+        // 確認驗證卡號完成沒
+        if (isAuthorizedComplete() /*|| ShmSysConfigAndInfo->SysConfig.OfflinePolicy == _OFFLINE_POLICY_FREE_CHARGING*/) {
+            StopSystemTimeoutDet();
+            // 判斷後台回覆狀態
+            if (canStartCharging() /*|| ShmSysConfigAndInfo->SysConfig.OfflinePolicy == _OFFLINE_POLICY_FREE_CHARGING*/) {
+                // LCM => Authorize complete
+                ShmSysConfigAndInfo->SysInfo.SystemPage = _LCM_AUTHORIZ_COMP;
+            } else {
+                // LCM => Authorize fail
+                ShmSysConfigAndInfo->SysInfo.SystemPage = _LCM_AUTHORIZ_FAIL;
+                strcpy((char *)ShmSysConfigAndInfo->SysConfig.UserId, "");
+            }
+            ClearAuthorizedFlag();
+        } else if (ShmSysConfigAndInfo->SysConfig.OfflinePolicy == _OFFLINE_POLICY_LOCAL_LIST) {
+            // 白名單驗證
+            for (int i = 0; i < 10; i++) {
+                if (strcmp((char *)ShmSysConfigAndInfo->SysConfig.LocalWhiteCard[i], "") != EQUAL) {
+                    if (strcmp((char *)ShmSysConfigAndInfo->SysConfig.LocalWhiteCard[i], (char *)ShmSysConfigAndInfo->SysConfig.UserId) == EQUAL) {
+                        ShmSysConfigAndInfo->SysInfo.SystemPage = _LCM_AUTHORIZ_COMP;
+                        ClearAuthorizedFlag();
+                        break;
+                    }
+                }
+            }
+        }
+    } else if (ShmSysConfigAndInfo->SysInfo.PageIndex == _LCM_AUTHORIZ_FAIL) {
+        StartSystemTimeoutDet(Timeout_VerifyFail);
+        isCardScan = false;
+    } else if (ShmSysConfigAndInfo->SysInfo.PageIndex == _LCM_AUTHORIZ_COMP) {
+        StartSystemTimeoutDet(Timeout_VerifyComp);
+    } else if (ShmSysConfigAndInfo->SysInfo.PageIndex == _LCM_WAIT_FOR_PLUG) {
+        StartSystemTimeoutDet(Timeout_WaitPlug);
+    } else {
+        isCardScan = false;
+    }
+}
+
+bool AddGunInfoByConnector(byte typeValue, byte slots)
+{
+    bool result = true;
+
+    switch (typeValue) {
+    case '0': // none
+        break;
+    case '1': // IEC 62196-2 Type 1/SAE J1772 Plug
+        break;
+    case '2': // IEC 62196-2 Type 1/SAE J1772 Socket
+        break;
+    case '3': // IEC 62196-2 Type 2 Plug
+    case '4': // IEC 62196-2 Type 2 Socket
+        if (AC_QUANTITY > _ac_Index) {
+            ac_chargingInfo[_acgunIndex] = &ShmSysConfigAndInfo->SysInfo.AcChargingData[_ac_Index];
+
+            // AC 固定 index
+            ac_chargingInfo[_acgunIndex]->Index = 0;
+            ac_chargingInfo[_acgunIndex]->ReservationId = -1;
+            ac_chargingInfo[_acgunIndex]->SystemStatus = S_IDLE;
+            ac_chargingInfo[_acgunIndex]->Type = _Type_AC;
+            ac_chargingInfo[_acgunIndex]->IsAvailable = YES;
+            _ac_Index++;
+            _acgunIndex++;
+        } else {
+            result = false;
+        }
+        break;
+    case '5': // GB/T AC Plug
+        break;
+    case '6': // GB/T AC Socket
+        break;
+    case 'J': { // CHAdeMO
+        if (CHAdeMO_QUANTITY > _chademoIndex) {
+            chargingInfo[_gunIndex] = &ShmSysConfigAndInfo->SysInfo.ChademoChargingData[_chademoIndex];
+            chargingInfo[_gunIndex]->Index = _gunIndex;
+            chargingInfo[_gunIndex]->ReservationId = -1;
+            chargingInfo[_gunIndex]->slotsIndex = slots;
+            chargingInfo[_gunIndex]->SystemStatus = S_BOOTING;
+            chargingInfo[_gunIndex]->Type = _Type_Chademo;
+            chargingInfo[_gunIndex]->type_index = _chademoIndex;
+            chargingInfo[_gunIndex]->IsAvailable = YES;
+            _chademoIndex++;
+            _gunIndex++;
+        } else {
+            result = false;
+        }
+    }
+    break;
+    case 'U': // CCS1 combo
+    case 'E': // CCS2 combo
+    case 'V': // Liquid CCS1 combo
+    case 'F': { // Liquid CCS2 combo
+        if (CCS_QUANTITY > _ccsIndex) {
+            chargingInfo[_gunIndex] = &ShmSysConfigAndInfo->SysInfo.CcsChargingData[_ccsIndex];
+
+            chargingInfo[_gunIndex]->Index = _gunIndex;
+            chargingInfo[_gunIndex]->ReservationId = -1;
+            chargingInfo[_gunIndex]->slotsIndex = slots;
+            chargingInfo[_gunIndex]->SystemStatus = S_BOOTING;
+            chargingInfo[_gunIndex]->Type = _Type_CCS_2;
+            chargingInfo[_gunIndex]->type_index = _ccsIndex;
+            chargingInfo[_gunIndex]->IsAvailable = YES;
+            // 現階段預設為走 DIN70121
+            ShmCcsData->CommProtocol = _CCS_COMM_V2GMessage_DIN70121;
+            _ccsIndex++;
+            _gunIndex++;
+        } else {
+            result = false;
+        }
+    }
+    break;
+    case 'G': { // GBT DC
+        if (GB_QUANTITY > _gb_Index) {
+            chargingInfo[_gunIndex] = &ShmSysConfigAndInfo->SysInfo.GbChargingData[_gb_Index];
+
+            chargingInfo[_gunIndex]->Index = _gunIndex;
+            chargingInfo[_gunIndex]->ReservationId = -1;
+            chargingInfo[_gunIndex]->slotsIndex = slots;
+            chargingInfo[_gunIndex]->SystemStatus = S_BOOTING;
+            chargingInfo[_gunIndex]->Type = _Type_GB;
+            chargingInfo[_gunIndex]->type_index = _gb_Index;
+            chargingInfo[_gunIndex]->IsAvailable = YES;
+            _gb_Index++;
+            _gunIndex++;
+        } else {
+            result = false;
+        }
+    }
+    break;
+    case 'D': // GBT DC x 2
+        break;
+    }
+    return result;
+}
+
+bool CheckConnectorTypeStatus()
+{
+    bool result = true;
+
+    /*
+    PRINTF_FUNC("bd0_1_status = %d, bd0_2_status = %d, bd1_1_status = %d, bd1_2_status = %d \n",
+            bd0_1_status, bd0_2_status, bd1_1_status, bd1_2_status);
+    */
+    if (strlen((char *) ShmSysConfigAndInfo->SysConfig.ModelName) >= 9) {
+        byte slots = 1;
+        for (byte typeIndex = 7; typeIndex <= 9; typeIndex++) {
+            if (!AddGunInfoByConnector(ShmSysConfigAndInfo->SysConfig.ModelName[typeIndex], slots)) {
+                return false;
+            }
+
+            slots++;
+        }
+
+        // AC index 接在 DC 後面
+        if (AC_QUANTITY > 0) {
+            ac_chargingInfo[0]->Index += _gunIndex;
+        }
+
+        ShmSysConfigAndInfo->SysConfig.TotalConnectorCount = _gunIndex;
+        ShmSysConfigAndInfo->SysConfig.AcConnectorCount = _acgunIndex;
+        DEBUG_INFO_MSG("DC connector Quality = %d, AC connector Quality = %d",
+                       ShmSysConfigAndInfo->SysConfig.TotalConnectorCount,
+                       ShmSysConfigAndInfo->SysConfig.AcConnectorCount);
+        DEBUG_INFO_MSG("Type 0~3 = CHAdeMO, CCS, GB, AC");
+        if (ShmSysConfigAndInfo->SysConfig.TotalConnectorCount == 0 &&
+                ShmSysConfigAndInfo->SysConfig.AcConnectorCount == 0) {
+            result = false;
+        }
+
+        if (ShmSysConfigAndInfo->SysConfig.TotalConnectorCount == 1) {
+            chargingInfo[0]->Evboard_id = 0x01;
+            DEBUG_INFO_MSG("index = %d, Type = %d, Evboard_id = %d", 0, chargingInfo[0]->Type, chargingInfo[0]->Evboard_id);
+        } else {
+            // 偵測槍屬於哪個 slot : 可知道插在板上的Slot 0 或 1 是 Chademo 還是 CCS
+            for (byte gunIndex = 0; gunIndex < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; gunIndex++) {
+                if (gunIndex == 0 && bd0_1_status == 0 && bd0_2_status == 1) {
+                    // 與硬體相同 type : Chademo
+                    if (chargingInfo[gunIndex]->Type == _Type_Chademo) {
+                        chargingInfo[gunIndex]->Evboard_id = 0x01;
+                    }
+                } else if (gunIndex == 0 && bd0_1_status == 1 && bd0_2_status == 0) {
+                    // 與硬體相同 type : CCS
+                    if (chargingInfo[gunIndex]->Type == _Type_CCS_2) {
+                        chargingInfo[gunIndex]->Evboard_id = 0x01;
+                    }
+                } else if (gunIndex == 0 && bd0_1_status == 1 && bd0_2_status == 1) {
+                    // 與硬體相同 type : GB
+                    if (chargingInfo[gunIndex]->Type == _Type_GB) {
+                        chargingInfo[gunIndex]->Evboard_id = 0x01;
+                    }
+                }
+
+                if (gunIndex == 1 && bd1_1_status == 0 && bd1_2_status == 1) {
+                    // 與硬體相同 type : Chademo
+                    if (chargingInfo[gunIndex]->Type == _Type_Chademo) {
+                        chargingInfo[gunIndex]->Evboard_id = 0x02;
+                    }
+
+                    if (ShmSysConfigAndInfo->SysConfig.TotalConnectorCount == 1) {
+                        chargingInfo[gunIndex]->Evboard_id = 0x01;
+                    }
+                } else if (gunIndex == 1 && bd1_1_status == 1 && bd1_2_status == 0) {
+                    // 與硬體相同 type : CCS
+                    if (chargingInfo[gunIndex]->Type == _Type_CCS_2) {
+                        chargingInfo[gunIndex]->Evboard_id = 0x02;
+                    }
+
+                    if (ShmSysConfigAndInfo->SysConfig.TotalConnectorCount == 1) {
+                        chargingInfo[gunIndex]->Evboard_id = 0x01;
+                    }
+                } else if (gunIndex == 1 && bd1_1_status == 1 && bd1_2_status == 1) {
+                    // 與硬體相同 type : GB
+                    if (chargingInfo[gunIndex]->Type == _Type_GB) {
+                        chargingInfo[gunIndex]->Evboard_id = 0x02;
+                    }
+
+                    if (ShmSysConfigAndInfo->SysConfig.TotalConnectorCount == 1) {
+                        chargingInfo[gunIndex]->Evboard_id = 0x01;
+                    }
+                }
+
+                DEBUG_INFO_MSG("index = %d, Type = %d, Evboard_id = %d", gunIndex, chargingInfo[gunIndex]->Type, chargingInfo[gunIndex]->Evboard_id);
+                if (chargingInfo[gunIndex]->Evboard_id == 0x00) {
+                    result = false;
+                }
+            }
+        }
+    } else {
+        // Module Name 不正確 - 告警
+        result = false;
+    }
+
+    return result;
+}
+
+void KillTask()
+{
+    ChangeLcmByIndex(_LCM_FIX);
+    system("killall Module_EventLogging");
+    system("killall Module_PrimaryComm");
+    system("killall Module_EvComm");
+    system("killall Module_LcmControl");
+    system("killall Module_InternalComm");
+    system("killall DoComm");
+    //system("killall Module_PsuComm");
+    //system("killall OcppBackend &");
+    //system("killall Module_4g &");
+    //system("killall Module_Wifi &");
+}
+
+char CheckUpdateProcess()
+{
+    DIR *d;
+    struct dirent *dir;
+    d = opendir("/mnt/");
+
+    if (d) {
+        long int MaxLen = 48 * 1024 * 1024, ImageLen = 0;
+        while ((dir = readdir(d)) != NULL) {
+            char *new_str;
+            new_str = malloc(strlen("/mnt/") + strlen(dir->d_name) + 1);
+            new_str[0] = '\0';
+            strcat(new_str, "/mnt/");
+            strcat(new_str, dir->d_name);
+            int fd = open(new_str, O_RDONLY);
+            if (fd < 0) {
+                return FAIL;
+            }
+
+            unsigned char *ptr = malloc(MaxLen); //-48 is take out the header
+            memset(ptr, 0xFF, MaxLen);  //-48 is take out the header
+            //get the image length
+            ImageLen = read(fd, ptr, MaxLen);
+
+            if (ImageLen > 20) {
+                unsigned int Type = (((unsigned int)ptr[16]) << 24 | ((unsigned int)ptr[17]) << 16 | ((unsigned int)ptr[18]) << 8 | ((unsigned int)ptr[19]));
+                PRINTF_FUNC("Typed...%x \r\n", Type);
+
+                switch (Type) {
+                case 0x10000001:
+                case 0x10000002:
+                case 0x10000003:
+                case 0x10000004:
+                case 0x10000005: {
+                    if (Upgrade_Flash(Type, new_str, (char *)ShmSysConfigAndInfo->SysConfig.ModelName) == PASS) {
+                        return PASS;
+                    } else {
+                        return FAIL;
+                    }
+                }
+                break;
+                case 0x10000007:
+                case 0x10000008:
+                case 0x10000009:
+                case 0x1000000A: {
+                    bool isPass = true;
+                    int CanFd = InitCanBus();
+
+                    if (CanFd > 0) {
+                        for (byte index = 0; index < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; index++) {
+                            if (!isPass) {
+                                break;
+                            }
+
+                            if (chargingInfo[index]->Type == _Type_CCS_2) {
+                                if (Upgrade_CCS(CanFd, Type, chargingInfo[index]->Evboard_id, new_str, (char *)ShmSysConfigAndInfo->SysConfig.ModelName) == FAIL) {
+                                    isPass = false;
+                                }
+                            }
+                        }
+                    } else {
+                        printf("Upgrade CCS open CAN FD fail.\n");
+                        isPass = false;
+                    }
+
+                    return isPass;
+                }
+                break;
+                case 0x10000006:
+                case 0x1000000D:
+                case 0x1000000E:
+                case 0x20000002:
+                case 0x10000014: {
+                    // CSU_PRIMARY_CONTROLLER : 0x10000006
+                    byte target = 0x00;
+
+                    if (Type == 0x10000006) {
+                        target = UPGRADE_PRI;
+                    } else if (Type == 0x1000000D) {
+                        target = UPGRADE_RB;
+                    } else if (Type == 0x1000000E) {
+                        target = UPGRADE_FAN;
+                    } else if (Type == 0x20000002) {
+                        target = UPGRADE_AC;
+                    } else if (Type == 0x10000014) {
+                        target = UPGRADE_LED;
+                    }
+
+                    int fd = InitComPort(target);
+
+                    if (Upgrade_UART(fd, Type, target, new_str, (char *)ShmSysConfigAndInfo->SysConfig.ModelName) == PASS) {
+                        return PASS;
+                    } else {
+                        return FAIL;
+                    }
+
+                    close(fd);
+                }
+                break;
+                case 0x1000000B:
+                case 0x1000000C: {
+                    // CHAdeMO_BOARD : 0x1000000B, GBT : 0x1000000C
+                    bool isPass = true;
+                    int CanFd = InitCanBus();
+
+                    if (CanFd > 0) {
+                        for (byte index = 0; index < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; index++) {
+                            if (!isPass) {
+                                break;
+                            }
+
+                            if ((Type == 0x1000000B && chargingInfo[index]->Type == _Type_Chademo) ||
+                                    (Type == 0x1000000C && chargingInfo[index]->Type == _Type_GB)) {
+                                if (Upgrade_CAN(CanFd, Type, chargingInfo[index]->Evboard_id, new_str, (char *)ShmSysConfigAndInfo->SysConfig.ModelName) == PASS) {
+                                    return PASS;
+                                } else {
+                                    return FAIL;
+                                }
+                            }
+                        }
+                    } else {
+                        PRINTF_FUNC("Upgrad FD fail. \n");
+                        isPass = false;
+                    }
+
+                    return isPass;
+                    break;
+                }
+                }
+            }
+            free(new_str);
+            free(ptr);
+        }
+    }
+    free(dir);
+    closedir(d);
+    return FAIL;
+}
+
+void CreateRfidFork()
+{
+    pid_t rfidRecPid;
+
+    rfidRecPid = fork();
+    if (rfidRecPid == 0) {
+        while (true) {
+            // 刷卡判斷
+            RFID rfid;
+            if (ShmSysConfigAndInfo->SysConfig.OfflinePolicy == _OFFLINE_POLICY_NO_CHARGING ||
+                    !ShmSysConfigAndInfo->SysConfig.isRFID)
+            {}
+            else if (getRequestCardSN(rfidFd, 0, &rfid)) {
+                //DEBUG_INFO_MSG("Get Card..-%s- \n", ShmSysConfigAndInfo->SysConfig.UserId);
+                if (strlen((char *)ShmSysConfigAndInfo->SysConfig.UserId) == 0) {
+                    if (ShmSysConfigAndInfo->SysConfig.RfidCardNumEndian == RFID_ENDIAN_LITTLE) {
+                        switch (rfid.snType) {
+                        case RFID_SN_TYPE_6BYTE:
+                            sprintf((char *) ShmSysConfigAndInfo->SysConfig.UserId,
+                                    "%02X%02X%02X%02X%02X%02X",
+                                    rfid.currentCard[0], rfid.currentCard[1],
+                                    rfid.currentCard[2], rfid.currentCard[3],
+                                    rfid.currentCard[4], rfid.currentCard[5]);
+                            break;
+                        case RFID_SN_TYPE_7BYTE:
+                            sprintf((char *) ShmSysConfigAndInfo->SysConfig.UserId,
+                                    "%02X%02X%02X%02X%02X%02X%02X",
+                                    rfid.currentCard[0], rfid.currentCard[1],
+                                    rfid.currentCard[2], rfid.currentCard[3],
+                                    rfid.currentCard[4], rfid.currentCard[5],
+                                    rfid.currentCard[6]);
+                            break;
+                        case RFID_SN_TYPE_10BYTE:
+                            sprintf((char *) ShmSysConfigAndInfo->SysConfig.UserId,
+                                    "%02X%02X%02X%02X%02X%02X%02X%02X%02X%02X",
+                                    rfid.currentCard[0], rfid.currentCard[1],
+                                    rfid.currentCard[2], rfid.currentCard[3],
+                                    rfid.currentCard[4], rfid.currentCard[5],
+                                    rfid.currentCard[6], rfid.currentCard[7],
+                                    rfid.currentCard[8], rfid.currentCard[9]);
+                            break;
+                        case RFID_SN_TYPE_4BYTE:
+                            sprintf((char *) ShmSysConfigAndInfo->SysConfig.UserId,
+                                    "%02X%02X%02X%02X",
+                                    rfid.currentCard[0], rfid.currentCard[1],
+                                    rfid.currentCard[2], rfid.currentCard[3]);
+                            break;
+                        }
+                    } else if (ShmSysConfigAndInfo->SysConfig.RfidCardNumEndian == RFID_ENDIAN_BIG) {
+                        switch (rfid.snType) {
+                        case RFID_SN_TYPE_6BYTE:
+                            sprintf((char *) ShmSysConfigAndInfo->SysConfig.UserId,
+                                    "%02X%02X%02X%02X%02X%02X",
+                                    rfid.currentCard[5], rfid.currentCard[4],
+                                    rfid.currentCard[3], rfid.currentCard[2],
+                                    rfid.currentCard[1], rfid.currentCard[0]);
+                            break;
+                        case RFID_SN_TYPE_7BYTE:
+                            sprintf((char *) ShmSysConfigAndInfo->SysConfig.UserId,
+                                    "%02X%02X%02X%02X%02X%02X%02X",
+                                    rfid.currentCard[6], rfid.currentCard[5],
+                                    rfid.currentCard[4], rfid.currentCard[3],
+                                    rfid.currentCard[2], rfid.currentCard[1],
+                                    rfid.currentCard[0]);
+                            break;
+                        case RFID_SN_TYPE_10BYTE:
+                            sprintf((char *) ShmSysConfigAndInfo->SysConfig.UserId,
+                                    "%02X%02X%02X%02X%02X%02X%02X%02X%02X%02X",
+                                    rfid.currentCard[9], rfid.currentCard[8],
+                                    rfid.currentCard[7], rfid.currentCard[6],
+                                    rfid.currentCard[5], rfid.currentCard[4],
+                                    rfid.currentCard[3], rfid.currentCard[2],
+                                    rfid.currentCard[1], rfid.currentCard[0]);
+                            break;
+                        case RFID_SN_TYPE_4BYTE:
+                            sprintf((char *) ShmSysConfigAndInfo->SysConfig.UserId,
+                                    "%02X%02X%02X%02X",
+                                    rfid.currentCard[3], rfid.currentCard[2],
+                                    rfid.currentCard[1], rfid.currentCard[0]);
+                            break;
+                        }
+                    }
+                    DEBUG_INFO_MSG("card number = %s\n", ShmSysConfigAndInfo->SysConfig.UserId);
+                }
+            }
+            usleep(500000);
+        }
+    }
+}
+
+void StartSystemTimeoutDet(unsigned char flag)
+{
+    if (ShmSysConfigAndInfo->SysInfo.SystemTimeoutFlag != flag) {
+        gettimeofday(&ShmSysConfigAndInfo->SysInfo.SystemTimeoutTimer, NULL);
+    }
+    ShmSysConfigAndInfo->SysInfo.SystemTimeoutFlag = flag;
+}
+
+void StopSystemTimeoutDet()
+{
+    gettimeofday(&ShmSysConfigAndInfo->SysInfo.SystemTimeoutTimer, NULL);
+    ShmSysConfigAndInfo->SysInfo.SystemTimeoutFlag = Timeout_None;
+}
+
+void StartGunInfoTimeoutDet(unsigned char gunIndex, unsigned char flag)
+{
+    if (gunIndex < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount) {
+        if (chargingInfo[gunIndex]->TimeoutFlag != flag) {
+            gettimeofday(&chargingInfo[gunIndex]->TimeoutTimer, NULL);
+        }
+        chargingInfo[gunIndex]->TimeoutFlag = flag;
+    }
+}
+
+void StopGunInfoTimeoutDet(unsigned char gunIndex)
+{
+    if (gunIndex < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount) {
+        chargingInfo[gunIndex]->TimeoutFlag = Timeout_None;
+    }
+}
+
+void CheckConnectionTimeout()
+{
+    if (system("pidof -s OcppBackend > /dev/null") != 0) {
+        _connectionTimeout = CONN_PLUG_TIME_OUT;
+    } else {
+        if (strcmp((char *)ShmOCPP16Data->ConfigurationTable.CoreProfile[ConnectionTimeOut].ItemData, "") != 0) {
+            _connectionTimeout = atoi((char *)ShmOCPP16Data->ConfigurationTable.CoreProfile[ConnectionTimeOut].ItemData);
+            if (_connectionTimeout <= 0) {
+                _connectionTimeout = CONN_PLUG_TIME_OUT;
+            }
+        } else {
+            _connectionTimeout = CONN_PLUG_TIME_OUT;
+        }
+    }
+}
+
+void CreateTimeoutFork()
+{
+    pid_t timeoutPid;
+
+    timeoutPid = fork();
+    if (timeoutPid > 0) {
+        gettimeofday(&_cmdSubPriority_time, NULL);
+        CheckConnectionTimeout();
+
+        while (true) {
+            if ((GetTimeoutValue(_cmdSubPriority_time) / 1000) > 5000) {
+                CheckConnectionTimeout();
+                gettimeofday(&_cmdSubPriority_time, NULL);
+            }
+
+            //printf("Timeout ***********SystemTimeoutFlag = %d, ********\n", ShmSysConfigAndInfo->SysInfo.SystemTimeoutFlag);
+            // 系統
+            switch (ShmSysConfigAndInfo->SysInfo.SystemTimeoutFlag) {
+            case Timeout_SelftestChk:
+                if (GetTimeoutValue(ShmSysConfigAndInfo->SysInfo.SystemTimeoutTimer) / uSEC_VAL >= SELFTEST_TIMEOUT) {
+                    _SelfTestTimeout();
+                    StopSystemTimeoutDet();
+                }
+                break;
+            case Timeout_Authorizing:
+                if (GetTimeoutValue(ShmSysConfigAndInfo->SysInfo.SystemTimeoutTimer) / uSEC_VAL >= AUTHORIZE_TIMEOUT) {
+                    _AuthorizedTimeout();
+                    StopSystemTimeoutDet();
+                }
+                break;
+            case Timeout_VerifyFail:
+                if (GetTimeoutValue(ShmSysConfigAndInfo->SysInfo.SystemTimeoutTimer) / uSEC_VAL >= AUTHORIZE_FAIL_TIMEOUT) {
+                    _AutoReturnTimeout();
+                    StopSystemTimeoutDet();
+                }
+                break;
+            case Timeout_VerifyComp:
+                if (GetTimeoutValue(ShmSysConfigAndInfo->SysInfo.SystemTimeoutTimer) / uSEC_VAL >= AUTHORIZE_COMP_TIMEOUT) {
+                    _AutoReturnTimeout();
+                    StopSystemTimeoutDet();
+                }
+                break;
+            case Timeout_WaitPlug:
+                if (GetTimeoutValue(ShmSysConfigAndInfo->SysInfo.SystemTimeoutTimer) / uSEC_VAL >= _connectionTimeout) {
+                    _DetectPlugInTimeout();
+                    StopSystemTimeoutDet();
+                }
+                break;
+            case Timeout_ReturnToChargingGunDet: {
+                if (GetTimeoutValue(ShmSysConfigAndInfo->SysInfo.SystemTimeoutTimer) / uSEC_VAL >= RETURN_TO_CHARGING_PAGE) {
+                    DisplayChargingInfo();
+                    StopSystemTimeoutDet();
+                }
+            }
+            break;
+            case Timeout_AuthorizingForStop: {
+                if (GetTimeoutValue(ShmSysConfigAndInfo->SysInfo.SystemTimeoutTimer) / uSEC_VAL >= AUTHORIZE_STOP_TIMEOUT) {
+                    strcpy((char *)ShmSysConfigAndInfo->SysConfig.UserId, "");
+                    ClearAuthorizedFlag();
+                    StopSystemTimeoutDet();
+                }
+            }
+            break;
+            }
+            // 各槍
+            for (byte gun_index = 0; gun_index < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; gun_index++) {
+                //printf("Timeout ***********TimeoutFlag = %d, ********\n", chargingInfo[gun_index]->TimeoutFlag);
+                switch (chargingInfo[gun_index]->TimeoutFlag) {
+                case Timeout_Preparing: {
+                    if (GetTimeoutValue(chargingInfo[gun_index]->TimeoutTimer) / uSEC_VAL >= GUN_PREPARE_TIMEOUT) {
+                        _PrepareTimeout(gun_index);
+                        StopGunInfoTimeoutDet(gun_index);
+                    }
+                }
+                break;
+                case Timeout_EvChargingDet: {
+                    if (GetTimeoutValue(chargingInfo[gun_index]->TimeoutTimer) / uSEC_VAL >= GUN_EV_WAIT_TIMEOUT) {
+                        _DetectEvChargingEnableTimeout(gun_index);
+                        StopGunInfoTimeoutDet(gun_index);
+                    }
+                }
+                break;
+                case Timeout_EvseChargingDet: {
+                    if (GetTimeoutValue(chargingInfo[gun_index]->TimeoutTimer) / uSEC_VAL >= GUN_EVSE_WAIT_TIMEOUT) {
+                        _DetectEvseChargingEnableTimeout(gun_index);
+                        StopGunInfoTimeoutDet(gun_index);
+                    }
+                }
+                break;
+                case Timeout_EvseCompleteDet: {
+                    if (GetTimeoutValue(chargingInfo[gun_index]->TimeoutTimer) / uSEC_VAL >= GUN_COMP_WAIT_TIMEOUT) {
+                        StopGunInfoTimeoutDet(gun_index);
+                    }
+                }
+                break;
+                case Timeout_ForCcsPrechargeDet: {
+                    if (GetTimeoutValue(chargingInfo[gun_index]->TimeoutTimer) / uSEC_VAL >= GUN_PRECHARGING_TIMEOUT) {
+                        _CcsPrechargeTimeout(gun_index);
+                        StopGunInfoTimeoutDet(gun_index);
+                    }
+                }
+                break;
+                }
+            }
+            sleep(1);
+        }
+    }
+}
+
+void GetSystemTime()
+{
+    struct timeb csuTime;
+    struct tm *tmCSU;
+
+    ftime(&csuTime);
+    tmCSU = localtime(&csuTime.time);
+    PRINTF_FUNC("Time : %04d-%02d-%02d %02d:%02d:%02d \n", tmCSU->tm_year + 1900,
+                tmCSU->tm_mon + 1, tmCSU->tm_mday, tmCSU->tm_hour, tmCSU->tm_min,
+                tmCSU->tm_sec);
+
+//  byte date[14];
+//
+//
+//       //sprintf(&date, "%d", );
+//
+//       date[0] = '0' + ((tmCSU->tm_year + 1900) / 1000 % 10);
+
+//  date[0] = (tmCSU->tm_year + 1900) / 1000 % 10;
+//  date[1] = (tmCSU->tm_year + 1900) / 100 % 10;
+//  date[2] = (tmCSU->tm_year + 1900) / 10 % 10;
+//  date[3] = (tmCSU->tm_year + 1900) / 1 % 10;
+//
+//  date[4] = (tmCSU->tm_mon + 1) / 10 % 10;
+//  date[5] = (tmCSU->tm_mon + 1) / 1 % 10;
+//
+//  date[6] = (tmCSU->tm_mday) / 10 % 10;
+//  date[7] = (tmCSU->tm_mday) / 1 % 10;
+//
+//  date[8] = (tmCSU->tm_hour) / 10 % 10;
+//  date[9] = (tmCSU->tm_hour) / 1 % 10;
+//
+//  date[10] = (tmCSU->tm_min) / 10 % 10;
+//  date[11] = (tmCSU->tm_min) / 1 % 10;
+//
+//  date[12] = (tmCSU->tm_sec) / 10 % 10;
+//  date[13] = (tmCSU->tm_sec) / 1 % 10;
+
+//  PRINTF_FUNC("%x, %x, %x, %x, %x, %x, %x, %x, %x, %x, %x, %x, %x, %x \n", date[0], date[1], date[2], date[3],
+//          date[4], date[5], date[6], date[7],
+//          date[8], date[9], date[10], date[11],
+//          date[12], date[13]);
+}
+
+void CheckFactoryConfigFunction()
+{
+    if (ShmSysConfigAndInfo->SysInfo.FactoryConfiguration) {
+        system("cd /root;./FactoryConfig -m");
+        system("sync");
+        sleep(5);
+        system("reboot -f");
+        sleep(5);
+        system("reboot -f");
+    }
+}
+
+void CheckFwUpdateFunction()
+{
+    //PRINTF_FUNC("ShmSysConfigAndInfo->SysInfo.FirmwareUpdate = %d \n", ShmSysConfigAndInfo->SysInfo.FirmwareUpdate);
+    if (ShmSysConfigAndInfo->SysInfo.FirmwareUpdate == YES) {
+        DEBUG_INFO_MSG("ftp : update start. \n");
+        KillTask();
+        if (CheckUpdateProcess() == PASS) {
+            DEBUG_INFO_MSG("ftp : update complete. \n");
+        } else {
+            DEBUG_INFO_MSG("ftp : update fail. \n");
+        }
+
+        ShmSysConfigAndInfo->SysInfo.FirmwareUpdate = NO;
+        sleep(5);
+        system("reboot -f");
+    } else if (ShmOCPP16Data->MsMsg.bits.UpdateFirmwareReq == YES) {
+        ShmOCPP16Data->MsMsg.bits.UpdateFirmwareReq = NO;
+
+        if (strcmp((char *)ShmOCPP16Data->FirmwareStatusNotification.Status, "Downloaded") == EQUAL) {
+            DEBUG_INFO_MSG("Backend : update start. \n");
+            strcpy((char *)ShmOCPP16Data->FirmwareStatusNotification.Status, "");
+            strcpy((char *)ShmOCPP16Data->FirmwareStatusNotification.Status, "Installing");
+            ShmOCPP16Data->SpMsg.bits.FirmwareStatusNotificationReq = YES;
+            KillTask();
+
+            for (byte _index = 0; _index < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; _index++) {
+                setChargerMode(_index, MODE_UPDATE);
+            }
+            for (byte _index = 0; _index < ShmSysConfigAndInfo->SysConfig.AcConnectorCount; _index++) {
+                ac_chargingInfo[_index]->SystemStatus = MODE_UPDATE;
+            }
+
+            if (CheckUpdateProcess() == PASS) {
+                DEBUG_INFO_MSG("Backend : update complete. \n");
+                strcpy((char *)ShmOCPP16Data->FirmwareStatusNotification.Status, "Installed");
+            } else {
+                DEBUG_INFO_MSG("Backend : update fail. \n");
+                strcpy((char *)ShmOCPP16Data->FirmwareStatusNotification.Status, "InstallationFailed");
+            }
+
+            strcpy((char *)ShmOCPP16Data->FirmwareStatusNotification.Status, "Installed");
+            ShmOCPP16Data->SpMsg.bits.FirmwareStatusNotificationReq = YES;
+            sleep(5);
+            system("reboot -f");
+        }
+    }
+}
+
+//===============================================
+// Check reservation date is expired
+//===============================================
+int isReservationExpired(unsigned char gun_index)
+{
+    int result = NO;
+    struct tm expiredDate;
+    struct timeb expiredTime;
+
+    if (sscanf((char *) ShmOCPP16Data->ReserveNow[gun_index].ExpiryDate,
+               "%4d-%2d-%2dT%2d:%2d:%2d", &expiredDate.tm_year,
+               &expiredDate.tm_mon, &expiredDate.tm_mday, &expiredDate.tm_hour,
+               &expiredDate.tm_min, &expiredDate.tm_sec) == 6) {
+        expiredDate.tm_year -= 1900;
+        expiredDate.tm_mon -= 1;
+
+        expiredTime.time = mktime(&expiredDate);
+        if (!CheckTimeOut(expiredTime)) {
+            result = YES;
+        }
+    }
+
+    return result;
+}
+
+//===============================================
+// OCPP
+//===============================================
+void CheckOcppStatus()
+{
+    if (ShmOCPP16Data->SpMsg.bits.BootNotificationConf == YES) {
+        ShmOCPP16Data->SpMsg.bits.BootNotificationConf = NO;
+    }
+
+    if (ShmOCPP16Data->MsMsg.bits.ResetReq == YES) {
+        bool canReset = true;
+        if (ShmSysConfigAndInfo->SysWarningInfo.Level != 2) {
+            for (byte _index = 0; _index < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; _index++) {
+                if (chargingInfo[_index]->SystemStatus != S_IDLE &&
+                        chargingInfo[_index]->SystemStatus != S_RESERVATION &&
+                        chargingInfo[_index]->SystemStatus != S_MAINTAIN) {
+                    canReset = false;
+                    if (chargingInfo[_index]->SystemStatus >= S_REASSIGN && chargingInfo[_index]->SystemStatus < S_TERMINATING) {
+                        ChargingTerminalProcess(_index);
+                    }
+                }
+            }
+        }
+
+        if (canReset) {
+            ShmOCPP16Data->MsMsg.bits.ResetReq = NO;
+            sprintf((char *)ShmOCPP16Data->Reset.ResponseStatus, "Accepted");
+            if (strcmp((char *)ShmOCPP16Data->Reset.Type, "Hard") == EQUAL) {
+                DEBUG_ERROR_MSG("****** Hard Reboot ****** \n");
+                ShmOCPP16Data->MsMsg.bits.ResetConf = YES;
+                sleep(3);
+                system("reboot -f");
+            } else if (strcmp((char *)ShmOCPP16Data->Reset.Type, "Soft") == EQUAL) {
+                DEBUG_ERROR_MSG("****** Soft Reboot ****** \n");
+                ShmOCPP16Data->MsMsg.bits.ResetConf = YES;
+                sleep(3);
+                system("killall OcppBackend &");
+                KillTask();
+                system("/usr/bin/run_evse_restart.sh");
+            }
+        }
+    }
+}
+
+void OcppStartTransation(byte gunIndex)
+{
+    byte _OcppGunIndex = gunIndex;
+
+    // 如果有 AC 槍，而現在是 DC 第二把槍進入充電
+    if (ShmSysConfigAndInfo->SysConfig.AcConnectorCount == 1 && gunIndex == 1) {
+        _OcppGunIndex = 2;
+    }
+
+    if (strcmp((char *)chargingInfo[gunIndex]->StartUserId, "") == EQUAL) {
+        strcpy((char *)ShmOCPP16Data->StartTransaction[_OcppGunIndex].IdTag, (char *)ShmOCPP16Data->StartTransaction[_OcppGunIndex].IdTag);
+    } else {
+        strcpy((char *)ShmOCPP16Data->StartTransaction[_OcppGunIndex].IdTag, (char *)chargingInfo[gunIndex]->StartUserId);
+    }
+
+    PRINTF_FUNC("IdTag = %s \n", ShmOCPP16Data->StartTransaction[_OcppGunIndex].IdTag);
+    ShmOCPP16Data->CpMsg.bits[_OcppGunIndex].StartTransactionReq = YES;
+}
+
+void OcppStopTransation(byte gunIndex)
+{
+    byte _OcppGunIndex = gunIndex;
+
+    // 如果有 AC 槍，而現在是 DC 第二把槍進入充電
+    if (ShmSysConfigAndInfo->SysConfig.AcConnectorCount == 1 && gunIndex == 1) {
+        _OcppGunIndex = 2;
+    }
+
+    if (strcmp((char *)chargingInfo[gunIndex]->StartUserId, "") == EQUAL) {
+        strcpy((char *)ShmOCPP16Data->StopTransaction[_OcppGunIndex].IdTag, (char *)ShmOCPP16Data->StopTransaction[_OcppGunIndex].IdTag);
+    } else {
+        strcpy((char *)ShmOCPP16Data->StopTransaction[_OcppGunIndex].IdTag, (char *)chargingInfo[gunIndex]->StartUserId);
+    }
+
+    PRINTF_FUNC("IdTag = %s \n", ShmOCPP16Data->StopTransaction[_OcppGunIndex].IdTag);
+    ShmOCPP16Data->CpMsg.bits[_OcppGunIndex].StopTransactionReq = YES;
+}
+
+bool OcppRemoteStop(byte gunIndex)
+{
+    byte acDirIndex = ShmSysConfigAndInfo->SysConfig.AcConnectorCount;
+
+    // 有 AC 槍的話
+    if (acDirIndex > 0 && gunIndex > 0) {
+        gunIndex += acDirIndex;
+    }
+
+    bool result = ShmOCPP16Data->CsMsg.bits[gunIndex].RemoteStopTransactionReq;
+
+    if (ShmOCPP16Data->CsMsg.bits[gunIndex].RemoteStopTransactionReq == YES) {
+        strcpy((char *)ShmOCPP16Data->StopTransaction[gunIndex].StopReason, "Remote");
+        ShmOCPP16Data->CsMsg.bits[gunIndex].RemoteStopTransactionReq = NO;
+    }
+
+    return result;
+}
+
+void OcppRemoteStartChk()
+{
+    if (ShmSysConfigAndInfo->SysConfig.OfflinePolicy == _OFFLINE_POLICY_NO_CHARGING)
+    {}
+    else if (!isDetectPlugin()) {
+        // 如果有 AC 槍，則固定是第 2 把槍，所以索引固定為 1
+        byte acDirIndex = ShmSysConfigAndInfo->SysConfig.AcConnectorCount;
+
+        for (byte ac_index = 0; ac_index < ShmSysConfigAndInfo->SysConfig.AcConnectorCount; ac_index++) {
+            if (ShmOCPP16Data->CsMsg.bits[acDirIndex].RemoteStartTransactionReq == YES) {
+                if (ac_chargingInfo[ac_index]->SystemStatus == S_IDLE ||
+                        ac_chargingInfo[ac_index]->SystemStatus == S_RESERVATION) {
+                    ShmOCPP16Data->CsMsg.bits[acDirIndex].RemoteStartTransactionReq = NO;
+                    ac_chargingInfo[ac_index]->RemoteStartFlag = YES;
+                    ShmSysConfigAndInfo->SysInfo.OrderCharging = YES;
+                    //ShmSysConfigAndInfo->SysInfo.OrderCharging = DEFAULT_AC_INDEX;
+                    ShmOCPP16Data->CsMsg.bits[ShmSysConfigAndInfo->SysConfig.TotalConnectorCount + ac_index].RemoteStartTransactionReq = NO;
+                    DetectPluginStart();
+                    return;
+                }
+                ShmOCPP16Data->CsMsg.bits[acDirIndex].RemoteStartTransactionReq = NO;
+            }
+        }
+
+        byte threeGunIndex = 0;
+        byte dcIndex = 0;
+        bool isGunUsingStatus = false;
+
+        for (byte _index = 0; _index < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; _index++) {
+            // 如果有 AC 槍，且 DC 槍也有兩把
+            if (acDirIndex == 1 && _index == 1) {
+                threeGunIndex = 1;
+            }
+
+            if (ShmOCPP16Data->CsMsg.bits[_index + threeGunIndex].RemoteStartTransactionReq == YES) {
+                dcIndex = _index;
+            }
+
+            if (chargingInfo[_index]->SystemStatus != S_IDLE) {
+                isGunUsingStatus = true;
+            }
+        }
+
+        // 如果是雙槍單模，只認閒置狀態的槍，如果有預約~ 則預約也算被使用
+        if (isGunUsingStatus && ShmSysConfigAndInfo->SysInfo.IsAlternatvieConf) {
+            if (dcIndex == 0) {
+                threeGunIndex = 0;
+            }
+
+            ShmOCPP16Data->CsMsg.bits[dcIndex + threeGunIndex].RemoteStartTransactionReq = NO;
+            return;
+        }
+
+        if (dcIndex == 0) {
+            threeGunIndex = 0;
+        }
+
+        if (ShmOCPP16Data->CsMsg.bits[dcIndex + threeGunIndex].RemoteStartTransactionReq == YES) {
+            if (chargingInfo[dcIndex]->SystemStatus == S_IDLE ||
+                    chargingInfo[dcIndex]->SystemStatus == S_RESERVATION) {
+                chargingInfo[dcIndex]->RemoteStartFlag = YES;
+                ShmSysConfigAndInfo->SysInfo.OrderCharging = YES;
+                //ShmSysConfigAndInfo->SysInfo.OrderCharging = gun_index;
+                ShmOCPP16Data->CsMsg.bits[dcIndex + threeGunIndex].RemoteStartTransactionReq = NO;
+                DetectPluginStart();
+            }
+            ShmOCPP16Data->CsMsg.bits[dcIndex + threeGunIndex].RemoteStartTransactionReq = NO;
+        }
+    }
+}
+
+void ChkOcppStatus(byte gunIndex)
+{
+    if (chargingInfo[gunIndex]->SystemStatus == S_IDLE &&
+            ShmOCPP16Data->CsMsg.bits[gunIndex].ReserveNowReq == YES) {
+        ShmOCPP16Data->CsMsg.bits[gunIndex].ReserveNowReq = NO;
+        if (isReservationExpired(gunIndex)) {
+            PRINTF_FUNC("***************ChkOcppStatus : OcppReservedStatus******************** \n");
+            DEBUG_ERROR_MSG("***************ChkOcppStatus : OcppReservedStatus******************** \n");
+            chargingInfo[gunIndex]->ReservationId = ShmOCPP16Data->ReserveNow[gunIndex].ReservationId;
+            chargingInfo[gunIndex]->SystemStatus = S_RESERVATION;
+        }
+        ShmOCPP16Data->CsMsg.bits[gunIndex].ReserveNowConf = YES;
+    }
+
+    if (chargingInfo[gunIndex]->SystemStatus == S_RESERVATION &&
+            ShmOCPP16Data->CsMsg.bits[gunIndex].CancelReservationReq == YES) {
+        ShmOCPP16Data->CsMsg.bits[gunIndex].CancelReservationReq = NO;
+        if (isReservationExpired(gunIndex)) {
+            PRINTF_FUNC("***************ChkOcppStatus : Cancel OcppReservedStatus******************** \n");
+            DEBUG_ERROR_MSG("***************ChkOcppStatus : Cancel OcppReservedStatus******************** \n");
+            chargingInfo[gunIndex]->ReservationId = 0;
+            chargingInfo[gunIndex]->SystemStatus = S_IDLE;
+        }
+        ShmOCPP16Data->CsMsg.bits[gunIndex].CancelReservationConf = YES;
+    }
+
+    if (ShmOCPP16Data->CsMsg.bits[gunIndex].ChangeAvailabilityReq == YES) {
+        PRINTF_FUNC("***************ChkOcppStatus : OcppChangeAvailability******************** \n");
+        DEBUG_ERROR_MSG("***************ChkOcppStatus : OcppChangeAvailability******************** \n");
+        ShmOCPP16Data->CsMsg.bits[gunIndex].ChangeAvailabilityReq = NO;
+        if (strcmp((char *)ShmOCPP16Data->ChangeAvailability[gunIndex].Type, "Operative") == EQUAL) {
+            if (isDb_ready) {
+                DB_Update_Operactive(localDb, gunIndex, true);
+            }
+
+            chargingInfo[gunIndex]->IsAvailable = YES;
+            if (chargingInfo[gunIndex]->SystemStatus == S_IDLE ||
+                    chargingInfo[gunIndex]->SystemStatus == S_RESERVATION ||
+                    chargingInfo[gunIndex]->SystemStatus == S_MAINTAIN) {
+                setChargerMode(gunIndex, MODE_IDLE);
+            }
+        } else if (strcmp((char *)ShmOCPP16Data->ChangeAvailability[gunIndex].Type, "Inoperative") == EQUAL) {
+            if (isDb_ready) {
+                DB_Update_Operactive(localDb, gunIndex, false);
+            }
+
+            chargingInfo[gunIndex]->IsAvailable = NO;
+            if (chargingInfo[gunIndex]->SystemStatus == S_IDLE ||
+                    chargingInfo[gunIndex]->SystemStatus == S_RESERVATION ||
+                    chargingInfo[gunIndex]->SystemStatus == S_MAINTAIN) {
+                setChargerMode(gunIndex, MODE_MAINTAIN);
+            }
+        }
+    }
+
+    if (ShmOCPP16Data->CsMsg.bits[gunIndex].UnlockConnectorReq == YES) {
+        ShmOCPP16Data->CsMsg.bits[gunIndex].UnlockConnectorReq = NO;
+        if (chargingInfo[gunIndex]->SystemStatus >= S_REASSIGN_CHECK ||
+                chargingInfo[gunIndex]->SystemStatus <= S_CHARGING) {
+            // 充電中，需停止充電
+            strcpy((char *)ShmOCPP16Data->StopTransaction[gunIndex].StopReason, "UnlockCommand");
+            ChargingTerminalProcess(gunIndex);
+        }
+        strcpy((char *)ShmOCPP16Data->UnlockConnector[gunIndex].ResponseStatus, "Unlocked");
+        ShmOCPP16Data->CsMsg.bits[gunIndex].UnlockConnectorConf = YES;
+    }
+}
+
+bool CheckBackendChargingTimeout(byte gunIndex)
+{
+    bool result = false;
+
+    if (ShmSysConfigAndInfo->SysConfig.AuthorisationMode == AUTH_MODE_ENABLE) {
+        if (ShmSysConfigAndInfo->SysConfig.MaxChargingDuration > 0) {
+            if (chargingInfo[gunIndex]->PresentChargedDuration > (ShmSysConfigAndInfo->SysConfig.MaxChargingDuration * 60)) {
+                result = true;
+            }
+        }
+    } else if (ShmSysConfigAndInfo->SysConfig.AuthorisationMode == AUTH_MODE_DISABLE) {
+        // 隨插即充電的要看 offline
+        if (ShmSysConfigAndInfo->SysConfig.OfflineMaxChargeDuration > 0) {
+            if (chargingInfo[gunIndex]->PresentChargedDuration > (ShmSysConfigAndInfo->SysConfig.OfflineMaxChargeDuration * 60)) {
+                result = true;
+            }
+        }
+    }
+
+    return result;
+}
+
+bool CheckBackendChargingEnergy(byte gunIndex)
+{
+    bool result = false;
+
+    if (ShmSysConfigAndInfo->SysConfig.AuthorisationMode == AUTH_MODE_ENABLE) {
+        if (ShmSysConfigAndInfo->SysConfig.MaxChargingEnergy > 0) {
+            if (chargingInfo[gunIndex]->PresentChargedEnergy > ShmSysConfigAndInfo->SysConfig.MaxChargingEnergy) {
+                result = true;
+            }
+        }
+    } else if (ShmSysConfigAndInfo->SysConfig.AuthorisationMode == AUTH_MODE_DISABLE) {
+        // 隨插即充電的要看 offline
+        if (ShmSysConfigAndInfo->SysConfig.OfflineMaxChargeEnergy > 0) {
+            if (chargingInfo[gunIndex]->PresentChargedEnergy > (ShmSysConfigAndInfo->SysConfig.OfflineMaxChargeEnergy)) {
+                result = true;
+            }
+        }
+    }
+
+    return result;
+}
+
+void InformOcppErrOccur(byte codeType)
+{
+    char _error[25];
+
+    switch (codeType) {
+    case 4: strcpy(_error, "InternalError"); break;
+    case 6: strcpy(_error, "NoError"); break;
+    case 7: strcpy(_error, "OtherError"); break;
+    case 13: strcpy(_error, "UnderVoltage"); break;
+    case 14: strcpy(_error, "OverVoltage"); break;
+    }
+
+    for (byte gun_index = 0; gun_index < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; gun_index++) {
+        strcpy((char *)ShmOCPP16Data->StatusNotification[gun_index].ErrorCode, _error);
+    }
+}
+
+//===============================================
+// SQLite3 related routine
+//===============================================
+int DB_Open(sqlite3 *db)
+{
+    int result = PASS;
+    char *errMsg = NULL;
+    char *createRecordSql = "CREATE TABLE IF NOT EXISTS charging_record("
+                            "idx integer primary key AUTOINCREMENT, "
+                            "reservationId text, "
+                            "transactionId text, "
+                            "startMethod text, "
+                            "userId text, "
+                            "dateTimeStart text, "
+                            "dateTimeStop text,"
+                            "socStart text, "
+                            "socStop text, "
+                            "chargeEnergy text, "
+                            "stopReason text"
+                            ");";
+
+    char *createCfgSql = "CREATE TABLE IF NOT EXISTS `config` ( "
+                         "`idx` INTEGER PRIMARY KEY AUTOINCREMENT, "
+                         "`IsAvailable` TEXT NOT NULL, "
+                         "`connector` INTEGER NOT NULL, "
+                         "`val` TEXT NOT NULL, unique(IsAvailable,connector) on conflict replace);";
+
+    if (sqlite3_open(DB_FILE, &db)) {
+        result = FAIL;
+        PRINTF_FUNC( "Can't open database: %s\r\n", sqlite3_errmsg(db));
+        sqlite3_close(db);
+    } else {
+        PRINTF_FUNC( "Local charging record database open successfully.\r\n");
+
+        if (sqlite3_exec(db, createRecordSql, 0, 0, &errMsg) != SQLITE_OK) {
+            result = FAIL;
+            PRINTF_FUNC( "Create local charging record table error message: %s\n", errMsg);
+        } else {
+            PRINTF_FUNC( "Opened local charging record table successfully\n");
+        }
+
+        if (sqlite3_exec(db, createCfgSql, 0, 0, &errMsg) != SQLITE_OK) {
+            result = FAIL;
+            PRINTF_FUNC( "Create local config table error message: %s\n", errMsg);
+        } else {
+            PRINTF_FUNC( "Opened local config table successfully\n");
+        }
+
+        sqlite3_close(db);
+    }
+
+    return result;
+}
+
+int DB_Insert_Record(sqlite3 *db, int gun_index)
+{
+    int result = PASS;
+    char *errMsg = NULL;
+    char insertSql[1024];
+
+    sprintf(insertSql, "insert into charging_record(reservationId, transactionId, startMethod, userId, dateTimeStart, dateTimeStop, socStart, socStop, chargeEnergy, stopReason) "
+            "values('%d', '%d', '%d', '%s', '%s', '%s', '%d', '%d', '%f', '%s');",
+            ShmSysConfigAndInfo->SysInfo.AcChargingData[gun_index].ReservationId,
+            ShmOCPP16Data->StartTransaction[gun_index].ResponseTransactionId,
+            ShmSysConfigAndInfo->SysInfo.AcChargingData[gun_index].StartMethod,
+            ShmSysConfigAndInfo->SysInfo.AcChargingData[gun_index].StartUserId,
+            ShmSysConfigAndInfo->SysInfo.AcChargingData[gun_index].StartDateTime,
+            ShmSysConfigAndInfo->SysInfo.AcChargingData[gun_index].StopDateTime,
+            ShmSysConfigAndInfo->SysInfo.AcChargingData[gun_index].EvBatterySoc,
+            ShmSysConfigAndInfo->SysInfo.AcChargingData[gun_index].EvBatterySoc,
+            ShmSysConfigAndInfo->SysInfo.AcChargingData[gun_index].PresentChargedEnergy,
+            ShmOCPP16Data->StopTransaction[gun_index].StopReason);
+
+    if (sqlite3_open("/Storage/ChargeLog/localCgargingRecord.db", &db)) {
+        result = FAIL;
+        PRINTF_FUNC( "Can't open database: %s\r\n", sqlite3_errmsg(db));
+        sqlite3_close(db);
+    } else {
+        PRINTF_FUNC( "Local charging record database open successfully.\r\n");
+        if (sqlite3_exec(db, insertSql, 0, 0, &errMsg) != SQLITE_OK) {
+            result = FAIL;
+            PRINTF_FUNC( "Insert local charging record error message: %s\n", errMsg);
+        } else {
+            PRINTF_FUNC( "Insert local charging record successfully\n");
+        }
+        sqlite3_close(db);
+    }
+
+    return result;
+}
+
+int DB_Update_Operactive(sqlite3 *db, uint8_t gun_index, uint8_t IsAvailable)
+{
+    uint8_t result = false;
+    char *errMsg = NULL;
+    char sqlStr[1024];
+    srand(time(NULL));
+
+    if (sqlite3_open(DB_FILE, &db)) {
+        result = FAIL;
+        PRINTF_FUNC( "Can't open database: %s\r\n", sqlite3_errmsg(db));
+        sqlite3_close(db);
+    } else {
+        PRINTF_FUNC( "Local charging record database open successfully (%d).\r\n", IsAvailable);
+
+        sprintf(sqlStr, "insert or replace into config (IsAvailable, connector, val) values('IsAvailable', %d, %d);", gun_index, IsAvailable);
+        PRINTF_FUNC("sqlStr= %s\r\n", sqlStr);
+        if (sqlite3_exec(db, sqlStr, 0, 0, &errMsg) != SQLITE_OK) {
+            result = FAIL;
+            PRINTF_FUNC( "update config error message: %s\n", errMsg);
+        } else {
+            PRINTF_FUNC("update connector-%d config item isOperactive to %d\r\n", gun_index, IsAvailable);
+        }
+
+        sqlite3_close(db);
+    }
+
+    return result;
+}
+
+int DB_Get_Operactive(sqlite3 *db, uint8_t gun_index)
+{
+    uint8_t result = true;
+    char *errMsg = NULL;
+    char sqlStr[1024];
+    char **rs;
+    int  rows, cols;
+
+    sprintf(sqlStr, "select * from config where IsAvailable='IsAvailable' and connector=%d;", gun_index);
+    //DEBUG_INFO("sqlStr= %s\r\n", sqlStr);
+
+    if (sqlite3_open(DB_FILE, &db)) {
+        result = FAIL;
+        PRINTF_FUNC( "Can't open database: %s\r\n", sqlite3_errmsg(db));
+        sqlite3_close(db);
+    } else {
+        PRINTF_FUNC( "Local config query database open successfully.\r\n");
+        sqlite3_get_table(db, sqlStr, &rs, &rows, &cols, &errMsg);
+        if (rows > 0) {
+            for (int idxRow = 1; idxRow <= rows; idxRow++) {
+                if (strcmp(rs[(idxRow * cols) + 3], "0") == 0) {
+                    result = false;
+                }
+                PRINTF_FUNC("Query connector-%d isOperactive: %s\r\n", gun_index, rs[(idxRow * cols) + 3]);
+            }
+        } else {
+            PRINTF_FUNC("Query connector-%d fail, set default value to operactive.\r\n", gun_index);
+        }
+
+        sqlite3_free_table(rs);
+        sqlite3_close(db);
+    }
+
+    return result;
+}
+
+//===============================================
+// Config process
+//===============================================
+void AddPlugInTimes(byte gunIndex)
+{
+    if (chargingInfo[gunIndex]->Type == _Type_Chademo) {
+        ShmSysConfigAndInfo->SysConfig.ChademoPlugInTimes += 1;
+    } else if (chargingInfo[gunIndex]->Type == _Type_CCS_2) {
+        ShmSysConfigAndInfo->SysConfig.Ccs2PlugInTimes += 1;
+    } else if (chargingInfo[gunIndex]->Type == _Type_GB) {
+        ShmSysConfigAndInfo->SysConfig.GbPlugInTimes += 1;
+    }
+}
+
+void ChangeStartOrStopDateTime(byte isStart, byte gunIndex)
+{
+    char cmdBuf[32];
+    struct timeb csuTime;
+    struct tm *tmCSU;
+
+    ftime(&csuTime);
+    tmCSU = localtime(&csuTime.time);
+
+    sprintf(cmdBuf, "%04d-%02d-%02d %02d:%02d:%02d", tmCSU->tm_year + 1900,
+            tmCSU->tm_mon + 1, tmCSU->tm_mday, tmCSU->tm_hour, tmCSU->tm_min,
+            tmCSU->tm_sec);
+    if (isStart) {
+        strcpy((char *)chargingInfo[gunIndex]->StartDateTime, cmdBuf);
+    } else {
+        strcpy((char *)chargingInfo[gunIndex]->StopDateTime, cmdBuf);
+    }
+}
+
+void zipLogFiles()
+{
+    const char *logPath = "/Storage/SystemLog";
+    // 獲取目錄
+    DIR *pDir = opendir(logPath);
+    if (pDir != NULL) {
+        struct timeb csuTime;
+        struct tm *tmCSU;
+
+        ftime(&csuTime);
+        tmCSU = localtime(&csuTime.time);
+//      PRINTF_FUNC("Time : %04d-%02d-%02d %02d:%02d:%02d \n", tmCSU->tm_year + 1900,
+//          tmCSU->tm_mon + 1, tmCSU->tm_mday, tmCSU->tm_hour, tmCSU->tm_min,
+//          tmCSU->tm_sec);
+
+        // Read items inside the folder
+        struct dirent *pEntry = NULL;
+        while ((pEntry = readdir(pDir)) != NULL) {
+            if (strcmp(pEntry->d_name, ".") != 0 &&
+                    strcmp(pEntry->d_name, "..") != 0 &&
+                    strncmp(pEntry->d_name, "[", 1) == 0 &&
+                    strstr(pEntry->d_name, "tar") < 0) {
+                char yearC[5];
+                unsigned short year = 0;
+                char monthC[3];
+                unsigned short month = 0;
+
+                yearC[4] = '\0';
+                strncpy(yearC, pEntry->d_name + 1, 4);
+                monthC[2] = '\0';
+                strncpy(monthC, pEntry->d_name + 6, 2);
+
+                year = atoi(yearC);
+                month = atoi(monthC);
+
+                if (year != 0) {
+                    if (year < tmCSU->tm_year + 1900 ||
+                            (year >= tmCSU->tm_year + 1900 && month < tmCSU->tm_mon + 1)) {
+                        DEBUG_INFO_MSG("tar file name : %s \n", pEntry->d_name);
+                        char file[256];
+
+                        memset(file, 0x00, sizeof(file));
+                        strcat(file, "tar zcvf ");
+                        strcat(file, logPath);
+                        strncat(file, "/", 1);
+                        strcat(file, pEntry->d_name);
+                        strcat(file, ".tar");
+                        strncat(file, " ", 1);
+                        strcat(file, logPath);
+                        strncat(file, "/", 1);
+                        strcat(file, pEntry->d_name);
+                        PRINTF_FUNC("zip = %s \n", file);
+                        system(file);
+                    }
+                }
+            }
+        }
+    }
+    // Close folder
+    closedir(pDir);
+}
+
+void ChangeGunSelectByIndex(byte sel)
+{
+    ShmSysConfigAndInfo->SysInfo.CurGunSelected = sel;
+    ShmSysConfigAndInfo->SysInfo.CurGunSelectedByAc = NO_DEFINE;
+}
+
+void CheckIsAlternatvieByModelName()
+{
+    // 黑白機 ?
+    if (strcmp((char *)ShmSysConfigAndInfo->SysConfig.ModelName, "DWWU301J0UT1PH") == EQUAL ||
+            strcmp((char *)ShmSysConfigAndInfo->SysConfig.ModelName, "DWYE301J0ET1PH") == EQUAL ||
+            strcmp((char *)ShmSysConfigAndInfo->SysConfig.ModelName, "DSYE301J3EW2PH") == EQUAL ||
+            strcmp((char *)ShmSysConfigAndInfo->SysConfig.ModelName, "DWYC301J0UW1PH") == EQUAL) {
+        ShmSysConfigAndInfo->SysInfo.IsAlternatvieConf = YES;
+    } else {
+        ShmSysConfigAndInfo->SysInfo.IsAlternatvieConf = NO;
+    }
+}
+
+void StopProcessingLoop()
+{
+    for (;;) {
+        CheckFactoryConfigFunction();
+        CheckFwUpdateFunction();
+        sleep(1);
+    }
+}
+
+void CreateWatchdog()
+{
+    if (ShmSysConfigAndInfo->SysConfig.SwitchDebugFlag == NO) {
+        wtdFd = InitWatchDog();
+
+        if (wtdFd < 0) {
+            ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CsuInitFailed = 1;
+        }
+    }
+}
+
+bool IsConnectorWholeIdle()
+{
+    bool result = true;
+
+    for (byte count = 0; count < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; count++) {
+        if (chargingInfo[count]->SystemStatus != S_IDLE &&
+                chargingInfo[count]->SystemStatus != S_RESERVATION) {
+            result = false;
+            break;
+        }
+    }
+
+    for (byte count = 0; count < ShmSysConfigAndInfo->SysConfig.AcConnectorCount; count++) {
+        if (ac_chargingInfo[count]->SystemStatus != S_IDLE &&
+                ac_chargingInfo[count]->IsErrorOccur == NO) {
+            result = false;
+            break;
+        }
+    }
+
+    return result;
+}
+
+void ClearAlarmCodeWhenAcOff()
+{
+    if (!ShmSysConfigAndInfo->SysInfo.AcContactorStatus) {
+        ShmStatusCodeData->AlarmCode.AlarmEvents.bits.PsuNoResource = NO;
+    }
+}
+
+//==========================================
+// Check task processing
+//==========================================
+void CheckTask()
+{
+    /*+++ 20200908, vern, disable it for DD360 +++*/
+#if 0
+    if (ShmSysConfigAndInfo->SysConfig.ModelName[10] == 'T') {
+        if (system("pidof -s Module_4g > /dev/null") != 0) {
+            DEBUG_ERROR_MSG("Module_4g not running, restart it.\r\n");
+            system("/root/Module_4g &");
+        }
+    } else if (ShmSysConfigAndInfo->SysConfig.ModelName[10] == 'W') {
+        if (system("pidof -s Module_Wifi > /dev/null") != 0) {
+            DEBUG_ERROR_MSG("Module_Wifi not running, restart it.\r\n");
+            system("/root/Module_Wifi &");
+        }
+    }
+
+    if (strcmp((char *)ShmSysConfigAndInfo->SysConfig.OcppServerURL, "") != EQUAL &&
+            strcmp((char *)ShmSysConfigAndInfo->SysConfig.ChargeBoxId, "") != EQUAL) {
+        if (system("pidof -s OcppBackend > /dev/null") != 0) {
+            DEBUG_ERROR_MSG("OcppBackend not running, restart it.\r\n");
+            system("/root/OcppBackend &");
+        }
+    }
+#endif
+    /*--- 20200908, vern, disable it for DD360 ---*/
+    if (system("pidof -s Module_ProduceUtils > /dev/null") != 0) {
+        DEBUG_ERROR_MSG("Module_ProduceUtils not running, restart it.\r\n");
+        system ("/root/Module_ProduceUtils &");
+    }
+}
+
+//==========================================
+// Check Smart Charging Profile
+//==========================================
+int GetStartScheduleTime(unsigned char *time)
+{
+    int result = -1;
+    struct tm tmScheduleStart;
+    struct timeb tbScheduleStart;
+
+    if ((sscanf((char *)time, "%4d-%2d-%2dT%2d:%2d:%2d", &tmScheduleStart.tm_year, &tmScheduleStart.tm_mon, &tmScheduleStart.tm_mday, &tmScheduleStart.tm_hour, &tmScheduleStart.tm_min, &tmScheduleStart.tm_sec) == 6)) {
+        tmScheduleStart.tm_year -= 1900;
+        tmScheduleStart.tm_mon -= 1;
+        tbScheduleStart.time = mktime(&tmScheduleStart);
+        tbScheduleStart.millitm = 0;
+
+        result = DiffTimebWithNow(tbScheduleStart) / 1000;
+    }
+
+    return result;
+}
+
+void CheckSmartChargeProfile(byte _index)
+{
+    if (ShmOCPP16Data->CSUMsg.bits[_index].ChargingProfileConf == NO) {
+        if (ShmOCPP16Data->CSUMsg.bits[_index].ChargingProfileReq == NO) {
+            ShmOCPP16Data->CSUMsg.bits[_index].ChargingProfileReq = YES;
+        }
+    } else {
+        // Get Charging Profile
+        ShmOCPP16Data->CSUMsg.bits[_index].ChargingProfileConf = NO;
+        if (strcmp((char *)ShmOCPP16Data->SmartChargingProfile[_index].ChargingProfileKind, "Absolute") == EQUAL) {
+            int _time = GetStartScheduleTime(ShmOCPP16Data->SmartChargingProfile[_index].ChargingSchedule.StartSchedule);
+            byte _startCount = NO_DEFINE;
+            byte _maxCount = ARRAY_SIZE(ShmOCPP16Data->SmartChargingProfile[_index].ChargingSchedule.ChargingSchedulePeriod);
+
+            for (byte _count = 0; _count < _maxCount; _count++) {
+                // 預設最小輸出電流 (MIN_OUTPUT_CUR) A
+                if (_time >= ShmOCPP16Data->SmartChargingProfile[_index].ChargingSchedule.ChargingSchedulePeriod[_count].StartPeriod &&
+                        ShmOCPP16Data->SmartChargingProfile[_index].ChargingSchedule.ChargingSchedulePeriod[_count].Limit > MIN_OUTPUT_CUR) {
+                    _startCount = _count;
+                }
+            }
+
+            PRINTF_FUNC("_startCount = %d \n", _startCount);
+            if (_startCount < _maxCount) {
+                PRINTF_FUNC("*********Limit = %f \n", ShmOCPP16Data->SmartChargingProfile[_index].ChargingSchedule.ChargingSchedulePeriod[_startCount].Limit);
+                chargingInfo[_index]->ChargingProfileCurrent = ShmOCPP16Data->SmartChargingProfile[_index].ChargingSchedule.ChargingSchedulePeriod[_startCount].Limit * 10;
+                chargingInfo[_index]->ChargingProfilePower = ShmOCPP16Data->SmartChargingProfile[_index].ChargingSchedule.ChargingSchedulePeriod[_startCount].Limit * chargingInfo[_index]->EvBatterytargetVoltage / 100;
+
+                //chargingInfo[_index]->ChargingProfilePower = ShmOCPP16Data->SmartChargingProfile[_index].ChargingSchedule.ChargingSchedulePeriod[_startCount].Limit * AC_OUTPUT_VOL;
+//              if ((chargingInfo[_index]->EvBatterytargetVoltage * 10) > 0)
+//              {
+//                  chargingInfo[_index]->ChargingProfileCurrent = chargingInfo[_index]->ChargingProfilePower / (chargingInfo[_index]->EvBatterytargetVoltage * 10);
+//              }
+            } else {
+                chargingInfo[_index]->ChargingProfilePower = -1;
+                chargingInfo[_index]->ChargingProfileCurrent = -1;
+            }
+
+            PRINTF_FUNC("ChargingProfilePower = %f \n", chargingInfo[_index]->ChargingProfilePower);
+            PRINTF_FUNC("ChargingProfileCurrent = %f \n", chargingInfo[_index]->ChargingProfileCurrent);
+        }
+//
+//      printf("-------------Schedule------------\n");
+//      printf("index = %d \n", _index);
+//      printf("StartSchedule = %s \n", ShmOCPP16Data->SmartChargingProfile[_index].ChargingSchedule.StartSchedule);
+//      printf("ChargingRateUnit = %s \n", ShmOCPP16Data->SmartChargingProfile[_index].ChargingSchedule.ChargingRateUnit);
+//      printf("----------SchedulePeriod---------\n");
+//      for (int v = 0; v < 10; v++)
+//      {
+//          printf("StartPeriod = %d \n", ShmOCPP16Data->SmartChargingProfile[_index].ChargingSchedule.ChargingSchedulePeriod[v].StartPeriod);
+//          printf("Limit = %f \n", ShmOCPP16Data->SmartChargingProfile[_index].ChargingSchedule.ChargingSchedulePeriod[v].Limit);
+//      }
+//      printf("---------------------------------\n");
+    }
+}
+
+void CheckReturnToChargingConn()
+{
+    if ((ShmSysConfigAndInfo->SysConfig.TotalConnectorCount + ShmSysConfigAndInfo->SysConfig.AcConnectorCount) > 1 &&
+            ShmSysConfigAndInfo->SysInfo.PageIndex != _LCM_AUTHORIZING &&
+            ShmSysConfigAndInfo->SysInfo.PageIndex != _LCM_AUTHORIZ_FAIL &&
+            ShmSysConfigAndInfo->SysInfo.PageIndex != _LCM_AUTHORIZ_COMP &&
+            ShmSysConfigAndInfo->SysInfo.PageIndex != _LCM_WAIT_FOR_PLUG) {
+        bool isReturnTimeout = false;
+
+        for (byte count = 0; count < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; count++) {
+            // 如果選的 DC 槍在充電~ 則 DC 槍不改變
+            if (count == ShmSysConfigAndInfo->SysInfo.CurGunSelected) {
+                if ((chargingInfo[count]->SystemStatus >= S_REASSIGN_CHECK && chargingInfo[count]->SystemStatus <= S_COMPLETE) ||
+                        (chargingInfo[count]->SystemStatus >= S_CCS_PRECHARGE_ST0 && chargingInfo[count]->SystemStatus <= S_CCS_PRECHARGE_ST1)) {
+                    isReturnTimeout = false;
+                    break;
+                }
+            } else if (count != ShmSysConfigAndInfo->SysInfo.CurGunSelected) {
+                if ((chargingInfo[count]->SystemStatus >= S_REASSIGN_CHECK && chargingInfo[count]->SystemStatus <= S_COMPLETE) ||
+                        (chargingInfo[count]->SystemStatus >= S_CCS_PRECHARGE_ST0 && chargingInfo[count]->SystemStatus <= S_CCS_PRECHARGE_ST1)) {
+                    isReturnTimeout = true;
+                    StartSystemTimeoutDet(Timeout_ReturnToChargingGunDet);
+                }
+            }
+        }
+
+        // AC 槍
+        if (!isReturnTimeout && ShmSysConfigAndInfo->SysConfig.AcConnectorCount > 0) {
+            // 沒有選中 AC，且 AC 在充電中
+            if (ShmSysConfigAndInfo->SysInfo.CurGunSelectedByAc == NO_DEFINE &&
+                    (ac_chargingInfo[0]->SystemStatus >= S_PREPARNING && ac_chargingInfo[0]->SystemStatus <= S_COMPLETE)) {
+                // 當前 DC 充電槍在 idle 狀態
+                if (chargingInfo[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->SystemStatus == S_IDLE ||
+                        chargingInfo[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->SystemStatus == S_RESERVATION) {
+                    isReturnTimeout = true;
+                    StartSystemTimeoutDet(Timeout_ReturnToChargingGunDet);
+                }
+            } else if (ShmSysConfigAndInfo->SysInfo.CurGunSelectedByAc == DEFAULT_AC_INDEX &&
+                       ((chargingInfo[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->SystemStatus >= S_REASSIGN_CHECK && chargingInfo[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->SystemStatus <= S_COMPLETE) ||
+                        (chargingInfo[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->SystemStatus >= S_CCS_PRECHARGE_ST0 && chargingInfo[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->SystemStatus <= S_CCS_PRECHARGE_ST1))) {
+                // 當前 DC 充電槍在 idle 狀態
+                if (ac_chargingInfo[0]->SystemStatus == S_IDLE ||
+                        ac_chargingInfo[0]->SystemStatus == S_RESERVATION) {
+                    isReturnTimeout = true;
+                    StartSystemTimeoutDet(Timeout_ReturnToChargingGunDet);
+                }
+            }
+        }
+
+        if (!isReturnTimeout) {
+            StopSystemTimeoutDet();
+        }
+    }
+}
+
+bool GetStartChargingByAlterMode(byte _gun)
+{
+    bool result = true;
+
+    if (ShmSysConfigAndInfo->SysConfig.TotalConnectorCount == 2 &&
+            ShmSysConfigAndInfo->SysInfo.IsAlternatvieConf == YES) {
+        for (byte _select = 0; _select < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; _select++) {
+            if (_select != _gun) {
+                if (chargingInfo[_select]->SystemStatus != S_IDLE &&
+                        chargingInfo[_select]->SystemStatus != S_RESERVATION) {
+                    result = false;
+                    break;
+                }
+            }
+        }
+    }
+
+    return result;
+}
+
+int main(void)
+{
+
+    if (CreateShareMemory() == 0) {
+#ifdef SystemLogMessage
+        DEBUG_ERROR_MSG("CreatShareMemory NG \n");
+#endif
+        if (ShmStatusCodeData != NULL) {
+            ShmStatusCodeData->AlarmCode.AlarmEvents.bits.FailToCreateShareMemory = 1;
+        }
+        sleep(5);
+        system("reboot -f");
+        sleep(5);
+        system("reboot -f");
+    }
+    DEBUG_INFO_MSG(" ****************  FileSystem Boot up ***************\n");
+    if (!InitialSystemDefaultConfig()) {
+        DEBUG_ERROR_MSG("InitialSystemDefaultConfig NG \n");
+        StopProcessingLoop();
+    }
+    CheckGunTypeFromHw();
+    CheckIsAlternatvieByModelName();
+    InitialShareMemoryInfo();
+    ChangeLcmByIndex(_LCM_INIT);
+    if (!CheckConnectorTypeStatus()) {
+        isModelNameMatch = false;
+    }
+
+    Initialization();
+    SpawnTask();
+    DEBUG_INFO_MSG("Spawned all Task");
+    if (!isModelNameMatch) {
+        ShmStatusCodeData->AlarmCode.AlarmEvents.bits.ModelNameNoneMatchStestFail = YES;
+        ChangeLcmByIndex(_LCM_FIX);
+        // Module Name 與硬體對應不正確
+        DEBUG_ERROR_MSG("Module Name & HW info none match. \n");
+        sleep(3);
+        KillTask();
+        StopProcessingLoop();
+    }
+    CreateTimeoutFork();
+    DEBUG_INFO_MSG("Start self test... \n");
+    SelfTestRun();
+    StopSystemTimeoutDet();
+    DEBUG_INFO_MSG("Self test finished : SelfTestSeq = %d, Work_Step = %d ", ShmSysConfigAndInfo->SysInfo.SelfTestSeq, ShmPsuData->Work_Step);
+    if (ShmSysConfigAndInfo->SysInfo.SelfTestSeq == _STEST_FAIL ||
+            ShmPsuData->Work_Step == _NO_WORKING) {
+        if (ShmSysConfigAndInfo->SysWarningInfo.Level != 2) {
+            DisplaySelfTestFailReason();
+        }
+
+        for (byte gun_index = 0; gun_index < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; gun_index++) {
+            setChargerMode(gun_index, MODE_ALARM);
+        }
+        ChangeLcmByIndex(_LCM_FIX);
+        sleep(3);
+        KillTask();
+        StopProcessingLoop();
+    } else {
+        for (byte gun_index = 0; gun_index < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; gun_index++) {
+            setChargerMode(gun_index, MODE_IDLE);
+        }
+    }
+
+    // Local DB
+    if (DB_Open(localDb) != PASS) {
+        PRINTF_FUNC("DB_Open fail. \n");
+        isDb_ready = false;
+    } else {
+        isDb_ready = true;
+        for (int _index = 0; _index < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; _index++) {
+            chargingInfo[_index]->IsAvailable = DB_Get_Operactive(localDb, _index);
+        }
+    }
+
+    ChangeLcmByIndex(_LCM_IDLE);
+    sleep(1);
+    //***** 須新增的偵測 *****//
+    // 1. Thernal - 控制風扇轉速
+    // 2. ouput fuse - 控制風扇轉速
+    CreateRfidFork();
+    // Create Watchdog
+    //CreateWatchdog();
+    // Main loop
+    PRINTF_FUNC("****************************Main Loop********************************** \n");
+    gettimeofday(&_cmdMainPriority_time, NULL);
+    for (;;) {
+        CheckOcppStatus();
+        ChkPrimaryStatus();
+        if ((IsConnectorWholeIdle() || ShmSysConfigAndInfo->SysInfo.PageIndex == _LCM_FIX) &&
+                ShmSysConfigAndInfo->SysInfo.SystemTimeoutFlag != Timeout_ReturnToChargingGunDet) {
+            CheckFactoryConfigFunction();
+
+            CheckFwUpdateFunction();
+        }
+
+        // OCPP 邏輯
+        OcppRemoteStartChk();
+        // 讀卡邏輯
+        ScannerCardProcess();
+        // 當 AC 沒有搭上時，清除一些錯誤碼
+        ClearAlarmCodeWhenAcOff();
+        // 確認是否要回到充電中的槍畫面邏輯判斷
+        CheckReturnToChargingConn();
+
+        if (_acgunIndex > 0 && isDetectPlugin() && !isCardScan) {
+            ShmSysConfigAndInfo->SysInfo.SystemPage = _LCM_WAIT_FOR_PLUG;
+        }
+
+        if ((GetTimeoutValue(_cmdMainPriority_time) / 1000) > 5000) {
+            CheckTask();
+            for (byte _index = 0; _index < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; _index++) {
+                if (chargingInfo[_index]->SystemStatus == S_CHARGING) {
+                    CheckSmartChargeProfile(_index);
+                }
+            }
+
+            gettimeofday(&_cmdMainPriority_time, NULL);
+        }
+
+        for (byte gun_index = 0; gun_index < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; gun_index++) {
+            CheckGpioInStatus();
+            CheckErrorOccurStatus(gun_index);
+            ChkOcppStatus(gun_index);
+
+            //PRINTF_FUNC("index = %d, ErrorCode = %s \n", gun_index, ShmOCPP16Data->StatusNotification[gun_index].ErrorCode);
+            switch (chargingInfo[gun_index]->SystemStatus) {
+            case S_IDLE:
+            case S_RESERVATION:
+            case S_MAINTAIN:
+            case S_ALARM: {
+                if (chargingInfo[gun_index]->SystemStatus == S_IDLE &&
+                        isModeChange(gun_index)) {
+                    DEBUG_INFO_MSG("S_IDLE================================== %x \n", gun_index);
+                    chargingInfo[gun_index]->PresentChargedDuration = 0;
+                    chargingInfo[gun_index]->RemainChargingDuration = 0;
+                    strcpy((char *)chargingInfo[gun_index]->StartDateTime, "");
+                    strcpy((char *)chargingInfo[gun_index]->StopDateTime, "");
+                    strcpy((char *)chargingInfo[gun_index]->StartUserId, "");
+                    strcpy((char *)ShmOCPP16Data->StopTransaction[gun_index].StopReason, "");
+                } else if (chargingInfo[gun_index]->SystemStatus == S_RESERVATION &&
+                           isModeChange(gun_index)) {
+                    DEBUG_INFO_MSG("S_RESERVATION....................%x \n", gun_index);
+                    ShmOCPP16Data->CsMsg.bits[gun_index].ReserveNowConf = YES;
+                }
+
+                if (chargingInfo[gun_index]->IsAvailable == NO) {
+                    setChargerMode(gun_index, MODE_MAINTAIN);
+                }
+
+                if (ShmSysConfigAndInfo->SysWarningInfo.Level == 2) {
+                    //if (gun_index == ShmSysConfigAndInfo->SysInfo.CurGunSelected)
+                    {
+                        ShmSysConfigAndInfo->SysInfo.SystemPage = _LCM_FIX;
+                    }
+                    ClearDetectPluginFlag();
+                    setChargerMode(gun_index, MODE_ALARM);
+                } else if (ShmSysConfigAndInfo->SysConfig.OfflinePolicy == _OFFLINE_POLICY_NO_CHARGING) {
+                    /*                           不給充電                        */
+
+                } else {
+                    if (ShmSysConfigAndInfo->SysInfo.SystemPage == _LCM_FIX) {
+                        ShmSysConfigAndInfo->SysInfo.SystemPage = _LCM_NONE;
+                        for (byte g_index = 0; g_index < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; g_index++) {
+                            setChargerMode(g_index, MODE_IDLE);
+                        }
+                    }
+
+                    if (ShmSysConfigAndInfo->SysInfo.MainChargingMode == _MAIN_CHARGING_MODE_AVER) {
+#ifndef DD360
+                        if (ShmSysConfigAndInfo->SysInfo.AcContactorStatus == YES)
+#else
+                        if (1)
+#endif
+                        {
+                            // 均充 -> 最大充
+                            if (ShmSysConfigAndInfo->SysInfo.BridgeRelayStatus == NO) {
+                                if (ShmSysConfigAndInfo->SysInfo.ReAssignedFlag == _REASSIGNED_NONE) {
+                                    DEBUG_INFO_MSG("=============Smart Charging============= Step 11 \n");
+                                    ShmSysConfigAndInfo->SysInfo.ReAssignedFlag = _REASSIGNED_PREPARE_A_TO_M;
+                                }
+                            } else if (ShmSysConfigAndInfo->SysInfo.ReAssignedFlag != _REASSIGNED_COMP &&
+                                       ShmSysConfigAndInfo->SysInfo.ReAssignedFlag != _REASSIGNED_WAITING) {
+                                DEBUG_INFO_MSG("=============Smart Charging============= Step 14 \n");
+                                ShmSysConfigAndInfo->SysInfo.ReAssignedFlag = _REASSIGNED_WAITING;
+                            } else if (ShmSysConfigAndInfo->SysInfo.ReAssignedFlag == _REASSIGNED_COMP) {
+                                ShmSysConfigAndInfo->SysInfo.MainChargingMode = _MAIN_CHARGING_MODE_MAX;
+                                ShmSysConfigAndInfo->SysInfo.ReAssignedFlag = _REASSIGNED_NONE;
+                            }
+                        } else {
+                            ShmSysConfigAndInfo->SysInfo.MainChargingMode = _MAIN_CHARGING_MODE_MAX;
+                            ShmSysConfigAndInfo->SysInfo.ReAssignedFlag = _REASSIGNED_NONE;
+                        }
+                    } else {
+                        ShmSysConfigAndInfo->SysInfo.ReAssignedFlag = _REASSIGNED_NONE;
+                    }
+
+                    {
+                        // Idle 正常程序起點
+                        // 判斷是否有啟用檢查插槍
+                        if (isDetectPlugin()) {
+                            //PRINTF_FUNC("----------------ShmSysConfigAndInfo->SysInfo.PageIndex--------------- %d \n", ShmSysConfigAndInfo->SysInfo.PageIndex);
+                            //PRINTF_FUNC("----------------ShmSysConfigAndInfo->SysInfo.SystemPage--------------- %d \n", ShmSysConfigAndInfo->SysInfo.SystemPage);
+                            //PRINTF_FUNC("----------------ShmSysConfigAndInfo->SysInfo.ConnectorPage--------------- %d \n", ShmSysConfigAndInfo->SysInfo.ConnectorPage);
+                            //PRINTF_FUNC("----------------isCardScan--------------- %d \n", isCardScan);
+
+                            // 卡號驗證成功後，等待充電槍插入充電車
+                            if (chargingInfo[gun_index]->RemoteStartFlag == YES) {
+                                if (chargingInfo[gun_index]->ConnectorPlugIn == YES &&
+                                        chargingInfo[gun_index]->IsAvailable) {
+                                    PRINTF_FUNC("-----------------1----------------- %d \n", gun_index);
+                                    chargingInfo[gun_index]->RemoteStartFlag = NO;
+                                    ChangeGunSelectByIndex(gun_index);
+                                    AddPlugInTimes(gun_index);
+#ifdef DD360
+                                    setChargerMode(gun_index, MODE_PRECHARGE);
+#else
+                                    setChargerMode(gun_index, MODE_REASSIGN_CHECK);
+#endif
+                                    strcpy((char *)chargingInfo[gun_index]->StartUserId, "");
+                                    ClearDetectPluginFlag();
+                                    continue;
+                                }
+                            } else if (ShmSysConfigAndInfo->SysInfo.OrderCharging == NO_DEFINE) {
+                                if (chargingInfo[gun_index]->ConnectorPlugIn == YES && chargingInfo[gun_index]->IsAvailable &&
+                                        chargingInfo[gun_index]->SystemStatus == S_IDLE /*&&((ShmSysConfigAndInfo->SysInfo.PageIndex == _LCM_AUTHORIZ_COMP)||(ShmSysConfigAndInfo->SysInfo.PageIndex == _LCM_WAIT_FOR_PLUG))*/) {
+                                    PRINTF_FUNC("-----------------2----------------- \n");
+                                    ChangeGunSelectByIndex(gun_index);
+                                    AddPlugInTimes(gun_index);
+                                    strcpy((char *)chargingInfo[gun_index]->StartUserId, (char *)ShmSysConfigAndInfo->SysConfig.UserId);
+                                    PRINTF_FUNC("index = %d, CardNumber = %s \n", gun_index, chargingInfo[gun_index]->StartUserId);
+                                    strcpy((char *)ShmSysConfigAndInfo->SysConfig.UserId, "");
+                                    // 當前操作的槍號，進入 Preparing
+                                    //#ifdef DD360
+                                    //setChargerMode(gun_index, MODE_PRECHARGE);
+                                    //#else
+                                    setChargerMode(gun_index, MODE_REASSIGN_CHECK);
+                                    //#endif
+                                    ClearDetectPluginFlag();
+                                    continue;
+                                }
+                            }
+
+                            if (!isCardScan) {
+                                // LCM => Waiting for plugging
+                                ShmSysConfigAndInfo->SysInfo.SystemPage = _LCM_WAIT_FOR_PLUG;
+                            }
+                        } else if (chargingInfo[gun_index]->SystemStatus == S_RESERVATION) {
+                            if (!isReservationExpired(gun_index)) {
+                                chargingInfo[gun_index]->SystemStatus = S_IDLE;
+                            }
+                        } else if (ShmSysConfigAndInfo->SysConfig.AuthorisationMode == AUTH_MODE_DISABLE &&
+                                   (chargingInfo[gun_index]->ConnectorPlugIn == YES && chargingInfo[gun_index]->IsAvailable)) {
+                            PRINTF_FUNC("-----------------3----------------- \n");
+                            bool isCanStartChargingFlag = GetStartChargingByAlterMode(gun_index);
+
+                            if (isCanStartChargingFlag) {
+                                ChangeGunSelectByIndex(gun_index);
+                                AddPlugInTimes(gun_index);
+                                //#ifdef DD360
+                                //setChargerMode(gun_index, MODE_PRECHARGE);
+                                //#else
+                                setChargerMode(gun_index, MODE_REASSIGN_CHECK);
+                                //#endif
+                                ClearDetectPluginFlag();
+                                continue;
+                            }
+                        } else {
+                            if (ShmSysConfigAndInfo->SysInfo.CurGunSelected == gun_index) {
+                                ShmSysConfigAndInfo->SysInfo.ConnectorPage = _LCM_IDLE;
+                            }
+                        }
+                    } // Idle 正常程序終點
+                }
+
+                ReleaseAlarmCode(gun_index);
+            }
+            break;
+            case S_REASSIGN_CHECK: {
+                if (isModeChange(gun_index)) {
+                    DEBUG_INFO_MSG("S_REASSIGN_CHECK================================== %x \n", gun_index);
+                    ShmSysConfigAndInfo->SysInfo.SystemPage = _LCM_NONE;
+                    if (ShmSysConfigAndInfo->SysInfo.OrderCharging != NO_DEFINE) {
+                        ShmSysConfigAndInfo->SysInfo.OrderCharging = NO_DEFINE;
+                    }
+                    StopSystemTimeoutDet();
+                }
+#if 0
+                bool isRessign = false;
+                if (ShmSysConfigAndInfo->SysConfig.TotalConnectorCount > 1 && ShmSysConfigAndInfo->SysInfo.IsAlternatvieConf == NO) {
+                    if (ShmSysConfigAndInfo->SysInfo.MainChargingMode == _MAIN_CHARGING_MODE_MAX) {
+                        for (byte index = 0; index < ShmSysConfigAndInfo->SysConfig.TotalConnectorCount; index++) {
+                            // 有其他槍已經分配好 psu 模塊
+                            if (ShmSysConfigAndInfo->SysInfo.CurGunSelected != index &&
+                                    chargingInfo[index]->SystemStatus >= S_PREPARNING &&
+                                    chargingInfo[index]->SystemStatus != S_MAINTAIN) {
+                                DEBUG_INFO_MSG("=============Smart Charging============= Step 1 \n");
+                                ShmSysConfigAndInfo->SysInfo.ReAssignedFlag = _REASSIGNED_PREPARE_M_TO_A;
+                                isRessign = true;
+                                break;
+                            }
+                        }
+                    } else if (ShmSysConfigAndInfo->SysInfo.MainChargingMode == _MAIN_CHARGING_MODE_AVER &&
+                               ShmSysConfigAndInfo->SysInfo.ReAssignedFlag != _REASSIGNED_NONE) {
+                        // 如果在切換最大充的過程中，需等待最大充切換完成後，在走均充流程
+                        if (ShmSysConfigAndInfo->SysInfo.BridgeRelayStatus == YES) {
+                            if (ShmSysConfigAndInfo->SysInfo.ReAssignedFlag != _REASSIGNED_COMP &&
+                                    ShmSysConfigAndInfo->SysInfo.ReAssignedFlag != _REASSIGNED_WAITING) {
+                                DEBUG_INFO_MSG("=============Smart Charging============= Step 14 \n");
+                                ShmSysConfigAndInfo->SysInfo.ReAssignedFlag = _REASSIGNED_WAITING;
+                            } else if (ShmSysConfigAndInfo->SysInfo.ReAssignedFlag == _REASSIGNED_COMP) {
+                                ShmSysConfigAndInfo->SysInfo.MainChargingMode = _MAIN_CHARGING_MODE_MAX;
+                                ShmSysConfigAndInfo->SysInfo.ReAssignedFlag = _REASSIGNED_NONE;
+                                continue;
+                            }
+                        }
+
+                        if (ShmSysConfigAndInfo->SysInfo.CurGunSelected == gun_index) {
+                            ShmSysConfigAndInfo->SysInfo.ConnectorPage = _LCM_PRE_CHARGE;
+                        }
+                        continue;
+                    }
+                }
+#endif
+                if (0)
+#ifdef DD360
+                    setChargerMode(gun_index, MODE_PRECHARGE);
+#else
+                    setChargerMode(gun_index, MODE_REASSIGN);
+#endif
+                else {
+                    setChargerMode(gun_index, MODE_PRECHARGE);
+                }
+
+                if (ShmSysConfigAndInfo->SysInfo.CurGunSelected == gun_index) {
+                    ShmSysConfigAndInfo->SysInfo.ConnectorPage = _LCM_PRE_CHARGE;
+                }
+            }
+            break;
+            case S_REASSIGN: {
+                if (isModeChange(gun_index)) {
+                    PRINTF_FUNC("S_REASSIGN================================== %x \n", gun_index);
+                    gettimeofday(&_toAverage_time, NULL);
+                }
+
+                // 重新分配，此階段主要是讓已經在充電或者準備進入充電前的緩衝
+                // 此狀態下~ 控制權在於 PSU 及 EV小板 Process
+                if (ShmSysConfigAndInfo->SysInfo.ReAssignedFlag == _REASSIGNED_NONE ||
+                        ShmSysConfigAndInfo->SysInfo.MainChargingMode == _MAIN_CHARGING_MODE_AVER) {
+                    if (ShmSysConfigAndInfo->SysInfo.CanAverageCharging) {
+                        setChargerMode(gun_index, MODE_PRECHARGE);
+                    } else {
+                        setChargerMode(gun_index, MODE_IDLE);
+                    }
+                } else if (ShmSysConfigAndInfo->SysInfo.ReAssignedFlag == _REASSIGNED_RELAY_M_TO_A &&
+                           ShmSysConfigAndInfo->SysInfo.BridgeRelayStatus == NO) {
+                    PRINTF_FUNC("=============Smart Charging : _REASSIGNED_COMP============= Step 6 \n");
+                    ShmSysConfigAndInfo->SysInfo.MainChargingMode = _MAIN_CHARGING_MODE_AVER;
+                    ShmSysConfigAndInfo->SysInfo.ReAssignedFlag = _REASSIGNED_NONE;
+                }
+
+                //PRINTF_FUNC("CurGunSelected = %d, gun_index = %d \n", ShmSysConfigAndInfo->SysInfo.CurGunSelected, gun_index);
+                if (ShmSysConfigAndInfo->SysInfo.CurGunSelected == gun_index) {
+                    ShmSysConfigAndInfo->SysInfo.ConnectorPage = _LCM_PRE_CHARGE;
+                }
+            }
+            break;
+            case S_PREPARNING: {
+                if (isModeChange(gun_index)) {
+                    PRINTF_FUNC("S_PREPARNING================================== %x \n", gun_index);
+                    StopGunInfoTimeoutDet(gun_index);
+                    StartGunInfoTimeoutDet(gun_index, Timeout_Preparing);
+                }
+
+                if (ShmPsuData->SystemPresentPsuQuantity > 0 && ShmPsuData->SystemAvailablePower > 10 &&
+                        GetTimeoutValue(chargingInfo[gun_index]->TimeoutTimer) >= 5000000) {
+                    if ((chargingInfo[gun_index]->MaximumChargingVoltage > 0) &&
+                            (chargingInfo[gun_index]->AvailableChargingCurrent > 0) &&
+                            (chargingInfo[gun_index]->AvailableChargingPower > 0)) {
+                        setChargerMode(gun_index, MODE_PREPARE_FOR_EV);
+                    }
+                }
+
+                if (isEvBoardStopChargeFlag(gun_index) == YES || OcppRemoteStop(gun_index) == YES) {
+                    // 板端或後臺要求停止
+                    ChargingTerminalProcess(gun_index);
+                }
+
+                if (ShmSysConfigAndInfo->SysInfo.CurGunSelected == gun_index) {
+                    ShmSysConfigAndInfo->SysInfo.ConnectorPage = _LCM_PRE_CHARGE;
+                }
+            }
+            break;
+            case S_PREPARING_FOR_EV: { // 等待車端的通訊 (EV 小板)，待車端回報後，開始樁端的測試
+                if (isModeChange(gun_index)) {
+                    DEBUG_INFO_MSG("S_PREPARING_FOR_EV================================== %x \n", gun_index);
+                    //strcpy((char *)ShmSysConfigAndInfo->SysConfig.UserId, "");
+                    StopGunInfoTimeoutDet(gun_index);
+                    StartGunInfoTimeoutDet(gun_index, Timeout_EvChargingDet);
+                }
+
+                if (chargingInfo[gun_index]->Type == _Type_Chademo) {
+                    // 檢查車端的槍鎖是否為鎖上
+                    if (isEvGunLocked_chademo(gun_index) == YES) {
+                        setChargerMode(gun_index, MODE_PREPARE_FOR_EVSE);
+                    }
+                } else if (chargingInfo[gun_index]->Type == _Type_GB) {
+                    // 檢查車端的 charging enable 是否為 1
+                    if (isEvGunLocked_gb(gun_index) == YES) {
+                        setChargerMode(gun_index, MODE_PREPARE_FOR_EVSE);
+                    }
+                } else if (chargingInfo[gun_index]->Type == _Type_CCS_2) {
+                    // 檢查車端的 charging enable 是否為 1
+                    if (isEvGunLocked_ccs(gun_index) == YES) {
+                        setChargerMode(gun_index, MODE_PREPARE_FOR_EVSE);
+                    }
+                }
+
+                if (isEvBoardStopChargeFlag(gun_index) == YES  ||
+                        OcppRemoteStop(gun_index) == YES) {
+                    // 板端或後臺要求停止
+                    ChargingTerminalProcess(gun_index);
+                }
+
+                // LCM => Pre-charging
+                if (ShmSysConfigAndInfo->SysInfo.CurGunSelected == gun_index) {
+                    ShmSysConfigAndInfo->SysInfo.ConnectorPage = _LCM_PRE_CHARGE;
+                }
+            }
+            break;
+            case S_PREPARING_FOR_EVSE: { // 等待 RB 通訊及測試，並將狀態回報， CSU 確認 Pass 後，開始進入充電
+                if (isModeChange(gun_index)) {
+                    DEBUG_INFO_MSG("S_PREPARING_FOR_EVSE================================== %x \n", gun_index);
+                    StopGunInfoTimeoutDet(gun_index);
+                    StartGunInfoTimeoutDet(gun_index, Timeout_EvseChargingDet);
+                }
+
+                if (chargingInfo[gun_index]->Type == _Type_Chademo) {
+                    // 檢查樁端的 GFD 結果
+                    if (isPrechargeStatus_chademo(gun_index) > 5 && isPrechargeStatus_chademo(gun_index) < 8) {
+                        // 當前操作的槍號，進入 Charging
+                        setChargerMode(gun_index, MODE_CHARGING);
+                    }
+
+                    if (chargingInfo[gun_index]->GroundFaultStatus == GFD_FAIL) {
+                        // GFD 錯誤停止
+                        RecordAlarmCode(gun_index, "012234");
+                    } else if (chargingInfo[gun_index]->GroundFaultStatus == GFD_WARNING) {
+                        // GFD 警告
+                        RecordWarningCode(gun_index, "012296");
+                    }
+                } else if (chargingInfo[gun_index]->Type == _Type_GB) {
+                    // 檢查樁端的 GFD 結果
+                    if (isPrechargeStatus_gb(gun_index) > 5 && isPrechargeStatus_gb(gun_index) < 9) {
+                        setChargerMode(gun_index, MODE_CHARGING);
+                    }
+
+                    if (chargingInfo[gun_index]->GroundFaultStatus == GFD_FAIL) {
+                        // GFD 錯誤停止
+                        RecordAlarmCode(gun_index, "012236");
+                    } else if (chargingInfo[gun_index]->GroundFaultStatus == GFD_WARNING) {
+                        // GFD 警告
+                        RecordWarningCode(gun_index, "012298");
+                    }
+                } else if (chargingInfo[gun_index]->Type == _Type_CCS_2) {
+                    // 檢查樁端的 GFD 結果
+                    if ((chargingInfo[gun_index]->GroundFaultStatus == GFD_PASS ||
+                            chargingInfo[gun_index]->GroundFaultStatus == GFD_WARNING)) {
+#ifdef DD360
+                        //setChargerMode(gun_index, MODE_CHARGING);
+                        setChargerMode(gun_index, MODE_CCS_PRECHARGE_STEP0);
+#else
+                        setChargerMode(gun_index, MODE_CCS_PRECHARGE_STEP0);
+#endif
+                    }
+
+                    if (chargingInfo[gun_index]->GroundFaultStatus == GFD_FAIL) {
+                        // GFD 錯誤停止
+                        RecordAlarmCode(gun_index, "012235");
+                    } else if (chargingInfo[gun_index]->GroundFaultStatus == GFD_WARNING) {
+                        // GFD 警告
+                        RecordWarningCode(gun_index, "012297");
+                    }
+                }
+
+                if (isEvBoardStopChargeFlag(gun_index) == YES ||
+                        OcppRemoteStop(gun_index) == YES) {
+                    // 板端或後臺要求停止
+                    ChargingTerminalProcess(gun_index);
+                }
+
+                // LCM => Pre-charging
+                if (ShmSysConfigAndInfo->SysInfo.CurGunSelected == gun_index) {
+                    ShmSysConfigAndInfo->SysInfo.ConnectorPage = _LCM_PRE_CHARGE;
+                }
+            }
+            break;
+            case S_CHARGING: { // 剛進入充電狀態，等待 EV 小板要求的輸出電流後開始輸出
+                if (isModeChange(gun_index)) {
+                    DEBUG_INFO_MSG("S_CHARGING================================== %x \n", gun_index);
+                    StopGunInfoTimeoutDet(gun_index);
+                    ftime(&startChargingTime[gun_index]);
+                    ChangeStartOrStopDateTime(YES, gun_index);
+                    /*OcppStartTransation(gun_index);*//*+++ 20200908, vern, disable it for DD360 ---*/
+                }
+
+                if (ShmOCPP16Data->CpMsg.bits[gun_index].StartTransactionConf) {
+                    ShmOCPP16Data->CpMsg.bits[gun_index].StartTransactionConf = NO;
+                }
+                ftime(&endChargingTime[gun_index]);
+                chargingInfo[gun_index]->PresentChargedDuration = DiffTimeb(startChargingTime[gun_index], endChargingTime[gun_index]);
+
+                if (chargingInfo[gun_index]->Type == _Type_Chademo) {
+                    if (chargingInfo[gun_index]->GroundFaultStatus == GFD_FAIL) {
+                        // GFD 錯誤停止
+                        RecordAlarmCode(gun_index, "012234");
+                    } else if (((chargingInfo[gun_index]->EvBatterytargetVoltage * 10) > 0 && chargingInfo[gun_index]->EvBatterytargetVoltage < SYSTEM_MIN_VOL)/* ||
+                    (chargingInfo[gun_index]->PresentChargedDuration >= 10 && chargingInfo[gun_index]->PresentChargingVoltage < SYSTEM_MIN_VOL)*/) {
+                        // UVP
+                        RecordAlarmCode(gun_index, "012289");
+                        ChargingTerminalProcess(gun_index);
+                    } else if (chargingInfo[gun_index]->GroundFaultStatus == GFD_WARNING) {
+                        // GFD 警告
+                        RecordWarningCode(gun_index, "012296");
+                    }
+                } else if (chargingInfo[gun_index]->Type == _Type_GB) {
+                    if (chargingInfo[gun_index]->GroundFaultStatus == GFD_FAIL) {
+                        // GFD 錯誤停止
+                        RecordAlarmCode(gun_index, "012236");
+                    } else if (isPrechargeStatus_gb(gun_index) == 10 &&
+                               (((chargingInfo[gun_index]->EvBatterytargetVoltage * 10) > 0 && chargingInfo[gun_index]->EvBatterytargetVoltage < SYSTEM_MIN_VOL)/* ||
+                    (chargingInfo[gun_index]->PresentChargedDuration >= 10 && chargingInfo[gun_index]->PresentChargingVoltage < SYSTEM_MIN_VOL)*/)) {
+                        // UVP
+                        RecordAlarmCode(gun_index, "012290");
+                        ChargingTerminalProcess(gun_index);
+                    } else if (chargingInfo[gun_index]->GroundFaultStatus == GFD_WARNING) {
+                        // GFD 警告
+                        RecordWarningCode(gun_index, "012298");
+                    }
+                } else if (chargingInfo[gun_index]->Type == _Type_CCS_2) {
+                    if (chargingInfo[gun_index]->GroundFaultStatus == GFD_FAIL) {
+                        // GFD 錯誤停止
+                        RecordAlarmCode(gun_index, "012235");
+                    } else if (((chargingInfo[gun_index]->EvBatterytargetVoltage * 10) > 0 && chargingInfo[gun_index]->EvBatterytargetVoltage < SYSTEM_MIN_VOL)/* ||
+                    (chargingInfo[gun_index]->PresentChargedDuration >= 10 && chargingInfo[gun_index]->PresentChargingVoltage < SYSTEM_MIN_VOL)*/) {
+                        // UVP
+                        RecordAlarmCode(gun_index, "012288");
+                        ChargingTerminalProcess(gun_index);
+                    } else if (chargingInfo[gun_index]->GroundFaultStatus == GFD_WARNING) {
+                        // GFD 警告
+                        RecordWarningCode(gun_index, "012297");
+                    }
+                }
+
+                if (isEvBoardStopChargeFlag(gun_index) ||
+                        OcppRemoteStop(gun_index) ||
+                        CheckBackendChargingTimeout(gun_index) ||
+                        CheckBackendChargingEnergy(gun_index) ||
+                        strcmp((char *)ShmOCPP16Data->StartTransaction[gun_index].ResponseIdTagInfo.Status, "Invalid") == EQUAL) {
+                    DEBUG_INFO_MSG("S_CHARGING=======Stop=========================== %f \n", (chargingInfo[gun_index]->EvBatterytargetVoltage * 10));
+                    // 板端或後臺要求停止
+                    ChargingTerminalProcess(gun_index);
+                }
+
+                // LCM => Charging
+                if (ShmSysConfigAndInfo->SysInfo.CurGunSelected == gun_index) {
+                    ShmSysConfigAndInfo->SysInfo.ConnectorPage = _LCM_CHARGING;
+                }
+            }
+            break;
+            case S_TERMINATING: {
+                if (isModeChange(gun_index)) {
+                    DEBUG_INFO_MSG ("terminating......................... %x \n", gun_index);
+                    StopGunInfoTimeoutDet(gun_index);
+                }
+
+                if (chargingInfo[gun_index]->Type == _Type_Chademo) {
+                    // 非車端的停止 : 需等待小板送出停止指令，讓車端解除槍
+                    if (isEvStopCharging_chademo(gun_index) == YES) {
+                        /*+++ 20200908, vern, disable it for DD360 +++*/
+                        /*if (strcmp((char *)ShmOCPP16Data->StopTransaction[gun_index].StopReason, "") == EQUAL)
+                            strcpy((char *)ShmOCPP16Data->StopTransaction[gun_index].StopReason, "Local");*/
+                        /*--- 20200908, vern, disable it for DD360 ---*/
+                    }
+
+                    if (chargingInfo[gun_index]->GroundFaultStatus == GFD_FAIL) {
+                        // GFD 錯誤停止
+                        RecordAlarmCode(gun_index, "012234");
+                    } else if (chargingInfo[gun_index]->GroundFaultStatus == GFD_WARNING) {
+                        // GFD 警告
+                        RecordWarningCode(gun_index, "012296");
+                    }
+
+                    if (isEvStopCharging_chademo(gun_index) == YES ||
+                            isPrechargeStatus_chademo(gun_index) <= 0) {
+                        setChargerMode(gun_index, MODE_COMPLETE);
+                    }
+                } else if (chargingInfo[gun_index]->Type == _Type_GB) {
+                    DEBUG_INFO_MSG("************ GB lock Status = %d, status = %d \n", isEvStopCharging_gb(gun_index), isPrechargeStatus_gb(gun_index));
+                    // 非車端的停止 : 需等待小板送出停止指令，讓車端解除槍
+                    if (isEvStopCharging_chademo(gun_index) == YES) {
+                        /*+++ 20200908, vern, disable it for DD360 +++*/
+                        /*if (strcmp((char *)ShmOCPP16Data->StopTransaction[gun_index].StopReason, "") == EQUAL)
+                                strcpy((char *)ShmOCPP16Data->StopTransaction[gun_index].StopReason, "Local");*/
+                        /*--- 20200908, vern, disable it for DD360 ---*/
+                    }
+
+                    if (chargingInfo[gun_index]->GroundFaultStatus == GFD_FAIL) {
+                        // GFD 錯誤停止
+                        RecordAlarmCode(gun_index, "012236");
+                    } else if (chargingInfo[gun_index]->GroundFaultStatus == GFD_WARNING) {
+                        // GFD 警告
+                        RecordWarningCode(gun_index, "012298");
+                    }
+
+                    if (isEvStopCharging_gb(gun_index) == YES ||
+                            isPrechargeStatus_gb(gun_index) <= 0) {
+                        setChargerMode(gun_index, MODE_COMPLETE);
+                    }
+                } else if (chargingInfo[gun_index]->Type == _Type_CCS_2) {
+                    // 非車端的停止 : 需等待小板送出停止指令，讓車端解除槍
+                    if (isEvStopCharging_chademo(gun_index) == YES) {
+                        /*+++ 20200908, vern, disable it for DD360 +++*/
+                        /*if (strcmp((char *)ShmOCPP16Data->StopTransaction[gun_index].StopReason, "") == EQUAL)
+                                strcpy((char *)ShmOCPP16Data->StopTransaction[gun_index].StopReason, "Local");*/
+                        /*--- 20200908, vern, disable it for DD360 ---*/
+                    }
+
+                    if (chargingInfo[gun_index]->GroundFaultStatus == GFD_FAIL) {
+                        // GFD 錯誤停止
+                        RecordAlarmCode(gun_index, "012235");
+                    } else if (chargingInfo[gun_index]->GroundFaultStatus == GFD_WARNING) {
+                        // GFD 警告
+                        RecordWarningCode(gun_index, "012297");
+                    }
+
+                    if (isEvStopCharging_ccs(gun_index) == YES &&
+                            (isPrechargeStatus_ccs(gun_index) >= 53 || isPrechargeStatus_ccs(gun_index) == 0 ||
+                             isPrechargeStatus_ccs(gun_index) == 13 || isPrechargeStatus_ccs(gun_index) == 14)) {
+                        setChargerMode(gun_index, MODE_COMPLETE);
+                    }
+                }
+
+                // 車端的停止
+                if (strcmp((char *)ShmOCPP16Data->StopTransaction[gun_index].StopReason, "") == EQUAL) {
+                    strcpy((char *)ShmOCPP16Data->StopTransaction[gun_index].StopReason, "EVDisconnected");
+                }
+
+                if (ShmSysConfigAndInfo->SysInfo.CurGunSelected == gun_index) {
+                    ShmSysConfigAndInfo->SysInfo.ConnectorPage = _LCM_COMPLETE;
+                }
+            }
+            break;
+            case S_COMPLETE: {
+                if (isModeChange(gun_index)) {
+                    PRINTF_FUNC ("complete......................... %x \n", gun_index);
+                    if (strcmp((char *)chargingInfo[gun_index]->StartDateTime, "") != EQUAL) {
+                        OcppStopTransation(gun_index);
+                    }
+                    ftime(&endChargingTime[gun_index]);
+                    if (chargingInfo[gun_index]->PresentChargedDuration != 0) {
+                        chargingInfo[gun_index]->PresentChargedDuration = DiffTimeb(startChargingTime[gun_index], endChargingTime[gun_index]);
+                    }
+
+                    StopGunInfoTimeoutDet(gun_index);
+                    StartGunInfoTimeoutDet(gun_index, Timeout_EvseCompleteDet);
+                    ChangeStartOrStopDateTime(NO, gun_index);
+                }
+
+                if (chargingInfo[gun_index]->ConnectorPlugIn == NO &&
+                        GetTimeoutValue(chargingInfo[gun_index]->TimeoutTimer) >= 10000000) {
+                    setChargerMode(gun_index, MODE_IDLE);
+                }
+
+                if (ShmSysConfigAndInfo->SysInfo.CurGunSelected == gun_index) {
+                    ShmSysConfigAndInfo->SysInfo.ConnectorPage = _LCM_COMPLETE;
+                }
+            }
+            break;
+            case S_CCS_PRECHARGE_ST0: {
+                if (isModeChange(gun_index)) {
+                    PRINTF_FUNC("CCS Precharge Processing 1....................%x \n", gun_index);
+                    StopGunInfoTimeoutDet(gun_index);
+                    StartGunInfoTimeoutDet(gun_index, Timeout_ForCcsPrechargeDet);
+                }
+
+                if (chargingInfo[gun_index]->GroundFaultStatus == GFD_FAIL) {
+                    // GFD 錯誤停止
+                    RecordAlarmCode(gun_index, "012235");
+                }
+
+                if (isEvBoardStopChargeFlag(gun_index) == YES) {
+                    // 板端要求停止
+                    ChargingTerminalProcess(gun_index);
+                }
+
+                // 等待 EV 小板 (CCS) 通知可以開始 Precharge
+                // 切換 D+ Relay to Precharge Relay
+                if (isPrechargeStatus_ccs(gun_index) == 39 || isPrechargeStatus_ccs(gun_index) == 40) {
+                    if (chargingInfo[gun_index]->RelayKPK2Status == YES && chargingInfo[gun_index]->PrechargeStatus != PRECHARGE_READY)
+                        //if (chargingInfo[gun_index]->PrechargeStatus != PRECHARGE_PRERELAY_PASS)
+                    {
+                        PRINTF_FUNC("Send precharge ready 1..........%x, status = %d \n", gun_index, isPrechargeStatus_ccs(gun_index));
+                        chargingInfo[gun_index]->PrechargeStatus = PRECHARGE_READY;
+                    }
+                } else if (isPrechargeStatus_ccs(gun_index) == 45 || isPrechargeStatus_ccs(gun_index) == 46) {
+                    setChargerMode(gun_index, MODE_CCS_PRECHARGE_STEP1);
+                }
+
+                break;
+            }
+            case S_CCS_PRECHARGE_ST1: {
+                if (isModeChange(gun_index)) {
+                    DEBUG_INFO_MSG("CCS Precharge Processing 2....................%x \n", gun_index);
+                }
+
+                if (chargingInfo[gun_index]->GroundFaultStatus == GFD_FAIL) {
+                    // GFD 錯誤停止
+                    RecordAlarmCode(gun_index, "012235");
+                }
+
+                if (isEvBoardStopChargeFlag(gun_index) == YES) {
+                    // 板端要求停止
+                    ChargingTerminalProcess(gun_index);
+                }
+
+                // 等待小板通知進入充電
+                // 切換 D+ Relay to Precharge Relay
+                if (chargingInfo[gun_index]->RelayK1K2Status == YES) {
+                    chargingInfo[gun_index]->PrechargeStatus = PRECHARGE_READY;
+                    setChargerMode(gun_index, MODE_CHARGING);
+                }
+                break;
+            }
+            }
+        }
+
+        if (ShmSysConfigAndInfo->SysInfo.SystemPage != _LCM_NONE) {
+            ChangeLcmByIndex(ShmSysConfigAndInfo->SysInfo.SystemPage);
+        } else {
+            bool dcPageRun = false;
+            if (_acgunIndex > 0 && ShmSysConfigAndInfo->SysInfo.CurGunSelectedByAc != NO_DEFINE) {
+                if  (ac_chargingInfo[0]->SystemStatus == S_IDLE) {
+                    ChangeLcmByIndex(_LCM_IDLE);
+                } else if (ac_chargingInfo[0]->SystemStatus == S_PREPARNING) {
+                    ChangeLcmByIndex(_LCM_PRE_CHARGE);
+                } else if (ac_chargingInfo[0]->SystemStatus == S_CHARGING) {
+                    ChangeLcmByIndex(_LCM_CHARGING);
+                } else if (ac_chargingInfo[0]->SystemStatus == S_TERMINATING ||
+                           ac_chargingInfo[0]->SystemStatus == S_COMPLETE) {
+                    ChangeLcmByIndex(_LCM_COMPLETE);
+                } else {
+                    dcPageRun = true;
+                }
+            } else {
+                dcPageRun = true;
+            }
+
+            if (dcPageRun) {
+                ChangeLcmByIndex(ShmSysConfigAndInfo->SysInfo.ConnectorPage);
+            }
+        }
+
+        write(wtdFd, "a", 1);
+        usleep(whileLoopTime);
+    }
+
+    return FAIL;
+}

EVSE/Projects/DD360ComBox/Apps/replaceOther.sh

@@ -0,0 +1,8 @@
+#/bin/bash
+
+rm -rf /opt/ti-processor-sdk-linux-am335x-evm-04.02.00.09/EVSE/Projects/DD360/Apps;
+cp -r /opt/ti-processor-sdk-linux-am335x-evm-04.02.00.09/EVSE/Projects/DD360Audi/Apps /opt/ti-processor-sdk-linux-am335x-evm-04.02.00.09/EVSE/Projects/DD360/;
+
+rm -rf /opt/ti-processor-sdk-linux-am335x-evm-04.02.00.09/EVSE/Projects/DD360ComBox/Apps;
+cp -r /opt/ti-processor-sdk-linux-am335x-evm-04.02.00.09/EVSE/Projects/DD360Audi/Apps /opt/ti-processor-sdk-linux-am335x-evm-04.02.00.09/EVSE/Projects/DD360ComBox/;
+

EVSE/Projects/DD360ComBox/Apps/timeout.c

@@ -0,0 +1,6 @@
+#include "timeout.h"
+
+//===============================================
+// Initial Callback function
+//===============================================
+

EVSE/Projects/DD360ComBox/Apps/timeout.h

@@ -0,0 +1,63 @@
+#ifndef TIMEOUT_H_
+#define TIMEOUT_H_
+
+#include    <sys/time.h>
+#include    <sys/timeb.h>
+#include    <sys/types.h>
+#include    <sys/stat.h>
+#include    <sys/types.h>
+#include    <sys/ioctl.h>
+#include    <sys/socket.h>
+#include    <sys/ipc.h>
+#include    <sys/shm.h>
+#include    <sys/shm.h>
+#include    <sys/mman.h>
+#include    <linux/wireless.h>
+#include    <linux/can.h>
+#include    <linux/can/raw.h>
+#include    <arpa/inet.h>
+#include    <netinet/in.h>
+
+#include    <unistd.h>
+#include    <stdarg.h>
+#include    <stdio.h>
+#include    <stdlib.h>
+#include    <unistd.h>
+#include    <fcntl.h>
+#include    <termios.h>
+#include    <errno.h>
+#include    <errno.h>
+#include    <string.h>
+#include    <time.h>
+#include    <ctype.h>
+#include    <ifaddrs.h>
+
+#define CONN_PLUG_TIME_OUT          40
+
+enum Timeout_flag {
+    Timeout_None =                      0,
+    Timeout_SelftestChk =               1,
+    Timeout_Authorizing =               2,
+    Timeout_VerifyFail =                3,
+    Timeout_VerifyComp =                4,
+    Timeout_WaitPlug =                  5,
+
+    Timeout_Preparing =                 6,
+    Timeout_EvChargingDet =             7,
+    Timeout_EvseChargingDet =           8,
+    Timeout_EvseCompleteDet =           9,
+    Timeout_ForCcsPrechargeDet =        10,
+    Timeout_ReturnToChargingGunDet =    11,
+    Timeout_AuthorizingForStop =        12,
+    Timeout_SelectGun =                 13,
+};
+
+// for timeout fork
+struct timeval _cmdSubPriority_time;
+unsigned short _connectionTimeout;
+
+// for main
+struct timeval _cmdMainPriority_time;
+struct timeval _toAverage_time;
+unsigned char _ocppProfileChkFlag;
+#endif /* TIMEOUT_H_ */

EVSE/Projects/DD360ComBox/Apps/web.sh

@@ -0,0 +1 @@
+/sbin/lighttpd -f /etc/lighttpd/lighttpd.conf  -m /lib

EVSE/Projects/DD360ComBox/ModelNameList.txt

@@ -0,0 +1,10 @@
+Dispenser
+
+Standard:
+
+
+Audi:
+DDYC182V0UE2AD
+
+ComBox:
+DXYE18200EE1E4

EVSE/Projects/DD360ComBox/output/init.sh

@@ -0,0 +1,11 @@
+chmod 777 Module_CSU
+chmod 777 Module_PrimaryComm
+chmod 777 Module_LcmControl
+chmod 777 Module_InternalComm
+chmod 777 Module_EventLogging
+chmod 777 Module_EvComm
+chmod 777 Module_PsuComm
+chmod 777 OcppBackend
+chmod 777 kill.sh
+chmod 777 ReadCmdline
+

EVSE/Projects/DD360ComBox/output/kill.sh

@@ -0,0 +1,39 @@
+pkill Module_CSU
+pkill Module_PrimaryComm
+pkill Module_LcmControl
+pkill Module_InternalComm
+pkill Module_EventLogging
+pkill Module_EvComm
+pkill Module_PsuComm
+pkill Module_4g
+pkill Module_Wifi
+pkill OcppBackend
+pkill Module_ProduceUtils
+pkill DoComm
+pkill main
+
+ipcrm -M 0x000003e9
+ipcrm -M 0x000003ed
+ipcrm -M 0x000003ea
+ipcrm -M 0x000003ec
+ipcrm -M 0x000003ee
+ipcrm -M 0x000003ef
+ipcrm -M 0x000003f0
+ipcrm -M 0x000003f3
+ipcrm -M 0x000003f1
+ipcrm -M 0x000003f6
+
+ipcrm -M 0x000003e9
+ipcrm -M 0x000003ed
+ipcrm -M 0x000003ea
+ipcrm -M 0x000003ec
+ipcrm -M 0x000003ee
+ipcrm -M 0x000003ef
+ipcrm -M 0x000003f0
+ipcrm -M 0x000003f3
+ipcrm -M 0x000003f1
+ipcrm -M 0x000003f6
+ipcrm -M 0x000003eb
+ipcrm -M 0x000003f2
+
+ipcs

EVSE/Projects/DD360ComBox/output/sftp-config.json

@@ -0,0 +1,45 @@
+{
+    // The tab key will cycle through the settings when first created
+    // Visit http://wbond.net/sublime_packages/sftp/settings for help
+
+    // sftp, ftp or ftps
+    "type": "ftp",
+
+    "save_before_upload": true,
+    "upload_on_save": false,
+    "sync_down_on_open": false,
+    "sync_skip_deletes": false,
+    "sync_same_age": true,
+    "confirm_downloads": false,
+    "confirm_sync": true,
+    "confirm_overwrite_newer": false,
+
+    "host": "192.168.0.10",
+    "user": "root",
+    "password": "y42j/4cj84",
+    "port": "21",
+
+    "remote_path": "/root/",
+    "ignore_regexes": [
+        "\\.sublime-(project|workspace)", "sftp-config(-alt\\d?)?\\.json",
+        "sftp-settings\\.json", "/venv/", "\\.svn/", "\\.hg/", "\\.git/",
+        "\\.bzr", "_darcs", "CVS", "\\.DS_Store", "Thumbs\\.db", "desktop\\.ini"
+    ],
+    //"file_permissions": "664",
+    //"dir_permissions": "775",
+
+    //"extra_list_connections": 0,
+
+    "connect_timeout": 30,
+    //"keepalive": 120,
+    //"ftp_passive_mode": true,
+    //"ftp_obey_passive_host": false,
+    //"ssh_key_file": "~/.ssh/id_rsa",
+    //"sftp_flags": ["-F", "/path/to/ssh_config"],
+
+    //"preserve_modification_times": false,
+    //"remote_time_offset_in_hours": 0,
+    //"remote_encoding": "utf-8",
+    //"remote_locale": "C",
+    //"allow_config_upload": false,
+}

EVSE/Projects/DD360ComBox/output/web.sh

@@ -0,0 +1 @@
+/sbin/lighttpd -f /etc/lighttpd/lighttpd.conf  -m /lib

Makefile

@@ -1601,7 +1601,6 @@ DD360Audi-rootfs:
 
 DD360Audi-all: DD360Audi-uboot DD360Audi-linux DD360Audi-rootfs
 
-
 AW-ChargeLab-uboot-default: u-boot_clean u-boot
 	@cp -f board-support/u-boot-2017.01+gitAUTOINC+340fb36f04-g340fb36f04/MLO EVSE/Projects/AW-ChargeLab/Images/
 	@cp -f board-support/u-boot-2017.01+gitAUTOINC+340fb36f04-g340fb36f04/u-boot.img EVSE/Projects/AW-ChargeLab/Images/
@@ -1674,3 +1673,33 @@ AW-ChargeLab-rootfs:
 
 AW-ChargeLab-all: AW-ChargeLab-uboot AW-ChargeLab-linux AW-ChargeLab-rootfs
 
+DD360ComBox-rootfs:
+	@echo =================================
+	@echo     Building User rootfs
+	@echo =================================
+#	@cd EVSE/GPL;make Project=DD360ComBox all
+	@cd EVSE/Modularization;make TLS_EXPIRED=TLS_VALID_CERT_EXPIRED Project=DD360ComBox all
+	@cd EVSE/Projects/DD360ComBox/Apps;make Project=DD360ComBox all
+	@rm -f EVSE/Projects/DD360ComBox/Images/ramdisk.gz
+	@dd if=/dev/zero of=/dev/ram0 bs=1k count=131072
+	@mke2fs -vm0 /dev/ram0 131072
+	@tune2fs -c 0 /dev/ram0
+	@dd if=/dev/ram0 bs=1k count=131072 | gzip -v9 > EVSE/Projects/DD360ComBox/Images/ramdisk.gz
+	@mkdir -p EVSE/Projects/DD360ComBox/Images/mnt
+	@gunzip EVSE/Projects/DD360ComBox/Images/ramdisk.gz
+	@sync
+	@mount -o loop EVSE/Projects/DD360ComBox/Images/ramdisk EVSE/Projects/DD360ComBox/Images/mnt
+	@cp -rfv EVSE/rootfs/* EVSE/Projects/DD360ComBox/Images/mnt/
+	@chown www-data:www-data EVSE/Projects/DD360ComBox/Images/mnt/var/www -R
+	@chmod 777 EVSE/Projects/DD360ComBox/Images/mnt/var/log -R
+	@chmod 777 EVSE/Projects/DD360ComBox/Images/mnt/var/run -R
+	@cp -rfv EVSE/Projects/DD360ComBox/Images/root/* EVSE/Projects/DD360ComBox/Images/mnt/root
+	@sync
+	@sleep 3
+	@umount EVSE/Projects/DD360ComBox/Images/mnt
+	@sync
+	@gzip -v9 EVSE/Projects/DD360ComBox/Images/ramdisk
+	@rm -rfv EVSE/Projects/DD360ComBox/Images/root
+	@rm -rfv EVSE/Projects/DD360ComBox/Images/mnt
+
+DD360ComBox-all: DD360ComBox-uboot DD360ComBox-linux DD360ComBox-rootfs