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
use crate::error::*;
use crate::sp::{SpacePacketDataField, TxUserData};
use byteorder::{BigEndian, ByteOrder};
extern crate alloc;
#[derive(Debug)]
pub struct TcPacketHeader {
pub(crate) pus_ver_no: u8,
pub(crate) acknowledgement_flags: (bool, bool, bool, bool),
pub(crate) service_type: u8,
pub(crate) message_subtype: u8,
pub(crate) source_id: u16,
}
impl TcPacketHeader {
pub(crate) const PUS_VER_NO: u8 = 2;
pub(crate) const TC_HEADER_LEN: usize = 5;
pub fn new(
acknowledgement_flags: (bool, bool, bool, bool),
service_type: u8,
message_subtype: u8,
source_id: u16,
) -> Result<Self, Error> {
Ok(TcPacketHeader {
pus_ver_no: TcPacketHeader::PUS_VER_NO,
acknowledgement_flags,
service_type,
message_subtype,
source_id,
})
}
pub fn from_bytes(buffer: &[u8]) -> Result<Self, Error> {
if buffer.len() != TcPacketHeader::TC_HEADER_LEN {
return Err(Error::InvalidPacket);
}
let ver_no_and_flags = buffer[0];
let service_type = buffer[1];
let message_subtype = buffer[2];
let source_id = BigEndian::read_u16(&buffer[3..5]);
let ver_no = ver_no_and_flags >> 4;
let flags = (
ver_no_and_flags & 0b0000_0001 != 0,
ver_no_and_flags & 0b0000_0010 != 0,
ver_no_and_flags & 0b0000_0100 != 0,
ver_no_and_flags & 0b0000_1000 != 0,
);
Ok(TcPacketHeader {
pus_ver_no: ver_no,
acknowledgement_flags: flags,
service_type,
message_subtype,
source_id,
})
}
pub fn to_bytes(&self) -> [u8; TcPacketHeader::TC_HEADER_LEN] {
let mut bytes: [u8; TcPacketHeader::TC_HEADER_LEN] = [0; TcPacketHeader::TC_HEADER_LEN];
let mut ver_no_and_flags = self.pus_ver_no << 4;
if self.acknowledgement_flags.0 {
ver_no_and_flags += 0b0000_0001
};
if self.acknowledgement_flags.1 {
ver_no_and_flags += 0b0000_0010
};
if self.acknowledgement_flags.2 {
ver_no_and_flags += 0b0000_0100
};
if self.acknowledgement_flags.3 {
ver_no_and_flags += 0b0000_1000
};
bytes[0] = ver_no_and_flags;
bytes[1] = self.service_type;
bytes[2] = self.message_subtype;
BigEndian::write_u16(&mut bytes[3..5], self.source_id);
bytes
}
}
pub trait TcData {
}
#[derive(Debug)]
pub struct TcPacket<T: TcData> {
pub(crate) header: TcPacketHeader,
pub(crate) user_data: TxUserData<T>,
}
impl<T: TcData> SpacePacketDataField for TcPacket<T> {
}