import enum from typing import Dict, Tuple from eive_tmtc.config.object_ids import PL_SUBSYSTEM_ID from spacepackets.ecss import PusTelecommand from eive_tmtc.tmtc.common import pack_mode_cmd_with_info from tmtccmd.config import CmdTreeNode from tmtccmd.tmtc import DefaultPusQueueHelper from tmtccmd.pus.s200_fsfw_mode import Subservice as ModeSubservice class ModeId(enum.IntEnum): OFF = 0 SUPV_ONLY = 10 MPSOC_STREAM = 11 CAM_STREAM = 12 EARTH_OBSV = 13 SCEX = 14 class OpCode(str, enum.Enum): OFF = "off" REPORT_ALL_MODES = "report_modes" class Info(str, enum.Enum): OFF = "Off Command" REPORT_ALL_MODES = "Report all modes" HANDLER_LIST: Dict[str, Tuple[int, str]] = { OpCode.OFF: (ModeId.OFF, Info.OFF), } def build_acs_subsystem_cmd(q: DefaultPusQueueHelper, cmd_str: str): info_prefix = "ACS Subsystem" if cmd_str == OpCode.REPORT_ALL_MODES: q.add_log_cmd(f"{info_prefix}: {Info.REPORT_ALL_MODES}") q.add_pus_tc( PusTelecommand( service=200, subservice=ModeSubservice.TC_MODE_ANNOUNCE_RECURSIVE, app_data=PL_SUBSYSTEM_ID, ) ) mode_info_tup = HANDLER_LIST.get(cmd_str) if mode_info_tup is None: return pack_mode_cmd_with_info( object_id=PL_SUBSYSTEM_ID, info=f"{info_prefix}: {mode_info_tup[1]}", submode=0, mode=mode_info_tup[0], q=q, ) def create_payload_subsystem_node() -> CmdTreeNode: payload_node = CmdTreeNode("payload", "Payload Subsystem") payload_node.add_child(CmdTreeNode(OpCode.OFF, Info.OFF)) payload_node.add_child(CmdTreeNode(OpCode.REPORT_ALL_MODES, Info.REPORT_ALL_MODES)) return payload_node