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
use super::*;
use crate::sp::{SpacePacketDataField, TxUserData};
use byteorder::{BigEndian, ByteOrder};
extern crate alloc;
#[derive(Debug)]
pub struct TmPacketHeader {
pub(crate) pus_ver_no: u8,
pub(crate) time_ref_status: u8,
pub(crate) service_type: u8,
pub(crate) message_subtype: u8,
pub(crate) message_type_counter: u16,
pub(crate) destination_id: u16,
pub(crate) abs_time: u16,
}
impl TmPacketHeader {
pub(crate) const PUS_VER_NO: u8 = 2;
pub(crate) const TM_HEADER_LEN: usize = 9;
pub(crate) const ABS_TIME_LEN: usize = 2;
pub fn new(service_type: u8, message_subtype: u8, destination_id: u16) -> Result<Self, Error> {
Ok(TmPacketHeader {
pus_ver_no: TmPacketHeader::PUS_VER_NO,
time_ref_status: 0,
service_type,
message_subtype,
message_type_counter: 0,
destination_id,
abs_time: 0,
})
}
pub fn from_bytes(buffer: &[u8]) -> Result<Self, Error> {
if buffer.len() != TmPacketHeader::TM_HEADER_LEN {
return Err(Error::InvalidPacket);
}
let ver_no_and_status = buffer[0];
let service_type = buffer[1];
let message_subtype = buffer[2];
let message_type_counter = BigEndian::read_u16(&buffer[3..5]);
let destination_id = BigEndian::read_u16(&buffer[5..7]);
let abs_time = BigEndian::read_u16(&buffer[7..7 + TmPacketHeader::ABS_TIME_LEN]);
let ver_no = ver_no_and_status >> 4;
let status = ver_no_and_status & 0b0000_1111;
Ok(TmPacketHeader {
pus_ver_no: ver_no,
time_ref_status: status,
service_type,
message_subtype,
message_type_counter,
destination_id,
abs_time,
})
}
pub fn to_bytes(&self) -> [u8; TmPacketHeader::TM_HEADER_LEN] {
let mut bytes: [u8; TmPacketHeader::TM_HEADER_LEN] = [0; TmPacketHeader::TM_HEADER_LEN];
let mut ver_no_and_status = self.pus_ver_no << 4;
ver_no_and_status += self.time_ref_status;
bytes[0] = ver_no_and_status;
bytes[1] = self.service_type;
bytes[2] = self.message_subtype;
BigEndian::write_u16(&mut bytes[3..5], self.message_type_counter);
BigEndian::write_u16(&mut bytes[5..7], self.destination_id);
BigEndian::write_u16(&mut bytes[7..9], self.abs_time);
bytes
}
}
pub trait TmData {
}
#[derive(Debug)]
pub struct TmPacket<T: TmData + core::fmt::Debug> {
pub(crate) header: TmPacketHeader,
pub(crate) user_data: TxUserData<T>,
}
impl<T: TmData + core::fmt::Debug> SpacePacketDataField for TmPacket<T> {
}