|
|
@@ -1,1416 +1,1468 @@
|
|
|
-/*
|
|
|
- * 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 <stdint.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 "./ShareMemory/shmMem.h"
|
|
|
-#include "./Define/define.h"
|
|
|
-#include "./SelectGun/SelectGun.h"
|
|
|
-#include "Config.h"
|
|
|
-
|
|
|
-//------------------------------------------------------------------------------
|
|
|
-#define CMD_KEY_WAIT (1)
|
|
|
-#define CMD_KEY_DONT_WAIT (0)
|
|
|
-
|
|
|
-#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 "
|
|
|
-
|
|
|
-//------------------------------------------------------------------------------
|
|
|
-uint8_t _curAutoRunCount = 0;
|
|
|
-uint8_t _usingAutoRun = 0;
|
|
|
-struct timeval _autoTime;
|
|
|
-
|
|
|
-static struct SysConfigData *pSysConfig = NULL;
|
|
|
-static struct SysInfoData *pSysInfo = NULL;
|
|
|
-static struct WARNING_CODE_INFO *pSysWarning = NULL;
|
|
|
-
|
|
|
-static struct AlarmCodeData *pAlarmCode = NULL;
|
|
|
-
|
|
|
-static struct PrimaryMcuData *ShmPrimaryMcuData = NULL;
|
|
|
-static struct CHAdeMOData *ShmCHAdeMOData = NULL;
|
|
|
-static struct CcsData *ShmCcsData = NULL;
|
|
|
-static struct GBTData *ShmGBTData = NULL;
|
|
|
-static struct FanModuleData *ShmFanModuleData = NULL;
|
|
|
-static struct RelayModuleData *ShmRelayModuleData = NULL;
|
|
|
-static struct LedModuleData *ShmLedModuleData = NULL;
|
|
|
-static struct PsuData *ShmPsuData = NULL;
|
|
|
-static struct OCPP16Data *ShmOCPP16Data = NULL;
|
|
|
-static SelectGunInfo *ShmSelectGunInfo = NULL;
|
|
|
-static DcCommonInfo *ShmDcCommonData = NULL;
|
|
|
-
|
|
|
-static struct ChargingInfoData *pDcChargingInfo = NULL;
|
|
|
-static struct ChargingInfoData *pAcChargingInfo = NULL;
|
|
|
-
|
|
|
-static char newString[8][16] = {0};
|
|
|
-
|
|
|
-//------------------------------------------------------------------------------
|
|
|
-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;
|
|
|
-}
|
|
|
-
|
|
|
-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);
|
|
|
- }
|
|
|
-}
|
|
|
-
|
|
|
-static uint8_t helpCmd(void)
|
|
|
-{
|
|
|
- if (strcmp(newString[0], "?") == 0 ||
|
|
|
- strcmp(newString[0], "help") == 0 ||
|
|
|
- strcmp(newString[0], "h") == 0) {
|
|
|
- return YES;
|
|
|
- }
|
|
|
-
|
|
|
- return NO;
|
|
|
-}
|
|
|
-
|
|
|
-static uint8_t exitCmd(void)
|
|
|
-{
|
|
|
- if (strcmp(newString[0], "c") == EQUAL ||
|
|
|
- strcmp(newString[0], "C") == EQUAL ||
|
|
|
- strncmp(&newString[0][0], "exit", 4) == EQUAL
|
|
|
- ) {
|
|
|
- return YES;
|
|
|
- }
|
|
|
-
|
|
|
- return NO;
|
|
|
-}
|
|
|
-
|
|
|
-static uint8_t readCmdKey(uint8_t state)
|
|
|
-{
|
|
|
- char word[128] = {0};
|
|
|
- int i = 0, j = 0, ctr = 0;
|
|
|
-
|
|
|
- memset(word, 0, sizeof(word));
|
|
|
- if (state == CMD_KEY_WAIT) {
|
|
|
- fgets(word, sizeof(word), stdin);
|
|
|
- } else if (state == CMD_KEY_DONT_WAIT) {
|
|
|
- get_char(word);
|
|
|
-
|
|
|
- if (strlen(word) == 0) {
|
|
|
- //usleep(50000);
|
|
|
- return NO;
|
|
|
- }
|
|
|
- }
|
|
|
-
|
|
|
- memset(newString, 0, sizeof(newString));
|
|
|
-
|
|
|
- strcpy(newString[1], "-1");
|
|
|
- strcpy(newString[2], "-1");
|
|
|
- for (i = 0; i <= (strlen(word)); i++) {
|
|
|
- if (word[i] == ' ' ||
|
|
|
- word[i] == '\0' ||
|
|
|
- word[i] == '\r' ||
|
|
|
- word[i] == '\n' ||
|
|
|
- word[i] == 10) {
|
|
|
- newString[ctr][j] = '\0';
|
|
|
- ctr++;
|
|
|
- j = 0;
|
|
|
- } else {
|
|
|
- newString[ctr][j] = word[i];
|
|
|
- j++;
|
|
|
- }
|
|
|
- }
|
|
|
-
|
|
|
- return YES;
|
|
|
-}
|
|
|
-
|
|
|
-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", pSysInfo->OrderCharging);
|
|
|
- printf("WaitForPlugit = %d \n", pSysInfo->WaitForPlugit);
|
|
|
- if (strcmp(v1, "ac") == 0) {
|
|
|
- pAcChargingInfo = (struct ChargingInfoData *)GetAcChargingInfoData(0);
|
|
|
- //if (!FindAcChargingInfoData(0, &ac_chargingInfo[0])) {
|
|
|
- // printf("FindChargingInfoData (AC) false \n");
|
|
|
- //}
|
|
|
- printf("AC Status = %d \n", pAcChargingInfo->ConnectorPlugIn);
|
|
|
- return;
|
|
|
- }
|
|
|
-
|
|
|
- int _index = atoi(v1);
|
|
|
-
|
|
|
- if (_index <= 1) {
|
|
|
- //if (!FindChargingInfoData(_index, &_chargingData[0])) {
|
|
|
- // printf ("FindChargingInfoData error\n");
|
|
|
- // return;
|
|
|
- //}
|
|
|
- pDcChargingInfo = (struct ChargingInfoData *)GetDcChargingInfoData(_index);
|
|
|
-
|
|
|
- if (strcmp(v2, "-1") == 0 || strcmp(v2, "") == 0) {
|
|
|
- // get
|
|
|
- printf ("index = %x, status = %x (%d)\n",
|
|
|
- _index,
|
|
|
- pDcChargingInfo->SystemStatus,
|
|
|
- pDcChargingInfo->IsAvailable);
|
|
|
- printf ("SystemTimeoutFlag = %d, PageIndex = %d\n",
|
|
|
- pSysInfo->SystemTimeoutFlag, pSysInfo->PageIndex);
|
|
|
- } else {
|
|
|
- // set
|
|
|
- pDcChargingInfo->SystemStatus = atoi(v2);
|
|
|
- }
|
|
|
- } else {
|
|
|
- //if (!FindAcChargingInfoData(0, &ac_chargingInfo[0])) {
|
|
|
- // printf("FindChargingInfoData (AC) false \n");
|
|
|
- //}
|
|
|
- pAcChargingInfo = (struct ChargingInfoData *)GetAcChargingInfoData(0);
|
|
|
-
|
|
|
- if (strcmp(v2, "-1") == 0 || strcmp(v2, "") == 0) {
|
|
|
- // get
|
|
|
- printf ("AC Type, status = %x (%d)\n",
|
|
|
- pAcChargingInfo->SystemStatus,
|
|
|
- pAcChargingInfo->IsAvailable);
|
|
|
- } else {
|
|
|
- // set
|
|
|
- pAcChargingInfo->SystemStatus = atoi(v2);
|
|
|
- }
|
|
|
- }
|
|
|
-}
|
|
|
-
|
|
|
-void RunCardProc(char *v1, char *v2)
|
|
|
-{
|
|
|
- if (strcmp(v1, "-1") == 0 || strcmp(v1, "") == 0) {
|
|
|
- if (pSysInfo->WaitForPlugit) {
|
|
|
- pSysInfo->WaitForPlugit = 0x00;
|
|
|
- printf ("SysInfo.WaitForPlugit = %x \n", pSysInfo->WaitForPlugit);
|
|
|
- } else {
|
|
|
- pSysInfo->WaitForPlugit = 0x01;
|
|
|
- printf ("SysInfo.WaitForPlugit = %x \n", pSysInfo->WaitForPlugit);
|
|
|
- }
|
|
|
- } else {
|
|
|
- strcpy((char *)pSysConfig->UserId, "");
|
|
|
- memcpy((char *)pSysConfig->UserId, v1, strlen(v1));
|
|
|
- pSysConfig->UserId[strlen(v1)] = '\0';
|
|
|
- printf("StartUserId = %s \n", pSysConfig->UserId);
|
|
|
- }
|
|
|
-}
|
|
|
-
|
|
|
-void RunGunPlugitProc(char *v1, char *v2)
|
|
|
-{
|
|
|
- if (strcmp(v1, "ac") == 0) {
|
|
|
- //if (!FindAcChargingInfoData(0, &ac_chargingInfo[0])) {
|
|
|
- // printf("FindChargingInfoData (AC) false \n");
|
|
|
- //}
|
|
|
- pAcChargingInfo = (struct ChargingInfoData *)GetAcChargingInfoData(0);
|
|
|
-
|
|
|
- if (strcmp(v2, "-1") == 0 || strcmp(v2, "") == 0) {
|
|
|
- // get
|
|
|
- printf("ConnectorPlugIn = %d \n", pAcChargingInfo->ConnectorPlugIn);
|
|
|
- } else {
|
|
|
- // set
|
|
|
- pAcChargingInfo->ConnectorPlugIn = atoi(v2);
|
|
|
- }
|
|
|
- return;
|
|
|
- }
|
|
|
-
|
|
|
- int _index = atoi(v1);
|
|
|
- //if (!FindChargingInfoData(_index, &_chargingData[0])) {
|
|
|
- // printf("FindChargingInfoData error\n");
|
|
|
- // return;
|
|
|
- //}
|
|
|
- pDcChargingInfo = (struct ChargingInfoData *)GetDcChargingInfoData(_index);
|
|
|
-
|
|
|
- if (strcmp(v2, "-1") == 0 || strcmp(v2, "") == 0) {
|
|
|
- // get
|
|
|
- printf("index = %x, plug it = %x\n",
|
|
|
- _index,
|
|
|
- pDcChargingInfo->ConnectorPlugIn);
|
|
|
- } else {
|
|
|
- // set
|
|
|
- pDcChargingInfo->ConnectorPlugIn = atoi(v2);
|
|
|
- }
|
|
|
-}
|
|
|
-
|
|
|
-void GetGunLockStatusProc(char *v1, char *v2)
|
|
|
-{
|
|
|
- int _index = atoi(v1);
|
|
|
- //if (!FindChargingInfoData(_index, &_chargingData[0])) {
|
|
|
- // printf("FindChargingInfoData error\n");
|
|
|
- // return;
|
|
|
- //}
|
|
|
- pDcChargingInfo = (struct ChargingInfoData *)GetDcChargingInfoData(_index);
|
|
|
-
|
|
|
- if (strcmp(v2, "-1") != 0 && strcmp(v2, "") != 0) {
|
|
|
- pDcChargingInfo->GunLocked = atoi(v2);
|
|
|
- }
|
|
|
-
|
|
|
- printf("Gun Locked Status = %d \n", pDcChargingInfo->GunLocked);
|
|
|
-}
|
|
|
-
|
|
|
-void SetSystemIDProc()
|
|
|
-{
|
|
|
- char *systemId = "Alston_Test";
|
|
|
- memcpy(&pSysConfig->SystemId, systemId, strlen(systemId));
|
|
|
-}
|
|
|
-
|
|
|
-void RunSelfProc()
|
|
|
-{
|
|
|
- printf("self test status = %x\n", pSysInfo->SelfTestSeq);
|
|
|
-}
|
|
|
-
|
|
|
-void GetFwVerProc(void)
|
|
|
-{
|
|
|
- int _index = 0;
|
|
|
- int isContinue = 1;
|
|
|
- char *usageMsg = "Usage:\n"
|
|
|
- " model\n"
|
|
|
- " 407\n"
|
|
|
- " conn index, ex: conn 0 | 1\n"
|
|
|
- " relay\n"
|
|
|
- " fan\n"
|
|
|
- " dc\n"
|
|
|
- " led\n"
|
|
|
- " ac\n"
|
|
|
- " exit | c | C\n"
|
|
|
- " help | ? | h\n";
|
|
|
-
|
|
|
- while (isContinue) {
|
|
|
- if (readCmdKey(CMD_KEY_WAIT) == NO) {
|
|
|
- continue;
|
|
|
- }
|
|
|
-
|
|
|
- if (strcmp(newString[0], "407") == 0) {
|
|
|
- printf("407 FW Version = %s\n", ShmPrimaryMcuData->version);
|
|
|
- } else if (strcmp(newString[0], "model") == 0) {
|
|
|
- printf("ModelName = %s\r\n", pSysConfig->ModelName);
|
|
|
- } else if (strcmp(newString[0], "conn") == 0) {
|
|
|
- if (strcmp(newString[1], "-1") == 0 ||
|
|
|
- strcmp(newString[1], "") == 0 ||
|
|
|
- atoi(newString[1]) >= pSysConfig->TotalConnectorCount
|
|
|
- ) {
|
|
|
- printf("index over flow\r\n");
|
|
|
- continue;
|
|
|
- }
|
|
|
-
|
|
|
- _index = atoi(newString[1]);
|
|
|
-
|
|
|
- if (_index == 0) {
|
|
|
- printf("Gun 0 FW Version = %s \n", pSysInfo->Connector1FwRev);
|
|
|
- } else if (_index == 1) {
|
|
|
- printf("Gun 1 FW Version = %s \n", pSysInfo->Connector2FwRev);
|
|
|
- }
|
|
|
- } else if (strcmp(newString[0], "relay") == 0) {
|
|
|
- printf("RB Version = %s \n", pSysInfo->RelayModuleFwRev);
|
|
|
- } else if (strcmp(newString[0], "fan") == 0) {
|
|
|
- printf("FAN Version = %s \n", pSysInfo->FanModuleFwRev);
|
|
|
- } else if (strcmp(newString[0], "dc") == 0) {
|
|
|
- printf("DC Main Version = %s \n", pSysInfo->CsuRootFsFwRev);
|
|
|
- } else if (strcmp(newString[0], "led") == 0) {
|
|
|
- printf("LED Version = %s \n", pSysInfo->LedModuleFwRev);
|
|
|
- } else if (strcmp(newString[0], "ac") == 0) {
|
|
|
- pAcChargingInfo = (struct ChargingInfoData *)GetAcChargingInfoData(0);
|
|
|
-
|
|
|
- printf("AC Version = %s \n", pAcChargingInfo->version);
|
|
|
- } else if (exitCmd() == YES) {
|
|
|
- return;
|
|
|
- } else if (helpCmd() == YES) {
|
|
|
- printf ("%s\n", usageMsg);
|
|
|
- }
|
|
|
-
|
|
|
- }//while
|
|
|
-}
|
|
|
-
|
|
|
-void CreateOneError(char *v1)
|
|
|
-{
|
|
|
- int value = atoi(v1);
|
|
|
-
|
|
|
- pAlarmCode->AlarmEvents.bits.SystemL1InputOVP = value;
|
|
|
- pSysConfig->BillingData.isBilling = value;
|
|
|
-}
|
|
|
-
|
|
|
-void GetAuthorizeFlag(char *v1)
|
|
|
-{
|
|
|
- if (strcmp(v1, "-1") == 0 || strcmp(v1, "") == 0) {
|
|
|
- printf("AuthorizeFlag = %d \n", pSysInfo->AuthorizeFlag);
|
|
|
- } else {
|
|
|
- pSysInfo->AuthorizeFlag = atoi(v1);
|
|
|
- }
|
|
|
-}
|
|
|
-
|
|
|
-void GetRelayStatus(char *v1)
|
|
|
-{
|
|
|
- int _index = atoi(v1);
|
|
|
- //if (!FindChargingInfoData(_index, &_chargingData[0])) {
|
|
|
- // printf("FindChargingInfoData error\n");
|
|
|
- // return;
|
|
|
- //}
|
|
|
- pDcChargingInfo = (struct ChargingInfoData *)GetDcChargingInfoData(_index);
|
|
|
-
|
|
|
- printf("RelayK1K2Status = %d \n", pDcChargingInfo->RelayK1K2Status);
|
|
|
- printf("RelayKPK2Status = %d \n", pDcChargingInfo->RelayKPK2Status);
|
|
|
-}
|
|
|
-
|
|
|
-void FwUpdateFlagProc()
|
|
|
-{
|
|
|
- pSysInfo->FirmwareUpdate = 0x01;
|
|
|
-}
|
|
|
-
|
|
|
-void CheckAcStatus(char *v1)
|
|
|
-{
|
|
|
- if (strcmp(v1, "-1") == 0 || strcmp(v1, "") == 0) {
|
|
|
- printf("AC Status = %d \n", pSysInfo->AcContactorStatus);
|
|
|
- }
|
|
|
-}
|
|
|
-
|
|
|
-void SetCableChkStatus(char *v1, char *v2)
|
|
|
-{
|
|
|
- int _index = atoi(v1);
|
|
|
- //if (!FindChargingInfoData(_index, &_chargingData[0])) {
|
|
|
- // printf ("FindChargingInfoData error\n");
|
|
|
- // return;
|
|
|
- //}
|
|
|
- pDcChargingInfo = (struct ChargingInfoData *)GetDcChargingInfoData(_index);
|
|
|
-
|
|
|
- pDcChargingInfo->GroundFaultStatus = atoi(v2);
|
|
|
-}
|
|
|
-
|
|
|
-void SetChargingInfoCCID(char *v1, char *v2)
|
|
|
-{
|
|
|
- int _index = atoi(v1);
|
|
|
- //if (!FindChargingInfoData(_index, &_chargingData[0])) {
|
|
|
- // printf ("FindChargingInfoData error\n");
|
|
|
- // return;
|
|
|
- //}
|
|
|
- pDcChargingInfo = (struct ChargingInfoData *)GetDcChargingInfoData(_index);
|
|
|
-
|
|
|
- memcpy(pDcChargingInfo->EVCCID, v2, 8);
|
|
|
- pDcChargingInfo->EVCCID[8] = '\0';
|
|
|
-}
|
|
|
-
|
|
|
-void SetPowerValue(char *v1, char *v2)
|
|
|
-{
|
|
|
- int _index = atoi(v1);
|
|
|
- float _Current = atof(v2);
|
|
|
-
|
|
|
- //if (!FindChargingInfoData(_index, &_chargingData[0])) {
|
|
|
- // printf ("FindChargingInfoData error\n");
|
|
|
- // return;
|
|
|
- //}
|
|
|
- pDcChargingInfo = (struct ChargingInfoData *)GetDcChargingInfoData(_index);
|
|
|
-
|
|
|
- // 盲沖的時候才允許使用~
|
|
|
- if (pDcChargingInfo->Type != 9) {
|
|
|
- return;
|
|
|
- }
|
|
|
-
|
|
|
- pDcChargingInfo->EvBatterytargetCurrent = _Current;
|
|
|
-}
|
|
|
-
|
|
|
-void GetSystemInfo()
|
|
|
-{
|
|
|
- printf ("ModelName = %s \n", pSysConfig->ModelName);
|
|
|
- printf ("SerialNumber = %s \n", pSysConfig->SerialNumber);
|
|
|
- printf ("InternetConn = %d \n", pSysInfo->InternetConn);
|
|
|
-
|
|
|
- printf ("MaxChargingPower = %d, MaxChargingCurrent = %d \n",
|
|
|
- pSysConfig->MaxChargingPower,
|
|
|
- pSysConfig->MaxChargingCurrent);
|
|
|
-}
|
|
|
-
|
|
|
-void ChangeGunNum()
|
|
|
-{
|
|
|
- if (pSysInfo->CurGunSelected + 1 < pSysConfig->TotalConnectorCount) {
|
|
|
- pSysInfo->CurGunSelected += 1;
|
|
|
- pSysInfo->CurGunSelectedByAc = NO_DEFINE;
|
|
|
- } else if (pSysConfig->AcConnectorCount > 0 &&
|
|
|
- pSysInfo->CurGunSelectedByAc == NO_DEFINE) {
|
|
|
- pSysInfo->CurGunSelectedByAc = DEFAULT_AC_INDEX;
|
|
|
- } else {
|
|
|
- pSysInfo->CurGunSelected = 0;
|
|
|
- pSysInfo->CurGunSelectedByAc = NO_DEFINE;
|
|
|
- }
|
|
|
-}
|
|
|
-
|
|
|
-void GetGunSelectedNum(char *v1)
|
|
|
-{
|
|
|
- if (strcmp(v1, "-1") == 0 || strcmp(v1, "") == 0) {
|
|
|
- if (AC_QUANTITY > 0 &&
|
|
|
- pSysInfo->CurGunSelectedByAc != NO_DEFINE) {
|
|
|
- printf("connector select changed = AC \n");
|
|
|
- } else {
|
|
|
- printf("connector selected = %d \n", pSysInfo->CurGunSelected);
|
|
|
- }
|
|
|
- } else {
|
|
|
- int _index = atoi(v1);
|
|
|
- if (_index <= 1) {
|
|
|
- pSysInfo->CurGunSelected = _index;
|
|
|
- pSysInfo->CurGunSelectedByAc = NO_DEFINE;
|
|
|
- printf("connector select changed = %d \n", _index);
|
|
|
- } else if (AC_QUANTITY > 0) {
|
|
|
- pSysInfo->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);
|
|
|
-
|
|
|
- pSysConfig->SwitchDebugFlag = mode;
|
|
|
-}
|
|
|
-
|
|
|
-void SetGFDMode(char *v1)
|
|
|
-{
|
|
|
- int mode = atoi(v1);
|
|
|
-
|
|
|
- pSysConfig->AlwaysGfdFlag = mode;
|
|
|
-}
|
|
|
-
|
|
|
-void GetPsuTemp()
|
|
|
-{
|
|
|
- for (uint8_t index = 0; index < ShmPsuData->GroupCount; index++) {
|
|
|
- for (uint8_t 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",
|
|
|
- pSysInfo->InputVoltageR,
|
|
|
- pSysInfo->InputVoltageS,
|
|
|
- pSysInfo->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 (uint8_t 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 < pSysConfig->TotalConnectorCount; i++) {
|
|
|
- //if (!FindChargingInfoData(i, &_chargingData[0])) {
|
|
|
- // printf ("FindChargingInfoData error\n");
|
|
|
- // continue;
|
|
|
- //}
|
|
|
- pDcChargingInfo = (struct ChargingInfoData *)GetDcChargingInfoData(i);
|
|
|
-
|
|
|
- printf("Form RB : Group Index = %d, OutputV = %f \n",
|
|
|
- i,
|
|
|
- pDcChargingInfo->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;
|
|
|
- //}
|
|
|
- pDcChargingInfo = (struct ChargingInfoData *)GetDcChargingInfoData(0);
|
|
|
-
|
|
|
- pDcChargingInfo->EvBatterytargetVoltage = vol;
|
|
|
- pDcChargingInfo->EvBatterytargetCurrent = cur;
|
|
|
- }
|
|
|
- }
|
|
|
- printf("*************************************************\n");
|
|
|
-}
|
|
|
-
|
|
|
-void GetConnectorCapInfo(char *v1)
|
|
|
-{
|
|
|
- int _GunIndex = atoi(v1);
|
|
|
-
|
|
|
- //if (!FindChargingInfoData(_GunIndex, &_chargingData[0])) {
|
|
|
- // printf ("FindChargingInfoData error\n");
|
|
|
- // return;
|
|
|
- //}
|
|
|
- pDcChargingInfo = (struct ChargingInfoData *)GetDcChargingInfoData(_GunIndex);
|
|
|
-
|
|
|
- printf ("Charger Max Current = %d, Max Power = %d \n",
|
|
|
- pSysConfig->MaxChargingCurrent * 10,
|
|
|
- pSysConfig->MaxChargingPower * 10);
|
|
|
-
|
|
|
- printf ("Index = %d, MaxPow = %f, MaxVol = %f, MaxCur = %f\n",
|
|
|
- _GunIndex,
|
|
|
- pDcChargingInfo->RealMaxPower,
|
|
|
- pDcChargingInfo->RealMaxVoltage,
|
|
|
- pDcChargingInfo->RealMaxCurrent);
|
|
|
-}
|
|
|
-
|
|
|
-static void setConfirmSelGun(uint8_t selGun)
|
|
|
-{
|
|
|
- if (selGun == LEFT_GUN_NUM && ShmSelectGunInfo->SelGunInfo.LeftGun == SEL_GUN_RELEASE) {
|
|
|
- ShmSelectGunInfo->SelGunInfo.LeftGun = SEL_GUN_CONFIRM;
|
|
|
- //printf("confirmSelGun left\r\n");
|
|
|
- } else if (selGun == RIGHT_GUN_NUM && ShmSelectGunInfo->SelGunInfo.RightGun == SEL_GUN_RELEASE) {
|
|
|
- ShmSelectGunInfo->SelGunInfo.RightGun = SEL_GUN_CONFIRM;
|
|
|
- //printf("confirmSelGun right\r\n");
|
|
|
- }
|
|
|
-}
|
|
|
-
|
|
|
-void RunUnconditionalChargeIndex1(char *v1, char *v2, char *v3)
|
|
|
-{
|
|
|
- int _GunIndex;
|
|
|
- uint8_t gunIndex = 0;
|
|
|
- uint8_t stopChg = 0;
|
|
|
- uint8_t curGun = 0;
|
|
|
- int isContinue = 1;
|
|
|
- float _Voltage;
|
|
|
- float _Current;
|
|
|
- uint8_t PreviousSystemStatus[2] = {0xff};
|
|
|
- char *usageMsg = "Usage:\n"
|
|
|
- " strchg <index> <voltage> <current> ex: strchg 0 150 2\n"
|
|
|
- " chg <voltage> <current> ex: chg 500 100\n"
|
|
|
- " c <index> ex: c 0\n"
|
|
|
- " help | ? | h\n"
|
|
|
- "\r\n";
|
|
|
-
|
|
|
- if (strcmp(v1, "auto") == EQUAL) {
|
|
|
- _usingAutoRun = 0x01;
|
|
|
- _GunIndex = 0;
|
|
|
- _Voltage = 500;
|
|
|
- _Current = (pSysConfig->MaxChargingPower * 1000) / _Voltage;
|
|
|
- } else {
|
|
|
- _usingAutoRun = 0x00;
|
|
|
- _GunIndex = atoi(v1);
|
|
|
- _Voltage = atof(v2);
|
|
|
- _Current = atof(v3);
|
|
|
- }
|
|
|
-
|
|
|
- pDcChargingInfo = (struct ChargingInfoData *)GetDcChargingInfoData(_GunIndex);
|
|
|
-
|
|
|
- printf("Power = %d, ReqVoltage = %f, ReqCurrent = %f\n",
|
|
|
- pSysConfig->MaxChargingPower,
|
|
|
- _Voltage,
|
|
|
- _Current);
|
|
|
-
|
|
|
- if (_Voltage > 1000 || _Voltage < 50) {
|
|
|
- printf ("Input Voltage over range\n");
|
|
|
- return;
|
|
|
- }
|
|
|
-
|
|
|
- //kill ev task
|
|
|
- system("killall Module_EvComm");
|
|
|
-
|
|
|
- pSysInfo->CurGunSelected = _GunIndex;
|
|
|
-
|
|
|
- while (isContinue) {
|
|
|
-
|
|
|
- curGun = pSysInfo->CurGunSelected;
|
|
|
- pDcChargingInfo = (struct ChargingInfoData *)GetDcChargingInfoData(curGun);
|
|
|
-
|
|
|
- //fix gun 1
|
|
|
- switch (pDcChargingInfo->SystemStatus) {
|
|
|
- case S_IDLE:
|
|
|
- if (PreviousSystemStatus[curGun] != pDcChargingInfo->SystemStatus) {
|
|
|
- PreviousSystemStatus[curGun] = pDcChargingInfo->SystemStatus;
|
|
|
-#if defined DD360Audi
|
|
|
- setConfirmSelGun(curGun);
|
|
|
-#endif //defined DD360Audi
|
|
|
-
|
|
|
- strcpy((char *)pSysConfig->UserId, "AutoStartCharging");
|
|
|
- pDcChargingInfo->ConnectorPlugIn = 1;
|
|
|
- printf ("[UnconditionalCharge - S_IDLE]\n");
|
|
|
- pDcChargingInfo->Type = 9;
|
|
|
-
|
|
|
- }
|
|
|
- if (ShmOCPP16Data->SpMsg.bits.AuthorizeConf == 1) {
|
|
|
- pSysInfo->StartToChargingFlag = 0x01;
|
|
|
- pDcChargingInfo->SystemStatus = S_PREPARNING;
|
|
|
- }
|
|
|
- break;
|
|
|
-
|
|
|
- case S_PREPARNING:
|
|
|
- if (PreviousSystemStatus[curGun] != pDcChargingInfo->SystemStatus) {
|
|
|
- PreviousSystemStatus[curGun] = pDcChargingInfo->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 機制
|
|
|
- pDcChargingInfo->TimeoutFlag = 0;
|
|
|
- //不論是什麼 type 的槍都固意設成 Chademo 不跑 Prechage step
|
|
|
- pDcChargingInfo->Type = 9;
|
|
|
- break;
|
|
|
-
|
|
|
- case S_PREPARING_FOR_EV:
|
|
|
- if (PreviousSystemStatus[curGun] != pDcChargingInfo->SystemStatus) {
|
|
|
- PreviousSystemStatus[curGun] = pDcChargingInfo->SystemStatus;
|
|
|
-
|
|
|
- printf ("[UnconditionalCharge - S_PREPARING_FOR_EV]\n");
|
|
|
- printf ("ReqVoltage = %f, ReqCurrent = %f \n", _Voltage * 10, _Current * 10);
|
|
|
-
|
|
|
- }
|
|
|
- //清除 main timeout 機制
|
|
|
- pDcChargingInfo->TimeoutFlag = 0;
|
|
|
- //不論是什麼 type 的槍都固意設成 Chademo 不跑 Prechage step
|
|
|
- pDcChargingInfo->Type = 9;
|
|
|
-
|
|
|
- //充電電壓電流
|
|
|
- pDcChargingInfo->EvBatterySoc = 50;
|
|
|
- pDcChargingInfo->EvBatterytargetVoltage = 500;
|
|
|
- pDcChargingInfo->EvBatterytargetCurrent = 2;
|
|
|
- pDcChargingInfo->AvailableChargingCurrent = 1000;
|
|
|
-
|
|
|
- //****** 注意~此行為是防止 K1K2 先開導到無法升壓 ( Relay Board 在此 state 還未搭上 K1K2 )
|
|
|
- //確定模組己升壓完成
|
|
|
- //if(pDcChargingInfo->PresentChargingVoltage <= (3000+500) &&
|
|
|
- // pDcChargingInfo->PresentChargingVoltage >= (3000-500) )
|
|
|
- {
|
|
|
- printf ("Precharge Done = %f \n",
|
|
|
- pDcChargingInfo->PresentChargingVoltage);
|
|
|
- //EV done
|
|
|
- pDcChargingInfo->SystemStatus = S_PREPARING_FOR_EVSE;
|
|
|
- }
|
|
|
- break;
|
|
|
-
|
|
|
- case S_PREPARING_FOR_EVSE:
|
|
|
- if (PreviousSystemStatus[curGun] != pDcChargingInfo->SystemStatus) {
|
|
|
- PreviousSystemStatus[curGun] = pDcChargingInfo->SystemStatus;
|
|
|
-
|
|
|
- printf ("[UnconditionalCharge - S_PREPARING_FOR_EVSE]\n");
|
|
|
-
|
|
|
- }
|
|
|
- //printf ("tar vol = %d \n", _Voltage);
|
|
|
- //printf ("tar cur = %d \n", _Current);
|
|
|
-
|
|
|
- //清除 main timeout 機制
|
|
|
- pDcChargingInfo->TimeoutFlag = 0;
|
|
|
- //不論是什麼 type 的槍都固意設成 Chademo 不跑 Prechage step
|
|
|
- pDcChargingInfo->Type = 9;
|
|
|
-
|
|
|
- //充電電壓電流
|
|
|
- pDcChargingInfo->EvBatterySoc = 50;
|
|
|
- pDcChargingInfo->EvBatterytargetVoltage = 500;
|
|
|
- pDcChargingInfo->EvBatterytargetCurrent = 2;
|
|
|
- pDcChargingInfo->AvailableChargingCurrent = 1000;
|
|
|
-
|
|
|
- //printf ("tar vol_ = %d \n", pDcChargingInfo->EvBatterytargetVoltage);
|
|
|
- // printf ("tar cur_ = %d \n", pDcChargingInfo->EvBatterytargetCurrent);
|
|
|
-
|
|
|
- //****** 注意~此行為是防止 K1K2 先開導到無法升壓 ( Relay Board 在此 state 還未搭上 K1K2 )
|
|
|
- //確定模組己升壓完成
|
|
|
- if (pDcChargingInfo->GroundFaultStatus == 0x01 ||
|
|
|
- pDcChargingInfo->GroundFaultStatus == 0x03) {
|
|
|
- printf ("First Ground Fault State (%d)\n",
|
|
|
- pDcChargingInfo->GroundFaultStatus);
|
|
|
- printf ("Wait K1K2 = %f \n", pDcChargingInfo->PresentChargingVoltage);
|
|
|
- sleep(5);
|
|
|
- //EV done
|
|
|
- pDcChargingInfo->SystemStatus = S_CHARGING;
|
|
|
- } else if (pDcChargingInfo->GroundFaultStatus > 0x02) {
|
|
|
- printf ("First Ground Fault check Fail (%d)\n",
|
|
|
- pDcChargingInfo->GroundFaultStatus);
|
|
|
- pDcChargingInfo->SystemStatus = S_TERMINATING;
|
|
|
- }
|
|
|
- break;
|
|
|
-
|
|
|
- case S_CHARGING:
|
|
|
- if (PreviousSystemStatus[curGun] != pDcChargingInfo->SystemStatus) {
|
|
|
- PreviousSystemStatus[curGun] = pDcChargingInfo->SystemStatus;
|
|
|
-
|
|
|
- if (_usingAutoRun == 0x00) {
|
|
|
- //充電電壓電流
|
|
|
- pDcChargingInfo->EvBatterytargetVoltage = _Voltage;
|
|
|
- pDcChargingInfo->EvBatterytargetCurrent = _Current;
|
|
|
- } else {
|
|
|
- _curAutoRunCount = 0;
|
|
|
- gettimeofday(&_autoTime, NULL);
|
|
|
- }
|
|
|
-
|
|
|
- pDcChargingInfo->EvBatterySoc = 50;
|
|
|
- pDcChargingInfo->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)
|
|
|
- ) {
|
|
|
- pDcChargingInfo->EvBatterytargetVoltage = _Voltage;
|
|
|
- pDcChargingInfo->EvBatterytargetCurrent = _Current;
|
|
|
- } else if ((GetTimeoutValue(_autoTime)) >= AUTORUN_END_TIME * 60) {
|
|
|
- _curAutoRunCount++;
|
|
|
- if (_curAutoRunCount >= AUTORUN_CYCLE_COUNT) {
|
|
|
- pDcChargingInfo->SystemStatus = S_TERMINATING;
|
|
|
- } else {
|
|
|
- gettimeofday(&_autoTime, NULL);
|
|
|
- }
|
|
|
- } else {
|
|
|
- pDcChargingInfo->EvBatterytargetVoltage = 0;
|
|
|
- pDcChargingInfo->EvBatterytargetCurrent = 0;
|
|
|
- }
|
|
|
- }
|
|
|
-
|
|
|
-// printf("out : vol = %f, cur = %f \n",
|
|
|
-// pDcChargingInfo->EvBatterytargetVoltage,
|
|
|
-// pDcChargingInfo->EvBatterytargetCurrent);
|
|
|
- //ev task do this
|
|
|
- pDcChargingInfo->PresentChargingPower =
|
|
|
- ((float)((pDcChargingInfo->PresentChargingVoltage) *
|
|
|
- (pDcChargingInfo->PresentChargingCurrent)) / 1000);
|
|
|
-
|
|
|
- if (pDcChargingInfo->GroundFaultStatus == 0x02) {
|
|
|
- printf ("Charging Ground Fault check Fail (%d)\n",
|
|
|
- pDcChargingInfo->GroundFaultStatus);
|
|
|
- pDcChargingInfo->SystemStatus = S_TERMINATING;
|
|
|
- }
|
|
|
- break;
|
|
|
-
|
|
|
- case S_TERMINATING:
|
|
|
- if (PreviousSystemStatus[curGun] != pDcChargingInfo->SystemStatus) {
|
|
|
- PreviousSystemStatus[curGun] = pDcChargingInfo->SystemStatus;
|
|
|
-
|
|
|
- printf ("[UnconditionalCharge - S_TERMINATING]\n");
|
|
|
- //無阻塞偵測 keybaord 結束
|
|
|
- system(STTY_DEF TTY_PATH);
|
|
|
- }
|
|
|
-
|
|
|
- pDcChargingInfo->SystemStatus = S_COMPLETE;
|
|
|
- break;
|
|
|
-
|
|
|
- case S_COMPLETE:
|
|
|
- if (PreviousSystemStatus[curGun] != pDcChargingInfo->SystemStatus) {
|
|
|
- PreviousSystemStatus[curGun] = pDcChargingInfo->SystemStatus;
|
|
|
-
|
|
|
- printf ("[UnconditionalCharge - S_COMPLETE]\n");
|
|
|
- }
|
|
|
-
|
|
|
- PreviousSystemStatus[curGun] = 0xFF;
|
|
|
- stopChg = 0;
|
|
|
- for (gunIndex = 0; gunIndex < pSysConfig->TotalConnectorCount; gunIndex++) {
|
|
|
- if (PreviousSystemStatus[gunIndex] == 0xFF) {
|
|
|
- pDcChargingInfo = (struct ChargingInfoData *)GetDcChargingInfoData(curGun);
|
|
|
- pDcChargingInfo->SystemStatus = S_IDLE;
|
|
|
- } else {
|
|
|
- pSysInfo->CurGunSelected = gunIndex;
|
|
|
- }
|
|
|
-
|
|
|
- pDcChargingInfo = (struct ChargingInfoData *)GetDcChargingInfoData(gunIndex);
|
|
|
- if (pDcChargingInfo->SystemStatus == S_IDLE) {
|
|
|
- stopChg++;
|
|
|
- }
|
|
|
- }
|
|
|
-
|
|
|
- pDcChargingInfo = (struct ChargingInfoData *)GetDcChargingInfoData(curGun);
|
|
|
- pDcChargingInfo->PresentChargingPower = 0;
|
|
|
-
|
|
|
- if (stopChg == pSysConfig->TotalConnectorCount) {
|
|
|
- system("/root/Module_EvComm &");
|
|
|
- sleep(3);
|
|
|
-
|
|
|
- for (_GunIndex = 0; _GunIndex < pSysConfig->TotalConnectorCount; _GunIndex++) {
|
|
|
- pDcChargingInfo = (struct ChargingInfoData *)GetDcChargingInfoData(_GunIndex);
|
|
|
-
|
|
|
- pDcChargingInfo->SystemStatus = S_IDLE;
|
|
|
- }
|
|
|
- return;
|
|
|
- }
|
|
|
- break;
|
|
|
- }
|
|
|
-
|
|
|
- if (readCmdKey(CMD_KEY_DONT_WAIT) == NO) {
|
|
|
- continue;
|
|
|
- }
|
|
|
-
|
|
|
- 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;
|
|
|
- }
|
|
|
-
|
|
|
- if (atoi(newString[1]) == pSysInfo->CurGunSelected) {
|
|
|
- continue;
|
|
|
- }
|
|
|
-
|
|
|
- _GunIndex = atoi((char *)newString[1]);
|
|
|
- _Voltage = atof((char *)newString[2]);
|
|
|
- _Current = atof((char *)newString[3]);
|
|
|
-
|
|
|
- printf ("Power = %d, ReqVoltage = %f, ReqCurrent = %f\n",
|
|
|
- pSysConfig->MaxChargingPower,
|
|
|
- _Voltage,
|
|
|
- _Current);
|
|
|
-
|
|
|
- if (_Voltage > 1000 || _Voltage < 50) {
|
|
|
- _Voltage = 200;
|
|
|
- printf ("Input Voltage over range\n");
|
|
|
- continue;
|
|
|
- }
|
|
|
-
|
|
|
- pSysInfo->CurGunSelected = _GunIndex;
|
|
|
- strcpy((char *)pSysConfig->UserId, "");
|
|
|
- } else if (strcmp(newString[0], "chg") == 0) {
|
|
|
- if (strcmp(newString[1], "-1") == 0) {
|
|
|
- continue;
|
|
|
- }
|
|
|
-
|
|
|
- if (strcmp(newString[2], "-1") == 0 ||
|
|
|
- strcmp(newString[2], "") == 0) {
|
|
|
- continue;
|
|
|
- }
|
|
|
-
|
|
|
- if (strcmp(newString[3], "-1") == 0 ||
|
|
|
- strcmp(newString[3], "") == 0) {
|
|
|
- continue;
|
|
|
- }
|
|
|
-
|
|
|
- _GunIndex = atoi((char *)newString[1]);
|
|
|
- float _vol = atof(newString[2]);
|
|
|
- float _cur = atof(newString[3]);
|
|
|
-
|
|
|
- if (_cur <= 0 || _cur <= 0) {
|
|
|
- continue;
|
|
|
- }
|
|
|
-
|
|
|
- pDcChargingInfo = (struct ChargingInfoData *)GetDcChargingInfoData(_GunIndex);
|
|
|
-
|
|
|
- printf("reset vol = %f, cur = %f \n", _vol, _cur);
|
|
|
- pDcChargingInfo->EvBatterytargetVoltage = _vol;
|
|
|
- pDcChargingInfo->EvBatterytargetCurrent = _cur;
|
|
|
- } else if (strcmp(newString[0], "c") == 0) {
|
|
|
- if (strcmp(newString[1], "-1") == 0 ||
|
|
|
- strcmp(newString[1], "") == 0) {
|
|
|
- printf("argc 1 is error parameter\r\n");
|
|
|
- continue;
|
|
|
- }
|
|
|
-
|
|
|
- if (atoi((char *)newString[1]) != -1) {
|
|
|
- pSysInfo->CurGunSelected = atoi((char *)newString[1]);
|
|
|
- }
|
|
|
- printf("stop \n\r");
|
|
|
-
|
|
|
- pSysInfo->StartToChargingFlag = 0x00;
|
|
|
-
|
|
|
- pDcChargingInfo = (struct ChargingInfoData *)GetDcChargingInfoData( pSysInfo->CurGunSelected);
|
|
|
-
|
|
|
- pDcChargingInfo->SystemStatus = S_TERMINATING;
|
|
|
- } else if (helpCmd() == YES) {
|
|
|
- printf("%s\n", usageMsg);
|
|
|
- }
|
|
|
-
|
|
|
- usleep(100000);
|
|
|
- }
|
|
|
-}
|
|
|
-
|
|
|
-int printTimeMsg(const char *fmt, ...)
|
|
|
-{
|
|
|
- char Buf[4096 + 256] = {0};
|
|
|
- char buffer[4096] = {0};
|
|
|
- int rc = -1;
|
|
|
- va_list args;
|
|
|
- struct timeb SeqEndTime;
|
|
|
- struct tm *tm;
|
|
|
- struct SysConfigData *pSysConfig = (struct SysConfigData *)GetShmSysConfigData();
|
|
|
-
|
|
|
- va_start(args, fmt);
|
|
|
- rc = vsnprintf(buffer, sizeof(buffer), fmt, args);
|
|
|
- va_end(args);
|
|
|
-
|
|
|
- ftime(&SeqEndTime);
|
|
|
- SeqEndTime.time = time(NULL);
|
|
|
- tm = localtime(&SeqEndTime.time);
|
|
|
-
|
|
|
- sprintf(Buf, "%02d:%02d:%02d:%03d - %s",
|
|
|
- tm->tm_hour,
|
|
|
- tm->tm_min,
|
|
|
- tm->tm_sec,
|
|
|
- SeqEndTime.millitm,
|
|
|
- buffer);
|
|
|
- printf("%s", Buf);
|
|
|
-
|
|
|
- return rc;
|
|
|
-}
|
|
|
-
|
|
|
-static void resdGunAndChillerTemp(void)
|
|
|
-{
|
|
|
- int isContinue = 1;
|
|
|
- uint8_t i = 0;
|
|
|
- uint32_t sleepTime = 500000;
|
|
|
- uint32_t loopTime = 1000;
|
|
|
- struct timeb showTime;
|
|
|
- struct timeb nowTime;
|
|
|
-
|
|
|
- char *usageMsg = "Usage:\n"
|
|
|
- " t <index>: loop time, ex: t 1\n"
|
|
|
- " exit | c | C: exit test\n"
|
|
|
- " h | help | ?: show usage message\n"
|
|
|
- "\r\n";
|
|
|
-
|
|
|
- ftime(&showTime);
|
|
|
-
|
|
|
- while (isContinue) {
|
|
|
- ftime(&nowTime);
|
|
|
-
|
|
|
- if (DiffTimeb(showTime, nowTime) > loopTime ||
|
|
|
- DiffTimeb(showTime, nowTime) < 0) {
|
|
|
- for (i = 0; i < pSysConfig->TotalConnectorCount; i++) {
|
|
|
-
|
|
|
- pDcChargingInfo = (struct ChargingInfoData *)GetDcChargingInfoData(i);
|
|
|
-
|
|
|
- printTimeMsg("get gun %d temp = %3d, chiller = %3d, ConnTemp = %3d, %3d,SysTemp = %3d, %3d, %3d, %3d\r\n",
|
|
|
- i,
|
|
|
- pDcChargingInfo->ConnectorTemp,
|
|
|
- pDcChargingInfo->ChillerTemp,
|
|
|
- ShmDcCommonData->ConnectorTemp[i][0],
|
|
|
- ShmDcCommonData->ConnectorTemp[i][1],
|
|
|
- ShmDcCommonData->SystemTemp[0],
|
|
|
- ShmDcCommonData->SystemTemp[1],
|
|
|
- ShmDcCommonData->SystemTemp[2],
|
|
|
- ShmDcCommonData->SystemTemp[3]);
|
|
|
- }//for
|
|
|
- ftime(&showTime);
|
|
|
- }
|
|
|
-
|
|
|
- if (readCmdKey(CMD_KEY_DONT_WAIT) == NO) {
|
|
|
- usleep(sleepTime);
|
|
|
- continue;
|
|
|
- }
|
|
|
-
|
|
|
- if (strcmp(newString[0], "t") == 0) {
|
|
|
- if (strcmp(newString[1], "-1") == 0 ||
|
|
|
- strcmp(newString[1], "") == 0 ||
|
|
|
- atoi((char *)newString[1]) > 255
|
|
|
- ) {
|
|
|
- printf("argc 1 is error parameter\r\n");
|
|
|
- continue;
|
|
|
- }
|
|
|
-
|
|
|
- loopTime = ((atoi((char *)newString[1])) * 1000);
|
|
|
- printf("loopTime = %d\r\n", loopTime);
|
|
|
- ftime(&showTime);
|
|
|
- continue;
|
|
|
- } else if (exitCmd() == YES) {
|
|
|
- return;
|
|
|
- } else if (helpCmd() == YES) {
|
|
|
- printf ("%s\n", usageMsg);
|
|
|
- }
|
|
|
-
|
|
|
- usleep(sleepTime);
|
|
|
- }//while
|
|
|
-}
|
|
|
-
|
|
|
-static void writeGunAndChillerTemp(void)
|
|
|
-{
|
|
|
- uint8_t _GunIndex = 0;
|
|
|
- int isContinue = 1;
|
|
|
- uint32_t sleepTime = 500000;
|
|
|
- char *usageMsg = "Usage:\n"
|
|
|
- " conn <index> <temp>, ex: conn 0 150\n"
|
|
|
- " chiller <index> <temp>, ex: chiller 0 150\n"
|
|
|
- " tempR\n"
|
|
|
- " exit | c | C\n"
|
|
|
- " help | ? | h\n"
|
|
|
- "\r\n";
|
|
|
-
|
|
|
- ShmDcCommonData->TestTemperature = YES;
|
|
|
-
|
|
|
- while (isContinue) {
|
|
|
- if (readCmdKey(CMD_KEY_WAIT) == NO) {
|
|
|
- sleep(sleepTime);
|
|
|
- continue;
|
|
|
- }
|
|
|
-
|
|
|
- if (helpCmd() == YES) {
|
|
|
- printf ("%s\n", usageMsg);
|
|
|
- continue;
|
|
|
- } else if (exitCmd() == YES) {
|
|
|
- ShmDcCommonData->TestTemperature = NO;
|
|
|
- sleep(1);
|
|
|
- return;
|
|
|
- } else if (strcmp(newString[0], "tempR") == 0) {
|
|
|
- resdGunAndChillerTemp();
|
|
|
- }
|
|
|
-
|
|
|
- if ((strcmp(newString[0], "chiller") != 0) &&
|
|
|
- (strcmp(newString[1], "-1") == 0 ||
|
|
|
- strcmp(newString[1], "") == 0)
|
|
|
- ) {
|
|
|
- printf("argc 1 is error parameter\r\n");
|
|
|
- continue;
|
|
|
- }
|
|
|
-
|
|
|
- if (atoi(newString[2]) > 255 ||
|
|
|
- atoi(newString[2]) == -1) {
|
|
|
- printf("temperature value overflow\r\n");
|
|
|
- continue;
|
|
|
- }
|
|
|
-
|
|
|
- _GunIndex = atoi((char *)newString[1]);
|
|
|
-
|
|
|
- if (_GunIndex >= pSysConfig->TotalConnectorCount) {
|
|
|
- printf("gun index over total connector\r\n");
|
|
|
- continue;
|
|
|
- }
|
|
|
-
|
|
|
- if (strcmp(newString[0], "chiller") == 0) {//修改水冷機溫度值
|
|
|
- if (_GunIndex >= 1) {
|
|
|
- _GunIndex = 0; //只會有一個水冷機
|
|
|
- }
|
|
|
-
|
|
|
- pDcChargingInfo = (struct ChargingInfoData *)GetDcChargingInfoData(_GunIndex);
|
|
|
- pDcChargingInfo->ChillerTemp = atoi(newString[2]);
|
|
|
- printf("set %d chiller temperature = %d\r\n",
|
|
|
- _GunIndex,
|
|
|
- pDcChargingInfo->ChillerTemp);
|
|
|
- } else if (strcmp(newString[0], "conn") == 0) {//修改槍頭溫度值
|
|
|
- pDcChargingInfo = (struct ChargingInfoData *)GetDcChargingInfoData(_GunIndex);
|
|
|
-
|
|
|
- pDcChargingInfo->ConnectorTemp = atoi(newString[2]);
|
|
|
- printf("set %d connector temp = %d\r\n",
|
|
|
- _GunIndex,
|
|
|
- pDcChargingInfo->ConnectorTemp);
|
|
|
- }
|
|
|
-
|
|
|
- usleep(sleepTime);
|
|
|
- }//while
|
|
|
-}
|
|
|
-
|
|
|
-int main(void)
|
|
|
-{
|
|
|
- uint8_t _GunIndex = 0;
|
|
|
- int isContinue = 1;
|
|
|
- char *usageMsg = "Usage:\n"
|
|
|
- " state <index> : get gun state\n"
|
|
|
- " card : scanning card (x)\n"
|
|
|
- " gun <index> : get gun plugit state\n"
|
|
|
- " lock <index> : get gun locked state\n"
|
|
|
- " sysid : test system ID\n"
|
|
|
- " self : self test state (x)\n"
|
|
|
- " version | v | -v : version of board (407 or relay or other)\n"
|
|
|
- " update : update firmware\n"
|
|
|
- " ac : get ac relay state (x) \n"
|
|
|
- " cable <index> <state> : set ground fault state\n"
|
|
|
- " pow <index> <power> : set power value\n"
|
|
|
- " model : get system information\n"
|
|
|
- " temp : get PSU temperature\n"
|
|
|
- " fan <speed> : set fan board speed\n"
|
|
|
- " strchg <auto> : auto test charging\n"
|
|
|
- " strchg <index> <voltage <current> : select gun test charging\n"
|
|
|
- " tempW : write connector header and Chiller temperature\r\n"
|
|
|
- " tempR : print connector header and chiller temperature\r\n"
|
|
|
- "\r\n";
|
|
|
-
|
|
|
- if (CreateAllCsuShareMemory() == FAIL) {
|
|
|
- printf("create share memory error\r\n");
|
|
|
- return FAIL;
|
|
|
- }
|
|
|
-
|
|
|
- MappingGunChargingInfo("ReadCmdline Task");
|
|
|
-
|
|
|
- pSysConfig = (struct SysConfigData *)GetShmSysConfigData();
|
|
|
- pSysInfo = (struct SysInfoData *)GetShmSysInfoData();
|
|
|
- pSysWarning = (struct WARNING_CODE_INFO *)GetShmSysWarningInfo();
|
|
|
-
|
|
|
- pAlarmCode = (struct AlarmCodeData *)GetShmAlarmCodeData();
|
|
|
-
|
|
|
- ShmCHAdeMOData = (struct CHAdeMOData *)GetShmCHAdeMOData();
|
|
|
- ShmGBTData = (struct GBTData *)GetShmGBTData();
|
|
|
- ShmCcsData = (struct CcsData *)GetShmCcsData();
|
|
|
-
|
|
|
- ShmPrimaryMcuData = (struct PrimaryMcuData *)GetShmPrimaryMcuData();
|
|
|
- ShmFanModuleData = (struct FanModuleData *)GetShmFanModuleData();
|
|
|
- ShmRelayModuleData = (struct RelayModuleData *)GetShmRelayModuleData();
|
|
|
- ShmLedModuleData = (struct LedModuleData *)GetShmLedModuleData();
|
|
|
- ShmPsuData = (struct PsuData *)GetShmPsuData();
|
|
|
- ShmOCPP16Data = (struct OCPP16Data *)GetShmOCPP16Data();
|
|
|
- ShmSelectGunInfo = (SelectGunInfo *)GetShmSelectGunInfo();
|
|
|
- ShmDcCommonData = (DcCommonInfo *)GetShmDcCommonData();
|
|
|
-
|
|
|
-// for (_GunIndex = 0; _GunIndex < pSysConfig->TotalConnectorCount; _GunIndex++) {
|
|
|
-// pDcChargingInfo = (struct ChargingInfoData *)GetDcChargingInfoData(_GunIndex);
|
|
|
-
|
|
|
-// pDcChargingInfo->SystemStatus = S_IDLE;
|
|
|
-// }
|
|
|
-
|
|
|
- while (isContinue) {
|
|
|
- if (readCmdKey(CMD_KEY_WAIT) == NO) {
|
|
|
- continue;
|
|
|
- }
|
|
|
-
|
|
|
- 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], "version") == 0 ||
|
|
|
- strcmp(newString[0], "v") == 0 ||
|
|
|
- strcmp(newString[0], "-v") == 0) {
|
|
|
- //if (strcmp(newString[1], "-1") == 0 || strcmp(newString[1], "") == 0) {
|
|
|
- // continue;
|
|
|
- //}
|
|
|
- // 取 FW 版號
|
|
|
- GetFwVerProc();
|
|
|
- } 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 if (strcmp(newString[0], "tempW") == 0) { //測試槍頭和水冷機溫度
|
|
|
- writeGunAndChillerTemp();
|
|
|
- } else if (strcmp(newString[0], "tempR") == 0) { //讀取槍頭和水冷機溫度
|
|
|
- resdGunAndChillerTemp();
|
|
|
- } else {
|
|
|
- printf("%s\n", usageMsg);
|
|
|
- }
|
|
|
-
|
|
|
- sleep(1);
|
|
|
- }//while
|
|
|
-
|
|
|
- return 0;
|
|
|
-}
|
|
|
+/*
|
|
|
+ * 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 <stdint.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 "./ShareMemory/shmMem.h"
|
|
|
+#include "./Define/define.h"
|
|
|
+#include "./SelectGun/SelectGun.h"
|
|
|
+#include "Config.h"
|
|
|
+
|
|
|
+//------------------------------------------------------------------------------
|
|
|
+#define CMD_KEY_WAIT (1)
|
|
|
+#define CMD_KEY_DONT_WAIT (0)
|
|
|
+
|
|
|
+#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 "
|
|
|
+
|
|
|
+//------------------------------------------------------------------------------
|
|
|
+uint8_t _curAutoRunCount = 0;
|
|
|
+uint8_t _usingAutoRun = 0;
|
|
|
+struct timeval _autoTime;
|
|
|
+
|
|
|
+static struct SysConfigData *pSysConfig = NULL;
|
|
|
+static struct SysInfoData *pSysInfo = NULL;
|
|
|
+static struct WARNING_CODE_INFO *pSysWarning = NULL;
|
|
|
+
|
|
|
+static struct AlarmCodeData *pAlarmCode = NULL;
|
|
|
+
|
|
|
+static struct PrimaryMcuData *ShmPrimaryMcuData = NULL;
|
|
|
+static struct CHAdeMOData *ShmCHAdeMOData = NULL;
|
|
|
+static struct CcsData *ShmCcsData = NULL;
|
|
|
+static struct GBTData *ShmGBTData = NULL;
|
|
|
+static struct FanModuleData *ShmFanModuleData = NULL;
|
|
|
+static struct RelayModuleData *ShmRelayModuleData = NULL;
|
|
|
+static struct LedModuleData *ShmLedModuleData = NULL;
|
|
|
+static struct PsuData *ShmPsuData = NULL;
|
|
|
+static struct OCPP16Data *ShmOCPP16Data = NULL;
|
|
|
+static SelectGunInfo *ShmSelectGunInfo = NULL;
|
|
|
+static DcCommonInfo *ShmDcCommonData = NULL;
|
|
|
+
|
|
|
+static struct ChargingInfoData *pDcChargingInfo = NULL;
|
|
|
+static struct ChargingInfoData *pAcChargingInfo = NULL;
|
|
|
+
|
|
|
+static char newString[8][16] = {0};
|
|
|
+
|
|
|
+//------------------------------------------------------------------------------
|
|
|
+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;
|
|
|
+}
|
|
|
+
|
|
|
+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);
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+static uint8_t helpCmd(void)
|
|
|
+{
|
|
|
+ if (strcmp(newString[0], "?") == 0 ||
|
|
|
+ strcmp(newString[0], "help") == 0 ||
|
|
|
+ strcmp(newString[0], "h") == 0) {
|
|
|
+ return YES;
|
|
|
+ }
|
|
|
+
|
|
|
+ return NO;
|
|
|
+}
|
|
|
+
|
|
|
+static uint8_t exitCmd(void)
|
|
|
+{
|
|
|
+ if (strcmp(newString[0], "c") == EQUAL ||
|
|
|
+ strcmp(newString[0], "C") == EQUAL ||
|
|
|
+ strncmp(&newString[0][0], "exit", 4) == EQUAL
|
|
|
+ ) {
|
|
|
+ return YES;
|
|
|
+ }
|
|
|
+
|
|
|
+ return NO;
|
|
|
+}
|
|
|
+
|
|
|
+static uint8_t readCmdKey(uint8_t state)
|
|
|
+{
|
|
|
+ char word[128] = {0};
|
|
|
+ int i = 0, j = 0, ctr = 0;
|
|
|
+
|
|
|
+ memset(word, 0, sizeof(word));
|
|
|
+ if (state == CMD_KEY_WAIT) {
|
|
|
+ fgets(word, sizeof(word), stdin);
|
|
|
+ } else if (state == CMD_KEY_DONT_WAIT) {
|
|
|
+ get_char(word);
|
|
|
+
|
|
|
+ if (strlen(word) == 0) {
|
|
|
+ //usleep(50000);
|
|
|
+ return NO;
|
|
|
+ }
|
|
|
+ }
|
|
|
+
|
|
|
+ memset(newString, 0, sizeof(newString));
|
|
|
+
|
|
|
+ strcpy(newString[1], "-1");
|
|
|
+ strcpy(newString[2], "-1");
|
|
|
+ for (i = 0; i <= (strlen(word)); i++) {
|
|
|
+ if (word[i] == ' ' ||
|
|
|
+ word[i] == '\0' ||
|
|
|
+ word[i] == '\r' ||
|
|
|
+ word[i] == '\n' ||
|
|
|
+ word[i] == 10) {
|
|
|
+ newString[ctr][j] = '\0';
|
|
|
+ ctr++;
|
|
|
+ j = 0;
|
|
|
+ } else {
|
|
|
+ newString[ctr][j] = word[i];
|
|
|
+ j++;
|
|
|
+ }
|
|
|
+ }
|
|
|
+
|
|
|
+ return YES;
|
|
|
+}
|
|
|
+
|
|
|
+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", pSysInfo->OrderCharging);
|
|
|
+ printf("WaitForPlugit = %d \n", pSysInfo->WaitForPlugit);
|
|
|
+ if (strcmp(v1, "ac") == 0) {
|
|
|
+ pAcChargingInfo = (struct ChargingInfoData *)GetAcChargingInfoData(0);
|
|
|
+ //if (!FindAcChargingInfoData(0, &ac_chargingInfo[0])) {
|
|
|
+ // printf("FindChargingInfoData (AC) false \n");
|
|
|
+ //}
|
|
|
+ printf("AC Status = %d \n", pAcChargingInfo->ConnectorPlugIn);
|
|
|
+ return;
|
|
|
+ }
|
|
|
+
|
|
|
+ int _index = atoi(v1);
|
|
|
+
|
|
|
+ if (_index <= 1) {
|
|
|
+ //if (!FindChargingInfoData(_index, &_chargingData[0])) {
|
|
|
+ // printf ("FindChargingInfoData error\n");
|
|
|
+ // return;
|
|
|
+ //}
|
|
|
+ pDcChargingInfo = (struct ChargingInfoData *)GetDcChargingInfoData(_index);
|
|
|
+
|
|
|
+ if (strcmp(v2, "-1") == 0 || strcmp(v2, "") == 0) {
|
|
|
+ // get
|
|
|
+ printf ("index = %x, status = %x (%d)\n",
|
|
|
+ _index,
|
|
|
+ pDcChargingInfo->SystemStatus,
|
|
|
+ pDcChargingInfo->IsAvailable);
|
|
|
+ printf ("SystemTimeoutFlag = %d, PageIndex = %d\n",
|
|
|
+ pSysInfo->SystemTimeoutFlag, pSysInfo->PageIndex);
|
|
|
+ } else {
|
|
|
+ // set
|
|
|
+ pDcChargingInfo->SystemStatus = atoi(v2);
|
|
|
+ }
|
|
|
+ } else {
|
|
|
+ //if (!FindAcChargingInfoData(0, &ac_chargingInfo[0])) {
|
|
|
+ // printf("FindChargingInfoData (AC) false \n");
|
|
|
+ //}
|
|
|
+ pAcChargingInfo = (struct ChargingInfoData *)GetAcChargingInfoData(0);
|
|
|
+
|
|
|
+ if (strcmp(v2, "-1") == 0 || strcmp(v2, "") == 0) {
|
|
|
+ // get
|
|
|
+ printf ("AC Type, status = %x (%d)\n",
|
|
|
+ pAcChargingInfo->SystemStatus,
|
|
|
+ pAcChargingInfo->IsAvailable);
|
|
|
+ } else {
|
|
|
+ // set
|
|
|
+ pAcChargingInfo->SystemStatus = atoi(v2);
|
|
|
+ }
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+void RunCardProc(char *v1, char *v2)
|
|
|
+{
|
|
|
+ if (strcmp(v1, "-1") == 0 || strcmp(v1, "") == 0) {
|
|
|
+ if (pSysInfo->WaitForPlugit) {
|
|
|
+ pSysInfo->WaitForPlugit = 0x00;
|
|
|
+ printf ("SysInfo.WaitForPlugit = %x \n", pSysInfo->WaitForPlugit);
|
|
|
+ } else {
|
|
|
+ pSysInfo->WaitForPlugit = 0x01;
|
|
|
+ printf ("SysInfo.WaitForPlugit = %x \n", pSysInfo->WaitForPlugit);
|
|
|
+ }
|
|
|
+ } else {
|
|
|
+ strcpy((char *)pSysConfig->UserId, "");
|
|
|
+ memcpy((char *)pSysConfig->UserId, v1, strlen(v1));
|
|
|
+ pSysConfig->UserId[strlen(v1)] = '\0';
|
|
|
+ printf("StartUserId = %s \n", pSysConfig->UserId);
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+void RunGunPlugitProc(char *v1, char *v2)
|
|
|
+{
|
|
|
+ if (strcmp(v1, "ac") == 0) {
|
|
|
+ //if (!FindAcChargingInfoData(0, &ac_chargingInfo[0])) {
|
|
|
+ // printf("FindChargingInfoData (AC) false \n");
|
|
|
+ //}
|
|
|
+ pAcChargingInfo = (struct ChargingInfoData *)GetAcChargingInfoData(0);
|
|
|
+
|
|
|
+ if (strcmp(v2, "-1") == 0 || strcmp(v2, "") == 0) {
|
|
|
+ // get
|
|
|
+ printf("ConnectorPlugIn = %d \n", pAcChargingInfo->ConnectorPlugIn);
|
|
|
+ } else {
|
|
|
+ // set
|
|
|
+ pAcChargingInfo->ConnectorPlugIn = atoi(v2);
|
|
|
+ }
|
|
|
+ return;
|
|
|
+ }
|
|
|
+
|
|
|
+ int _index = atoi(v1);
|
|
|
+ //if (!FindChargingInfoData(_index, &_chargingData[0])) {
|
|
|
+ // printf("FindChargingInfoData error\n");
|
|
|
+ // return;
|
|
|
+ //}
|
|
|
+ pDcChargingInfo = (struct ChargingInfoData *)GetDcChargingInfoData(_index);
|
|
|
+
|
|
|
+ if (strcmp(v2, "-1") == 0 || strcmp(v2, "") == 0) {
|
|
|
+ // get
|
|
|
+ printf("index = %x, plug it = %x\n",
|
|
|
+ _index,
|
|
|
+ pDcChargingInfo->ConnectorPlugIn);
|
|
|
+ } else {
|
|
|
+ // set
|
|
|
+ pDcChargingInfo->ConnectorPlugIn = atoi(v2);
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+void GetGunLockStatusProc(char *v1, char *v2)
|
|
|
+{
|
|
|
+ int _index = atoi(v1);
|
|
|
+ //if (!FindChargingInfoData(_index, &_chargingData[0])) {
|
|
|
+ // printf("FindChargingInfoData error\n");
|
|
|
+ // return;
|
|
|
+ //}
|
|
|
+ pDcChargingInfo = (struct ChargingInfoData *)GetDcChargingInfoData(_index);
|
|
|
+
|
|
|
+ if (strcmp(v2, "-1") != 0 && strcmp(v2, "") != 0) {
|
|
|
+ pDcChargingInfo->GunLocked = atoi(v2);
|
|
|
+ }
|
|
|
+
|
|
|
+ printf("Gun Locked Status = %d \n", pDcChargingInfo->GunLocked);
|
|
|
+}
|
|
|
+
|
|
|
+void SetSystemIDProc()
|
|
|
+{
|
|
|
+ char *systemId = "Alston_Test";
|
|
|
+ memcpy(&pSysConfig->SystemId, systemId, strlen(systemId));
|
|
|
+}
|
|
|
+
|
|
|
+void RunSelfProc()
|
|
|
+{
|
|
|
+ printf("self test status = %x\n", pSysInfo->SelfTestSeq);
|
|
|
+}
|
|
|
+
|
|
|
+void GetFwVerProc(void)
|
|
|
+{
|
|
|
+ int _index = 0;
|
|
|
+ int isContinue = 1;
|
|
|
+ char *usageMsg = "Usage:\n"
|
|
|
+ " model\n"
|
|
|
+ " 407\n"
|
|
|
+ " conn index, ex: conn 0 | 1\n"
|
|
|
+ " relay\n"
|
|
|
+ " fan\n"
|
|
|
+ " dc\n"
|
|
|
+ " led\n"
|
|
|
+ " ac\n"
|
|
|
+ " exit | c | C\n"
|
|
|
+ " help | ? | h\n";
|
|
|
+
|
|
|
+ while (isContinue) {
|
|
|
+ if (readCmdKey(CMD_KEY_WAIT) == NO) {
|
|
|
+ continue;
|
|
|
+ }
|
|
|
+
|
|
|
+ if (strcmp(newString[0], "407") == 0) {
|
|
|
+ printf("407 FW Version = %s\n", ShmPrimaryMcuData->version);
|
|
|
+ } else if (strcmp(newString[0], "model") == 0) {
|
|
|
+ printf("ModelName = %s\r\n", pSysConfig->ModelName);
|
|
|
+ } else if (strcmp(newString[0], "conn") == 0) {
|
|
|
+ if (strcmp(newString[1], "-1") == 0 ||
|
|
|
+ strcmp(newString[1], "") == 0 ||
|
|
|
+ atoi(newString[1]) >= pSysConfig->TotalConnectorCount
|
|
|
+ ) {
|
|
|
+ printf("index over flow\r\n");
|
|
|
+ continue;
|
|
|
+ }
|
|
|
+
|
|
|
+ _index = atoi(newString[1]);
|
|
|
+
|
|
|
+ if (_index == 0) {
|
|
|
+ printf("Gun 0 FW Version = %s \n", pSysInfo->Connector1FwRev);
|
|
|
+ } else if (_index == 1) {
|
|
|
+ printf("Gun 1 FW Version = %s \n", pSysInfo->Connector2FwRev);
|
|
|
+ }
|
|
|
+ } else if (strcmp(newString[0], "relay") == 0) {
|
|
|
+ printf("RB Version = %s \n", pSysInfo->RelayModuleFwRev);
|
|
|
+ } else if (strcmp(newString[0], "fan") == 0) {
|
|
|
+ printf("FAN Version = %s \n", pSysInfo->FanModuleFwRev);
|
|
|
+ } else if (strcmp(newString[0], "dc") == 0) {
|
|
|
+ printf("DC Main Version = %s \n", pSysInfo->CsuRootFsFwRev);
|
|
|
+ } else if (strcmp(newString[0], "led") == 0) {
|
|
|
+ printf("LED Version = %s \n", pSysInfo->LedModuleFwRev);
|
|
|
+ } else if (strcmp(newString[0], "ac") == 0) {
|
|
|
+ pAcChargingInfo = (struct ChargingInfoData *)GetAcChargingInfoData(0);
|
|
|
+
|
|
|
+ printf("AC Version = %s \n", pAcChargingInfo->version);
|
|
|
+ } else if (exitCmd() == YES) {
|
|
|
+ return;
|
|
|
+ } else if (helpCmd() == YES) {
|
|
|
+ printf ("%s\n", usageMsg);
|
|
|
+ }
|
|
|
+
|
|
|
+ }//while
|
|
|
+}
|
|
|
+
|
|
|
+void CreateOneError(char *v1)
|
|
|
+{
|
|
|
+ int value = atoi(v1);
|
|
|
+
|
|
|
+ pAlarmCode->AlarmEvents.bits.SystemL1InputOVP = value;
|
|
|
+ pSysConfig->BillingData.isBilling = value;
|
|
|
+}
|
|
|
+
|
|
|
+void GetAuthorizeFlag(char *v1)
|
|
|
+{
|
|
|
+ if (strcmp(v1, "-1") == 0 || strcmp(v1, "") == 0) {
|
|
|
+ printf("AuthorizeFlag = %d \n", pSysInfo->AuthorizeFlag);
|
|
|
+ } else {
|
|
|
+ pSysInfo->AuthorizeFlag = atoi(v1);
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+void GetRelayStatus(char *v1)
|
|
|
+{
|
|
|
+ int _index = atoi(v1);
|
|
|
+ //if (!FindChargingInfoData(_index, &_chargingData[0])) {
|
|
|
+ // printf("FindChargingInfoData error\n");
|
|
|
+ // return;
|
|
|
+ //}
|
|
|
+ pDcChargingInfo = (struct ChargingInfoData *)GetDcChargingInfoData(_index);
|
|
|
+
|
|
|
+ printf("RelayK1K2Status = %d \n", pDcChargingInfo->RelayK1K2Status);
|
|
|
+ printf("RelayKPK2Status = %d \n", pDcChargingInfo->RelayKPK2Status);
|
|
|
+}
|
|
|
+
|
|
|
+void FwUpdateFlagProc()
|
|
|
+{
|
|
|
+ pSysInfo->FirmwareUpdate = 0x01;
|
|
|
+}
|
|
|
+
|
|
|
+void CheckAcStatus(char *v1)
|
|
|
+{
|
|
|
+ if (strcmp(v1, "-1") == 0 || strcmp(v1, "") == 0) {
|
|
|
+ printf("AC Status = %d \n", pSysInfo->AcContactorStatus);
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+void SetCableChkStatus(char *v1, char *v2)
|
|
|
+{
|
|
|
+ int _index = atoi(v1);
|
|
|
+ //if (!FindChargingInfoData(_index, &_chargingData[0])) {
|
|
|
+ // printf ("FindChargingInfoData error\n");
|
|
|
+ // return;
|
|
|
+ //}
|
|
|
+ pDcChargingInfo = (struct ChargingInfoData *)GetDcChargingInfoData(_index);
|
|
|
+
|
|
|
+ pDcChargingInfo->GroundFaultStatus = atoi(v2);
|
|
|
+}
|
|
|
+
|
|
|
+void SetChargingInfoCCID(char *v1, char *v2)
|
|
|
+{
|
|
|
+ int _index = atoi(v1);
|
|
|
+ //if (!FindChargingInfoData(_index, &_chargingData[0])) {
|
|
|
+ // printf ("FindChargingInfoData error\n");
|
|
|
+ // return;
|
|
|
+ //}
|
|
|
+ pDcChargingInfo = (struct ChargingInfoData *)GetDcChargingInfoData(_index);
|
|
|
+
|
|
|
+ memcpy(pDcChargingInfo->EVCCID, v2, 8);
|
|
|
+ pDcChargingInfo->EVCCID[8] = '\0';
|
|
|
+}
|
|
|
+
|
|
|
+void SetPowerValue(char *v1, char *v2)
|
|
|
+{
|
|
|
+ int _index = atoi(v1);
|
|
|
+ float _Current = atof(v2);
|
|
|
+
|
|
|
+ //if (!FindChargingInfoData(_index, &_chargingData[0])) {
|
|
|
+ // printf ("FindChargingInfoData error\n");
|
|
|
+ // return;
|
|
|
+ //}
|
|
|
+ pDcChargingInfo = (struct ChargingInfoData *)GetDcChargingInfoData(_index);
|
|
|
+
|
|
|
+ // 盲沖的時候才允許使用~
|
|
|
+ if (pDcChargingInfo->Type != 9) {
|
|
|
+ return;
|
|
|
+ }
|
|
|
+
|
|
|
+ pDcChargingInfo->EvBatterytargetCurrent = _Current;
|
|
|
+}
|
|
|
+
|
|
|
+void GetSystemInfo()
|
|
|
+{
|
|
|
+ printf ("ModelName = %s \n", pSysConfig->ModelName);
|
|
|
+ printf ("SerialNumber = %s \n", pSysConfig->SerialNumber);
|
|
|
+ printf ("InternetConn = %d \n", pSysInfo->InternetConn);
|
|
|
+
|
|
|
+ printf ("MaxChargingPower = %d, MaxChargingCurrent = %d \n",
|
|
|
+ pSysConfig->MaxChargingPower,
|
|
|
+ pSysConfig->MaxChargingCurrent);
|
|
|
+}
|
|
|
+
|
|
|
+void ChangeGunNum()
|
|
|
+{
|
|
|
+ if (pSysInfo->CurGunSelected + 1 < pSysConfig->TotalConnectorCount) {
|
|
|
+ pSysInfo->CurGunSelected += 1;
|
|
|
+ pSysInfo->CurGunSelectedByAc = NO_DEFINE;
|
|
|
+ } else if (pSysConfig->AcConnectorCount > 0 &&
|
|
|
+ pSysInfo->CurGunSelectedByAc == NO_DEFINE) {
|
|
|
+ pSysInfo->CurGunSelectedByAc = DEFAULT_AC_INDEX;
|
|
|
+ } else {
|
|
|
+ pSysInfo->CurGunSelected = 0;
|
|
|
+ pSysInfo->CurGunSelectedByAc = NO_DEFINE;
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+void GetGunSelectedNum(char *v1)
|
|
|
+{
|
|
|
+ if (strcmp(v1, "-1") == 0 || strcmp(v1, "") == 0) {
|
|
|
+ if (AC_QUANTITY > 0 &&
|
|
|
+ pSysInfo->CurGunSelectedByAc != NO_DEFINE) {
|
|
|
+ printf("connector select changed = AC \n");
|
|
|
+ } else {
|
|
|
+ printf("connector selected = %d \n", pSysInfo->CurGunSelected);
|
|
|
+ }
|
|
|
+ } else {
|
|
|
+ int _index = atoi(v1);
|
|
|
+ if (_index <= 1) {
|
|
|
+ pSysInfo->CurGunSelected = _index;
|
|
|
+ pSysInfo->CurGunSelectedByAc = NO_DEFINE;
|
|
|
+ printf("connector select changed = %d \n", _index);
|
|
|
+ } else if (AC_QUANTITY > 0) {
|
|
|
+ pSysInfo->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);
|
|
|
+
|
|
|
+ pSysConfig->SwitchDebugFlag = mode;
|
|
|
+}
|
|
|
+
|
|
|
+void SetGFDMode(char *v1)
|
|
|
+{
|
|
|
+ int mode = atoi(v1);
|
|
|
+
|
|
|
+ pSysConfig->AlwaysGfdFlag = mode;
|
|
|
+}
|
|
|
+
|
|
|
+void GetPsuTemp()
|
|
|
+{
|
|
|
+ for (uint8_t index = 0; index < ShmPsuData->GroupCount; index++) {
|
|
|
+ for (uint8_t 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",
|
|
|
+ pSysInfo->InputVoltageR,
|
|
|
+ pSysInfo->InputVoltageS,
|
|
|
+ pSysInfo->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 (uint8_t 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 < pSysConfig->TotalConnectorCount; i++) {
|
|
|
+ //if (!FindChargingInfoData(i, &_chargingData[0])) {
|
|
|
+ // printf ("FindChargingInfoData error\n");
|
|
|
+ // continue;
|
|
|
+ //}
|
|
|
+ pDcChargingInfo = (struct ChargingInfoData *)GetDcChargingInfoData(i);
|
|
|
+
|
|
|
+ printf("Form RB : Group Index = %d, OutputV = %f \n",
|
|
|
+ i,
|
|
|
+ pDcChargingInfo->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;
|
|
|
+ //}
|
|
|
+ pDcChargingInfo = (struct ChargingInfoData *)GetDcChargingInfoData(0);
|
|
|
+
|
|
|
+ pDcChargingInfo->EvBatterytargetVoltage = vol;
|
|
|
+ pDcChargingInfo->EvBatterytargetCurrent = cur;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ printf("*************************************************\n");
|
|
|
+}
|
|
|
+
|
|
|
+void GetConnectorCapInfo(char *v1)
|
|
|
+{
|
|
|
+ int _GunIndex = atoi(v1);
|
|
|
+
|
|
|
+ //if (!FindChargingInfoData(_GunIndex, &_chargingData[0])) {
|
|
|
+ // printf ("FindChargingInfoData error\n");
|
|
|
+ // return;
|
|
|
+ //}
|
|
|
+ pDcChargingInfo = (struct ChargingInfoData *)GetDcChargingInfoData(_GunIndex);
|
|
|
+
|
|
|
+ printf ("Charger Max Current = %d, Max Power = %d \n",
|
|
|
+ pSysConfig->MaxChargingCurrent * 10,
|
|
|
+ pSysConfig->MaxChargingPower * 10);
|
|
|
+
|
|
|
+ printf ("Index = %d, MaxPow = %f, MaxVol = %f, MaxCur = %f\n",
|
|
|
+ _GunIndex,
|
|
|
+ pDcChargingInfo->RealMaxPower,
|
|
|
+ pDcChargingInfo->RealMaxVoltage,
|
|
|
+ pDcChargingInfo->RealMaxCurrent);
|
|
|
+}
|
|
|
+
|
|
|
+static void setConfirmSelGun(uint8_t selGun)
|
|
|
+{
|
|
|
+ if (selGun == LEFT_GUN_NUM && ShmSelectGunInfo->SelGunInfo.LeftGun == SEL_GUN_RELEASE) {
|
|
|
+ ShmSelectGunInfo->SelGunInfo.LeftGun = SEL_GUN_CONFIRM;
|
|
|
+ //printf("confirmSelGun left\r\n");
|
|
|
+ } else if (selGun == RIGHT_GUN_NUM && ShmSelectGunInfo->SelGunInfo.RightGun == SEL_GUN_RELEASE) {
|
|
|
+ ShmSelectGunInfo->SelGunInfo.RightGun = SEL_GUN_CONFIRM;
|
|
|
+ //printf("confirmSelGun right\r\n");
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+void RunUnconditionalChargeIndex1(char *v1, char *v2, char *v3)
|
|
|
+{
|
|
|
+ int _GunIndex;
|
|
|
+ uint8_t gunIndex = 0;
|
|
|
+ uint8_t stopChg = 0;
|
|
|
+ uint8_t curGun = 0;
|
|
|
+ int isContinue = 1;
|
|
|
+ float _Voltage;
|
|
|
+ float _Current;
|
|
|
+ uint8_t PreviousSystemStatus[2] = {0xff};
|
|
|
+ char *usageMsg = "Usage:\n"
|
|
|
+ " strchg <index> <voltage> <current> ex: strchg 0 150 2\n"
|
|
|
+ " chg <voltage> <current> ex: chg 500 100\n"
|
|
|
+ " c <index> ex: c 0\n"
|
|
|
+ " help | ? | h\n"
|
|
|
+ "\r\n";
|
|
|
+
|
|
|
+ if (strcmp(v1, "auto") == EQUAL) {
|
|
|
+ _usingAutoRun = 0x01;
|
|
|
+ _GunIndex = 0;
|
|
|
+ _Voltage = 500;
|
|
|
+ _Current = (pSysConfig->MaxChargingPower * 1000) / _Voltage;
|
|
|
+ } else {
|
|
|
+ _usingAutoRun = 0x00;
|
|
|
+ _GunIndex = atoi(v1);
|
|
|
+ _Voltage = atof(v2);
|
|
|
+ _Current = atof(v3);
|
|
|
+ }
|
|
|
+
|
|
|
+ pDcChargingInfo = (struct ChargingInfoData *)GetDcChargingInfoData(_GunIndex);
|
|
|
+
|
|
|
+ printf("Power = %d, ReqVoltage = %f, ReqCurrent = %f\n",
|
|
|
+ pSysConfig->MaxChargingPower,
|
|
|
+ _Voltage,
|
|
|
+ _Current);
|
|
|
+
|
|
|
+ if (_Voltage > 1000 || _Voltage < 50) {
|
|
|
+ printf ("Input Voltage over range\n");
|
|
|
+ return;
|
|
|
+ }
|
|
|
+
|
|
|
+ //kill ev task
|
|
|
+ system("killall Module_EvComm");
|
|
|
+
|
|
|
+ pSysInfo->CurGunSelected = _GunIndex;
|
|
|
+
|
|
|
+ while (isContinue) {
|
|
|
+
|
|
|
+ curGun = pSysInfo->CurGunSelected;
|
|
|
+ pDcChargingInfo = (struct ChargingInfoData *)GetDcChargingInfoData(curGun);
|
|
|
+
|
|
|
+ //fix gun 1
|
|
|
+ switch (pDcChargingInfo->SystemStatus) {
|
|
|
+ case S_IDLE:
|
|
|
+ if (PreviousSystemStatus[curGun] != pDcChargingInfo->SystemStatus) {
|
|
|
+ PreviousSystemStatus[curGun] = pDcChargingInfo->SystemStatus;
|
|
|
+#if defined DD360Audi
|
|
|
+ setConfirmSelGun(curGun);
|
|
|
+#endif //defined DD360Audi
|
|
|
+
|
|
|
+ strcpy((char *)pSysConfig->UserId, "AutoStartCharging");
|
|
|
+ pDcChargingInfo->ConnectorPlugIn = 1;
|
|
|
+ printf ("[UnconditionalCharge - S_IDLE]\n");
|
|
|
+ pDcChargingInfo->Type = 9;
|
|
|
+
|
|
|
+ }
|
|
|
+ if (ShmOCPP16Data->SpMsg.bits.AuthorizeConf == 1) {
|
|
|
+ pSysInfo->StartToChargingFlag = 0x01;
|
|
|
+ pDcChargingInfo->SystemStatus = S_PREPARNING;
|
|
|
+ }
|
|
|
+ break;
|
|
|
+
|
|
|
+ case S_PREPARNING:
|
|
|
+ if (PreviousSystemStatus[curGun] != pDcChargingInfo->SystemStatus) {
|
|
|
+ PreviousSystemStatus[curGun] = pDcChargingInfo->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 機制
|
|
|
+ pDcChargingInfo->TimeoutFlag = 0;
|
|
|
+ //不論是什麼 type 的槍都固意設成 Chademo 不跑 Prechage step
|
|
|
+ pDcChargingInfo->Type = 9;
|
|
|
+ break;
|
|
|
+
|
|
|
+ case S_PREPARING_FOR_EV:
|
|
|
+ if (PreviousSystemStatus[curGun] != pDcChargingInfo->SystemStatus) {
|
|
|
+ PreviousSystemStatus[curGun] = pDcChargingInfo->SystemStatus;
|
|
|
+
|
|
|
+ printf ("[UnconditionalCharge - S_PREPARING_FOR_EV]\n");
|
|
|
+ printf ("ReqVoltage = %f, ReqCurrent = %f \n", _Voltage * 10, _Current * 10);
|
|
|
+
|
|
|
+ }
|
|
|
+ //清除 main timeout 機制
|
|
|
+ pDcChargingInfo->TimeoutFlag = 0;
|
|
|
+ //不論是什麼 type 的槍都固意設成 Chademo 不跑 Prechage step
|
|
|
+ pDcChargingInfo->Type = 9;
|
|
|
+
|
|
|
+ //充電電壓電流
|
|
|
+ pDcChargingInfo->EvBatterySoc = 50;
|
|
|
+ pDcChargingInfo->EvBatterytargetVoltage = 500;
|
|
|
+ pDcChargingInfo->EvBatterytargetCurrent = 2;
|
|
|
+ pDcChargingInfo->AvailableChargingCurrent = 1000;
|
|
|
+
|
|
|
+ //****** 注意~此行為是防止 K1K2 先開導到無法升壓 ( Relay Board 在此 state 還未搭上 K1K2 )
|
|
|
+ //確定模組己升壓完成
|
|
|
+ //if(pDcChargingInfo->PresentChargingVoltage <= (3000+500) &&
|
|
|
+ // pDcChargingInfo->PresentChargingVoltage >= (3000-500) )
|
|
|
+ {
|
|
|
+ printf ("Precharge Done = %f \n",
|
|
|
+ pDcChargingInfo->PresentChargingVoltage);
|
|
|
+ //EV done
|
|
|
+ pDcChargingInfo->SystemStatus = S_PREPARING_FOR_EVSE;
|
|
|
+ }
|
|
|
+ break;
|
|
|
+
|
|
|
+ case S_PREPARING_FOR_EVSE:
|
|
|
+ if (PreviousSystemStatus[curGun] != pDcChargingInfo->SystemStatus) {
|
|
|
+ PreviousSystemStatus[curGun] = pDcChargingInfo->SystemStatus;
|
|
|
+
|
|
|
+ printf ("[UnconditionalCharge - S_PREPARING_FOR_EVSE]\n");
|
|
|
+
|
|
|
+ }
|
|
|
+ //printf ("tar vol = %d \n", _Voltage);
|
|
|
+ //printf ("tar cur = %d \n", _Current);
|
|
|
+
|
|
|
+ //清除 main timeout 機制
|
|
|
+ pDcChargingInfo->TimeoutFlag = 0;
|
|
|
+ //不論是什麼 type 的槍都固意設成 Chademo 不跑 Prechage step
|
|
|
+ pDcChargingInfo->Type = 9;
|
|
|
+
|
|
|
+ //充電電壓電流
|
|
|
+ pDcChargingInfo->EvBatterySoc = 50;
|
|
|
+ pDcChargingInfo->EvBatterytargetVoltage = 500;
|
|
|
+ pDcChargingInfo->EvBatterytargetCurrent = 2;
|
|
|
+ pDcChargingInfo->AvailableChargingCurrent = 1000;
|
|
|
+
|
|
|
+ //printf ("tar vol_ = %d \n", pDcChargingInfo->EvBatterytargetVoltage);
|
|
|
+ // printf ("tar cur_ = %d \n", pDcChargingInfo->EvBatterytargetCurrent);
|
|
|
+
|
|
|
+ //****** 注意~此行為是防止 K1K2 先開導到無法升壓 ( Relay Board 在此 state 還未搭上 K1K2 )
|
|
|
+ //確定模組己升壓完成
|
|
|
+ if (pDcChargingInfo->GroundFaultStatus == 0x01 ||
|
|
|
+ pDcChargingInfo->GroundFaultStatus == 0x03) {
|
|
|
+ printf ("First Ground Fault State (%d)\n",
|
|
|
+ pDcChargingInfo->GroundFaultStatus);
|
|
|
+ printf ("Wait K1K2 = %f \n", pDcChargingInfo->PresentChargingVoltage);
|
|
|
+ sleep(5);
|
|
|
+ //EV done
|
|
|
+ pDcChargingInfo->SystemStatus = S_CHARGING;
|
|
|
+ } else if (pDcChargingInfo->GroundFaultStatus > 0x02) {
|
|
|
+ printf ("First Ground Fault check Fail (%d)\n",
|
|
|
+ pDcChargingInfo->GroundFaultStatus);
|
|
|
+ pDcChargingInfo->SystemStatus = S_TERMINATING;
|
|
|
+ }
|
|
|
+ break;
|
|
|
+
|
|
|
+ case S_CHARGING:
|
|
|
+ if (PreviousSystemStatus[curGun] != pDcChargingInfo->SystemStatus) {
|
|
|
+ PreviousSystemStatus[curGun] = pDcChargingInfo->SystemStatus;
|
|
|
+
|
|
|
+ if (_usingAutoRun == 0x00) {
|
|
|
+ //充電電壓電流
|
|
|
+ pDcChargingInfo->EvBatterytargetVoltage = _Voltage;
|
|
|
+ pDcChargingInfo->EvBatterytargetCurrent = _Current;
|
|
|
+ } else {
|
|
|
+ _curAutoRunCount = 0;
|
|
|
+ gettimeofday(&_autoTime, NULL);
|
|
|
+ }
|
|
|
+
|
|
|
+ pDcChargingInfo->EvBatterySoc = 50;
|
|
|
+ pDcChargingInfo->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)
|
|
|
+ ) {
|
|
|
+ pDcChargingInfo->EvBatterytargetVoltage = _Voltage;
|
|
|
+ pDcChargingInfo->EvBatterytargetCurrent = _Current;
|
|
|
+ } else if ((GetTimeoutValue(_autoTime)) >= AUTORUN_END_TIME * 60) {
|
|
|
+ _curAutoRunCount++;
|
|
|
+ if (_curAutoRunCount >= AUTORUN_CYCLE_COUNT) {
|
|
|
+ pDcChargingInfo->SystemStatus = S_TERMINATING;
|
|
|
+ } else {
|
|
|
+ gettimeofday(&_autoTime, NULL);
|
|
|
+ }
|
|
|
+ } else {
|
|
|
+ pDcChargingInfo->EvBatterytargetVoltage = 0;
|
|
|
+ pDcChargingInfo->EvBatterytargetCurrent = 0;
|
|
|
+ }
|
|
|
+ }
|
|
|
+
|
|
|
+// printf("out : vol = %f, cur = %f \n",
|
|
|
+// pDcChargingInfo->EvBatterytargetVoltage,
|
|
|
+// pDcChargingInfo->EvBatterytargetCurrent);
|
|
|
+ //ev task do this
|
|
|
+ pDcChargingInfo->PresentChargingPower =
|
|
|
+ ((float)((pDcChargingInfo->PresentChargingVoltage) *
|
|
|
+ (pDcChargingInfo->PresentChargingCurrent)) / 1000);
|
|
|
+
|
|
|
+ if (pDcChargingInfo->GroundFaultStatus == 0x02) {
|
|
|
+ printf ("Charging Ground Fault check Fail (%d)\n",
|
|
|
+ pDcChargingInfo->GroundFaultStatus);
|
|
|
+ pDcChargingInfo->SystemStatus = S_TERMINATING;
|
|
|
+ }
|
|
|
+ break;
|
|
|
+
|
|
|
+ case S_TERMINATING:
|
|
|
+ if (PreviousSystemStatus[curGun] != pDcChargingInfo->SystemStatus) {
|
|
|
+ PreviousSystemStatus[curGun] = pDcChargingInfo->SystemStatus;
|
|
|
+
|
|
|
+ printf ("[UnconditionalCharge - S_TERMINATING]\n");
|
|
|
+ //無阻塞偵測 keybaord 結束
|
|
|
+ system(STTY_DEF TTY_PATH);
|
|
|
+ }
|
|
|
+
|
|
|
+ pDcChargingInfo->SystemStatus = S_COMPLETE;
|
|
|
+ break;
|
|
|
+
|
|
|
+ case S_COMPLETE:
|
|
|
+ if (PreviousSystemStatus[curGun] != pDcChargingInfo->SystemStatus) {
|
|
|
+ PreviousSystemStatus[curGun] = pDcChargingInfo->SystemStatus;
|
|
|
+
|
|
|
+ printf ("[UnconditionalCharge - S_COMPLETE]\n");
|
|
|
+ }
|
|
|
+
|
|
|
+ PreviousSystemStatus[curGun] = 0xFF;
|
|
|
+ stopChg = 0;
|
|
|
+ for (gunIndex = 0; gunIndex < pSysConfig->TotalConnectorCount; gunIndex++) {
|
|
|
+ if (PreviousSystemStatus[gunIndex] == 0xFF) {
|
|
|
+ pDcChargingInfo = (struct ChargingInfoData *)GetDcChargingInfoData(curGun);
|
|
|
+ pDcChargingInfo->SystemStatus = S_IDLE;
|
|
|
+ } else {
|
|
|
+ pSysInfo->CurGunSelected = gunIndex;
|
|
|
+ }
|
|
|
+
|
|
|
+ pDcChargingInfo = (struct ChargingInfoData *)GetDcChargingInfoData(gunIndex);
|
|
|
+ if (pDcChargingInfo->SystemStatus == S_IDLE) {
|
|
|
+ stopChg++;
|
|
|
+ }
|
|
|
+ }
|
|
|
+
|
|
|
+ pDcChargingInfo = (struct ChargingInfoData *)GetDcChargingInfoData(curGun);
|
|
|
+ pDcChargingInfo->PresentChargingPower = 0;
|
|
|
+
|
|
|
+ if (stopChg == pSysConfig->TotalConnectorCount) {
|
|
|
+ system("/root/Module_EvComm &");
|
|
|
+ sleep(3);
|
|
|
+
|
|
|
+ for (_GunIndex = 0; _GunIndex < pSysConfig->TotalConnectorCount; _GunIndex++) {
|
|
|
+ pDcChargingInfo = (struct ChargingInfoData *)GetDcChargingInfoData(_GunIndex);
|
|
|
+
|
|
|
+ pDcChargingInfo->SystemStatus = S_IDLE;
|
|
|
+ }
|
|
|
+ return;
|
|
|
+ }
|
|
|
+ break;
|
|
|
+ }
|
|
|
+
|
|
|
+ if (readCmdKey(CMD_KEY_DONT_WAIT) == NO) {
|
|
|
+ continue;
|
|
|
+ }
|
|
|
+
|
|
|
+ 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;
|
|
|
+ }
|
|
|
+
|
|
|
+ if (atoi(newString[1]) == pSysInfo->CurGunSelected) {
|
|
|
+ continue;
|
|
|
+ }
|
|
|
+
|
|
|
+ _GunIndex = atoi((char *)newString[1]);
|
|
|
+ _Voltage = atof((char *)newString[2]);
|
|
|
+ _Current = atof((char *)newString[3]);
|
|
|
+
|
|
|
+ printf ("Power = %d, ReqVoltage = %f, ReqCurrent = %f\n",
|
|
|
+ pSysConfig->MaxChargingPower,
|
|
|
+ _Voltage,
|
|
|
+ _Current);
|
|
|
+
|
|
|
+ if (_Voltage > 1000 || _Voltage < 50) {
|
|
|
+ _Voltage = 200;
|
|
|
+ printf ("Input Voltage over range\n");
|
|
|
+ continue;
|
|
|
+ }
|
|
|
+
|
|
|
+ pSysInfo->CurGunSelected = _GunIndex;
|
|
|
+ strcpy((char *)pSysConfig->UserId, "");
|
|
|
+ } else if (strcmp(newString[0], "chg") == 0) {
|
|
|
+ if (strcmp(newString[1], "-1") == 0) {
|
|
|
+ continue;
|
|
|
+ }
|
|
|
+
|
|
|
+ if (strcmp(newString[2], "-1") == 0 ||
|
|
|
+ strcmp(newString[2], "") == 0) {
|
|
|
+ continue;
|
|
|
+ }
|
|
|
+
|
|
|
+ if (strcmp(newString[3], "-1") == 0 ||
|
|
|
+ strcmp(newString[3], "") == 0) {
|
|
|
+ continue;
|
|
|
+ }
|
|
|
+
|
|
|
+ _GunIndex = atoi((char *)newString[1]);
|
|
|
+ float _vol = atof(newString[2]);
|
|
|
+ float _cur = atof(newString[3]);
|
|
|
+
|
|
|
+ if (_cur <= 0 || _cur <= 0) {
|
|
|
+ continue;
|
|
|
+ }
|
|
|
+
|
|
|
+ pDcChargingInfo = (struct ChargingInfoData *)GetDcChargingInfoData(_GunIndex);
|
|
|
+
|
|
|
+ printf("reset vol = %f, cur = %f \n", _vol, _cur);
|
|
|
+ pDcChargingInfo->EvBatterytargetVoltage = _vol;
|
|
|
+ pDcChargingInfo->EvBatterytargetCurrent = _cur;
|
|
|
+ } else if (strcmp(newString[0], "c") == 0) {
|
|
|
+ if (strcmp(newString[1], "-1") == 0 ||
|
|
|
+ strcmp(newString[1], "") == 0) {
|
|
|
+ printf("argc 1 is error parameter\r\n");
|
|
|
+ continue;
|
|
|
+ }
|
|
|
+
|
|
|
+ if (atoi((char *)newString[1]) != -1) {
|
|
|
+ pSysInfo->CurGunSelected = atoi((char *)newString[1]);
|
|
|
+ }
|
|
|
+ printf("stop \n\r");
|
|
|
+
|
|
|
+ pSysInfo->StartToChargingFlag = 0x00;
|
|
|
+
|
|
|
+ pDcChargingInfo = (struct ChargingInfoData *)GetDcChargingInfoData( pSysInfo->CurGunSelected);
|
|
|
+
|
|
|
+ pDcChargingInfo->SystemStatus = S_TERMINATING;
|
|
|
+ } else if (helpCmd() == YES) {
|
|
|
+ printf("%s\n", usageMsg);
|
|
|
+ }
|
|
|
+
|
|
|
+ usleep(100000);
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+int printTimeMsg(const char *fmt, ...)
|
|
|
+{
|
|
|
+ char Buf[4096 + 256] = {0};
|
|
|
+ char buffer[4096] = {0};
|
|
|
+ int rc = -1;
|
|
|
+ va_list args;
|
|
|
+ struct timeb SeqEndTime;
|
|
|
+ struct tm *tm;
|
|
|
+ struct SysConfigData *pSysConfig = (struct SysConfigData *)GetShmSysConfigData();
|
|
|
+
|
|
|
+ va_start(args, fmt);
|
|
|
+ rc = vsnprintf(buffer, sizeof(buffer), fmt, args);
|
|
|
+ va_end(args);
|
|
|
+
|
|
|
+ ftime(&SeqEndTime);
|
|
|
+ SeqEndTime.time = time(NULL);
|
|
|
+ tm = localtime(&SeqEndTime.time);
|
|
|
+
|
|
|
+ sprintf(Buf, "%02d:%02d:%02d:%03d - %s",
|
|
|
+ tm->tm_hour,
|
|
|
+ tm->tm_min,
|
|
|
+ tm->tm_sec,
|
|
|
+ SeqEndTime.millitm,
|
|
|
+ buffer);
|
|
|
+ printf("%s", Buf);
|
|
|
+
|
|
|
+ return rc;
|
|
|
+}
|
|
|
+
|
|
|
+static void resdGunAndChillerTemp(void)
|
|
|
+{
|
|
|
+ int isContinue = 1;
|
|
|
+ uint8_t i = 0;
|
|
|
+ uint32_t sleepTime = 500000;
|
|
|
+ uint32_t loopTime = 1000;
|
|
|
+ struct timeb showTime;
|
|
|
+ struct timeb nowTime;
|
|
|
+
|
|
|
+ char *usageMsg = "Usage:\n"
|
|
|
+ " t <index>: loop time, ex: t 1\n"
|
|
|
+ " exit | c | C: exit test\n"
|
|
|
+ " h | help | ?: show usage message\n"
|
|
|
+ "\r\n";
|
|
|
+
|
|
|
+ ftime(&showTime);
|
|
|
+
|
|
|
+ while (isContinue) {
|
|
|
+ ftime(&nowTime);
|
|
|
+
|
|
|
+ if (DiffTimeb(showTime, nowTime) > loopTime ||
|
|
|
+ DiffTimeb(showTime, nowTime) < 0) {
|
|
|
+ for (i = 0; i < pSysConfig->TotalConnectorCount; i++) {
|
|
|
+
|
|
|
+ pDcChargingInfo = (struct ChargingInfoData *)GetDcChargingInfoData(i);
|
|
|
+
|
|
|
+ printTimeMsg("get gun %d temp = %3d, chiller = %3d, ConnTemp = %3d, %3d,SysTemp = %3d, %3d, %3d, %3d\r\n",
|
|
|
+ i,
|
|
|
+ pDcChargingInfo->ConnectorTemp,
|
|
|
+ pDcChargingInfo->ChillerTemp,
|
|
|
+ ShmDcCommonData->ConnectorTemp[i][0],
|
|
|
+ ShmDcCommonData->ConnectorTemp[i][1],
|
|
|
+ ShmDcCommonData->SystemTemp[0],
|
|
|
+ ShmDcCommonData->SystemTemp[1],
|
|
|
+ ShmDcCommonData->SystemTemp[2],
|
|
|
+ ShmDcCommonData->SystemTemp[3]);
|
|
|
+ }//for
|
|
|
+ ftime(&showTime);
|
|
|
+ }
|
|
|
+
|
|
|
+ if (readCmdKey(CMD_KEY_DONT_WAIT) == NO) {
|
|
|
+ usleep(sleepTime);
|
|
|
+ continue;
|
|
|
+ }
|
|
|
+
|
|
|
+ if (strcmp(newString[0], "t") == 0) {
|
|
|
+ if (strcmp(newString[1], "-1") == 0 ||
|
|
|
+ strcmp(newString[1], "") == 0 ||
|
|
|
+ atoi((char *)newString[1]) > 255
|
|
|
+ ) {
|
|
|
+ printf("argc 1 is error parameter\r\n");
|
|
|
+ continue;
|
|
|
+ }
|
|
|
+
|
|
|
+ loopTime = ((atoi((char *)newString[1])) * 1000);
|
|
|
+ printf("loopTime = %d\r\n", loopTime);
|
|
|
+ ftime(&showTime);
|
|
|
+ continue;
|
|
|
+ } else if (exitCmd() == YES) {
|
|
|
+ return;
|
|
|
+ } else if (helpCmd() == YES) {
|
|
|
+ printf ("%s\n", usageMsg);
|
|
|
+ }
|
|
|
+
|
|
|
+ usleep(sleepTime);
|
|
|
+ }//while
|
|
|
+}
|
|
|
+static void writeOTPTemp(void)
|
|
|
+{
|
|
|
+ uint8_t _GunIndex = 0;
|
|
|
+ int isContinue = 1;
|
|
|
+ uint32_t sleepTime = 500000;
|
|
|
+ char *usageMsg = "Usage:\n"
|
|
|
+ " OTP <temp_recovery> <temp>, ex: OTP 140 150\n"
|
|
|
+ " exit | c | C\n"
|
|
|
+ " help | ? | h\n"
|
|
|
+ "\r\n";
|
|
|
+
|
|
|
+ while (isContinue) {
|
|
|
+ if (readCmdKey(CMD_KEY_WAIT) == NO) {
|
|
|
+ sleep(sleepTime);
|
|
|
+ continue;
|
|
|
+ }
|
|
|
+
|
|
|
+ if (helpCmd() == YES) {
|
|
|
+ printf ("%s\n", usageMsg);
|
|
|
+ continue;
|
|
|
+ } else if (exitCmd() == YES) {
|
|
|
+ sleep(1);
|
|
|
+ return;
|
|
|
+ }
|
|
|
+ if (strcmp(newString[0], "OTP") != 0) {
|
|
|
+ printf("argc 1 is error parameter\r\n");
|
|
|
+ continue;
|
|
|
+ }
|
|
|
+
|
|
|
+ if (atoi(newString[1]) > 255 ||
|
|
|
+ atoi(newString[1]) == -1) {
|
|
|
+ printf("Recovey temperature value overflow\r\n");
|
|
|
+ continue;
|
|
|
+ }
|
|
|
+
|
|
|
+ if (atoi(newString[2]) > 255 ||
|
|
|
+ atoi(newString[2]) == -1) {
|
|
|
+ printf("Recovey temperature value overflow\r\n");
|
|
|
+ continue;
|
|
|
+ }
|
|
|
+
|
|
|
+ pSysInfo->OTPTempR = atoi(newString[1]);
|
|
|
+ pSysInfo->OTPTemp = atoi(newString[2]);
|
|
|
+
|
|
|
+ printf("OTP Recovery Temp set:%d\n",pSysInfo->OTPTempR);
|
|
|
+ printf("OTP Temp set:%d\n",pSysInfo->OTPTemp);
|
|
|
+ usleep(sleepTime);
|
|
|
+ }//while
|
|
|
+}
|
|
|
+
|
|
|
+static void writeGunAndChillerTemp(void)
|
|
|
+{
|
|
|
+ uint8_t _GunIndex = 0;
|
|
|
+ int isContinue = 1;
|
|
|
+ uint32_t sleepTime = 500000;
|
|
|
+ char *usageMsg = "Usage:\n"
|
|
|
+ " conn <index> <temp>, ex: conn 0 150\n"
|
|
|
+ " chiller <index> <temp>, ex: chiller 0 150\n"
|
|
|
+ " tempR\n"
|
|
|
+ " exit | c | C\n"
|
|
|
+ " help | ? | h\n"
|
|
|
+ "\r\n";
|
|
|
+
|
|
|
+ ShmDcCommonData->TestTemperature = YES;
|
|
|
+
|
|
|
+ while (isContinue) {
|
|
|
+ if (readCmdKey(CMD_KEY_WAIT) == NO) {
|
|
|
+ sleep(sleepTime);
|
|
|
+ continue;
|
|
|
+ }
|
|
|
+
|
|
|
+ if (helpCmd() == YES) {
|
|
|
+ printf ("%s\n", usageMsg);
|
|
|
+ continue;
|
|
|
+ } else if (exitCmd() == YES) {
|
|
|
+ ShmDcCommonData->TestTemperature = NO;
|
|
|
+ sleep(1);
|
|
|
+ return;
|
|
|
+ } else if (strcmp(newString[0], "tempR") == 0) {
|
|
|
+ resdGunAndChillerTemp();
|
|
|
+ }
|
|
|
+
|
|
|
+ if ((strcmp(newString[0], "chiller") != 0) &&
|
|
|
+ (strcmp(newString[1], "-1") == 0 ||
|
|
|
+ strcmp(newString[1], "") == 0)
|
|
|
+ ) {
|
|
|
+ printf("argc 1 is error parameter\r\n");
|
|
|
+ continue;
|
|
|
+ }
|
|
|
+
|
|
|
+ if (atoi(newString[2]) > 255 ||
|
|
|
+ atoi(newString[2]) == -1) {
|
|
|
+ printf("temperature value overflow\r\n");
|
|
|
+ continue;
|
|
|
+ }
|
|
|
+
|
|
|
+ _GunIndex = atoi((char *)newString[1]);
|
|
|
+
|
|
|
+ if (_GunIndex >= pSysConfig->TotalConnectorCount) {
|
|
|
+ printf("gun index over total connector\r\n");
|
|
|
+ continue;
|
|
|
+ }
|
|
|
+
|
|
|
+ if (strcmp(newString[0], "chiller") == 0) {//修改水冷機溫度值
|
|
|
+ if (_GunIndex >= 1) {
|
|
|
+ _GunIndex = 0; //只會有一個水冷機
|
|
|
+ }
|
|
|
+
|
|
|
+ pDcChargingInfo = (struct ChargingInfoData *)GetDcChargingInfoData(_GunIndex);
|
|
|
+ pDcChargingInfo->ChillerTemp = atoi(newString[2]);
|
|
|
+ printf("set %d chiller temperature = %d\r\n",
|
|
|
+ _GunIndex,
|
|
|
+ pDcChargingInfo->ChillerTemp);
|
|
|
+ } else if (strcmp(newString[0], "conn") == 0) {//修改槍頭溫度值
|
|
|
+ pDcChargingInfo = (struct ChargingInfoData *)GetDcChargingInfoData(_GunIndex);
|
|
|
+
|
|
|
+ pDcChargingInfo->ConnectorTemp = atoi(newString[2]);
|
|
|
+ printf("set %d connector temp = %d\r\n",
|
|
|
+ _GunIndex,
|
|
|
+ pDcChargingInfo->ConnectorTemp);
|
|
|
+ }
|
|
|
+
|
|
|
+ usleep(sleepTime);
|
|
|
+ }//while
|
|
|
+}
|
|
|
+
|
|
|
+int main(void)
|
|
|
+{
|
|
|
+ uint8_t _GunIndex = 0;
|
|
|
+ int isContinue = 1;
|
|
|
+ char *usageMsg = "Usage:\n"
|
|
|
+ " state <index> : get gun state\n"
|
|
|
+ " card : scanning card (x)\n"
|
|
|
+ " gun <index> : get gun plugit state\n"
|
|
|
+ " lock <index> : get gun locked state\n"
|
|
|
+ " sysid : test system ID\n"
|
|
|
+ " self : self test state (x)\n"
|
|
|
+ " version | v | -v : version of board (407 or relay or other)\n"
|
|
|
+ " update : update firmware\n"
|
|
|
+ " ac : get ac relay state (x) \n"
|
|
|
+ " cable <index> <state> : set ground fault state\n"
|
|
|
+ " pow <index> <power> : set power value\n"
|
|
|
+ " model : get system information\n"
|
|
|
+ " temp : get PSU temperature\n"
|
|
|
+ " fan <speed> : set fan board speed\n"
|
|
|
+ " strchg <auto> : auto test charging\n"
|
|
|
+ " strchg <index> <voltage <current> : select gun test charging\n"
|
|
|
+ " tempW : write connector header and Chiller temperature\r\n"
|
|
|
+ " tempR : print connector header and chiller temperature\r\n"
|
|
|
+ " OTP : Write OTP temperature\r\n"
|
|
|
+ "\r\n";
|
|
|
+
|
|
|
+ if (CreateAllCsuShareMemory() == FAIL) {
|
|
|
+ printf("create share memory error\r\n");
|
|
|
+ return FAIL;
|
|
|
+ }
|
|
|
+
|
|
|
+ MappingGunChargingInfo("ReadCmdline Task");
|
|
|
+
|
|
|
+ pSysConfig = (struct SysConfigData *)GetShmSysConfigData();
|
|
|
+ pSysInfo = (struct SysInfoData *)GetShmSysInfoData();
|
|
|
+ pSysWarning = (struct WARNING_CODE_INFO *)GetShmSysWarningInfo();
|
|
|
+
|
|
|
+ pAlarmCode = (struct AlarmCodeData *)GetShmAlarmCodeData();
|
|
|
+
|
|
|
+ ShmCHAdeMOData = (struct CHAdeMOData *)GetShmCHAdeMOData();
|
|
|
+ ShmGBTData = (struct GBTData *)GetShmGBTData();
|
|
|
+ ShmCcsData = (struct CcsData *)GetShmCcsData();
|
|
|
+
|
|
|
+ ShmPrimaryMcuData = (struct PrimaryMcuData *)GetShmPrimaryMcuData();
|
|
|
+ ShmFanModuleData = (struct FanModuleData *)GetShmFanModuleData();
|
|
|
+ ShmRelayModuleData = (struct RelayModuleData *)GetShmRelayModuleData();
|
|
|
+ ShmLedModuleData = (struct LedModuleData *)GetShmLedModuleData();
|
|
|
+ ShmPsuData = (struct PsuData *)GetShmPsuData();
|
|
|
+ ShmOCPP16Data = (struct OCPP16Data *)GetShmOCPP16Data();
|
|
|
+ ShmSelectGunInfo = (SelectGunInfo *)GetShmSelectGunInfo();
|
|
|
+ ShmDcCommonData = (DcCommonInfo *)GetShmDcCommonData();
|
|
|
+
|
|
|
+// for (_GunIndex = 0; _GunIndex < pSysConfig->TotalConnectorCount; _GunIndex++) {
|
|
|
+// pDcChargingInfo = (struct ChargingInfoData *)GetDcChargingInfoData(_GunIndex);
|
|
|
+
|
|
|
+// pDcChargingInfo->SystemStatus = S_IDLE;
|
|
|
+// }
|
|
|
+
|
|
|
+ while (isContinue) {
|
|
|
+ if (readCmdKey(CMD_KEY_WAIT) == NO) {
|
|
|
+ continue;
|
|
|
+ }
|
|
|
+
|
|
|
+ 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], "version") == 0 ||
|
|
|
+ strcmp(newString[0], "v") == 0 ||
|
|
|
+ strcmp(newString[0], "-v") == 0) {
|
|
|
+ //if (strcmp(newString[1], "-1") == 0 || strcmp(newString[1], "") == 0) {
|
|
|
+ // continue;
|
|
|
+ //}
|
|
|
+ // 取 FW 版號
|
|
|
+ GetFwVerProc();
|
|
|
+ } 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 if (strcmp(newString[0], "tempW") == 0) { //測試槍頭和水冷機溫度
|
|
|
+ writeGunAndChillerTemp();
|
|
|
+ } else if (strcmp(newString[0], "tempR") == 0) { //讀取槍頭和水冷機溫度
|
|
|
+ resdGunAndChillerTemp();
|
|
|
+ } else if (strcmp(newString[0], "OTP") == 0) { //測試槍頭和水冷機溫度
|
|
|
+ writeOTPTemp();
|
|
|
+ } else {
|
|
|
+ printf("%s\n", usageMsg);
|
|
|
+ }
|
|
|
+
|
|
|
+ sleep(1);
|
|
|
+ }//while
|
|
|
+
|
|
|
+ return 0;
|
|
|
+}
|
Simon Xue