csu3_am335x/EVSE/Projects/CCS/Apps/EvComm.c

#include<netinet/ip.h>
#include<arpa/inet.h>
#include <sys/types.h>
#include <sys/stat.h>
#include <fcntl.h>
#include <linux/termios.h>
#include <stdio.h>
#include <string.h>
#include <time.h>
#include <stdlib.h>
#include <sys/ipc.h>
#include <sys/shm.h>
#include <sys/mman.h>
#include <linux/sockios.h> 
#include <linux/socket.h>
#include <sys/socket.h>
#include <netinet/in.h>
#include <sys/time.h> 
#include <sys/timeb.h> 
#include <math.h>//for pow
#include <unistd.h>
#include <linux/if_packet.h>
#include <netinet/if_ether.h>
#include <net/if.h>
#include <netinet/ether.h>


#include "define.h"
#include "EvComm.h"

#define Debug

struct SysConfigAndInfo			*ShmSysConfigAndInfo;
struct StatusCodeData 			*ShmStatusCodeData;
struct CcsData				*ShmCcsData;
struct InternalComm			*ShmInternalComm;

pid_t						PilotDetectionPid;
enum MsgFlowStatus			V2gFlowStatus;
int 							RawSock;
unsigned char 					*RecvBuffer,*SendBuffer;
int 							RecvBufferSize=64*1024;
int 							SendBufferSize=64*1024;
struct MmeHeader 				SendMmePacket;
int							SendMmePacketSize
unsigned char					CsuMac[6],QcaMac[6],EvMac[6],SlacRunId[8];
struct sockaddr_ll 				DestSocketAddress;
struct ifreq 					Req;
unsigned int 					PwmStartTime;
struct timeb 					SeqStartTime,SeqEndTime;
unsigned char 					AagGroupsNum;

#ifdef SystemLogMessage
int StoreLogMsg(unsigned char *DataString)
{
	unsigned char Buf[256];
	time_t CurrentTime;
	struct tm *tm;
			
	memset(Buf,0,sizeof(Buf));
	CurrentTime = time(NULL);
	tm=localtime(&CurrentTime);
	sprintf(Buf,"echo \"%04d.%02d.%02d %02d:%02d:%02d - %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,
			DataString,
			tm->tm_year+1900,tm->tm_mon+1);
	system(Buf);
	#ifdef Debug
	printf("%s \n",DataString);
	#endif
}		
#endif

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 CreatShareMemory()
{
	int MeterSMId;
	
	//creat ShmSysConfigAndInfo
	if ((MeterSMId = shmget(ShmSysConfigAndInfoKey, sizeof(struct SysConfigAndInfo), IPC_CREAT | 0777)) < 0) 
    	{
		#ifdef SystemLogMessage	
		StoreLogMsg("[main]CreatShareMemory:shmget ShmSysConfigAndInfo NG");
		#endif			
		return 0;
	}
    	else if ((ShmSysConfigAndInfo = shmat(MeterSMId, NULL, 0)) == (void *) -1) 
    	{
    		#ifdef SystemLogMessage	
		StoreLogMsg("[main]CreatShareMemory:shmat ShmSysConfigAndInfo NG");
		#endif		
		return 0;
   	 }
   	 memset(ShmSysConfigAndInfo,0,sizeof(struct SysConfigAndInfo));
   	 //creat ShmStatusCodeData
   	 if ((MeterSMId = shmget(ShmStatusCodeKey, sizeof(struct StatusCodeData), IPC_CREAT | 0777)) < 0) 
    	{
		#ifdef SystemLogMessage	
		StoreLogMsg("[main]CreatShareMemory:shmget ShmStatusCodeData NG");
		#endif		
		return 0;	
	}
    	else if ((ShmStatusCodeData = shmat(MeterSMId, NULL, 0)) == (void *) -1) 
    	{
    		#ifdef SystemLogMessage	
		StoreLogMsg("[main]CreatShareMemory:shmat ShmStatusCodeData NG");
		#endif		
		return 0;
   	 }
   	 memset(ShmStatusCodeData,0,sizeof(struct StatusCodeData));
   	 //creat ShmCcsData
   	 if ((MeterSMId = shmget(ShmCcsCommKey, sizeof(struct CcsData), IPC_CREAT | 0777)) < 0) 
    	{
		#ifdef SystemLogMessage	
		StoreLogMsg("[main]CreatShareMemory:shmget ShmCcsData NG");
		#endif			
		return 0;
	}
    	else if ((ShmCcsData = shmat(MeterSMId, NULL, 0)) == (void *) -1) 
    	{
    		#ifdef SystemLogMessage	
		StoreLogMsg("[main]CreatShareMemory:shmat ShmCcsData NG");
		#endif		
		return 0;
   	 }
   	 memset(ShmCcsData,0,sizeof(struct CcsData));
    	return 1;
}

int InitShareMemory()
{
	int MeterSMId;
	
	//creat ShmSysConfigAndInfo
	if ((MeterSMId = shmget(ShmSysConfigAndInfoKey, sizeof(struct SysConfigAndInfo),  0777)) < 0) 
    	{
		#ifdef SystemLogMessage	
		StoreLogMsg("[CsuComm]InitShareMemory:shmget ShmSysConfigAndInfo NG");
		#endif			
		return 0;
	}
    	else if ((ShmSysConfigAndInfo = shmat(MeterSMId, NULL, 0)) == (void *) -1) 
    	{
    		#ifdef SystemLogMessage	
		StoreLogMsg("[CsuComm]InitShareMemory:shmat ShmSysConfigAndInfo NG");
		#endif		
		return 0;
   	 }
   	 //creat ShmStatusCodeData
   	 if ((MeterSMId = shmget(ShmStatusCodeKey, sizeof(struct StatusCodeData),  0777)) < 0) 
    	{
		#ifdef SystemLogMessage	
		StoreLogMsg("[CsuComm]InitShareMemory:shmget ShmStatusCodeData NG");
		#endif		
		return 0;	
	}
    	else if ((ShmStatusCodeData = shmat(MeterSMId, NULL, 0)) == (void *) -1) 
    	{
    		#ifdef SystemLogMessage	
		StoreLogMsg("[CsuComm]InitShareMemory:shmat ShmStatusCodeData NG");
		#endif		
		return 0;
   	 }

   	 //creat ShmCcsData
   	 if ((MeterSMId = shmget(ShmCcsCommKey, sizeof(struct CcsData),  0777)) < 0) 
    	{
		#ifdef SystemLogMessage	
		StoreLogMsg("[CsuComm]InitShareMemory:shmget ShmCcsData NG");
		#endif			
		return 0;
	}
    	else if ((ShmCcsData = shmat(MeterSMId, NULL, 0)) == (void *) -1) 
    	{
    		#ifdef SystemLogMessage	
		StoreLogMsg("[CsuComm]InitShareMemory:shmat ShmCcsData NG");
		#endif		
		return 0;
   	 }
   	 
   	  //creat ShmInternalComm
   	 if ((MeterSMId = shmget(ShmInternalCommKey, sizeof(struct InternalComm),   0777)) < 0) 
    	{
		#ifdef SystemLogMessage	
		StoreLogMsg("[CsuComm]InitShareMemory:shmget ShmInternalComm NG");
		#endif			
		return 0;
	}
    	else if ((ShmInternalComm = shmat(MeterSMId, NULL, 0)) == (void *) -1) 
    	{
    		#ifdef SystemLogMessage	
		StoreLogMsg("[CsuComm]InitShareMemory:shmat ShmInternalComm NG");
		#endif		
		return 0;
   	 }
   	 
    	return 1;
}

int GetEthMac(unsigned char *Eth, unsigned char *mac)
{
	//Parameters:MAC,IP,Mask,Gateway
    	int fd,rd=0;
	unsigned char addr[18], Buffer[128];
	
	memset(Buffer,0,sizeof(Buffer));
	sprintf(Buffer,"cat /sys/class/net/%s/address > /mnt/GetEthInfo",Eth);
	system(Buffer);
	fd = open("/mnt/GetEthInfo", O_RDONLY);
	if(fd<0)
	{
		system("rm -f /mnt/GetEthInfo");
		#ifdef SystemLogMessage	
		StoreLogMsg("[EvComm]GetEthMac: MAC Address open error");
		#endif		
	        return 0;
	}
    	memset(mac,0,6);
    	memset(addr,0,sizeof(addr));
    	rd=read(fd,addr,17);	
    	close(fd);
    	system("rm -f /mnt/GetEthInfo");
    	sscanf(addr, "%02x:%02x:%02x:%02x:%02x:%02x", &mac[0], &mac[1], &mac[2], &mac[3], &mac[4], &mac[5]); 
    	return 1;
}

float ReadAdcVolt(unsigned char AdcChannel)
{
    	FILE *fp; 
	unsigned char str[64];
	unsigned char AdcValue[8];
	
	if(AdcChannel>7)
		return -1;
	memset(str,0,sizeof(str));
	memset(AdcValue,0,sizeof(AdcValue));
	sprintf(str,"cat /sys/bus/iio/devices/iio\\:device0/in_voltage%d_raw",AdcChannel);	    
   	fp=popen(str, "r"); 
    	if(fgets(AdcValue,sizeof(AdcValue),fp)==NULL)
    	{	
    		pclose(fp);
    		 return -1;	 
    	}
    	pclose(fp);
    	//Vin =  Vref *D / (2^n - 1) 
    	return ((float)1.8*(float)atoi(AdcValue))/4095;
}

void Qca7kPowerReset()
{
	system("echo 1 > /sys/class/gpio/gpio88/value");
	usleep(500000);
	system("echo 0 > /sys/class/gpio/gpio88/value");
}

void SwitchCpStateE(unsigned char OnOff)
{
	//OnOff=1 => switch State to E
	//OnOff=0 => return noraml 
	if(OnOff==0)
		system("echo 0 > /sys/class/gpio/gpio86/value");
	else
		system("echo 1 > /sys/class/gpio/gpio86/value");	
}

int OutputCpPwmDuty(unsigned char Duty)
{
	unsigned char str[128];
	int DutyInNanoSec;
	
	if((Duty<0)||(Duty>100))
		return -1;
		
	memset(str,0,sizeof(str));
	DutyInNanoSec=10000*Duty;	
	sprintf(str,"echo %d > /sys/class/pwm/pwmchip0/pwm0/duty_cycle",DutyInNanoSec);//nanoseconds
	system(str);
	ShmSysConfigAndInfo->SysInfo.CcsChargingData[0].PilotDuty=Duty;
	return 0;
}

int ConnectorPlugIn()
{
	//return 0 => unplug
	//return 1 => plug-in
	float TmpProximity;
	unsigned char Rtn=0;
	
	if(((FirmwareVersion&0x0000FF00)>>8)==0x01)
	{
		//UL version: judge with CP and proximity
		TmpProximity=ReadAdcVolt(2);
		if((ShmSysConfigAndInfo->SysInfo.CcsChargingData[0].PilotState>=2)&&(ShmSysConfigAndInfo->SysInfo.CcsChargingData[0].PilotState<=5)&&
			(TmpProximity>=0.4)&&(TmpProximity<=0.9))
		{
			Rtn=1;
		}  
	}	
	else
	{
		//CE version: judge with CP only
		if((ShmSysConfigAndInfo->SysInfo.CcsChargingData[0].PilotState>=2)&&(ShmSysConfigAndInfo->SysInfo.CcsChargingData[0].PilotState<=5))
			Rtn=1;
	}
	ShmSysConfigAndInfo->SysInfo.CcsChargingData[0].ConnectorPlugIn=Rtn;
	return Rtn;	
} 

void PilotDetection()
{
	pid_t tmp=0;
	struct timeb StartTime,EndTime;
	unsigned char CpState[3],count;
	float TmpVolt;
	
	if(PilotDetectionPid==0)
	{
		tmp=fork();
		if(tmp>0)
		{
			PilotDetectionPid=tmp;	
			{
				unsigned char buf[64];
				memset(buf,0,sizeof(buf));
				sprintf(buf,"renice -20 -p %d",tmp);
				system(buf);
			}
			return;
		}
	}
	
	while(1)
	{
		//ADC_Voltage = (1+RE62/RE63)*0.9 - (RE62/RE63)*Pilot_Voltage, 	RE62/RE63=0.06
		//=>Pilot_Voltage=(0.954-ADC_Voltage)/0.06
		//ftime(&StartTime);	
		TmpVolt=0;
		for(count=0;count<3;count++)
		{
			TmpVolt+=(0.954-ReadAdcVolt(3))/0.06;
		}	
		TmpVolt/=3;
		ShmSysConfigAndInfo->SysInfo.CcsChargingData[0].PilotVoltage=TmpVolt;
		if(TmpVolt>=13.5)
		{
			//Pilot Error
			if((ShmSysConfigAndInfo->SysInfo.CcsChargingData[0].PilotState==1)&&(TmpVolt<13.75))
				ShmSysConfigAndInfo->SysInfo.CcsChargingData[0].PilotState=1;
			else		
				ShmSysConfigAndInfo->SysInfo.CcsChargingData[0].PilotState=8;	
		}
		else if((TmpVolt>=10.5)&&(TmpVolt<13.5))
		{
			//State A
			if((ShmSysConfigAndInfo->SysInfo.CcsChargingData[0].PilotState>=2)&&(ShmSysConfigAndInfo->SysInfo.CcsChargingData[0].PilotState<=3)&&(TmpVolt<10.75))
			{	
				if((ShmSysConfigAndInfo->SysInfo.CcsChargingData[0].PilotDuty>=5)&&(ShmSysConfigAndInfo->SysInfo.CcsChargingData[0].PilotDuty<100))
					ShmSysConfigAndInfo->SysInfo.CcsChargingData[0].PilotState=3;
				else
					ShmSysConfigAndInfo->SysInfo.CcsChargingData[0].PilotState=2;	
			}
			else if((ShmSysConfigAndInfo->SysInfo.CcsChargingData[0].PilotState==8)&&(TmpVolt>=13.25))
				ShmSysConfigAndInfo->SysInfo.CcsChargingData[0].PilotState=8;	
			else
				ShmSysConfigAndInfo->SysInfo.CcsChargingData[0].PilotState=1;	
		}	
		else if((TmpVolt>=7.5)&&(TmpVolt<10.5))
		{
			//State B
			if((ShmSysConfigAndInfo->SysInfo.CcsChargingData[0].PilotState==4)&&(TmpVolt<7.75))
				ShmSysConfigAndInfo->SysInfo.CcsChargingData[0].PilotState=4;
			else if((ShmSysConfigAndInfo->SysInfo.CcsChargingData[0].PilotState==1)&&(TmpVolt>=10.25))
				ShmSysConfigAndInfo->SysInfo.CcsChargingData[0].PilotState=1;	
			else
			{
				if((ShmSysConfigAndInfo->SysInfo.CcsChargingData[0].PilotDuty>=5)&&(ShmSysConfigAndInfo->SysInfo.CcsChargingData[0].PilotDuty<100))
					ShmSysConfigAndInfo->SysInfo.CcsChargingData[0].PilotState=3;
				else
					ShmSysConfigAndInfo->SysInfo.CcsChargingData[0].PilotState=2;	
			}		
		}	
		else if((TmpVolt>=4.5)&&(TmpVolt<7.5))
		{
			//State C
			if((ShmSysConfigAndInfo->SysInfo.CcsChargingData[0].PilotState==5)&&(TmpVolt<4.75))
				ShmSysConfigAndInfo->SysInfo.CcsChargingData[0].PilotState=5;
			else if((ShmSysConfigAndInfo->SysInfo.CcsChargingData[0].PilotState>=2)&&(ShmSysConfigAndInfo->SysInfo.CcsChargingData[0].PilotState<=3)&&(TmpVolt>=7.25))
			{
				if((ShmSysConfigAndInfo->SysInfo.CcsChargingData[0].PilotDuty>=5)&&(ShmSysConfigAndInfo->SysInfo.CcsChargingData[0].PilotDuty<100))
					ShmSysConfigAndInfo->SysInfo.CcsChargingData[0].PilotState=3;
				else
					ShmSysConfigAndInfo->SysInfo.CcsChargingData[0].PilotState=2;	
			}
			else
			{
				ShmSysConfigAndInfo->SysInfo.CcsChargingData[0].PilotState=4;	
			}		
		}	
		else if((TmpVolt>=1.5)&&(TmpVolt<4.5))
		{
			//State D
			if((ShmSysConfigAndInfo->SysInfo.CcsChargingData[0].PilotState==6)&&(TmpVolt<1.75))
				ShmSysConfigAndInfo->SysInfo.CcsChargingData[0].PilotState=6;
			else if((ShmSysConfigAndInfo->SysInfo.CcsChargingData[0].PilotState==4)&&(TmpVolt>=4.25))
				ShmSysConfigAndInfo->SysInfo.CcsChargingData[0].PilotState=4;	
			else
			{
				ShmSysConfigAndInfo->SysInfo.CcsChargingData[0].PilotState=5;	
			}		
		}		
		else if((TmpVolt>= -1.5)&&(TmpVolt<1.5))
		{
			//State E
			if((ShmSysConfigAndInfo->SysInfo.CcsChargingData[0].PilotState==8)&&(TmpVolt< -1.25))
				ShmSysConfigAndInfo->SysInfo.CcsChargingData[0].PilotState=8;
			else if((ShmSysConfigAndInfo->SysInfo.CcsChargingData[0].PilotState==5)&&(TmpVolt>=1.25))
				ShmSysConfigAndInfo->SysInfo.CcsChargingData[0].PilotState=5;	
			else
			{
				ShmSysConfigAndInfo->SysInfo.CcsChargingData[0].PilotState=6;	
			}		
		}		
		else if((TmpVolt>= -13.5)&&(TmpVolt< -10.5))
		{
			//State F
			if((ShmSysConfigAndInfo->SysInfo.CcsChargingData[0].PilotState==8)&&(TmpVolt>= -10.75))
				ShmSysConfigAndInfo->SysInfo.CcsChargingData[0].PilotState=8;	
			else
			{
				ShmSysConfigAndInfo->SysInfo.CcsChargingData[0].PilotState=7;	
			}		
		}		
		//ftime(&EndTime);	
		//printf("duration:%d\n", DiffTimeb(StartTime, EndTime));
	}//while
}

int MmeProcess(unsigned char *Buffer, int DataLength)
{
	//struct ethhdr	*EthPacket;
	struct MmeHeader	*MmePacket;
	int Rtn;
	static unsigned char counter;
	static unsigned short Aag[64];
	
	MmePacket = (struct MmeHeader *)Buffer;
	#ifdef Debug
	printf("\n***** Received MME Packet *****\n");
	printf("DataLength=%d\n",DataLength);
	printf("ODA: %02x:%02x:%02x:%02x:%02x:%02x\n", 
		MmePacket->ODA[0],MmePacket->ODA[1],MmePacket->ODA[2],MmePacket->ODA[3],MmePacket->ODA[4],MmePacket->ODA[5]);
	printf("OSA: %02x:%02x:%02x:%02x:%02x:%02x\n", 
		MmePacket->OSA[0],MmePacket->OSA[1],MmePacket->OSA[2],MmePacket->OSA[3],MmePacket->OSA[4],MmePacket->OSA[5]);
	printf("MTYPE: 0x%x\n", htons(MmePacket->MTYPE));
	printf("MMV: 0x%x\n", MmePacket->MMV);
	printf("MMTYPE: 0x%x\n", MmePacket->MMTYPE);
	printf("FMI 0x%x, 0x%x\n", MmePacket->FMI[0],MmePacket->FMI[1]);
	#endif
	//check if the destination address is broadcast or EVSE itself, it can be ignore if not belong to itself.  
	switch(MmePacket->MMTYPE)
	{
		case MMTYPE_CM_SLAC_PARM_REQ:
			#ifdef Debug
			printf("--- CM_SLAC_PARM_REQ ---\n");
			printf("APPLICATION_TYPE: 0x%x\n", MmePacket->MMENTRY[0]);
			printf("SECURITY_TYPE: 0x%x\n", MmePacket->MMENTRY[1]);
			printf("RunID: %02x,%02x,%02x,%02x,%02x,%02x,%02x,%02x\n", 
				MmePacket->MMENTRY[2],MmePacket->MMENTRY[3],MmePacket->MMENTRY[4],MmePacket->MMENTRY[5],MmePacket->MMENTRY[6],
				MmePacket->MMENTRY[7],MmePacket->MMENTRY[8],MmePacket->MMENTRY[9]);
			printf("CipherSuiteSetSize: 0x%x\n", MmePacket->MMENTRY[10]);	
			printf("CipherSuite [1]: 0x%x,0x%x\n", MmePacket->MMENTRY[11], MmePacket->MMENTRY[12]);	
			#endif
			V2gFlowStatus=CM_SLAC_PARM_REQ;
			memcpy(EvMac,MmePacket->OSA,sizeof(EvMac));
			memcpy(DestSocketAddress.sll_addr,MmePacket->OSA,sizeof(EvMac));
			memcpy(SlacRunId,MmePacket->MMENTRY+2,sizeof(SlacRunId));
			memset(&SendMmePacket,0,sizeof(struct MmeHeader));
			memcpy(SendMmePacket.ODA,MmePacket->OSA,6);
			memcpy(SendMmePacket.OSA,CsuMac,6);
			SendMmePacket.MTYPE=htons(EtherType_HomePlug);
			SendMmePacket.MMV=MmePacket->MMV;
			SendMmePacket.MMTYPE=MMTYPE_CM_SLAC_PARM_CNF;
			SendMmePacket.FMI[0]=SendMmePacket.FMI[1]=0;
			SendMmePacketSize=0;
			memset(SendMmePacket.MMENTRY,0xFF,6);	//Fixed value indicating that M-Sounds to be sent as Ethernet broadcast
			SendMmePacketSize+=6;
			SendMmePacket.MMENTRY[SendMmePacketSize++]=C_EV_match_MNBC;
			SendMmePacket.MMENTRY[SendMmePacketSize++]=TT_EVSE_match_MNBC;
			SendMmePacket.MMENTRY[SendMmePacketSize++]=0x01;	//Fixed value indicating ¡§Other GP station¡¨, 0x00 ¡V HLE of the STA, 0x01 ¡V Another GP STA, 0x02 ¡V 0xFF ¡V Reserved
			memcpy(SendMmePacket.MMENTRY+SendMmePacketSize,EvMac,6);
			SendMmePacketSize+=6;
			SendMmePacket.MMENTRY[SendMmePacketSize++]=0;		//Fixed value indicating ¡§PEVEVSEMatching¡¨
			SendMmePacket.MMENTRY[SendMmePacketSize++]=0;		//Fixed value indicating ¡§No Security¡¨
			memcpy(SendMmePacket.MMENTRY+SendMmePacketSize,SlacRunId,sizeof(SlacRunId));
			SendMmePacketSize+=sizeof(SlacRunId);
			SendMmePacketSize+=19;	//the size before MMENTRY
			V2gFlowStatus=CM_SLAC_PARM_CONF;
			Rtn=sendto(RawSock, &SendMmePacket, SendMmePacketSize, 0, (struct sockaddr*)&DestSocketAddress, sizeof(struct sockaddr_ll));
			ftime(&SeqStartTime);	
			counter=0;
			#ifdef Debug
			printf("\n***** Response MME Packet *****\n");
			printf("SendMmePacketSize=%d,Rtn=%d\n",SendMmePacketSize,Rtn);
			printf("SendMmePacket->ODA: %02x:%02x:%02x:%02x:%02x:%02x:\n", 
				SendMmePacket.ODA[0],SendMmePacket.ODA[1],SendMmePacket.ODA[2],SendMmePacket.ODA[3],SendMmePacket.ODA[4],SendMmePacket.ODA[5]);
			printf("SendMmePacket->OSA: %02x:%02x:%02x:%02x:%02x:%02x:\n", 
				SendMmePacket.OSA[0],SendMmePacket.OSA[1],SendMmePacket.OSA[2],SendMmePacket.OSA[3],SendMmePacket.OSA[4],SendMmePacket.OSA[5]);
			printf("MTYPE: 0x%x\n", htons(SendMmePacket.MTYPE));
			printf("MMV: 0x%x\n", SendMmePacket.MMV);
			printf("MMTYPE: 0x%x\n", SendMmePacket.MMTYPE);
			printf("FMI 0x%x, 0x%x\n", SendMmePacket.FMI[0],SendMmePacket.FMI[1]);
			printf("--- CM_SLAC_PARM_CNF ---\n");
			printf("M-SOUND_TARGET: %02x:%02x:%02x:%02x:%02x:%02x\n", 
				SendMmePacket.MMENTRY[0],SendMmePacket.MMENTRY[1],SendMmePacket.MMENTRY[2],SendMmePacket.MMENTRY[3],
				SendMmePacket.MMENTRY[4],SendMmePacket.MMENTRY[5]);
			printf("NUM_SOUNDS: 0x%x\n", SendMmePacket.MMENTRY[6]);
			printf("Time_Out: 0x%x\n", SendMmePacket.MMENTRY[7]);
			printf("RESP_TYPE: 0x%x\n", SendMmePacket.MMENTRY[8]);
			printf("M-FORWARDING_STA: %02x:%02x:%02x:%02x:%02x:%02x:\n", 
				SendMmePacket.MMENTRY[9],SendMmePacket.MMENTRY[10],SendMmePacket.MMENTRY[11],SendMmePacket.MMENTRY[12],
				SendMmePacket.MMENTRY[13],SendMmePacket.MMENTRY[14]);
			printf("APPLICATION_TYPE: 0x%x\n", SendMmePacket.MMENTRY[15]);
			printf("SECURITY_TYPE: 0x%x\n", SendMmePacket.MMENTRY[16]);
			printf("RunID: %02x,%02x,%02x,%02x,%02x,%02x,%02x,%02x\n", 
				SendMmePacket.MMENTRY[17],SendMmePacket.MMENTRY[18],SendMmePacket.MMENTRY[19],SendMmePacket.MMENTRY[20],
				SendMmePacket.MMENTRY[21],SendMmePacket.MMENTRY[22],SendMmePacket.MMENTRY[23],SendMmePacket.MMENTRY[24]);
			#endif
			break;	
		case MMTYPE_CM_START_ATTEN_CHAR_IND:
			#ifdef Debug
			printf("--- CM_START_ATTEN_CHAR_IND (counter : %d) ---\n",counter+1);
			printf("APPLICATION_TYPE: 0x%x\n", MmePacket->MMENTRY[0]);
			printf("SECURITY_TYPE: 0x%x\n", MmePacket->MMENTRY[1]);
			printf("NUM_SOUNDS: 0x%x\n", MmePacket->MMENTRY[2]);
			printf("Time_Out 0x%x\n", MmePacket->MMENTRY[3]);
			printf("RESP_TYPE 0x%x\n", MmePacket->MMENTRY[4]);//Fixed value (0x01) indicating ¡§other Green PHY station¡¨
			printf("FORWARDING_STA: %02x:%02x:%02x:%02x:%02x:%02x\n", 
				MmePacket->MMENTRY[5],MmePacket->MMENTRY[6],MmePacket->MMENTRY[7],MmePacket->MMENTRY[8],
				MmePacket->MMENTRY[9],MmePacket->MMENTRY[10]);
			printf("RunID: %02x,%02x,%02x,%02x,%02x,%02x,%02x,%02x\n", 
				MmePacket.MMENTRY[11],MmePacket.MMENTRY[12],MmePacket.MMENTRY[13],MmePacket.MMENTRY[14],
				MmePacket.MMENTRY[15],MmePacket.MMENTRY[16],MmePacket.MMENTRY[17],MmePacket.MMENTRY[18]);	
			#endif
			V2gFlowStatus=CM_START_ATTEN_CHAR_IND;
			counter++;
			if(counter==1)
			{
				ftime(&SeqStartTime);	//start TT_EVSE_match_MNBC
				memset(Aag,0,sizeof(Aag));
			}	
			else if(counter>=3)
			{
				counter=0;
			}	
			break;	
		case MMTYPE_CM_MNBC_SOUND_IND:
			#ifdef Debug
			printf("--- MMTYPE_CM_MNBC_SOUND_IND (counter : %d) ---\n",counter+1);
			printf("APPLICATION_TYPE: 0x%x\n", MmePacket->MMENTRY[0]);
			printf("SECURITY_TYPE: 0x%x\n", MmePacket->MMENTRY[1]);
			printf("SenderID: %02x,%02x,%02x,%02x,%02x,%02x,%02x,%02x,%02x,%02x,%02x,%02x,%02x,%02x,%02x,%02x,%02x\n", 
				MmePacket.MMENTRY[2],MmePacket.MMENTRY[3],MmePacket.MMENTRY[4],MmePacket.MMENTRY[5],
				MmePacket.MMENTRY[6],MmePacket.MMENTRY[7],MmePacket.MMENTRY[8],MmePacket.MMENTRY[9],
				MmePacket.MMENTRY[10],MmePacket.MMENTRY[11],MmePacket.MMENTRY[12],MmePacket.MMENTRY[13],
				MmePacket.MMENTRY[14],MmePacket.MMENTRY[15],MmePacket.MMENTRY[16],MmePacket.MMENTRY[17],
				MmePacket.MMENTRY[18]);	
			printf("Cnt: 0x%x\n", MmePacket->MMENTRY[19]);
			printf("RunID: %02x,%02x,%02x,%02x,%02x,%02x,%02x,%02x\n", 
				MmePacket.MMENTRY[20],MmePacket.MMENTRY[21],MmePacket.MMENTRY[22],MmePacket.MMENTRY[23],
				MmePacket.MMENTRY[24],MmePacket.MMENTRY[25],MmePacket.MMENTRY[26],MmePacket.MMENTRY[27]);	
			printf("RSVD: %02x,%02x,%02x,%02x,%02x,%02x,%02x,%02x\n", 
				MmePacket.MMENTRY[28],MmePacket.MMENTRY[29],MmePacket.MMENTRY[30],MmePacket.MMENTRY[31],
				MmePacket.MMENTRY[32],MmePacket.MMENTRY[33],MmePacket.MMENTRY[34],MmePacket.MMENTRY[35]);		
			printf("Rnd: %02x,%02x,%02x,%02x,%02x,%02x,%02x,%02x,%02x,%02x,%02x,%02x,%02x,%02x,%02x,%02x,%02x\n", 
				MmePacket.MMENTRY[36],MmePacket.MMENTRY[37],MmePacket.MMENTRY[38],MmePacket.MMENTRY[39],
				MmePacket.MMENTRY[40],MmePacket.MMENTRY[41],MmePacket.MMENTRY[42],MmePacket.MMENTRY[43],
				MmePacket.MMENTRY[44],MmePacket.MMENTRY[45],MmePacket.MMENTRY[46],MmePacket.MMENTRY[47],
				MmePacket.MMENTRY[48],MmePacket.MMENTRY[49],MmePacket.MMENTRY[50],MmePacket.MMENTRY[51]);	
			#endif
			V2gFlowStatus=CM_MNBC_SOUND_IND;
			counter++;
			break;		
		case MMTYPE_CM_ATTEN_PROFILE_IND:
			#ifdef Debug
			printf("--- MMTYPE_CM_ATTEN_PROFILE_IND (counter : %d) ---\n",counter+1);
			printf("EV MAC: %02x:%02x:%02x:%02x:%02x:%02x\n", 
				MmePacket->MMENTRY[0],MmePacket->MMENTRY[1],MmePacket->MMENTRY[2],MmePacket->MMENTRY[3],
				MmePacket->MMENTRY[4],MmePacket->MMENTRY[5]);
			printf("NumGroups: 0x%x\n", MmePacket->MMENTRY[6]);	
			printf("RSVD: 0x%x\n", MmePacket->MMENTRY[7]);	
			printf("AAG: \n");	
			for(Rtn=0;Rtn<MmePacket->MMENTRY[6];Rtn++)
				printf("%02x, ",MmePacket->MMENTRY[8+Rtn]);
			printf("\n");	
			#endif
			AagGroupsNum=MmePacket->MMENTRY[6];
			for(Rtn=0;Rtn<MmePacket->MMENTRY[6];Rtn++)
				Aag[Rtn]+=MmePacket->MMENTRY[8+Rtn];
			//V2gFlowStatus=CM_MNBC_SOUND_IND;
			break;	
		case MMTYPE_CM_ATTN_CHAR_RSP:
			#ifdef Debug
			printf("--- MMTYPE_CM_ATTN_CHAR_RSP ---\n");
			printf("APPLICATION_TYPE: 0x%x\n", MmePacket->MMENTRY[0]);
			printf("SECURITY_TYPE: 0x%x\n", MmePacket->MMENTRY[1]);
			printf("SOURCE_ADDRESS: %02x:%02x:%02x:%02x:%02x:%02x\n", 
				MmePacket->MMENTRY[2],MmePacket->MMENTRY[3],MmePacket->MMENTRY[4],MmePacket->MMENTRY[5],
				MmePacket->MMENTRY[6],MmePacket->MMENTRY[7]);
			printf("RunID: %02x,%02x,%02x,%02x,%02x,%02x,%02x,%02x\n", 
				MmePacket.MMENTRY[8],MmePacket.MMENTRY[9],MmePacket.MMENTRY[10],MmePacket.MMENTRY[11],
				MmePacket.MMENTRY[12],MmePacket.MMENTRY[13],MmePacket.MMENTRY[14],MmePacket.MMENTRY[15]);		
			printf("SOURCE_ID: \n");	
			for(Rtn=0;Rtn<17;Rtn++)
				printf("%02x, ",MmePacket->MMENTRY[16+Rtn]);
			printf("\n");		
			printf("RESP_ID: \n");	
			for(Rtn=0;Rtn<17;Rtn++)
				printf("%02x, ",MmePacket->MMENTRY[33+Rtn]);
			printf("\n");		
			printf("Result: 0x%x\n", MmePacket->MMENTRY[50]);//Fixed value of 0x00 indicates a successful SLAC process
			#endif	
			V2gFlowStatus=CM_ATTEN_CHAR_RSP;
			break;
		default:
			break;
	}
}

int SlacComm()
{
	int packet_size,count;
	
	if(RawSock>=0)	
	{
		packet_size = recvfrom(RawSock , RecvBuffer , RecvBufferSize , 0 , NULL, NULL);
		#ifdef Debug
		printf("packet_size=%d\n",packet_size);
		#endif
		if(packet_size>0)
		{
			/*#ifdef Debug
			printf("Raw Data: ");
			for(count=0;count<packet_size;count++)
				printf("0x%x, ",RecvBuffer[count]);
			printf("\n");
			#endif*/
			MmeProcess(RecvBuffer, packet_size);
		}	
	}
	switch(V2gFlowStatus)
	{
		case Idle:
			if(RawSock<0)	
			{
				struct timeval	tv;
				RawSock= socket(PF_PACKET, SOCK_RAW, htons(EtherType_HomePlug));
				#ifdef Debug
				printf("RawSock=%d\n",RawSock);
				#endif
				if(RawSock == -1)
				{
					
					#ifdef SystemLogMessage	
					StoreLogMsg("[EvComm]SlacComm:Failed to create socke");
					#endif		
					V2gFlowStatus=Other_Fault;
				   	return -1;
				}
				setsockopt(RawSock, SOL_SOCKET, SO_BINDTODEVICE, "eth0", 4);
			    	tv.tv_sec = 0; 
			    	tv.tv_usec = 10000; 
			   	 if (setsockopt(RawSock, SOL_SOCKET, SO_RCVTIMEO, (char *)&tv, sizeof(struct	timeval)) < 0) 
			    	{
				       	#ifdef SystemLogMessage	
					StoreLogMsg("[EvComm]SlacComm:Set SO_RCVTIMEO NG");
					#endif	
					V2gFlowStatus=Other_Fault;
				   	return -1;	
			    	}
			    	memset(&Req, 0, sizeof(struct ifreq));
	    			strcpy( (char*)Req.ifr_name, /*QcaInterface*/"eth0");
				if (ioctl(RawSock, SIOCGIFINDEX, &Req) < 0)
				{
			    		#ifdef SystemLogMessage	
					StoreLogMsg("[EvComm]SlacComm: ioctl NG");
					#endif	
					V2gFlowStatus=Other_Fault;
				   	return -1;	
				}
				memset( &DestSocketAddress, 0, sizeof(struct sockaddr_ll) );
				//DestSocketAddress.sll_family   = PF_PACKET;
	  			//DestSocketAddress.sll_protocol = 0;
				DestSocketAddress.sll_ifindex = Req.ifr_ifindex;
				DestSocketAddress.sll_halen = ETH_ALEN;
				OutputCpPwmDuty(5);
				PwmStartTime=time(NULL);
			}	
			else
			{
				if((time(NULL)-PwmStartTime)>TT_EVSE_SLAC_init)
				{
					#ifdef SystemLogMessage	
					StoreLogMsg("[EvComm]SlacComm: Wait CM_SLAC_PARM_REQ Timeout - TT_EVSE_SLAC_init ");
					#endif	
					V2gFlowStatus=Sequence_Timeout;
				   	return -1;	
				}	
			}
			break;
		case CM_SLAC_PARM_CONF:
			ftime(&SeqEndTime);	
			if(DiffTimeb(SeqStartTime, SeqEndTime)>TT_match_sequence)
			{
				#ifdef SystemLogMessage	
				StoreLogMsg("[EvComm]SlacComm: Wait CM_START_ATTEN_CHAR_IND Timeout - TT_match_sequence ");
				#endif	
				V2gFlowStatus=Sequence_Timeout;
				return -1;	
			}	
			break;
		case CM_START_ATTEN_CHAR_IND:	
			ftime(&SeqEndTime);	
			if(DiffTimeb(SeqStartTime, SeqEndTime)>(3*TP_EV_batch_msg_interval))//one more time interval for tolerance 
			{
				#ifdef SystemLogMessage	
				StoreLogMsg("[EvComm]SlacComm: Wait CM_MNBC_SOUND_IND Timeout - 3*TP_EV_batch_msg_interval ");
				#endif	
				V2gFlowStatus=Sequence_Timeout;
				return -1;	
			}	
			break;
		case CM_MNBC_SOUND_IND:	
			ftime(&SeqEndTime);	
			if(DiffTimeb(SeqStartTime, SeqEndTime)>TT_EVSE_match_MNBC)
			{
				memset(&SendMmePacket,0,sizeof(struct MmeHeader));
				memcpy(SendMmePacket.ODA,EvMac,6);
				memcpy(SendMmePacket.OSA,CsuMac,6);
				SendMmePacket.MTYPE=htons(EtherType_HomePlug);
				SendMmePacket.MMV=0x01;
				SendMmePacket.MMTYPE=MMTYPE_CM_ATTN_CHAR_IND;
				SendMmePacket.FMI[0]=SendMmePacket.FMI[1]=0;
				SendMmePacketSize=0;
				SendMmePacket.MMENTRY[SendMmePacketSize++]=0;//APPLICATION_TYPE,  Fixed value indicating ¡§PEVEVSE matching¡¨
				SendMmePacket.MMENTRY[SendMmePacketSize++]=0;//SECURITY_TYPE, Fixed value indicating ¡§No Security¡¨
				memcpy(SendMmePacket.MMENTRY+SendMmePacketSize,EvMac,6);//SOURCE_ADDRESS, MAC address of the EV Host
				SendMmePacketSize+=6;
				memcpy(SendMmePacket.MMENTRY+SendMmePacketSize,SlacRunId,sizeof(SlacRunId));
				SendMmePacketSize+=sizeof(SlacRunId);
				memset(SendMmePacket.MMENTRY+SendMmePacketSize,0,17);//SOURCE_ID
				SendMmePacketSize+=17;
				memset(SendMmePacket.MMENTRY+SendMmePacketSize,0,17);//RESP_ID
				SendMmePacketSize+=17;
				SendMmePacket.MMENTRY[SendMmePacketSize++]=C_EV_match_MNBC;//NumSounds
				for(count=0;count<AagGroupsNum;count++)
					SendMmePacket.MMENTRY[SendMmePacketSize++]=(Aag[count]/C_EV_match_MNBC)&0xFF;
				SendMmePacketSize--;
				SendMmePacketSize+=19;	//the size before MMENTRY
				V2gFlowStatus=CM_ATTEN_CHAR_IND;
				count=sendto(RawSock, &SendMmePacket, SendMmePacketSize, 0, (struct sockaddr*)&DestSocketAddress, sizeof(struct sockaddr_ll));
				ftime(&SeqStartTime);	
			}	
			break;	
		case CM_ATTEN_CHAR_IND:	
			ftime(&SeqEndTime);	
			if(DiffTimeb(SeqStartTime, SeqEndTime)>TT_match_response)
			{
				#ifdef SystemLogMessage	
				StoreLogMsg("[EvComm]SlacComm: Wait CM_ATTEN_CHAR_RSP Timeout - TT_match_response ");
				#endif	
				V2gFlowStatus=Sequence_Timeout;
				return -1;	
			}	
			break;	
		defaudlt:
			break;		
	}	
    return 0;  
} 

int V2gComm()
{
	return 0;  
}
 
int main(int argc,char *argv[])
{

	//Initialization	
	//InitShareMemory();
	CreatShareMemory();
	//Qca7kPowerReset();
	//PilotDetectionPid=0;
	//PilotDetection();
	GetEthMac("eth0",CsuMac);
	GetEthMac(QcaInterface, QcaMac);
	RecvBuffer=(unsigned char *)malloc(RecvBufferSize);
	memset(RecvBuffer,0,RecvBufferSize);
	SendBuffer=(unsigned char *)malloc(SendBufferSize);
	memset(SendBuffer,0,SendBufferSize);
	RawSock=-1;
	V2gFlowStatus=0;
	while(1)
	{
		SlacComm();
		continue;
		
		if((ShmInternalComm->ChargingPermission==0x01)&&(ConnectorPlugIn()==1))
		{
			if(V2gFlowStatus<=CM_AMP_MAP_CNF)
				SlacComm();
			else 	if(V2gFlowStatus<=Performance_Timeout)
				V2gComm();
		}
		if(V2gFlowStatus>=Performance_Timeout)	
		{
			//Normal Stop
			//alarm and duty to 100%
			goto ReSet;
		}	
		else if((ConnectorPlugIn()==0)&&(V2gFlowStatus>Idle))
		{
			//Emergency stop
			goto ReSet;
		}	
ReSet:
		RawSock=-1;
		V2gFlowStatus=0;
		while(1)
		{
			//wait for CSU configrm
		}
	}//main while
}