2023-07-05 15:12:03 +02:00
|
|
|
use crate::tmtc::PusTcSource;
|
|
|
|
use log::{error, info, warn};
|
2024-02-03 13:41:51 +01:00
|
|
|
use satrs_core::pool::{PoolProviderMemInPlace, StaticMemoryPool};
|
|
|
|
use satrs_core::pus::scheduler::{PusScheduler, TcInfo};
|
2023-07-05 11:58:43 +02:00
|
|
|
use satrs_core::pus::scheduler_srv::PusService11SchedHandler;
|
2024-02-03 13:41:51 +01:00
|
|
|
use satrs_core::pus::{EcssTcInSharedStoreConverter, PusPacketHandlerResult};
|
2023-07-04 18:51:54 +02:00
|
|
|
|
2023-07-05 11:58:43 +02:00
|
|
|
pub struct Pus11Wrapper {
|
2024-02-03 13:41:51 +01:00
|
|
|
pub pus_11_handler: PusService11SchedHandler<EcssTcInSharedStoreConverter, PusScheduler>,
|
|
|
|
pub sched_tc_pool: StaticMemoryPool,
|
2023-07-05 15:12:03 +02:00
|
|
|
pub tc_source_wrapper: PusTcSource,
|
2023-07-05 11:58:43 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
impl Pus11Wrapper {
|
2023-07-05 15:12:03 +02:00
|
|
|
pub fn release_tcs(&mut self) {
|
2024-02-03 13:41:51 +01:00
|
|
|
let releaser = |enabled: bool, _info: &TcInfo, tc: &[u8]| -> bool {
|
2023-07-05 15:12:03 +02:00
|
|
|
if enabled {
|
2024-02-03 13:41:51 +01:00
|
|
|
// Transfer TC from scheduler TC pool to shared TC pool.
|
|
|
|
let released_tc_addr = self
|
|
|
|
.tc_source_wrapper
|
|
|
|
.tc_store
|
|
|
|
.pool
|
|
|
|
.write()
|
|
|
|
.expect("locking pool failed")
|
|
|
|
.add(tc)
|
|
|
|
.expect("adding TC to shared pool failed");
|
|
|
|
|
2023-07-05 15:12:03 +02:00
|
|
|
self.tc_source_wrapper
|
|
|
|
.tc_source
|
2024-02-03 13:41:51 +01:00
|
|
|
.send(released_tc_addr)
|
2023-07-05 15:12:03 +02:00
|
|
|
.expect("sending TC to TC source failed");
|
|
|
|
}
|
|
|
|
true
|
|
|
|
};
|
|
|
|
|
|
|
|
self.pus_11_handler
|
|
|
|
.scheduler_mut()
|
|
|
|
.update_time_from_now()
|
|
|
|
.unwrap();
|
2024-02-03 13:41:51 +01:00
|
|
|
let released_tcs = self
|
2023-07-05 15:12:03 +02:00
|
|
|
.pus_11_handler
|
|
|
|
.scheduler_mut()
|
2024-02-03 13:41:51 +01:00
|
|
|
.release_telecommands(releaser, &mut self.sched_tc_pool)
|
|
|
|
.expect("releasing TCs failed");
|
|
|
|
if released_tcs > 0 {
|
|
|
|
info!("{released_tcs} TC(s) released from scheduler");
|
2023-07-05 15:12:03 +02:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
pub fn handle_next_packet(&mut self) -> bool {
|
2024-02-03 13:41:51 +01:00
|
|
|
match self.pus_11_handler.handle_one_tc(&mut self.sched_tc_pool) {
|
2023-07-05 11:58:43 +02:00
|
|
|
Ok(result) => match result {
|
|
|
|
PusPacketHandlerResult::RequestHandled => {}
|
|
|
|
PusPacketHandlerResult::RequestHandledPartialSuccess(e) => {
|
|
|
|
warn!("PUS11 partial packet handling success: {e:?}")
|
|
|
|
}
|
|
|
|
PusPacketHandlerResult::CustomSubservice(invalid, _) => {
|
|
|
|
warn!("PUS11 invalid subservice {invalid}");
|
|
|
|
}
|
2023-07-05 14:25:51 +02:00
|
|
|
PusPacketHandlerResult::SubserviceNotImplemented(subservice, _) => {
|
|
|
|
warn!("PUS11: Subservice {subservice} not implemented");
|
|
|
|
}
|
2023-07-05 11:58:43 +02:00
|
|
|
PusPacketHandlerResult::Empty => {
|
|
|
|
return true;
|
|
|
|
}
|
|
|
|
},
|
|
|
|
Err(error) => {
|
|
|
|
error!("PUS packet handling error: {error:?}")
|
|
|
|
}
|
|
|
|
}
|
|
|
|
false
|
|
|
|
}
|
|
|
|
}
|