-
Notifications
You must be signed in to change notification settings - Fork 0
Expand file tree
/
Copy pathpacketutilityv2.cpp
More file actions
101 lines (84 loc) · 2.18 KB
/
packetutilityv2.cpp
File metadata and controls
101 lines (84 loc) · 2.18 KB
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
#include "packetutilityv2.h"
using namespace PacketV2;
quint8 g_loopCount = 0;
PacketEncoderFixed::PacketEncoderFixed()
{
m_buf.reserve(128);
m_buf.append(sizeof (BasicPktHeader), 0);
BasicPktHeader *header = reinterpret_cast<BasicPktHeader*>(m_buf.data());
header->fixValue1 = 0xAA;
header->fixValue2 = 0x55;
header->pktType = 0;
}
char *PacketEncoderFixed::data()
{
return m_buf.data();
}
unsigned int PacketEncoderFixed::size()
{
return m_buf.size();
}
void PacketEncoderFixed::setUAVID(int id)
{
BasicPktHeader *header = reinterpret_cast<BasicPktHeader*>(m_buf.data());
header->UAVID = id;
}
void PacketEncoderFixed::setUAVType(int type)
{
BasicPktHeader *header = reinterpret_cast<BasicPktHeader*>(m_buf.data());
header->UAVType = type;
}
PacketDecoderFixed::PacketDecoderFixed(const char *buf)
{
m_buf = buf;
}
int PacketDecoderFixed::UAVID()
{
const BasicPktHeader *header = reinterpret_cast<const BasicPktHeader*>(m_buf);
return header->UAVID;
}
int PacketDecoderFixed::UAVType()
{
const BasicPktHeader *header = reinterpret_cast<const BasicPktHeader*>(m_buf);
return header->UAVType;
}
PacketEncoderVariable::PacketEncoderVariable()
{
m_buf.reserve(1024);
m_buf.append(sizeof(BasicPktHeader), 0);
m_buf.append(sizeof(ArrayPktHeader), 0);
BasicPktHeader *header = reinterpret_cast<BasicPktHeader*>(m_buf.data());
header->fixValue1 = 0xAA;
header->fixValue2 = 0x55;
header->pktType = 1;
}
char *PacketEncoderVariable::data()
{
return m_buf.data();
}
unsigned int PacketEncoderVariable::size()
{
return m_buf.size();
}
void PacketEncoderVariable::setUAVID(int id)
{
BasicPktHeader *header = reinterpret_cast<BasicPktHeader*>(m_buf.data());
header->UAVID = id;
}
void PacketEncoderVariable::setUAVType(int type)
{
BasicPktHeader *header = reinterpret_cast<BasicPktHeader*>(m_buf.data());
header->UAVType = type;
}
PacketDecoderVariable::PacketDecoderVariable(const char *buf)
{
m_buf = buf;
}
int PacketDecoderVariable::UAVID()
{
return *reinterpret_cast<const quint8*>(m_buf+5);
}
int PacketDecoderVariable::UAVType()
{
return *reinterpret_cast<const quint8*>(m_buf+6);
}