109 lines
3.1 KiB
C++
109 lines
3.1 KiB
C++
|
#include "qserialproto.h"
|
||
|
|
#include "globalvar.h"
|
||
|
|
|
||
|
|
QSerialProto::QSerialProto(QObject *parent) : QObject(parent){
|
||
|
|
this->mState = StateNOPACKAGE;
|
||
|
|
this->mUnsortLen = 0;
|
||
|
|
this->mRecvDataLen = 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
void QSerialProto::OnSerailData(QByteArray data){
|
||
|
|
qDebug()<<"receive data"<<data.length();
|
||
|
|
if(this->mState == StateNOPACKAGE){
|
||
|
|
uint8_t len = data.at(1);
|
||
|
|
if(len > 255){
|
||
|
|
qDebug()<<"len error";
|
||
|
|
}
|
||
|
|
if(len == data.length()){
|
||
|
|
uint8_t verify = 0;
|
||
|
|
for(uint16_t i = 0;i < data.length() - 1;i++){
|
||
|
|
verify += data.at(i);
|
||
|
|
}
|
||
|
|
if(verify == data[data.length() - 1]){
|
||
|
|
ProtoData ret;
|
||
|
|
ret.len = data.at(1);
|
||
|
|
ret.funcode = data.at(0);
|
||
|
|
ret.data = new char[data.length() - 2];
|
||
|
|
memcpy(ret.data,data.data() + 2,data.length() - 2);
|
||
|
|
qDebug()<<"on package ";
|
||
|
|
emit this->OnPackage(ret);
|
||
|
|
return;
|
||
|
|
}else{
|
||
|
|
qDebug()<<"verify fail";
|
||
|
|
return;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
if(len < data.length()) {
|
||
|
|
mUnsortLen = len;
|
||
|
|
this->mRecvDataLen += data.length();
|
||
|
|
memcpy(mUnsortData,data.data(),data.length());
|
||
|
|
|
||
|
|
}
|
||
|
|
if(data.length() > len){
|
||
|
|
|
||
|
|
}
|
||
|
|
}else{
|
||
|
|
this->mRecvDataLen += data.length();
|
||
|
|
memcpy(mUnsortData,data.data(),data.length());
|
||
|
|
if(this->mRecvDataLen == mUnsortData[1]){ // 一个完整的包
|
||
|
|
uint8_t verify = 0;
|
||
|
|
for(uint16_t i = 0;i < mRecvDataLen;i++){
|
||
|
|
verify += data.at(i);
|
||
|
|
}
|
||
|
|
if(verify == mUnsortLen){
|
||
|
|
ProtoData ret;
|
||
|
|
ret.len = mUnsortData[1];
|
||
|
|
ret.funcode = mUnsortData[0];
|
||
|
|
ret.data = new char[mRecvDataLen - 2];
|
||
|
|
memcpy(ret.data,mUnsortData + 2,mRecvDataLen - 2);
|
||
|
|
// 更新状态
|
||
|
|
this->UpdateState(ANALYSEFINISH);
|
||
|
|
emit this->OnPackage(ret);
|
||
|
|
qDebug()<<"on package ";
|
||
|
|
|
||
|
|
}else{
|
||
|
|
qDebug()<<"verified ";
|
||
|
|
}
|
||
|
|
}
|
||
|
|
if(this->mRecvDataLen < mUnsortData[1]){
|
||
|
|
|
||
|
|
}
|
||
|
|
}
|
||
|
|
qDebug()<<"serial data"<<data.data();
|
||
|
|
}
|
||
|
|
|
||
|
|
int QSerialProto::UpdateState(AnalyseAction action){
|
||
|
|
switch (action) {
|
||
|
|
case INDATA:
|
||
|
|
this->mState = StateINPACKAGE;
|
||
|
|
break;
|
||
|
|
case ANALYSEFINISH:
|
||
|
|
this->mState = StateNOPACKAGE;
|
||
|
|
this->mUnsortLen = 0;
|
||
|
|
this->mRecvDataLen = 0;
|
||
|
|
break;
|
||
|
|
case ANALYSEINPROGRESS:
|
||
|
|
this->mState = StateINPACKAGE;
|
||
|
|
break;
|
||
|
|
default:
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
int QSerialProto::WriteData(uint8_t fun, uint8_t *data, uint8_t len){
|
||
|
|
char verify = 0;
|
||
|
|
char *send = new char[len + 3];
|
||
|
|
send[0] = fun;
|
||
|
|
send[1] = len;
|
||
|
|
|
||
|
|
memcpy(send + 2,data,len - 2);
|
||
|
|
for(uint8_t i = 0;i < len;i++){
|
||
|
|
verify += send[i];
|
||
|
|
}
|
||
|
|
qDebug()<<QString("send verify is %1 %1 %1").arg(verify).arg(fun).arg(len);
|
||
|
|
send[len ] = verify;
|
||
|
|
return GlobalVarManager::Instance()->GetSerailController()->SendData((uint8_t*)send,len);
|
||
|
|
}
|
||
|
|
|