439 lines
11 KiB
C++
439 lines
11 KiB
C++
//-------------------------------------------------------------------------------
|
||
// File Name: comm.cpp
|
||
// Brief:
|
||
// Version: 1.0.0
|
||
// Create Date: 2017/05/08
|
||
// Create by: Marshal Lee
|
||
// Copyright:
|
||
// Copyright (c) 2017, Richpeace Co., LTD.
|
||
// All rights reserved.
|
||
//
|
||
// Modify by: Marshal Lee
|
||
// Modify Date: 2017/05/08
|
||
//-------------------------------------------------------------------------------
|
||
|
||
#define _IN_COMM_CPP
|
||
|
||
#include "comm.h"
|
||
#include "crc16.h"
|
||
|
||
|
||
//--------------------------------------------------------------------------------------------------
|
||
|
||
// 读空缓冲区
|
||
void readBuffEmpty(DataExFuns * funs)
|
||
{
|
||
int rslt, len;
|
||
u8 temp;
|
||
|
||
len = funs->getRsvLen();
|
||
|
||
while (len > 0)
|
||
{
|
||
rslt = funs->getCommData(&temp, 1);
|
||
if (rslt != 1)
|
||
{
|
||
rslt = 0;
|
||
break;
|
||
}
|
||
len--;
|
||
}
|
||
}
|
||
|
||
//--------------------------------------------------------------------------------------------------
|
||
// 功能: 从通讯口接收缓冲区中得到一个数据包, 如果有附加数据，包括附加数据
|
||
// 参数: pPacket, 数据包指针
|
||
// 返回: >=0, 成功取得一个数据包，包括定长数据包和可变长度数据包，返回值为数据包长度
|
||
// -1, 参数错误
|
||
// -2, CRC错误
|
||
// -3, 数据不足
|
||
// -4, 没有找到同步序列
|
||
// -5，等待接收数据超时
|
||
// -6, 数据包参数错误
|
||
// -7, 附加数据CRC错误
|
||
// -8, 发生未知错误
|
||
|
||
// 结果: 如果正确取得数据包，或通讯口没有命令, 循环队列尾指针回向后移动
|
||
|
||
int getANormalPacket(DataExFuns * funs, DataPacket * pPacket)
|
||
{
|
||
int rslt, len;
|
||
int i;
|
||
int phase;
|
||
int status;
|
||
int exlen;
|
||
static int rdstatus = 0;
|
||
static u8 odBuf[LEN_NORMAL_PACKET];
|
||
|
||
u8 temp;
|
||
u8 rdBuf[LEN_NORMAL_PACKET];
|
||
DataPacket * pDat;
|
||
|
||
u8 getBuf[LEN_NORMAL_PACKET-DP_SYNC_LEN];
|
||
int getBuflen;
|
||
int getIdx;
|
||
|
||
u8 tmpBuf[LEN_NORMAL_PACKET-DP_SYNC_LEN];
|
||
int tmpBuflen;
|
||
|
||
if (funs == NULL || pPacket == NULL)
|
||
{
|
||
return -1;
|
||
}
|
||
|
||
rslt = 0;
|
||
i = 0; // 扫描字节计数器
|
||
getBuflen = 0;
|
||
getIdx = 0;
|
||
tmpBuflen = 0;
|
||
pDat = (DataPacket *)rdBuf;
|
||
|
||
if (rdstatus == 0)
|
||
{
|
||
do
|
||
{
|
||
len = funs->getRsvLen(); // 得到接收长度
|
||
len += getBuflen; // 加上已经获取的长度
|
||
|
||
if (len < LEN_NORMAL_PACKET)
|
||
{
|
||
rslt = -3;
|
||
break; // 没有足够数据
|
||
}
|
||
|
||
phase = 0;
|
||
status = 0;
|
||
rslt = 0;
|
||
|
||
// 从接收缓冲区中找数据包
|
||
while(((len + phase) >= LEN_NORMAL_PACKET) && (phase < LEN_NORMAL_PACKET))
|
||
{
|
||
if (getBuflen == 0)
|
||
{
|
||
if (phase == 0 && i > MAX_ONCE_SCAN)
|
||
{
|
||
rslt = -4;
|
||
break; // 查找同步序列超出最大单次扫描字节数
|
||
}
|
||
|
||
rslt = funs->getCommData(&temp, 1);
|
||
if (rslt != 1)
|
||
{
|
||
printf("error at GetCommData rslt\r\n");
|
||
rslt = -8;
|
||
break;
|
||
}
|
||
rslt = 0;
|
||
i++; // 扫描字数增加
|
||
}
|
||
else
|
||
{
|
||
temp = getBuf[getIdx];
|
||
getIdx++;
|
||
getBuflen--;
|
||
}
|
||
|
||
len--; // 剩余长度减小
|
||
|
||
pDat->buff.normal[phase] = temp;
|
||
if (phase < DP_SYNC_LEN) // 识别同步序列
|
||
{
|
||
tmpBuflen = 0;
|
||
|
||
if (phase == 0)
|
||
{
|
||
if (temp == FLDP_SYNC[0])
|
||
{
|
||
status = 1;
|
||
}
|
||
else if (temp == VLDP_SYNC[0])
|
||
{
|
||
status = 2;
|
||
}
|
||
else
|
||
{
|
||
status = 0;
|
||
phase = 0;
|
||
rslt = 0; // 非同步序列
|
||
break;
|
||
}
|
||
}
|
||
else
|
||
{
|
||
if (status == 1)
|
||
{
|
||
if (temp != FLDP_SYNC[phase])
|
||
{
|
||
status = 0;
|
||
phase = 0;
|
||
rslt = 0;
|
||
break;
|
||
}
|
||
}
|
||
else if (status == 2)
|
||
{
|
||
if (temp != VLDP_SYNC[phase])
|
||
{
|
||
status = 0;
|
||
phase = 0;
|
||
rslt = 0;
|
||
break;
|
||
}
|
||
}
|
||
else
|
||
{
|
||
printf("error status in GetANormalPacket\r\n");
|
||
rslt = -8;
|
||
break;
|
||
}
|
||
}
|
||
}
|
||
else
|
||
{
|
||
tmpBuf[tmpBuflen] = temp;
|
||
tmpBuflen++;
|
||
}
|
||
|
||
phase++;
|
||
}
|
||
|
||
if (rslt != 0)
|
||
{
|
||
break;
|
||
}
|
||
|
||
if (phase >= LEN_NORMAL_PACKET) // 得到数据包
|
||
{
|
||
u16 crc;
|
||
crc = calcCrc16(pDat->normal.content, DP_CONT_LEN);
|
||
if (crc == pDat->normal.crc)
|
||
{
|
||
// 得到正确数据包
|
||
memcpy(pPacket, pDat, LEN_NORMAL_PACKET);
|
||
|
||
// printf("GetANormalPacket ok\r\n");
|
||
rslt = LEN_NORMAL_PACKET;
|
||
break;
|
||
}
|
||
else
|
||
{
|
||
// CRC 不正确
|
||
printf("crc error in GetANormalPacket\r\n");
|
||
// 拷贝需要再判断的数据
|
||
if (tmpBuflen != 0)
|
||
{
|
||
memcpy(getBuf, tmpBuf, tmpBuflen);
|
||
}
|
||
getBuflen = tmpBuflen;
|
||
getIdx = 0;
|
||
// continue;
|
||
}
|
||
}
|
||
else
|
||
{
|
||
// 没有找到同步序列的情况
|
||
getBuflen = 0;
|
||
getIdx = 0;
|
||
// continue;
|
||
}
|
||
}while(1);
|
||
}
|
||
|
||
if (rdstatus == 1)
|
||
{
|
||
memcpy(pPacket, odBuf, LEN_NORMAL_PACKET);
|
||
rslt = LEN_NORMAL_PACKET;
|
||
}
|
||
|
||
// 附加数据
|
||
if (rslt == LEN_NORMAL_PACKET)
|
||
{
|
||
if (memcmp(pPacket->normal.sync, VLDP_SYNC, DP_SYNC_LEN) == 0) // 是可变长度数据包
|
||
{
|
||
exlen = pPacket->vldp.exlen;
|
||
if (exlen > MAX_EXDP_LEN)
|
||
{
|
||
printf("data exlen error, len=%d\r\n", exlen);
|
||
return -6; // 数据包参数错误
|
||
}
|
||
|
||
memset(pPacket->buff.exData, 0, MAX_EXDP_LEN);
|
||
|
||
i = 0;
|
||
status = 0; // 作为历史计数器
|
||
// 读取附加数据
|
||
do
|
||
{
|
||
rslt = funs->getCommData(pPacket->buff.exData, exlen);
|
||
if (rslt == exlen)
|
||
{
|
||
u16 crc;
|
||
// 校验CRC
|
||
crc = calcCrc16(pPacket->buff.exData, exlen);
|
||
if (crc == pPacket->vldp.excrc)
|
||
{
|
||
// printf("get exdata ok\r\n");
|
||
rslt = exlen+LEN_NORMAL_PACKET;
|
||
}
|
||
else
|
||
{
|
||
printf("crc error at get exdata\r\n");
|
||
rslt = -7; // CRC错误
|
||
}
|
||
rdstatus = 0;
|
||
break; // 得到数据
|
||
}
|
||
else if (rslt == 0)
|
||
{
|
||
memcpy(odBuf, pPacket, LEN_NORMAL_PACKET);
|
||
rdstatus = 1;
|
||
rslt = -3;
|
||
break;
|
||
/*
|
||
// 数据不足
|
||
if (funs->delay != NULL)
|
||
{
|
||
funs->delay(1); // 延时等待
|
||
}
|
||
len = funs->getRsvLen(); // 得到接收数据长度
|
||
qDebug()<<"getRsvLen"<<len;
|
||
if (len != status) // 和上次长度比较
|
||
{
|
||
status = len;
|
||
i = 0;
|
||
}
|
||
else // 如果没有变化，则计数器增加
|
||
{
|
||
i++;
|
||
if (i > GTEX_TIME_OUT) // 如果无变化计数器值大于超时值
|
||
{
|
||
qDebug()<<"call GetCommData timeout";
|
||
rslt = -5;
|
||
break;
|
||
}
|
||
}
|
||
*/
|
||
}
|
||
else
|
||
{
|
||
qDebug()<<"error after call GetCommData";
|
||
break;
|
||
}
|
||
}while(1);
|
||
|
||
}
|
||
}
|
||
return rslt;
|
||
}
|
||
|
||
//--------------------------------------------------------------------------------------------------
|
||
|
||
// 功能: 添加数据到发送队列中, 通过通讯口发送数据
|
||
// 参数: pPacket, 需要发送的数据，已经正确存放在了相应字段。
|
||
// 结果:
|
||
// 0, 可以发送, 添加到了发送数据队列中
|
||
// -1, 参数错误
|
||
// -2，发送错误
|
||
// 1, 队列已满, 不能发送
|
||
int sendAPacket(DataExFuns * funs, DataPacket * pPacket)
|
||
{
|
||
int rslt;
|
||
int freelen, sendlen;
|
||
|
||
if (pPacket == NULL)
|
||
{
|
||
return -1;
|
||
}
|
||
|
||
if (memcmp(pPacket->normal.sync, FLDP_SYNC, DP_SYNC_LEN) == 0)
|
||
{
|
||
sendlen = LEN_NORMAL_PACKET;
|
||
}
|
||
else if (memcmp(pPacket->normal.sync, VLDP_SYNC, DP_SYNC_LEN) == 0)
|
||
{
|
||
sendlen = LEN_NORMAL_PACKET + pPacket->vldp.exlen;
|
||
}
|
||
else
|
||
{
|
||
printf("para err, not a corrected packet\r\n");
|
||
return -1;
|
||
}
|
||
|
||
freelen = funs->getTrsFreeLen();
|
||
|
||
if (freelen < sendlen)
|
||
{
|
||
// printf("buff is full in SendAPacket\r\n");
|
||
return 1;
|
||
}
|
||
|
||
rslt = funs->sendCommData(pPacket->datbuff, sendlen);
|
||
if (rslt != sendlen)
|
||
{
|
||
printf("error at call SendCommData, rslt=%d\r\n", rslt);
|
||
return -2;
|
||
}
|
||
|
||
return 0;
|
||
}
|
||
|
||
//--------------------------------------------------------------------------------------------------
|
||
|
||
// 功能: 打包一个固定长度数据包
|
||
// 参数:
|
||
// pPacket, 需要打包的数据包，其中除了sync和crc的部分已经就绪
|
||
// 结果:
|
||
// 0, 打包好数据
|
||
// -1, 参数错误
|
||
|
||
int packetAFLDP(DataPacket * pPacket)
|
||
{
|
||
if (pPacket == NULL)
|
||
{
|
||
return -1;
|
||
}
|
||
|
||
memcpy(pPacket->normal.sync, FLDP_SYNC, DP_SYNC_LEN);
|
||
pPacket->normal.crc = calcCrc16(pPacket->normal.content, DP_CONT_LEN);
|
||
|
||
return 0;
|
||
}
|
||
|
||
//--------------------------------------------------------------------------------------------------
|
||
|
||
// 功能: 打包一个可变长度数据包
|
||
// 参数: pPacket, 需要打包的数据包，需要填充其中的 SYNC EXLEN EXCRC 和 EXDAT 等部分
|
||
// pExdat, 附加数据，可以为空
|
||
// exlen，附加数据长度，可以为0
|
||
// 结果:
|
||
// 0, 打包好数据
|
||
// -1, 参数错误
|
||
// -2，
|
||
|
||
int packetAVLDP(DataPacket * pPacket, u8 * pExdat, u16 exlen)
|
||
{
|
||
if (pPacket == NULL)
|
||
{
|
||
return -1;
|
||
}
|
||
|
||
if (pExdat == NULL)
|
||
{
|
||
exlen = 0;
|
||
}
|
||
|
||
memcpy(pPacket->vldp.sync, VLDP_SYNC, DP_SYNC_LEN);
|
||
pPacket->vldp.exlen = exlen;
|
||
pPacket->vldp.excrc = calcCrc16(pExdat, exlen);
|
||
pPacket->vldp.crc = calcCrc16(pPacket->normal.content, DP_CONT_LEN);
|
||
if (exlen != 0)
|
||
{
|
||
memcpy(pPacket->vldp.exData, pExdat, exlen);
|
||
}
|
||
return 0;
|
||
}
|
||
|
||
//--------------------------------------------------------------------------------------------------
|
||
|
||
|