|
31
|
1 |
|
|
|
2 |
#include "NetworkPacket.hh"
|
|
|
3 |
|
|
|
4 |
|
|
|
5 |
NetworkPacket::NetworkPacket (void) :
|
|
33
|
6 |
buf_size(NETWORK_PACKET_SIZE), data_size(0), offset(0) {
|
|
31
|
7 |
|
|
|
8 |
// nothing
|
|
|
9 |
}
|
|
|
10 |
|
|
33
|
11 |
void NetworkPacket::check_write_size (size_t item_size) {
|
|
|
12 |
if (offset + item_size > buf_size)
|
|
36
|
13 |
throw NetworkPacketError("not enough space to write");
|
|
33
|
14 |
|
|
|
15 |
}
|
|
|
16 |
|
|
|
17 |
void NetworkPacket::check_read_size (size_t item_size) {
|
|
|
18 |
if (offset + item_size > data_size)
|
|
36
|
19 |
throw NetworkPacketError("not enough data to read");
|
|
33
|
20 |
}
|
|
|
21 |
|
|
31
|
22 |
template <typename T> T NetworkPacket::read_val (void) {
|
|
|
23 |
T val;
|
|
|
24 |
|
|
|
25 |
// check size
|
|
33
|
26 |
check_read_size(sizeof(T));
|
|
31
|
27 |
|
|
|
28 |
// set value
|
|
|
29 |
val = *((T*) (buf + offset));
|
|
|
30 |
|
|
|
31 |
// update offset
|
|
|
32 |
offset += sizeof(T);
|
|
|
33 |
|
|
|
34 |
// return
|
|
|
35 |
return val;
|
|
|
36 |
}
|
|
|
37 |
|
|
|
38 |
template <typename T> void NetworkPacket::write_val (const T &val) {
|
|
|
39 |
// check max size
|
|
33
|
40 |
check_write_size(sizeof(T));
|
|
31
|
41 |
|
|
|
42 |
// set value
|
|
|
43 |
*((T*) (buf + offset)) = val;
|
|
|
44 |
|
|
|
45 |
// update offset and size
|
|
|
46 |
offset += sizeof(T);
|
|
33
|
47 |
data_size += sizeof(T);
|
|
31
|
48 |
}
|
|
|
49 |
|
|
36
|
50 |
uint32_t NetworkPacket::read_uint32 (void) {
|
|
31
|
51 |
return ntohl(read_val<uint32_t>());
|
|
|
52 |
}
|
|
|
53 |
|
|
36
|
54 |
uint16_t NetworkPacket::read_uint16 (void) {
|
|
31
|
55 |
return ntohs(read_val<uint16_t>());
|
|
|
56 |
}
|
|
|
57 |
|
|
36
|
58 |
uint8_t NetworkPacket::read_uint8 (void) {
|
|
31
|
59 |
return read_val<uint8_t>();
|
|
|
60 |
}
|
|
|
61 |
|
|
36
|
62 |
int32_t NetworkPacket::read_int32 (void) {
|
|
31
|
63 |
return ntohl(read_val<int32_t>());
|
|
|
64 |
}
|
|
|
65 |
|
|
36
|
66 |
int16_t NetworkPacket::read_int16 (void) {
|
|
31
|
67 |
return ntohs(read_val<int16_t>());
|
|
|
68 |
}
|
|
|
69 |
|
|
36
|
70 |
int8_t NetworkPacket::read_int8 (void) {
|
|
31
|
71 |
return read_val<int8_t>();
|
|
|
72 |
}
|
|
36
|
73 |
|
|
|
74 |
float NetworkPacket::read_float32 (void) {
|
|
37
|
75 |
return (float) read_uint32();
|
|
36
|
76 |
}
|
|
|
77 |
|
|
|
78 |
Vector NetworkPacket::read_vector (void) {
|
|
|
79 |
float fx = read_float32();
|
|
|
80 |
float fy = read_float32();
|
|
|
81 |
|
|
|
82 |
return Vector(fx, fy);
|
|
|
83 |
}
|
|
31
|
84 |
|
|
|
85 |
void NetworkPacket::write_uint32 (uint32_t val) {
|
|
|
86 |
write_val<uint32_t>(htonl(val));
|
|
|
87 |
}
|
|
|
88 |
|
|
|
89 |
void NetworkPacket::write_uint16 (uint16_t val) {
|
|
|
90 |
write_val<uint16_t>(htons(val));
|
|
|
91 |
}
|
|
|
92 |
|
|
|
93 |
void NetworkPacket::write_uint8 (uint8_t val) {
|
|
|
94 |
write_val<uint8_t>(val);
|
|
|
95 |
}
|
|
|
96 |
|
|
|
97 |
void NetworkPacket::write_int32 (int32_t val) {
|
|
|
98 |
write_val<int32_t>(htonl(val));
|
|
|
99 |
}
|
|
|
100 |
|
|
|
101 |
void NetworkPacket::write_int16 (int16_t val) {
|
|
|
102 |
write_val<int16_t>(htons(val));
|
|
|
103 |
}
|
|
|
104 |
|
|
|
105 |
void NetworkPacket::write_int8 (int8_t val) {
|
|
|
106 |
write_val<int8_t>(val);
|
|
|
107 |
}
|
|
36
|
108 |
|
|
37
|
109 |
void NetworkPacket::write_float32 (float val) {
|
|
|
110 |
write_uint32((uint32_t) val);
|
|
36
|
111 |
}
|
|
31
|
112 |
|
|
36
|
113 |
void NetworkPacket::write_vector (const Vector &vec) {
|
|
|
114 |
write_float32(vec.x);
|
|
|
115 |
write_float32(vec.y);
|
|
|
116 |
}
|
|
|
117 |
|
|
|
118 |
void NetworkPacket::write_packet (const NetworkPacket &pkt) {
|
|
33
|
119 |
// check buffer size
|
|
|
120 |
check_write_size(pkt.get_data_size());
|
|
|
121 |
|
|
|
122 |
// copy
|
|
|
123 |
memcpy(buf + offset, pkt.get_buf(), pkt.get_data_size());
|
|
|
124 |
|
|
|
125 |
// update offset/data_size
|
|
|
126 |
offset += pkt.get_data_size();
|
|
|
127 |
data_size += pkt.get_data_size();
|
|
|
128 |
}
|
|
36
|
129 |
|