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