137 lines
3.0 KiB
C++
137 lines
3.0 KiB
C++
|
|
||
|
|
#include "codec.h"
|
||
|
|
|
||
|
|
class CodecYm : public Codec
|
||
|
|
{
|
||
|
|
Q_OBJECT
|
||
|
|
public:
|
||
|
|
CodecYm() : Codec()
|
||
|
|
{
|
||
|
|
is_big_data = false;
|
||
|
|
num_to_read = 0;
|
||
|
|
}
|
||
|
|
~CodecYm() {}
|
||
|
|
// 重载接收字节函数
|
||
|
|
bool recvByte(int byte)
|
||
|
|
{
|
||
|
|
bool ack = false;
|
||
|
|
if (fullFrame == true)
|
||
|
|
{
|
||
|
|
return fullFrame;
|
||
|
|
}
|
||
|
|
data.append(uint8_t(byte));
|
||
|
|
switch (data.size())
|
||
|
|
{
|
||
|
|
case 2:
|
||
|
|
if (uint8_t(data[0]) == 0x59u && uint8_t(data[1]) == 0x6du)
|
||
|
|
{
|
||
|
|
is_big_data = false;
|
||
|
|
num_to_read = 4; // 帧头+2byte负载长度
|
||
|
|
}
|
||
|
|
else
|
||
|
|
{
|
||
|
|
data.remove(0, 1);
|
||
|
|
num_to_read = 0;
|
||
|
|
}
|
||
|
|
break;
|
||
|
|
case 4:
|
||
|
|
{
|
||
|
|
int len = data[2] | (data[3] << 8);
|
||
|
|
if (len < 65535)
|
||
|
|
{
|
||
|
|
is_big_data = false;
|
||
|
|
num_to_read += len + 2; // 负载+2byte校验
|
||
|
|
qDebug("normal data. len=%d", len);
|
||
|
|
}
|
||
|
|
else
|
||
|
|
{
|
||
|
|
is_big_data = true;
|
||
|
|
num_to_read = 11; // 扩展数据长度
|
||
|
|
qDebug("big data.");
|
||
|
|
}
|
||
|
|
}
|
||
|
|
break;
|
||
|
|
case 11:
|
||
|
|
{
|
||
|
|
if (is_big_data == true)
|
||
|
|
{
|
||
|
|
int len = data[7] | (data[8] << 8) | (data[9] << 16) | (data[10] << 24);
|
||
|
|
num_to_read = 4 + len + 2; // 负载+2byte校验
|
||
|
|
qDebug("big data. len=%d", len);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
default:
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
// 此时一帧数据已完成
|
||
|
|
if (num_to_read > 0 && num_to_read == data.size())
|
||
|
|
{
|
||
|
|
ack = true;
|
||
|
|
num_to_read = 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
fullFrame = ack;
|
||
|
|
return fullFrame;
|
||
|
|
}
|
||
|
|
// 重载解码函数
|
||
|
|
QByteArray decode(int &srcAddr, int &dstAddr, int &cmd, QByteArray data)
|
||
|
|
{
|
||
|
|
Q_UNUSED(srcAddr);
|
||
|
|
Q_UNUSED(dstAddr);
|
||
|
|
QByteArray r;
|
||
|
|
if (data.size() < 9)
|
||
|
|
{
|
||
|
|
// 主机一帧数据至少9字节
|
||
|
|
qWarning("recv data len too less");
|
||
|
|
return r;
|
||
|
|
}
|
||
|
|
|
||
|
|
if ((uint8_t(data[0]) != 0x59u) || (uint8_t(data[1]) != 0x6du))
|
||
|
|
{
|
||
|
|
// 帧头不对
|
||
|
|
qWarning("frame head not 0x59 0x6d");
|
||
|
|
return r;
|
||
|
|
}
|
||
|
|
|
||
|
|
int len = (data[2] | (data[3] << 8));
|
||
|
|
if (len == 65535)
|
||
|
|
{
|
||
|
|
// 重新设置数据长度
|
||
|
|
len = data[7] | (data[8] << 8) | (data[9] << 16) | (data[10] << 24);
|
||
|
|
is_big_data = true;
|
||
|
|
}
|
||
|
|
else
|
||
|
|
{
|
||
|
|
is_big_data = false;
|
||
|
|
}
|
||
|
|
if (len + 6 != data.size())
|
||
|
|
{
|
||
|
|
// 如果长度不相等则产生了数据丢失
|
||
|
|
qWarning("recv data have lossed");
|
||
|
|
return r;
|
||
|
|
}
|
||
|
|
uint8_t chk_a = 0, chk_b = 0;
|
||
|
|
// crc::crc16((uint8_t *)data.data(),2,len+4,&chk_a,&chk_b);
|
||
|
|
if (chk_a != uint8_t(data[data.size() - 2]) || chk_b != uint8_t(data[data.size() - 1]))
|
||
|
|
{
|
||
|
|
// crc校验不对
|
||
|
|
qWarning("recv data check error:%02x,%02x %02x,%02x", chk_a, chk_b, int(data[data.size() - 2]),
|
||
|
|
int(data[data.size() - 1]));
|
||
|
|
}
|
||
|
|
// 保存此流水号
|
||
|
|
cmd_no = data[5] | (data[6] << 8);
|
||
|
|
cmd = data[4];
|
||
|
|
// 数据负载
|
||
|
|
if (is_big_data == false)
|
||
|
|
r = data.mid(7, len - 3);
|
||
|
|
else
|
||
|
|
r = data.mid(11, len - 7);
|
||
|
|
return r;
|
||
|
|
}
|
||
|
|
|
||
|
|
private:
|
||
|
|
bool is_big_data;
|
||
|
|
int num_to_read;
|
||
|
|
int cmd_no;
|
||
|
|
};
|