netsvr.c

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

{
	unsigned char *pBegin;
	int 	CMDNum;
	char 	state;
	while(semTake(semQueueRecv,WAIT_FOREVER)== OK)
	{
		/*从队头取出信息*/
		pBegin = queueHead[QUEUE_INDEX_RECV]->pBuff;
		CMDNum = pBegin[0]*0x100+pBegin[1];
		/*这里只是示意性地作了几个命令的解释，用户应该根据
		自己的通讯协议再添加内容*/
		switch(CMDNum)
		{
			case 0x0200:
				state = t0x0200(pBegin);
				break;
			case 0x0400:
				state = t0x0400(pBegin);
				break;
			case 0x1600:
				state = t0x1600(pBegin);
				break;
			default:
				logMsg("netCMDExplain: command 0x%04x is not supported\n",CMDNum,0,0,0,0,0);
				break;
		}
		if(state == STATUS_NORMAL)
			logMsg("netCMDExplain: result of command 0x%04x is *OK*\n",CMDNum,0,0,0,0,0);
		else
			logMsg("netCMDExplain: result of command 0x%04x is *ERROR*\n",CMDNum,0,0,0,0,0);

		free(pBegin);
	
		queueDelHead(QUEUE_INDEX_RECV);
		
	}
	
	logMsg("netCMDExplain: error in taking semQueue\n",0,0,0,0,0,0);
}


/**********************************************************************
 void netCMDSend()
 函数说明:	循环从网络发送缓冲队列中取出数据并发送
 参数:		无
 返回:		无
 调用:		
  		netQueue.c
			char queueDelHead(int index);
 被调用:
		netTask.c
			char t0xXXXX(char *pBuff);
 **********************************************************************/
void netCMDSend()
{
	unsigned char *pBegin;
	int lenAll,remainLen,realLen;
	while(semTake(semQueueSend,WAIT_FOREVER)!=ERROR)
	{
		/*从队头取出信息*/
		pBegin = queueHead[QUEUE_INDEX_SEND]->pBuff;
		lenAll = ((pBegin[2]*0x1000000)&0xFF000000)+((pBegin[3]*0x10000)&0xFF0000)
					+((pBegin[4]*0x100)&0xFF00)+pBegin[5]; 				/*单条命令的总长度*/

		/*循环发送，直到发送完毕或者出错为止*/
		remainLen = lenAll;
		while(remainLen>0)
		{
			if(remainLen>NET_MSG_MAX_SIZE)
			{
				realLen =  send(commuSkt,pBegin+lenAll-remainLen,NET_MSG_MAX_SIZE,0);
			}
			else
			{
				realLen =  send(commuSkt,pBegin+lenAll-remainLen,remainLen,0);
			}
			if(realLen== ERROR)
			{
				logMsg("netCMDSend: unable to send command\n",0,0,0,0,0,0);
				semGive(semCmdLink);
				break;
			}
			remainLen = remainLen-realLen;
		}

		/*结束发送，释放空间*/
		free(pBegin);
		queueDelHead(QUEUE_INDEX_SEND);
		
		if(remainLen!=0)		/*发送出错，中途跳出的情况*/
			break;
	}
	logMsg("netCMDSend: something wrong, now exit\n",0,0,0,0,0,0);
}
	
/**********************************************************************
 void netCloseAll(int mode)
 函数说明:  关闭侦听socket 以及和socket相关的任务，并根
 				据模式的不同选择是直接关闭侦听套接字
 				(MODE_NET_DEFAULT) 还是重新初始化网络(MODE_NET_REINIT)
 参数:		mode,	选择关闭方式
 返回:		无
 调用:		
 			void netInit(int mode);
 		netQueue.c
 			char queuDelAll();
 被调用: 	
 			void netCheckLink();
 			用户在shell下调用
 **********************************************************************/
void netCloseAll(int mode)
{
	int taskId;

	/*删除网络相关任务*/
	taskId = taskNameToId(TNAME_NETRECV);
	if(taskId!=taskIdSelf() && taskId!=ERROR)
	{
		taskDelete(taskId);
	}
	taskId = taskNameToId(TNAME_NETSEND);
	if(taskId!=taskIdSelf() && taskId!=ERROR)
	{
		taskDelete(taskId);
	}
	taskId = taskNameToId(TNAME_NETEXPLAIN);
	if(taskId!=taskIdSelf() && taskId!=ERROR)
	{
		taskDelete(taskId);
	}
	taskId = taskNameToId(TNAME_NETCHECKLINK);
	if(taskId!=taskIdSelf() && taskId!=ERROR)
	{
		taskDelete(taskId);
	}

	/*删除缓冲队列*/
	queueDelAll();
	/*删除缓冲队列的信号灯*/
	semDelete(semQueueRecv);
	semDelete(semQueueSend);

	/*删除网络通断检测用信号灯*/
	semDelete(semCmdLink);

	boardWorkEnv.boardInit = boardWorkEnv.boardInit & (~(BOARD_NET_INITED));		
	
	/*根据网络初始化的不同状态作相应的退出工作*/
	if(mode==MODE_NET_DEFAULT)
	{
		close(commuSkt);
		close(listenSkt);
		flagNetInit = NET_INIT_NULL;
	}
	else if(mode==MODE_NET_REINIT)
	{
		close(commuSkt);
		flagNetInit = NET_INIT_LISTENSKT;
		/*重新初始化网络*/
		logMsg("netCloseAll: reInitialize net server\n",0,0,0,0,0,0);
		taskDelete(taskNameToId(TNAME_NETINIT));
		taskSpawn(TNAME_NETINIT,TPRI_NETINIT,0,USER_STACK_SIZE,
					(FUNCPTR)netInit,mode,0,0,0,0,0,0,0,0,0);	
	}
}


/**********************************************************************
 void netCheckLink()
 函数说明:	监测网络状态，出错即关闭网络并重新初始化
 参数:		无
 返回:		无
 调用:
 			void netCloseAll(int mode)
 被调用:
 			void netInit();
 **********************************************************************/
void netCheckLink()
{
	/*由于优先极高，因此先创建信号灯才会进行网络的接收和发送*/
	semCmdLink = semBCreate(SEM_Q_FIFO,SEM_EMPTY);

	/*等待send()和recv()出错释放信号灯*/
	semTake(semCmdLink,WAIT_FOREVER);

	/*获得信号灯，表示网络连接断开*/
	semDelete(semCmdLink);
	taskSpawn(TNAME_NETCLOSEALL,TPRI_NETCLOSEALL,0,USER_STACK_SIZE,(FUNCPTR)netCloseAll,
				MODE_NET_REINIT,0,0,0,0,0,0,0,0,0);
}
			
/**********************************************************************
 char netRecvSize(unsigned char *pBuff, int len)
 函数说明:	底层函数，从网络接收数据
 参数:		pBuff,	接收数据存储的地方
 			len,		需要接受的总长度
 返回:		正确执行返回STATUS_NORMAL，否则返回错误
 调用:		无	
 被调用:	void netCMDRecv();
 **********************************************************************/
char netRecvSize(unsigned char *pBuff, int len)
{
	int recvLen,remainLen;
	if((len<=0) || (flagNetInit!=NET_INIT_COMMUSKT))
		return(STATUS_INVALID);
	else
		remainLen = len;
	while(remainLen>0)
	{
		recvLen = recv(commuSkt,pBuff+len-remainLen, remainLen,0);
		if( (recvLen==ERROR) || (recvLen ==0) )
		{
			semGive(semCmdLink);
			return(STATUS_ERROR);
		}
		remainLen = remainLen-recvLen;
	}
	return(STATUS_NORMAL);
}			

/**********************************************************************
 char netCMDAdd(unsigned char *pBuff, int buffLen, int cmdNum, unsigned char priority)
 函数说明:	添加内容到发送缓冲队列
 参数:		pBuff,	需要经过修改后添加的数组首地址
 			buffLen,	数组长度，单位为byte
 			cmdNum,命令号
 			priority,	优先级
 返回:		添加成功返回STATUS_NORMAL，否则返回错误
 调用:		
 		netQueue.c
			char queueAdd(int index, unsigned char* pBuff, int pri)
 被调用:
		netTask.c
			char t0xXXXX(char *pBuff);
 **********************************************************************/
char netCMDAdd(unsigned char *pBuff, int buffLen, int cmdNum, unsigned char priority)
{
	pBuff[0] = (cmdNum&0xFF00)>>8;
	pBuff[1] = cmdNum&0x00FF;
	pBuff[2] = ((buffLen>>24)&0xFF);
	pBuff[3] = ((buffLen>>16)&0xFF);
	pBuff[4] = ((buffLen>>8)&0xFF);
	pBuff[5] = (buffLen&0xFF);
	pBuff[6] = priority;
	pBuff[7] = 0;

	queueAdd(QUEUE_INDEX_SEND, pBuff, priority);
	semGive(semQueueSend);
	return(STATUS_NORMAL);
}