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