|
1 | | -use satrs::spacepackets::time::cds::CdsTime; |
| 1 | +extern crate alloc; |
| 2 | + |
| 3 | +use satrs::spacepackets::{ |
| 4 | + ccsds_packet_len_for_user_data_len_with_checksum, time::cds::CdsTime, CcsdsPacketCreationError, |
| 5 | + CcsdsPacketCreatorWithReservedData, CcsdsPacketIdAndPsc, SpacePacketHeader, |
| 6 | +}; |
2 | 7 |
|
3 | 8 | pub mod config; |
4 | 9 | pub mod ids; |
5 | 10 |
|
| 11 | +#[derive( |
| 12 | + Debug, |
| 13 | + Copy, |
| 14 | + Clone, |
| 15 | + PartialEq, |
| 16 | + Eq, |
| 17 | + Hash, |
| 18 | + serde::Serialize, |
| 19 | + serde::Deserialize, |
| 20 | + num_enum::TryFromPrimitive, |
| 21 | + num_enum::IntoPrimitive, |
| 22 | +)] |
| 23 | +#[repr(u64)] |
| 24 | +pub enum ComponentId { |
| 25 | + Pcdu, |
| 26 | +} |
| 27 | + |
| 28 | +#[derive(Debug, Copy, Clone, PartialEq, Eq, serde::Serialize, serde::Deserialize)] |
| 29 | +pub enum MessageType { |
| 30 | + Ping, |
| 31 | + Mode, |
| 32 | + Hk, |
| 33 | + Action, |
| 34 | + Verification, |
| 35 | +} |
| 36 | + |
| 37 | +/// Unserialized owned TM packet which can be cloned and sent around. |
| 38 | +#[derive(Debug, Clone, PartialEq, Eq)] |
| 39 | +pub struct CcsdsTmPacketOwned { |
| 40 | + pub sp_header: SpacePacketHeader, |
| 41 | + pub tm_header: TmHeader, |
| 42 | + pub payload: alloc::vec::Vec<u8>, |
| 43 | +} |
| 44 | + |
| 45 | +#[derive(Debug, thiserror::Error)] |
| 46 | +pub enum CcsdsCreationError { |
| 47 | + #[error("CCSDS packet creation error: {0}")] |
| 48 | + CcsdsPacketCreation(#[from] CcsdsPacketCreationError), |
| 49 | + #[error("postcard error: {0}")] |
| 50 | + Postcard(#[from] postcard::Error), |
| 51 | + #[error("timestamp generation error")] |
| 52 | + Time, |
| 53 | +} |
| 54 | + |
| 55 | +impl CcsdsTmPacketOwned { |
| 56 | + pub fn write_to_bytes(&self, buf: &mut [u8]) -> Result<usize, CcsdsCreationError> { |
| 57 | + let response_len = |
| 58 | + postcard::experimental::serialized_size(&self.tm_header)? + self.payload.len(); |
| 59 | + let mut ccsds_tm = CcsdsPacketCreatorWithReservedData::new_tm_with_checksum( |
| 60 | + self.sp_header, |
| 61 | + response_len, |
| 62 | + buf, |
| 63 | + )?; |
| 64 | + let user_data = ccsds_tm.packet_data_mut(); |
| 65 | + let ser_len = postcard::to_slice(&self.tm_header, user_data)?.len(); |
| 66 | + user_data[ser_len..ser_len + self.payload.len()].copy_from_slice(&self.payload); |
| 67 | + let ccsds_packet_len = ccsds_tm.finish(); |
| 68 | + Ok(ccsds_packet_len) |
| 69 | + } |
| 70 | + |
| 71 | + pub fn len_written(&self) -> usize { |
| 72 | + ccsds_packet_len_for_user_data_len_with_checksum( |
| 73 | + postcard::experimental::serialized_size(&self.tm_header).unwrap() as usize |
| 74 | + + postcard::experimental::serialized_size(&self.payload).unwrap() as usize, |
| 75 | + ) |
| 76 | + .unwrap() |
| 77 | + } |
| 78 | + |
| 79 | + pub fn to_vec(&self) -> Result<alloc::vec::Vec<u8>, CcsdsCreationError> { |
| 80 | + let mut buf = alloc::vec![0u8; self.len_written()]; |
| 81 | + let len = self.write_to_bytes(&mut buf)?; |
| 82 | + buf.truncate(len); |
| 83 | + Ok(buf) |
| 84 | + } |
| 85 | +} |
| 86 | + |
| 87 | +#[derive(Debug, Copy, Clone, PartialEq, Eq, serde::Serialize, serde::Deserialize)] |
| 88 | +#[non_exhaustive] |
| 89 | +pub struct TmHeader { |
| 90 | + pub sender_id: ComponentId, |
| 91 | + pub target_id: ComponentId, |
| 92 | + pub message_type: MessageType, |
| 93 | + /// Telemetry can either be sent unsolicited, or as a response to telecommands. |
| 94 | + pub tc_id: Option<CcsdsPacketIdAndPsc>, |
| 95 | + /// Raw CDS short timestamp. |
| 96 | + pub timestamp: Option<[u8; 7]>, |
| 97 | +} |
| 98 | + |
| 99 | +#[derive(Debug, Copy, Clone, PartialEq, Eq, serde::Serialize, serde::Deserialize)] |
| 100 | +#[non_exhaustive] |
| 101 | +pub struct TcHeader { |
| 102 | + pub target_id: ComponentId, |
| 103 | + pub request_type: MessageType, |
| 104 | +} |
| 105 | + |
| 106 | +#[derive(Debug, Clone, PartialEq, Eq)] |
| 107 | +pub struct CcsdsTcPacketOwned { |
| 108 | + pub sp_header: SpacePacketHeader, |
| 109 | + pub tc_header: TcHeader, |
| 110 | + pub payload: alloc::vec::Vec<u8>, |
| 111 | +} |
| 112 | + |
6 | 113 | #[derive(Debug, PartialEq, Eq, Copy, Clone)] |
7 | 114 | pub enum DeviceMode { |
8 | 115 | Off = 0, |
|
0 commit comments