添加
This commit is contained in:
@@ -0,0 +1,49 @@
|
||||
#include "Process.h"
|
||||
|
||||
Process::Process(QObject *parent)
|
||||
: QObject{parent}
|
||||
{
|
||||
|
||||
}
|
||||
|
||||
|
||||
QByteArray Process::Packer(quint8 id, QByteArray msg)
|
||||
{
|
||||
size_t j;
|
||||
size_t i;
|
||||
uint8_t sum;
|
||||
QByteArray pack;
|
||||
|
||||
pack[0] = head1;
|
||||
pack[1] = head2;
|
||||
|
||||
pack[2] = id;
|
||||
|
||||
uint32_t len = msg.size();
|
||||
|
||||
pack[3] = (quint8)((len & 0x000000FF) >> 0);
|
||||
pack[4] = (quint8)((len & 0x0000FF00) >> 8);
|
||||
pack[5] = (quint8)((len & 0x00FF0000) >> 16);
|
||||
pack[6] = (quint8)((len & 0xFF000000) >> 24);
|
||||
|
||||
sum = 0u;
|
||||
for (i=7,j=0u;j<len;++i,++j)
|
||||
{
|
||||
pack[i] = msg[j];
|
||||
sum += msg[j];
|
||||
}
|
||||
pack[i] = sum;
|
||||
return pack;
|
||||
}
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
Reference in New Issue
Block a user