csu3_am335x/EVSE/Projects/DW30/Apps/ReadCmdline.c

/*
 * 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 ARRAY_SIZE(A)		(sizeof(A) / sizeof(A[0]))

struct SysConfigAndInfo			*ShmSysConfigAndInfo;
struct StatusCodeData 			*ShmStatusCodeData;
struct PrimaryMcuData			*ShmPrimaryMcuData;
struct CHAdeMOData				*ShmCHAdeMOData;
struct CcsData					*ShmCcsData;
struct FanModuleData			*ShmFanModuleData;
struct RelayModuleData			*ShmRelayModuleData;

struct ChargingInfoData 		*_chargingData[CHAdeMO_QUANTITY + CCS_QUANTITY + GB_QUANTITY];


struct timeval _id_assign_time;

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";




#define TTY_PATH            "/dev/tty"
#define STTY_US             "stty raw -echo -F "
#define STTY_DEF            "stty -raw echo -F "


static int get_char()
{
    fd_set rfds;
    struct timeval tv;
    int ch = 0;

    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)
    {
        ch = getchar(); 
    }

    return ch;
}


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;
}

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 ((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;
   	}

    return result;
}

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_RESERVATION,
	S_BOOKING,
	S_MAINTAIN,
	S_DEBUG,
	S_CCS_PRECHARGE_ST0,
	S_CCS_PRECHARGE_ST1,
	S_SINGLE_RUN,
};

void RunUnconditionalChargeIndex1(char *v1, char *v2)
{
	int _Voltage = atoi(v1);
	int _Current = atoi(v2);
	unsigned char PreviousSystemStatus = 0xff;
	int ch = 0,chcount = 0;;
	
	char InputChar[128];
	
	if (!FindChargingInfoData(0, &_chargingData[0]))
	{
		printf ("FindChargingInfoData error\n");
		return;
	}

    printf ("ReqVoltage = %d, ReqCurrent = %d\n", _Voltage,_Current);
    
    if(_Voltage > 1000 || _Voltage < 150){
        
        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 = 0;
        
    	switch(_chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->SystemStatus)
    	{    	    
            case S_IDLE:
    		{    		    
        	    if(PreviousSystemStatus != _chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->SystemStatus)
        	    {
        	        PreviousSystemStatus = _chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->SystemStatus;
        	        
        	        printf ("[UnconditionalCharge - S_IDLE]\n");
        	        
        	    }
        	    
        	        		    
                _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 = %d, ReqCurrent = %d\n", _Voltage,_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 = 5000;
    		    _chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->EvBatterytargetCurrent = 20;
    		    _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 = %d\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 = 5000;
    		    _chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->EvBatterytargetCurrent = 20;
    		    _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 = %d \n", _chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->PresentChargingVoltage);
    		        sleep(3);
    		        //EV done 
    		        _chargingData[0]->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;
        	        
        	        printf ("[UnconditionalCharge - S_CHARGING]\n");
        	               	        
        	    }
    		    //充電電壓電流
    		    _chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->EvBatterySoc = 50;
    		    _chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->EvBatterytargetVoltage = _Voltage;
    		    _chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->EvBatterytargetCurrent = _Current;
    		    _chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->AvailableChargingCurrent = 1000;
    		    
    		    //ev task do this
    		    _chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->PresentChargingPower = ((float)((_chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->PresentChargingVoltage / 10) * (_chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->PresentChargingCurrent / 10)) / 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;
    		    }
    		    
    		    if (_chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->GroundFaultStatus == 0x03){
    		         printf ("Charging Ground Fault Warning (%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");
        	               	        
        	    }
        	    sleep(3);
        	    return;
    		}
    		break;
    	}
    	
    	/*
    	//使用 Keyboard input 阻塞方法
        fgets(InputChar, sizeof(InputChar), stdin);
        
        if (InputChar[0] == 's' && InputChar[1] == 't' && InputChar[2] == 'o' && InputChar[3] == 'p')
        {
           printf ("Precharge Done\n");
           _chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->SystemStatus = S_TERMINATING;

        }
        */
        
        //使用 keybaord input 非阻塞方法
        ch = get_char();       
        if (ch)
        {
            printf("%c \n\r", ch);
            
            switch (ch)
            {
                //Ctrl + C
                case 3:
                    //system(STTY_DEF TTY_PATH);
                        return 0;
                //input c or C
                case 'c':
                case 'C':
                    printf("stop \n\r");
                    //system(STTY_DEF TTY_PATH);
                    _chargingData[ShmSysConfigAndInfo->SysInfo.CurGunSelected]->SystemStatus = S_TERMINATING;
                    break;
            }
        }
               
    }		

}

void RunStatusProc(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)
	{
		// get
		printf ("index = %x, status = %x\n", _index, _chargingData[_index]->SystemStatus);
	}
	else
	{
		// set
		_chargingData[_index]->SystemStatus = atoi(v2);
	}
}

void RunCardProc(char *v1, char *v2)
{
	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);
	}
}

void RunGunPlugitProc(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)
	{
		// 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)
{
	if (strcmp(v1, "0") == 0)
	{
		printf("Gun Locked Status = %x \n", _chargingData[0]->GunLocked);
	}

	if (strcmp(v1, "1") == 0)
	{
		printf("Gun Locked Status = %x \n", _chargingData[1]->GunLocked);
	}
}

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)
	{
		printf("Ev board 1 FW Version = %s \n", ShmCHAdeMOData->evse[0].version);
		printf("Ev board 1 FW Version = %s \n", ShmCcsData->V2GMessage_DIN70121->version);
	}
	else if (strcmp(v1, "1") == 0)
	{
		printf("Ev board 2 FW Version = %s \n", ShmCHAdeMOData->evse[1].version);
		printf("Ev board 2 FW Version = %s \n", ShmCcsData->V2GMessage_DIN70121->version);
	}
	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);
	}
}

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);
}

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[3][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], "strchg") == 0)
		{    
		    //如果連一個參數都沒有 (此命令不理會) 加上判斷第二參數
			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]);
			continue;
		}		
		else if(strcmp(newString[0], "state") == 0)
		{
			if (strcmp(newString[1], "-1") == 0 || strcmp(newString[1], "") == 0)
				continue;

			// 槍狀態
			RunStatusProc(newString[1], newString[2]);
			continue;
		}
		else if(strcmp(newString[0], "card") == 0)
		{
			// 刷卡狀態
			RunCardProc(newString[1], newString[2]);
			continue;
		}
		else if(strcmp(newString[0], "gun") == 0)
		{
			if (strcmp(newString[1], "-1") == 0	|| strcmp(newString[1], "") == 0)
				continue;

			// 插槍狀態
			RunGunPlugitProc(newString[1], newString[2]);
			continue;
		}
		else if(strcmp(newString[0], "lock") == 0)
		{
			if (strcmp(newString[1], "-1") == 0	|| strcmp(newString[1], "") == 0)
				continue;

			// 插槍狀態
			GetGunLockStatusProc(newString[1], newString[2]);
			continue;
		}
		else if(strcmp(newString[0], "self") == 0)
		{
			// CSU 自我檢測狀態
			RunSelfProc(newString[1]);
			continue;
		}
		else if(strcmp(newString[0], "ver") == 0)
		{
			if (strcmp(newString[1], "-1") == 0	|| strcmp(newString[1], "") == 0)
				continue;
			// 取 FW 版號
			GetFwVerProc(newString[1]);
			continue;
		}
		else if (strcmp(newString[0], "update") == 0)
		{
			// 更新
			FwUpdateFlagProc(newString[1]);
			continue;
		}
		else if (strcmp(newString[0], "ac") == 0)
		{
			// AC contactor 狀態
			CheckAcStatus(newString[1]);
			continue;
		}
		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]);
			continue;
		}
		else if (strcmp(newString[0], "?") == 0)
		{
		    
            printf ("\r\n\r\n%-12s : %-20s\n", "state","get gun state (index)");
            printf ("%-12s : %-20s\n", "card","scanning card (x)");
            printf ("%-12s : %-20s\n", "gun","get gun plugit state (index)");
            printf ("%-12s : %-20s\n", "lock","get gun locked state (index)");
            printf ("%-12s : %-20s\n", "self","self test state (x)");
            printf ("%-12s : %-20s\n", "ver","ver of board (407 or index or rb or fan)");
            printf ("%-12s : %-20s \r\n\r\n", "ac","get ac relay state (x)");
			continue;
		}
		else{
		    printf ("Dbg->", msg);
		    continue;
		}
		usleep(100000);
		
	}

	return 0;
}