csu3_am335x/EVSE/Projects/Taurus/Apps/InternalComm.c

#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 "../../define.h"


//#define Debug

struct SysConfigAndInfo			*ShmSysConfigAndInfo;
struct StatusCodeData 			*ShmStatusCodeData;
struct FanModuleData			*ShmFanModuleData;
struct RelayModuleData			*ShmRelayModuleData;


#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;
}	
	
/**************************************************************************************/
/**************************Init all share memory *********************************/
/**************************************************************************************/
int InitShareMemory()
{
	int MeterSMId;
	
	//creat ShmSysConfigAndInfo
	if ((MeterSMId = shmget(ShmSysConfigAndInfoKey, sizeof(struct SysConfigAndInfo),  0777)) < 0) 
    	{
		#ifdef SystemLogMessage	
		StoreLogMsg("[InternalComm]InitShareMemory:shmget ShmSysConfigAndInfo NG");
		#endif			
		return 0;
	}
    	else if ((ShmSysConfigAndInfo = shmat(MeterSMId, NULL, 0)) == (void *) -1) 
    	{
    		#ifdef SystemLogMessage	
		StoreLogMsg("[InternalComm]InitShareMemory:shmat ShmSysConfigAndInfo NG");
		#endif		
		return 0;
   	 }
   	 //creat ShmStatusCodeData
   	 if ((MeterSMId = shmget(ShmStatusCodeKey, sizeof(struct StatusCodeData),  0777)) < 0) 
    	{
		#ifdef SystemLogMessage	
		StoreLogMsg("[InternalComm]InitShareMemory:shmget ShmStatusCodeData NG");
		#endif		
		return 0;	
	}
    	else if ((ShmStatusCodeData = shmat(MeterSMId, NULL, 0)) == (void *) -1) 
    	{
    		#ifdef SystemLogMessage	
		StoreLogMsg("[InternalComm]InitShareMemory:shmat ShmStatusCodeData NG");
		#endif		
		return 0;
   	 }

   	//creat ShmFanModuleData
   	 if ((MeterSMId = shmget(ShmFanBdKey, sizeof(struct FanModuleData),  0777)) < 0) 
    	{
		#ifdef SystemLogMessage	
		StoreLogMsg("[InternalComm]InitShareMemory:shmget ShmFanModuleData NG");
		#endif			
		return 0;
	}
    	else if ((ShmFanModuleData = shmat(MeterSMId, NULL, 0)) == (void *) -1) 
    	{
    		#ifdef SystemLogMessage	
		StoreLogMsg("[InternalComm]InitShareMemory:shmat ShmFanModuleData NG");
		#endif		
		return 0;
   	 }
   	 memset(ShmFanModuleData,0,sizeof(struct FanModuleData));
   	 //creat ShmRelayModuleData
   	 if ((MeterSMId = shmget(ShmRelayBdKey, sizeof(struct RelayModuleData),  0777)) < 0) 
    	{
		#ifdef SystemLogMessage	
		StoreLogMsg("[InternalComm]InitShareMemory:shmget ShmRelayModuleData NG");
		#endif			
		return 0;
	}
    	else if ((ShmRelayModuleData = shmat(MeterSMId, NULL, 0)) == (void *) -1) 
    	{
    		#ifdef SystemLogMessage	
		StoreLogMsg("[InternalComm]InitShareMemory:shmat ShmRelayModuleData NG");
		#endif		
		return 0;
   	 }
    	return 1;
}

int InitComPort()
{
	int fd;
	struct termios tios;
	
	fd = open("/dev/ttyS4", O_RDWR);
	if(fd<=0)
	{ 
		#ifdef SystemLogMessage	
		StoreLogMsg("[InternalComm]InitComPort: open /dev/ttyS4 NG");
		#endif	
		return -1;
	}
	ioctl (fd, TCGETS, &tios);
	tios.c_cflag = B115200| CS8 | CLOCAL | CREAD; 
	tios.c_lflag = 0;
	tios.c_iflag = 0; 
	tios.c_oflag = 0;
	tios.c_cc[VMIN]=0;    
	tios.c_cc[VTIME]=1000; 
	tios.c_lflag=0;  
	tcflush(fd, TCIFLUSH);
	ioctl (fd, TCSETS, &tios);
	return fd;
}

/**************************************************************/
/************** main function********************************/
/*************************************************************/
int main(int argc,char *argv[])
{
	int Uart4Fd;

	//Initialization
	if(InitShareMemory()==0)
	{
		#ifdef SystemLogMessage	
		StoreLogMsg("[InternalComm]main:InitShareMemory NG");
		#endif		
		if(ShmStatusCodeData!=NULL)
		{
			ShmStatusCodeData->AlarmCode.AlarmEvents.bits.FailToCreateShareMemory=1;
		}	
		sleep(5);
		return 0;
	}	
	Uart4Fd=InitComPort();
	if(Uart4Fd<0)
	{
		#ifdef SystemLogMessage	
		StoreLogMsg("[InternalComm]main:InitComPort NG");
		#endif		
		if(ShmStatusCodeData!=NULL)
		{
			ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CsuInitFailed=1;
		}	
		sleep(5);
		return 0;
	}	
	
	while(1)
	{
		//processing
	}//main while loop
}