-
Notifications
You must be signed in to change notification settings - Fork 9
/
event.go
220 lines (193 loc) · 5.01 KB
/
event.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
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
package socket
import (
"fmt"
"github.com/omzlo/clog"
"io"
)
type EventId byte
type Eventer interface {
Id() EventId
MsgId() uint16
SetMsgId(uint16)
Pack() ([]byte, error)
Unpack([]byte) error
String() string
}
// Event
//
//
type BaseEvent struct {
msgId uint16
eventId EventId
}
func (e BaseEvent) Id() EventId {
return e.eventId
}
func (e BaseEvent) MsgId() uint16 {
return e.msgId
}
func (e *BaseEvent) SetMsgId(mid uint16) {
e.msgId = mid
}
func (e BaseEvent) String() string {
return fmt.Sprintf("<BaseEvent %s %d>", e.Id(), e.Id())
}
func CreateEvent(eid EventId) BaseEvent {
return BaseEvent{msgId: 0, eventId: eid}
}
//
// MISC
//
func packLength(size uint) []byte {
dest := make([]byte, 5)
if size <= 0x80 {
dest[0] = byte(size)
return dest[:1]
}
if size < 0x100 {
dest[0] = 0x81
dest[1] = byte(size)
return dest[:2]
}
if size < 0x10000 {
dest[0] = 0x82
dest[1] = byte(size >> 8)
dest[2] = byte(size)
return dest[:3]
}
if size < 0x1000000 {
dest[0] = 0x83
dest[1] = byte(size >> 16)
dest[2] = byte(size >> 8)
dest[3] = byte(size)
return dest[:4]
}
dest[0] = 0x84
dest[1] = byte(size >> 24)
dest[2] = byte(size >> 16)
dest[3] = byte(size >> 8)
dest[4] = byte(size)
return dest
}
func EncodeEvent(w io.Writer, e Eventer) error {
var pv []byte
var err error
pv, err = e.Pack()
if err != nil {
return err
}
dest := make([]byte, 0, 8+len(pv)) // prealloc
dest = append(dest, byte(e.MsgId()>>8))
dest = append(dest, byte(e.MsgId()))
dest = append(dest, byte(e.Id()))
dest = append(dest, packLength(uint(len(pv)))...)
dest = append(dest, pv...)
//clog.DebugXX(">>> Sending [%d] %s\n", e.MsgId(), e)
_, err = w.Write(dest)
if err != nil {
return fmt.Errorf("Failed to write %d bytes for value of encoded event %d, %s", len(dest), e.Id(), err)
}
return nil
}
func DecodeEvent(r io.Reader) (Eventer, error) {
var rbuf [4]byte
var err error
var rlen uint
_, err = io.ReadFull(r, rbuf[:])
if err != nil {
return nil, err
}
msgId := (uint16(rbuf[0]) << 8) | uint16(rbuf[1])
eventId := EventId(rbuf[2])
if rbuf[3] <= 0x80 {
rlen = uint(rbuf[3])
} else {
switch rbuf[3] & 0xF {
case 1:
_, err = io.ReadFull(r, rbuf[:1])
rlen = uint(rbuf[0])
case 2:
_, err = io.ReadFull(r, rbuf[:2])
rlen = (uint(rbuf[0]) << 8) | uint(rbuf[1])
case 3:
_, err = io.ReadFull(r, rbuf[:3])
rlen = (uint(rbuf[0]) << 16) | (uint(rbuf[1]) << 8) | uint(rbuf[2])
case 4:
_, err = io.ReadFull(r, rbuf[:4])
rlen = (uint(rbuf[0]) << 24) | (uint(rbuf[1]) << 16) | (uint(rbuf[2]) << 8) | uint(rbuf[3])
default:
return nil, fmt.Errorf("Wrong byte length in event decoding (got %d)", rbuf[1])
}
if err != nil {
return nil, fmt.Errorf("Length read failed in event decoding, %s", err)
}
}
dbuf := make([]byte, rlen)
re, err := io.ReadFull(r, dbuf)
if err != nil {
return nil, fmt.Errorf("Expected %d bytes, but got %d bytes while decoding value for event %d (%s), %s", rlen, re, eventId, eventId, err)
}
// fmt.Printf("%q\n", dbuf[:rlen])
if msgId != 0 {
clog.DebugXX("Got message %d with event %s(%d) and %d bytes of payload", msgId, eventId, eventId, rlen)
} else {
clog.DebugXX("Got server message with event %s(%d) and %d bytes of payload", eventId, eventId, rlen)
}
var x Eventer
switch eventId {
case ClientHelloEventId:
x = NewClientHelloEvent("", 0, 0)
case ServerHelloEventId:
x = NewServerHelloEvent("", 9, 0)
case ChannelFilterEventId:
x = NewChannelFilterEvent()
case ServerAckEventId:
x = NewServerAckEvent(0)
case BusPowerStatusUpdateEventId:
x = NewBusPowerStatusUpdateEvent(nil)
case BusPowerEventId:
x = NewBusPowerEvent(true)
case ChannelUpdateRequestEventId:
x = NewChannelUpdateRequestEvent("", 0)
case ChannelUpdateEventId:
x = NewChannelUpdateEventEmpty()
case ChannelListRequestEventId:
x = NewChannelListRequestEvent()
case ChannelListEventId:
x = NewChannelListEvent()
case NodeUpdateRequestEventId:
x = NewNodeUpdateRequestEvent(0)
case NodeUpdateEventId:
x = NewNodeUpdateEvent()
case NodeListRequestEventId:
x = NewNodeListRequestEvent()
case NodeListEventId:
x = NewNodeListEvent()
case NodeFirmwareDownloadRequestEventId:
x = NewNodeFirmwareDownloadRequestEvent(0)
case NodeFirmwareEventId:
x = NewNodeFirmwareEvent(0)
case NodeFirmwareProgressEventId:
x = NewNodeFirmwareProgressEvent(0)
case NodeRebootRequestEventId:
x = NewNodeRebootRequestEvent(0, false)
case BusPowerStatusUpdateRequestEventId:
x = NewBusPowerStatusUpdateRequestEvent()
case DeviceInformationRequestEventId:
x = NewDeviceInformationRequestEvent()
case DeviceInformationEventId:
x = NewDeviceInformationEvent(nil)
case SystemPropertiesRequestEventId:
x = NewSystemPropertiesRequestEvent()
case SystemPropertiesEventId:
x = NewSystemPropertiesEvent(nil)
default:
return nil, fmt.Errorf("Unprocessable event %d with %d bytes of payload", eventId, rlen)
}
x.SetMsgId(msgId)
if err = x.Unpack(dbuf); err != nil {
return nil, err
}
//clog.DebugXX("<<< Receiving [%d] %s\n", x.MsgId(), x)
return x, nil
}