eive-tmtc/pus_tc/system/acs.py

125 lines
3.6 KiB
Python
Raw Normal View History

import enum
2022-07-04 17:59:09 +02:00
from tmtccmd.tc import QueueHelper
from tmtccmd.tc.pus_200_fsfw_modes import Modes
2022-03-22 10:14:22 +01:00
from config.object_ids import ACS_BOARD_ASS_ID, SUS_BOARD_ASS_ID
from .common import command_mode
2022-05-19 13:20:22 +02:00
2022-03-07 11:07:54 +01:00
class AcsOpCodes:
2022-03-22 09:54:57 +01:00
ACS_ASS_A_SIDE = ["0", "acs-a"]
ACS_ASS_B_SIDE = ["1", "acs-b"]
ACS_ASS_DUAL_MODE = ["2", "acs-d"]
ACS_ASS_OFF = ["3", "acs-off"]
ACS_ASS_A_ON = ["4", "acs-ao"]
ACS_ASS_B_ON = ["5", "acs-bo"]
ACS_ASS_DUAL_ON = ["6", "acs-do"]
2022-03-22 10:14:22 +01:00
class SusOpCodes:
SUS_ASS_NOM_SIDE = ["0", "sus-nom"]
SUS_ASS_RED_SIDE = ["1", "sus-red"]
SUS_ASS_DUAL_MODE = ["2", "sus-d"]
SUS_ASS_OFF = ["3", "sus-off"]
2022-03-22 09:54:57 +01:00
class DualSideSubmodes(enum.IntEnum):
A_SIDE = 0
B_SIDE = 1
DUAL_SIDE = 2
2022-07-04 17:59:09 +02:00
def pack_acs_command(q: QueueHelper, op_code: str):
2022-03-07 11:07:54 +01:00
if op_code in AcsOpCodes.ACS_ASS_A_SIDE:
command_mode(
2022-03-22 10:14:22 +01:00
object_id=ACS_BOARD_ASS_ID,
2022-03-22 09:54:57 +01:00
mode=Modes.NORMAL,
submode=DualSideSubmodes.A_SIDE,
2022-07-04 17:59:09 +02:00
q=q,
2022-03-22 09:54:57 +01:00
info="Switching to ACS board assembly A side",
)
2022-03-07 17:02:44 +01:00
if op_code in AcsOpCodes.ACS_ASS_B_SIDE:
command_mode(
2022-03-22 10:14:22 +01:00
object_id=ACS_BOARD_ASS_ID,
2022-03-22 09:54:57 +01:00
mode=Modes.NORMAL,
submode=DualSideSubmodes.B_SIDE,
2022-07-04 17:59:09 +02:00
q=q,
2022-03-22 09:54:57 +01:00
info="Switching to ACS board assembly B side",
)
2022-03-07 17:02:44 +01:00
if op_code in AcsOpCodes.ACS_ASS_DUAL_MODE:
command_mode(
2022-03-22 10:14:22 +01:00
object_id=ACS_BOARD_ASS_ID,
2022-03-22 09:54:57 +01:00
mode=Modes.NORMAL,
submode=DualSideSubmodes.DUAL_SIDE,
2022-07-04 17:59:09 +02:00
q=q,
2022-03-22 09:54:57 +01:00
info="Switching to ACS board assembly dual mode",
)
2022-03-07 17:02:44 +01:00
if op_code in AcsOpCodes.ACS_ASS_A_ON:
command_mode(
2022-03-22 10:14:22 +01:00
object_id=ACS_BOARD_ASS_ID,
2022-03-22 09:54:57 +01:00
mode=Modes.ON,
submode=DualSideSubmodes.A_SIDE,
2022-07-04 17:59:09 +02:00
q=q,
2022-03-22 09:54:57 +01:00
info="Switching ACS board assembly A side on",
)
2022-03-07 17:02:44 +01:00
if op_code in AcsOpCodes.ACS_ASS_B_ON:
command_mode(
2022-03-22 10:14:22 +01:00
object_id=ACS_BOARD_ASS_ID,
2022-03-22 09:54:57 +01:00
mode=Modes.ON,
submode=DualSideSubmodes.B_SIDE,
2022-07-04 17:59:09 +02:00
q=q,
2022-03-22 09:54:57 +01:00
info="Switching ACS board assembly B side on",
)
2022-03-07 17:02:44 +01:00
if op_code in AcsOpCodes.ACS_ASS_DUAL_ON:
command_mode(
2022-03-22 10:14:22 +01:00
object_id=ACS_BOARD_ASS_ID,
2022-03-22 09:54:57 +01:00
mode=Modes.ON,
submode=DualSideSubmodes.B_SIDE,
2022-07-04 17:59:09 +02:00
q=q,
2022-03-22 09:54:57 +01:00
info="Switching ACS board assembly dual side on",
)
2022-03-07 17:02:44 +01:00
if op_code in AcsOpCodes.ACS_ASS_OFF:
command_mode(
2022-03-22 10:14:22 +01:00
object_id=ACS_BOARD_ASS_ID,
2022-03-22 09:54:57 +01:00
mode=Modes.OFF,
submode=0,
2022-07-04 17:59:09 +02:00
q=q,
2022-03-22 09:54:57 +01:00
info="Switching to ACS board assembly off",
)
2022-03-22 10:14:22 +01:00
2022-07-04 17:59:09 +02:00
def pack_sus_cmds(q: QueueHelper, op_code: str):
2022-03-22 10:14:22 +01:00
if op_code in SusOpCodes.SUS_ASS_NOM_SIDE:
command_mode(
2022-03-22 10:14:22 +01:00
object_id=SUS_BOARD_ASS_ID,
2022-03-22 09:54:57 +01:00
mode=Modes.NORMAL,
submode=DualSideSubmodes.A_SIDE,
2022-07-04 17:59:09 +02:00
q=q,
2022-03-22 09:54:57 +01:00
info="Switching to SUS board to nominal side",
)
2022-03-22 10:14:22 +01:00
if op_code in SusOpCodes.SUS_ASS_RED_SIDE:
command_mode(
2022-03-22 10:14:22 +01:00
object_id=SUS_BOARD_ASS_ID,
2022-03-22 09:54:57 +01:00
mode=Modes.NORMAL,
submode=DualSideSubmodes.B_SIDE,
2022-07-04 17:59:09 +02:00
q=q,
2022-03-22 09:54:57 +01:00
info="Switching to SUS board to redundant side",
)
2022-03-22 10:14:22 +01:00
if op_code in SusOpCodes.SUS_ASS_OFF:
command_mode(
2022-03-22 10:14:22 +01:00
object_id=SUS_BOARD_ASS_ID,
2022-03-22 09:54:57 +01:00
mode=Modes.OFF,
submode=0,
2022-07-04 17:59:09 +02:00
q=q,
2022-03-22 09:54:57 +01:00
info="Switching SUS board off",
2022-03-07 11:07:54 +01:00
)
2022-03-22 11:05:48 +01:00
if op_code in SusOpCodes.SUS_ASS_DUAL_MODE:
command_mode(
2022-03-22 11:05:48 +01:00
object_id=SUS_BOARD_ASS_ID,
mode=Modes.NORMAL,
submode=DualSideSubmodes.DUAL_SIDE,
2022-07-04 17:59:09 +02:00
q=q,
2022-03-22 11:05:48 +01:00
info="Switching to SUS board to dual side",
)