CVI 不定长帧解析

//处理数据
int CVICALLBACK thread_process()
{
	char frame[500]={0};
	int  frameLen=0;
	int  readLen=0;
	char temp;
	
	//协议解析
	while (G_threadRuning)
	{    
		
		memset(frame,0,sizeof frame);
		
		//读队列长度
		readLen=CmtReadTSQData (G_queue,frame,sizeof frame, 100, OPT_TSQ_READ_PEEK);
		//如果没有4个数据就继续下次循环
		if (readLen < 4)
			continue;
		//有四个数据就判断帧头
		if (0x55!=(frame[0]&0xff) || 0x55!=(frame[1]&0xff))
		{
			//如果帧头不对,就把队列第一个值去掉,然后继续下次循环.
			CmtReadTSQData (G_queue,&temp,1, 100, 0);
			continue;
		}
		//有帧头,就获取帧长度
		frameLen=(frame[3]&0xff);
		//判断队列长度是否够一帧,不够就循环继续读取.
		if(readLen < frameLen)
			continue;
		//帧长度够就判断帧尾.
		if (0xaa!=(frame[frameLen-2]&0xff) || 0xaa!=(frame[frameLen-1]&0xff))
		{
			//帧尾不对,也把队列第一格去掉继续下次循环.
			CmtReadTSQData (G_queue,&temp,1, 100, 0);
			continue;
		}
		
		char sum1= frame[frameLen-3]&0xff;
		char sum2= checkSum(frame,frameLen);
		//判断校验和
		if (sum1 != sum2)
		{
			//数据错误,整帧丢弃
			CmtReadTSQData (G_queue,&frame,frameLen, 100, 0);
			continue;
		}
		
		//都正确说明找到一个正确帧,按长度取出帧,并且把队列里面的数据去掉.
		memset(frame,0,sizeof frame);
		CmtReadTSQData (G_queue,&frame,frameLen, 100, 0);
		
		//处理帧
		frameProcess(frame,frameLen);
		
	}
	return 0;
}

//转16进制字符串
void frameProcess(char * frame ,int len)
{
	int one;
	char str[20]={0};
	char oneframe[2000]={0};
	
	for (int i=0; i<len; i++)
	{
		one=frame[i];
		sprintf(str,"0x%.2x ",one&0xff);
		strcat(oneframe,str);
	}
	
	//写日志
	base_log_write(oneframe);
	//SetCtrlVal(g_panelMain,PANEL_MAIN_TEXTBOX,"\r\n");
	//SetCtrlVal(g_panelMain,PANEL_MAIN_NUMERIC_recTime,second_end-second_start);
}