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
use super::*;
use crate::tx_ack::TxPkNack;
use std::convert::TryFrom;
const PROTOCOL_VERSION_INDEX: usize = 0;
const IDENTIFIER_INDEX: usize = 3;
const PACKET_PAYLOAD_START: usize = 8;
fn random_token(buffer: &[u8]) -> u16 {
(buffer[1] as u16) << 8 | buffer[2] as u16
}
pub fn gateway_mac(buffer: &[u8]) -> MacAddress {
MacAddress::new(array_ref![buffer, 0, 8])
}
pub trait Parser {
fn parse(buffer: &[u8]) -> std::result::Result<Packet, ParseError>;
}
impl Parser for Packet {
fn parse(buffer: &[u8]) -> std::result::Result<Packet, ParseError> {
if buffer[PROTOCOL_VERSION_INDEX] != PROTOCOL_VERSION {
return Err(ParseError::InvalidProtocolVersion);
};
match Identifier::try_from(buffer[IDENTIFIER_INDEX]) {
Err(_) => Err(ParseError::InvalidIdentifier),
Ok(id) => {
let random_token = random_token(buffer);
let buffer = &buffer[4..];
Ok(match id {
Identifier::PullData => {
let gateway_mac = gateway_mac(&buffer[..PACKET_PAYLOAD_START]);
pull_data::Packet {
random_token,
gateway_mac,
}
.into()
}
Identifier::PushData => {
let gateway_mac = gateway_mac(&buffer[..PACKET_PAYLOAD_START]);
let json_str = std::str::from_utf8(&buffer[PACKET_PAYLOAD_START..])?;
let data = serde_json::from_str(json_str)?;
push_data::Packet {
random_token,
gateway_mac,
data,
}
.into()
}
Identifier::TxAck => {
let gateway_mac = gateway_mac(&buffer[..PACKET_PAYLOAD_START]);
let data = if buffer.len() > PACKET_PAYLOAD_START {
let json_str = std::str::from_utf8(&buffer[PACKET_PAYLOAD_START..])?;
serde_json::from_str(json_str)?
} else {
TxPkNack::default()
};
tx_ack::Packet {
random_token,
gateway_mac,
data,
}
.into()
}
Identifier::PushAck => push_ack::Packet { random_token }.into(),
Identifier::PullAck => pull_ack::Packet { random_token }.into(),
Identifier::PullResp => {
let json_str = std::str::from_utf8(buffer)?;
let data = serde_json::from_str(json_str)?;
pull_resp::Packet { random_token, data }.into()
}
})
}
}
}
}