eive-tmtc/eive_tmtc/pus_tc/tc_handler.py

162 lines
7.2 KiB
Python
Raw Normal View History

2023-08-17 11:33:42 +02:00
import logging
from typing import cast
2023-08-17 16:42:53 +02:00
from eive_tmtc.config.definitions import (
CFDP_REMOTE_ENTITY_ID,
PUS_APID,
CFDP_LOCAL_ENTITY_ID,
)
2023-11-22 19:22:51 +01:00
from eive_tmtc.pus_tc.cmd_demux import handle_pus_procedure
2023-11-22 10:17:05 +01:00
from eive_tmtc.cfdp.handler import CfdpInCcsdsHandler
2023-08-17 11:33:42 +02:00
from tmtccmd import TcHandlerBase, ProcedureWrapper
2024-01-24 17:59:16 +01:00
from cfdppy.defs import CfdpRequestType
2023-08-17 11:33:42 +02:00
from tmtccmd.logging import get_current_time_string
from tmtccmd.logging.pus import RawTmtcTimedLogWrapper
2023-11-10 19:23:06 +01:00
from tmtccmd.tmtc import (
2023-08-17 11:33:42 +02:00
DefaultPusQueueHelper,
QueueWrapper,
FeedWrapper,
TcProcedureType,
SendCbParams,
TcQueueEntryType,
)
2023-09-13 13:37:10 +02:00
from tmtccmd.config.cfdp import generic_cfdp_params_to_put_request
2023-08-17 11:33:42 +02:00
from spacepackets.ecss import PusVerificator
2024-01-24 17:59:16 +01:00
from spacepackets.seqcount import FileSeqCountProvider
2023-08-17 11:33:42 +02:00
from spacepackets.cfdp import PduHolder, DirectiveType
_LOGGER = logging.getLogger(__name__)
class TcHandler(TcHandlerBase):
def __init__(
self,
seq_count_provider: FileSeqCountProvider,
2023-08-29 21:41:29 +02:00
cfdp_in_ccsds_handler: CfdpInCcsdsHandler,
2023-08-17 11:33:42 +02:00
pus_verificator: PusVerificator,
high_level_file_logger: logging.Logger,
raw_pus_logger: RawTmtcTimedLogWrapper,
gui: bool,
):
super().__init__()
self.cfdp_handler_started = False
self.seq_count_provider = seq_count_provider
self.pus_verificator = pus_verificator
self.high_level_file_logger = high_level_file_logger
self.pus_raw_logger = raw_pus_logger
self.gui = gui
2023-08-31 15:10:07 +02:00
self.proxy_op = True
2023-08-17 11:33:42 +02:00
self.queue_helper = DefaultPusQueueHelper(
queue_wrapper=QueueWrapper.empty(),
default_pus_apid=PUS_APID,
seq_cnt_provider=seq_count_provider,
pus_verificator=pus_verificator,
tc_sched_timestamp_len=4,
)
2023-08-29 21:41:29 +02:00
self.cfdp_in_ccsds_handler = cfdp_in_ccsds_handler
2023-08-17 11:33:42 +02:00
def cfdp_done(self) -> bool:
if self.cfdp_handler_started:
2023-08-31 15:10:07 +02:00
if (
not self.cfdp_in_ccsds_handler.put_request_pending()
and not self.proxy_op
):
2023-08-17 11:33:42 +02:00
self.cfdp_handler_started = False
return True
return False
def feed_cb(self, info: ProcedureWrapper, wrapper: FeedWrapper):
self.queue_helper.queue_wrapper = wrapper.queue_wrapper
2024-05-06 11:23:31 +02:00
if info.proc_type == TcProcedureType.TREE_COMMANDING:
handle_pus_procedure(info.to_tree_commanding_procedure(), self.queue_helper)
2023-08-17 11:33:42 +02:00
elif info.proc_type == TcProcedureType.CFDP:
self.handle_cfdp_procedure(info)
def send_cb(self, send_params: SendCbParams):
entry_helper = send_params.entry
if entry_helper.is_tc:
if entry_helper.entry_type == TcQueueEntryType.PUS_TC:
pus_tc_wrapper = entry_helper.to_pus_tc_entry()
# pus_tc_wrapper.pus_tc.apid = PUS_APID
raw_tc = pus_tc_wrapper.pus_tc.pack()
self.pus_raw_logger.log_tc(pus_tc_wrapper.pus_tc)
tc_info_string = f"Sent {pus_tc_wrapper.pus_tc}"
_LOGGER.info(tc_info_string)
self.high_level_file_logger.info(
f"{get_current_time_string(True)}: {tc_info_string}"
)
# with open("tc.bin", "wb") as of:
# of.write(raw_tc)
send_params.com_if.send(raw_tc)
elif entry_helper.entry_type == TcQueueEntryType.CCSDS_TC:
cfdp_packet_in_ccsds = entry_helper.to_space_packet_entry()
send_params.com_if.send(cfdp_packet_in_ccsds.space_packet.pack())
# TODO: Log raw CFDP packets similarly to how PUS packets are logged.
# - Log full raw format including space packet wrapper
# - Log context information: Transaction ID, and PDU type and directive
# Could re-use file logger. Should probably do that
# print(f"sending packet: [{cfdp_packet_in_ccsds.space_packet.pack()}]")
# with open(f"cfdp_packet_{self.cfdp_counter}", "wb") as of:
# of.write(cfdp_packet_in_ccsds.space_packet.pack())
# self.cfdp_counter += 1
elif entry_helper.entry_type == TcQueueEntryType.LOG:
log_entry = entry_helper.to_log_entry()
_LOGGER.info(log_entry.log_str)
self.high_level_file_logger.info(log_entry.log_str)
def handle_cfdp_procedure(self, info: ProcedureWrapper):
cfdp_procedure = info.to_cfdp_procedure()
if cfdp_procedure.cfdp_request_type == CfdpRequestType.PUT:
if (
2023-08-29 21:41:29 +02:00
not self.cfdp_in_ccsds_handler.put_request_pending()
2023-08-17 11:33:42 +02:00
and not self.cfdp_handler_started
):
2023-08-17 16:42:53 +02:00
put_req_cfg_wrapper = cfdp_procedure.request_wrapper.to_put_request()
if put_req_cfg_wrapper.cfg.proxy_op:
2023-08-31 15:10:07 +02:00
self.proxy_op = True
2023-09-13 13:37:10 +02:00
put_req = generic_cfdp_params_to_put_request(
params=put_req_cfg_wrapper.cfg,
local_id=CFDP_LOCAL_ENTITY_ID,
remote_id=CFDP_REMOTE_ENTITY_ID,
dest_id_proxy_put_req=CFDP_LOCAL_ENTITY_ID,
)
2023-08-17 11:33:42 +02:00
_LOGGER.info(
f"CFDP: Starting file put request with parameters:\n{put_req}"
)
2024-01-25 13:03:04 +01:00
assert put_req is not None
2023-08-29 21:41:29 +02:00
self.cfdp_in_ccsds_handler.cfdp_handler.put_request(put_req)
2023-08-17 11:33:42 +02:00
self.cfdp_handler_started = True
2024-01-25 13:03:04 +01:00
for source_pair, _ in self.cfdp_in_ccsds_handler:
if source_pair is not None:
pdu, sp = source_pair
pdu = cast(PduHolder, pdu)
if pdu.is_file_directive:
if pdu.pdu_directive_type == DirectiveType.METADATA_PDU:
metadata = pdu.to_metadata_pdu()
self.queue_helper.add_log_cmd(
"CFDP Source: Sending Metadata PDU for file with size "
f"{metadata.file_size}"
)
elif pdu.pdu_directive_type == DirectiveType.EOF_PDU:
self.queue_helper.add_log_cmd(
"CFDP Source: Sending EOF PDU"
)
else:
fd_pdu = pdu.to_file_data_pdu()
2023-08-17 11:33:42 +02:00
self.queue_helper.add_log_cmd(
2024-01-25 13:03:04 +01:00
"CFDP Source: Sending File Data PDU for segment at offset "
f"{fd_pdu.offset} with length {len(fd_pdu.file_data)}"
2023-08-17 11:33:42 +02:00
)
2024-01-25 13:03:04 +01:00
self.queue_helper.add_ccsds_tc(sp)
2023-08-29 21:41:29 +02:00
self.cfdp_in_ccsds_handler.source_handler.state_machine()
2023-08-17 11:33:42 +02:00
def queue_finished_cb(self, info: ProcedureWrapper):
if info is not None:
if info.proc_type == TcQueueEntryType.PUS_TC:
2024-05-06 11:23:31 +02:00
def_proc = info.to_tree_commanding_procedure()
2024-01-25 13:03:04 +01:00
_LOGGER.info(f"Finished queue for command {def_proc.cmd_path}")
2023-08-17 11:33:42 +02:00
elif info.proc_type == TcProcedureType.CFDP:
_LOGGER.info("Finished CFDP queue")