netsvr.c

vxworks 在线升级内核的驱动程序

/**********************************************************************
 chengjy@felab, copyright 2002-2004
 netSvr.c
 vxWorks作为server，双缓冲网络通讯，带网络监控，同时支持通讯协议
 函数:
		void netInit(int mode);
		void netCMDRecv();
		void netCMDExplain();
		void netCMDSend();
		void netCloseAll(int mode);
		void netCheckLink();
		char netCMDAdd(unsigned char *pBuff, int buffLen, int cmdNum, unsigned char priority);
		char netRecvSize(unsigned char *pBuff, int len);
 调用:
 		netTask.c
			extern char t0x0200(unsigned char *pBuff);
			extern char t0x0400(unsigned char *pBuff);
			extern char t0x1600(unsigned char*pBuff);
		netQueue.c
			extern void queueInit();
			extern char queueAdd(int index, unsigned char* pBuff, int pri);
			extern char queueDelHead(int index);
			extern char queueDelAll();
 被调用:
 		用户程序初始化部分
 		netTask.c
 **********************************************************************/
 
#include "vxWorks.h"
#include "taskLib.h"
#include "sockLib.h"
#include "ioLib.h"
#include "inetLib.h"
#include "logLib.h"
#include "string.h"
#include "fioLib.h"
#include "stdio.h"
#include "memLib.h"
#include "stdLib.h"
#include "semLib.h"
#include "netinet\\tcp.h"

#include "board.h"

/*通讯协议支持的命令*/
extern char t0x0200(unsigned char *pBuff);	/*参数配置*/
extern char t0x0400(unsigned char *pBuff);	/*reset*/  
extern char t0x1600(unsigned char*pBuff);	/*flash程序下载*/

/*缓冲队列操作*/
extern void queueInit();
extern char queueAdd(int index, unsigned char* pBuff, int pri);
extern char queueDelHead(int index);
extern char queueDelAll();
extern struct cmdSingle *queueHead[QUEUE_NUM];

extern struct BoardWorkEnv boardWorkEnv;

int flagNetInit = NET_INIT_NULL;	/*服务器初始化标志,程序中省略了对应的判断和操作*/
int listenSkt;			/*命令通道侦听socket*/
int commuSkt;			/*命令通道通讯socket*/
SEM_ID semQueueRecv;	/*网络接收缓冲队列信号灯*/
SEM_ID semQueueSend;	/*网络发送缓冲队列信号灯*/
SEM_ID semCmdLink;		/*网络连接出错信号灯*/

void netInit(int mode);
void netCMDRecv();
void netCMDExplain();
void netCMDSend();
void netCloseAll(int mode);

void netCheckLink();

char netCMDAdd(unsigned char *pBuff, int buffLen, int cmdNum, unsigned char priority);
char netRecvSize(unsigned char *pBuff, int len);

/**********************************************************************
 void netInit(int mode)
 函数说明:	网络初始化程序
 参数:		mode,	分为MODE_NET_DEFAULT 和MODE_NET_REINIT	两种，
 					分别对应初始化侦听+通讯套接字和只
 					初始化通讯套接字两种。
 返回:		无
 调用:			
			void netCMDRecv();
			void netCMDExplain();
			void netCMDSend();
			void netCheckLink();
 		netQueue.c:
			extern void 	queueInit();
 被调用:	用户程序初始化模块
			void netCloseAll(int mode);
 **********************************************************************/
void netInit(int mode)
{
	struct	sockaddr_in  serverAddr;
	struct	sockaddr_in  clientAddr;
	int		sockAddrSize;
	int		i;
	char 	optval = 1;

	/*建立本地的侦听用套接字listenSkt 并bind和listen*/
	if(flagNetInit==NET_INIT_COMMUSKT)
		return;
	if((mode == MODE_NET_DEFAULT) && (flagNetInit == NET_INIT_NULL))
	{
		if((listenSkt = socket (AF_INET, SOCK_STREAM, 0)) == ERROR)
		{
			logMsg("netInit: can not open listen socket\n",0,0,0,0,0,0);
			return;
		}
		sockAddrSize = sizeof (struct sockaddr_in);
		bzero ((char *) &serverAddr, sockAddrSize);
		serverAddr.sin_family = AF_INET;
		serverAddr.sin_len = (u_char) sockAddrSize;
		serverAddr.sin_port = htons (LOCAL_SERVER_PORT);
		serverAddr.sin_addr.s_addr = htonl (INADDR_ANY);
		if (bind (listenSkt, (struct sockaddr *) &serverAddr, sockAddrSize) == ERROR)
		{
		    logMsg("netInit:unable to bind to port %d\n",LOCAL_SERVER_PORT,0,0,0,0,0);
		    close(listenSkt);
		    return;
		}
		logMsg("netInit: successfully bind to port\n",LOCAL_SERVER_PORT,0,0,0,0,0);
		if (listen (listenSkt, 1) == ERROR)
		{
			logMsg("netInit: can not listen to listen socket\n",0,0,0,0,0,0);
			close (listenSkt);        
			return;
		}
		flagNetInit=NET_INIT_LISTENSKT;	
	}

	/*接收外部联接，建立通讯套接字commuSkt*/
	if(flagNetInit==NET_INIT_LISTENSKT)
	{
		sockAddrSize = sizeof (struct sockaddr_in);
		commuSkt = accept(listenSkt, (struct sockaddr*)(&clientAddr), &sockAddrSize);
		if(commuSkt==ERROR)
		{
			logMsg("netInit: can not accept command socket\n",0,0,0,0,0,0);
			close (listenSkt);
			return;
		}
		setsockopt (commuSkt, IPPROTO_TCP, TCP_NODELAY, &optval, sizeof (optval));
		/*初始化网络通讯的缓冲对列*/
		queueInit();  
		/*初始化缓冲队列的计数型信号灯*/
		semQueueSend = semCCreate(SEM_Q_FIFO,0);
		semQueueRecv = semCCreate(SEM_Q_FIFO,0);
		if((semQueueSend==NULL) ||(semQueueRecv==NULL))
		{
			semDelete(semQueueSend);
			semDelete(semQueueRecv);
		}
		/*发起网络命令循环接收任务、命令解释任务、命令发送任务和网络监控任务*/
		taskSpawn(TNAME_NETCHECKLINK,TPRI_NETCHECKLINK,0,USER_STACK_SIZE,
					(FUNCPTR)netCheckLink,0,0,0,0,0,0,0,0,0,0);	
		taskSpawn(TNAME_NETRECV,TPRI_NETRECV,0,USER_STACK_SIZE,
					(FUNCPTR)netCMDRecv,0,0,0,0,0,0,0,0,0,0);
		taskSpawn(TNAME_NETEXPLAIN,TPRI_NETEXPLAIN,0,USER_STACK_SIZE,
					(FUNCPTR)netCMDExplain,0,0,0,0,0,0,0,0,0,0);
		taskSpawn(TNAME_NETSEND,TPRI_NETSEND,0,USER_STACK_SIZE,
					(FUNCPTR)netCMDSend,0,0,0,0,0,0,0,0,0,0);
		flagNetInit = NET_INIT_COMMUSKT;
		boardWorkEnv.boardInit = boardWorkEnv.boardInit |BOARD_NET_INITED;		
		logMsg("netInit: netInit finished\n",0,0,0,0,0,0);
	}
}


/**********************************************************************
 void netCMDRecv()
 函数说明:	信息接收任务。循环从网络获得信息，打包后
 				添加到缓冲队列，等待信息解释任务处理。
 参数:		无
 返回:		无
 调用:
			char netRecvSize(unsigned char *pBuff, int len)
 		netQueue.c
			char queueAdd(int index, unsigned char* pBuff, int pri);
 被调用:	
 			void netInit()
 **********************************************************************/
void netCMDRecv()
{
	unsigned char buff[8];
	unsigned char *pBuff;
	int lenAll;
	char pri;
	char state=STATUS_NORMAL;
	int i;
		
	/* 循环接收*/
	while(1)
	{
		if(netRecvSize(buff,8)!=STATUS_NORMAL)
		{
			logMsg("netCMDRecv: error in head Recv netRecvSize(buff,8)\n",0,0,0,0,0,0);
			break;
		}
		else		
		{

#ifdef LOG_NETMSG_HEAD	
			printf("netCMDRecv: print out head 8 bytes\n");
			for(i=0;i<8;i++)
				printf("0x%02x ",buff[i]);
			printf("\n");
#endif
			/*计算需要缓冲的总长度*/
			lenAll = ((buff[2]*0x1000000)&0xFF000000)+((buff[3]*0x10000)&0xFF0000)
						+((buff[4]*0x100)&0xFF00)+buff[5]; 				/*单条命令的总长度*/	
			logMsg("netCMDRecv: recv a command of %d bytes\n",lenAll,0,0,0,0,0);
			pBuff = malloc(lenAll*sizeof(char));
			if(pBuff!=NULL)
			{
				memcpy(pBuff,buff,8*sizeof(char));
				if(lenAll>8)
				{
					state = netRecvSize(pBuff+8,lenAll-8);
					if(state!=STATUS_NORMAL)
					{
						logMsg("netCMDRecv: error in rear part recv netRecvSize(pBuff,%d)\n",lenAll-8,0,0,0,0,0);
						break;
					}
				}
				/*正确接收了所有数据，添加到接收缓冲队列中*/
				if(state== STATUS_NORMAL)
				{
					queueAdd(QUEUE_INDEX_RECV, pBuff, buff[6]);
					semGive(semQueueRecv);
				}
			}
		}
	}
	logMsg("netCMDRecv: something wrong, now exit\n",0,0,0,0,0,0);
}

/**********************************************************************
 void netCMDExplain()
 函数说明:	主循环消息处理和状态发送任务。循环获取信号灯
				获取成功后, 根据命令号执行相应任务。
 参数:		无
 返回:		无
 调用:
 		netQueue.c
 			char queueDelHead();
 		netTask:
 			STATUS t0xXXXX(char *pBuff);
 被调用：	
 			void netInit()
 **********************************************************************/
void netCMDExplain()