-
Notifications
You must be signed in to change notification settings - Fork 10
/
Copy pathpacket.go
161 lines (124 loc) · 2.71 KB
/
packet.go
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
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
// Copyright 2017 Tim Oster. All rights reserved.
// Use of this source code is governed by the MIT license.
// More information can be found in the LICENSE file.
package rmnp
import (
"encoding/binary"
"hash/crc32"
)
type sequenceNumber uint16
type orderNumber uint8
type descriptor byte
const (
descReliable descriptor = 1 << iota
descAck
descOrdered
descConnect
descDisconnect
)
type packet struct {
protocolID byte
crc32 uint32
descriptor descriptor
// only contained in Reliable or Unreliable Ordered packets
sequence sequenceNumber
// only for Reliable Ordered packets
order orderNumber
// only contained in Ack packets
ack sequenceNumber
ackBits uint32
// body
data []byte
}
func (p *packet) serialize() []byte {
s := NewSerializer()
s.Write(p.protocolID)
s.Write(p.crc32)
s.Write(p.descriptor)
if p.flag(descReliable) || p.flag(descOrdered) {
s.Write(p.sequence)
}
if p.flag(descReliable) && p.flag(descOrdered) {
s.Write(p.order)
}
if p.flag(descAck) {
s.Write(p.ack)
s.Write(p.ackBits)
}
if p.data != nil && len(p.data) > 0 {
s.Write(p.data)
}
return s.Bytes()
}
func (p *packet) deserialize(packet []byte) bool {
s := NewSerializerFor(packet)
// head is valid (validated before data processing)
s.Read(&p.protocolID)
s.Read(&p.crc32)
s.Read(&p.descriptor)
if p.flag(descReliable) || p.flag(descOrdered) {
if s.Read(&p.sequence) != nil {
return false
}
}
if p.flag(descReliable) && p.flag(descOrdered) {
if s.Read(&p.order) != nil {
return false
}
}
if p.flag(descAck) {
if s.Read(&p.ack) != nil {
return false
}
if s.Read(&p.ackBits) != nil {
return false
}
}
if size := s.RemainingSize(); size > 0 {
p.data = make([]byte, size)
s.Read(&p.data)
}
return true
}
func (p *packet) calculateHash() {
p.crc32 = 0
buffer := p.serialize()
p.crc32 = crc32.ChecksumIEEE(buffer)
}
func (p *packet) flag(flag descriptor) bool {
return p.descriptor&flag != 0
}
func validateHeader(packet []byte) bool {
// 1b protocolId + 4b crc32 + 1b descriptor
if len(packet) < 6 {
return false
}
if packet[0] != CfgProtocolID {
return false
}
if len(packet) < headerSize(packet) {
return false
}
hash1 := binary.LittleEndian.Uint32(packet[1:5])
hash2 := crc32.ChecksumIEEE(append([]byte{packet[0], 0, 0, 0, 0}, packet[5:]...))
return hash1 == hash2
}
func headerSize(packet []byte) int {
desc := descriptor(packet[5])
size := 0
// protocolId (1) + crc (4) + descriptor (1)
size += 6
if desc&descReliable != 0 || desc&descOrdered != 0 {
// sequence (2)
size += 2
}
if desc&descReliable != 0 && desc&descOrdered != 0 {
// order (1)
size++
}
if desc&descAck != 0 {
// ack (2) + ackBits (4)
size += 6
}
return size
}