andy/checker_host
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

添加自研批检仪检测命令

Browse Source
This commit is contained in:
ranchuan
2023-11-27 14:31:00 +08:00
parent b3a0d7b57c
commit a0b0f41c39
45 changed files with 3778 additions and 2628 deletions
Download Patch File Download Diff File Expand all files Collapse all files

316
interface/codec_ym.cpp
View File

@@ -3,181 +3,179 @@
#include "base/crc.h"
#include "interface/codec_ym.h"
// 重载接收字节函数
bool CodecYm::recvByte(int byte)
// 重载接收字节函数
bool CodecYm::recvByte(int byte)
{
bool ack = false;
if (fullFrame == true)
{
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;
}
// 重载解码函数
myarray CodecYm::decode(int &srcAddr, int &dstAddr, int &cmd, myarray data)
data.append(uint8_t(byte));
switch (data.size())
{
Q_UNUSED(srcAddr);
Q_UNUSED(dstAddr);
myarray r;
if(packCheck(data)==true){
cmd=this->cmd;
if (is_big_data == false)
r = data.mid(7, len - 3);
else
r = data.mid(11, len - 7);
}
return r;
}
bool CodecYm::packCheck(myarray data)
{
bool ack=false;
if (data.size() < 9)
case 2:
if (uint8_t(data[0]) == 0x59u && uint8_t(data[1]) == 0x6du)
{
// 主机一帧数据至少9字节
qWarning("recv data len too less");
return ack;
}
if ((uint8_t(data[0]) != 0x59u) || (uint8_t(data[1]) != 0x6du))
{
// 帧头不对
qWarning("frame head not 0x59 0x6d");
return ack;
}
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;
is_big_data = false;
num_to_read = 4; // 帧头+2byte负载长度
}
else
{
is_big_data = false;
data.remove(0, 1);
num_to_read = 0;
}
if (len + 6 != data.size())
{
// 如果长度不相等则产生了数据丢失
qWarning("recv data have lossed");
return ack;
}
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];
// 数据负载
return true;
}
myarray CodecYm::encode(int srcAddr, int dstAddr, int cmd, myarray data)
break;
case 4:
{
Q_UNUSED(srcAddr);
Q_UNUSED(dstAddr);
myarray t;
uint32_t len=data.size()+3;
t.append(0x59u);
t.append(0x6du);
t.append(0x43u);
if(len<65535)
{
t.append((len)&0xff);
t.append((len)>>8);
t.append(cmd);
t.append(cmd_no&0xff);
t.append(cmd_no>>8);
}else{
len+=4;
t.append(0xff);
t.append(0xff);
t.append(cmd);
t.append(cmd_no&0xff);
t.append(cmd_no>>8);
t.append(len&0xff);
t.append((len>>8)&0xff);
t.append((len>>16)&0xff);
t.append((len>>24)&0xff);
}
t.append(data);
uint8_t chk_a,chk_b;
crc::crc16((uint8_t *)t.data(),3,len+5,&chk_a,&chk_b);
t.append(chk_a);
t.append(chk_b);
return t;
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;
}
// 重载解码函数
myarray CodecYm::decode(int &srcAddr, int &dstAddr, int &cmd, myarray data)
{
Q_UNUSED(srcAddr);
Q_UNUSED(dstAddr);
myarray r;
if (packCheck(data) == true)
{
cmd = this->cmd;
if (is_big_data == false)
r = data.mid(7, len - 3);
else
r = data.mid(11, len - 7);
}
return r;
}
bool CodecYm::packCheck(myarray data)
{
bool ack = false;
if (data.size() < 9)
{
// 主机一帧数据至少9字节
qWarning("recv data len too less");
return ack;
}
if ((uint8_t(data[0]) != 0x59u) || (uint8_t(data[1]) != 0x6du))
{
// 帧头不对
qWarning("frame head not 0x59 0x6d");
return ack;
}
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 ack;
}
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];
// 数据负载
return true;
}
myarray CodecYm::encode(int srcAddr, int dstAddr, int cmd, myarray data)
{
Q_UNUSED(srcAddr);
Q_UNUSED(dstAddr);
myarray t;
uint32_t len = data.size() + 3;
t.append(0x59u);
t.append(0x6du);
t.append(0x43u);
if (len < 65535)
{
t.append((len) & 0xff);
t.append((len) >> 8);
t.append(cmd);
t.append(cmd_no & 0xff);
t.append(cmd_no >> 8);
}
else
{
len += 4;
t.append(0xff);
t.append(0xff);
t.append(cmd);
t.append(cmd_no & 0xff);
t.append(cmd_no >> 8);
t.append(len & 0xff);
t.append((len >> 8) & 0xff);
t.append((len >> 16) & 0xff);
t.append((len >> 24) & 0xff);
}
t.append(data);
uint8_t chk_a, chk_b;
crc::crc16((uint8_t *)t.data(), 3, len + 5, &chk_a, &chk_b);
t.append(chk_a);
t.append(chk_b);
return t;
}
Codec *codec_ym_get()
{
static Codec *codec_=nullptr;
if(codec_==nullptr){
codec_=new CodecYm();
}
return codec_;
static Codec *codec_ = nullptr;
if (codec_ == nullptr)
{
codec_ = new CodecYm();
}
return codec_;
}
codec_export(codec_ym,codec_ym_get);
codec_export(codec_ym, codec_ym_get);