//处理数据
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);
}