eive-tmtc/pus_tc/system/core.py

293 lines
9.7 KiB
Python
Raw Normal View History

2021-08-03 15:28:28 +02:00
import enum
2022-05-24 01:13:21 +02:00
from config.definitions import CustomServiceList
2022-09-26 22:25:47 +02:00
from spacepackets.ecss import PusTelecommand
from tmtccmd.config import TmtcDefinitionWrapper
2022-07-04 17:59:09 +02:00
2022-08-08 16:32:18 +02:00
from tmtccmd.tc import DefaultPusQueueHelper
2022-08-24 11:24:25 +02:00
from tmtccmd.tc.pus_8_funccmd import make_fsfw_action_cmd
2022-04-05 00:51:52 +02:00
from tmtccmd.logging import get_console_logger
from tmtccmd.tc.pus_3_fsfw_hk import make_sid, generate_one_hk_command
from tmtccmd.config.tmtc import OpCodeEntry, tmtc_definitions_provider
2021-08-03 15:28:28 +02:00
from config.object_ids import CORE_CONTROLLER_ID
2022-07-05 02:12:54 +02:00
2021-08-03 15:28:28 +02:00
LOGGER = get_console_logger()
class ActionIds(enum.IntEnum):
2022-02-24 10:56:36 +01:00
LIST_DIR_INTO_FILE = 0
SWITCH_REBOOT_FILE_HANDLING = 5
2022-09-26 22:25:47 +02:00
RESET_REBOOT_COUNTER = 6
SWITCH_IMG_LOCK = 7
SET_MAX_REBOOT_CNT = 8
UPDATE_OBSW_FROM_SD_0 = 10
UPDATE_OBSW_FROM_SD_1 = 11
UPDATE_OBSW_FROM_TMP = 12
2022-05-24 01:13:21 +02:00
XSC_REBOOT = 32
FULL_REBOOT = 34
2021-08-03 15:28:28 +02:00
2022-03-13 21:35:12 +01:00
class SetIds(enum.IntEnum):
HK = 5
2022-03-13 21:35:12 +01:00
2022-02-24 10:56:36 +01:00
class OpCodes:
2022-08-29 15:43:29 +02:00
REBOOT_XSC = ["0", "reboot_xsc"]
XSC_REBOOT_SELF = ["1", "reboot_self"]
XSC_REBOOT_0_0 = ["2", "reboot_00"]
XSC_REBOOT_0_1 = ["3", "reboot_01"]
XSC_REBOOT_1_0 = ["4", "reboot_10"]
XSC_REBOOT_1_1 = ["5", "reboot_11"]
REBOOT_FULL = ["6", "reboot_regular"]
GET_HK = ["7", "get_hk"]
2022-09-26 22:25:47 +02:00
OBSW_UPDATE_FROM_SD_0 = ["obsw_update_sd0"]
OBSW_UPDATE_FROM_SD_1 = ["obsw_update_sd1"]
OBSW_UPDATE_FROM_TMP = ["obsw_update_tmp"]
2022-08-29 15:43:29 +02:00
ENABLE_REBOOT_FILE_HANDLING = ["32", "rbh_off"]
DISABLE_REBOOT_FILE_HANDLING = ["33", "rbh_on"]
RESET_ALL_REBOOT_COUNTERS = ["34", "rbh_reset_a"]
RESET_REBOOT_COUNTER_00 = ["35", "rbh_reset_00"]
RESET_REBOOT_COUNTER_01 = ["36", "rbh_reset_01"]
RESET_REBOOT_COUNTER_10 = ["37", "rbh_reset_10"]
RESET_REBOOT_COUNTER_11 = ["38", "rbh_reset_11"]
SET_MAX_REBOOT_CNT = ["39", "rbh_max_cnt"]
2022-05-24 01:13:21 +02:00
class Info:
REBOOT_XSC = "XSC reboot with prompt"
REBOOT_FULL = "Full regular reboot"
2022-09-26 22:25:47 +02:00
OBSW_UPDATE_FROM_SD_0 = "Update OBSW from SD Card 0"
OBSW_UPDATE_FROM_SD_1 = "Update OBSW from SD Card 1"
OBSW_UPDATE_FROM_TMP = "Update OBSW from tmp folder"
2021-08-03 15:28:28 +02:00
class Chip(enum.IntEnum):
CHIP_0 = 0
CHIP_1 = 1
NONE = 2
class Copy(enum.IntEnum):
COPY_0_NOM = 0
COPY_1_GOLD = 1
NONE = 2
@tmtc_definitions_provider
def add_core_controller_definitions(defs: TmtcDefinitionWrapper):
2022-07-05 02:12:54 +02:00
oce = OpCodeEntry()
oce.add(keys=OpCodes.REBOOT_XSC, info=Info.REBOOT_XSC)
oce.add(keys=OpCodes.REBOOT_XSC, info=Info.REBOOT_XSC)
oce.add(keys=OpCodes.REBOOT_FULL, info=Info.REBOOT_FULL)
oce.add(keys=OpCodes.XSC_REBOOT_SELF, info="Reboot Self")
oce.add(keys=OpCodes.XSC_REBOOT_0_0, info="Reboot 0 0")
oce.add(keys=OpCodes.XSC_REBOOT_0_1, info="Reboot 0 1")
oce.add(keys=OpCodes.XSC_REBOOT_1_0, info="Reboot 1 0")
oce.add(keys=OpCodes.XSC_REBOOT_1_1, info="Reboot 1 1")
oce.add(
2022-05-24 01:13:21 +02:00
keys=OpCodes.GET_HK,
info="Request housekeeping set",
)
2022-07-05 02:12:54 +02:00
oce.add(
2022-05-24 01:13:21 +02:00
keys=OpCodes.ENABLE_REBOOT_FILE_HANDLING,
info="Enable reboot file handling",
)
2022-07-05 02:12:54 +02:00
oce.add(
2022-05-24 01:13:21 +02:00
keys=OpCodes.DISABLE_REBOOT_FILE_HANDLING,
info="Disable reboot file handling",
)
2022-07-05 02:12:54 +02:00
oce.add(
2022-05-24 01:13:21 +02:00
keys=OpCodes.RESET_ALL_REBOOT_COUNTERS,
info="Reset all reboot counters",
)
2022-07-05 02:12:54 +02:00
oce.add(
2022-05-24 01:13:21 +02:00
keys=OpCodes.RESET_REBOOT_COUNTER_00,
info="Reset reboot counter 0 0",
)
2022-07-05 02:12:54 +02:00
oce.add(
2022-05-24 01:13:21 +02:00
keys=OpCodes.RESET_REBOOT_COUNTER_01,
info="Reset reboot counter 0 1",
)
2022-07-05 02:12:54 +02:00
oce.add(
2022-05-24 01:13:21 +02:00
keys=OpCodes.RESET_REBOOT_COUNTER_10,
info="Reset reboot counter 1 0",
)
2022-07-05 02:12:54 +02:00
oce.add(
2022-05-24 01:13:21 +02:00
keys=OpCodes.RESET_REBOOT_COUNTER_11,
info="Reset reboot counter 1 1",
)
2022-09-26 22:25:47 +02:00
oce.add(keys=OpCodes.OBSW_UPDATE_FROM_SD_0, info=Info.OBSW_UPDATE_FROM_SD_0)
oce.add(keys=OpCodes.OBSW_UPDATE_FROM_SD_1, info=Info.OBSW_UPDATE_FROM_SD_1)
oce.add(keys=OpCodes.OBSW_UPDATE_FROM_TMP, info=Info.OBSW_UPDATE_FROM_TMP)
2022-08-08 16:47:41 +02:00
defs.add_service(CustomServiceList.CORE.value, "Core Controller", oce)
2022-05-24 01:13:21 +02:00
2022-08-08 16:32:18 +02:00
def pack_core_commands(q: DefaultPusQueueHelper, op_code: str):
2022-05-24 01:13:21 +02:00
if op_code in OpCodes.REBOOT_XSC:
2021-08-03 15:28:28 +02:00
reboot_self, chip_select, copy_select = determine_reboot_params()
perform_reboot_cmd(
2022-07-04 17:59:09 +02:00
q=q,
2022-01-18 14:03:56 +01:00
reboot_self=reboot_self,
chip=chip_select,
copy=copy_select,
2021-08-03 15:28:28 +02:00
)
2022-05-24 01:13:21 +02:00
if op_code in OpCodes.REBOOT_FULL:
2022-07-04 17:59:09 +02:00
q.add_log_cmd(f"Core Command: {Info.REBOOT_FULL}")
q.add_pus_tc(
2022-08-24 11:24:25 +02:00
make_fsfw_action_cmd(
2022-07-04 17:59:09 +02:00
object_id=CORE_CONTROLLER_ID, action_id=ActionIds.FULL_REBOOT
)
2022-05-24 17:24:09 +02:00
)
2022-05-24 01:13:21 +02:00
if op_code in OpCodes.XSC_REBOOT_SELF:
2022-07-04 17:59:09 +02:00
perform_reboot_cmd(q=q, reboot_self=True)
2022-05-24 01:13:21 +02:00
if op_code in OpCodes.XSC_REBOOT_0_0:
2021-08-03 15:28:28 +02:00
perform_reboot_cmd(
2022-07-04 17:59:09 +02:00
q=q, reboot_self=False, chip=Chip.CHIP_0, copy=Copy.COPY_0_NOM
2021-08-03 15:28:28 +02:00
)
2022-05-24 01:13:21 +02:00
if op_code in OpCodes.XSC_REBOOT_0_1:
2021-08-03 15:28:28 +02:00
perform_reboot_cmd(
2022-07-04 17:59:09 +02:00
q=q,
2022-01-18 14:03:56 +01:00
reboot_self=False,
chip=Chip.CHIP_0,
copy=Copy.COPY_1_GOLD,
2021-08-03 15:28:28 +02:00
)
2022-05-24 01:13:21 +02:00
if op_code in OpCodes.XSC_REBOOT_1_0:
2021-08-03 15:28:28 +02:00
perform_reboot_cmd(
2022-07-04 17:59:09 +02:00
q=q, reboot_self=False, chip=Chip.CHIP_1, copy=Copy.COPY_0_NOM
2021-08-03 15:28:28 +02:00
)
2022-05-24 01:13:21 +02:00
if op_code in OpCodes.XSC_REBOOT_1_1:
2021-08-03 15:28:28 +02:00
perform_reboot_cmd(
2022-07-04 17:59:09 +02:00
q=q,
2022-01-18 14:03:56 +01:00
reboot_self=False,
chip=Chip.CHIP_1,
copy=Copy.COPY_1_GOLD,
2021-08-03 15:28:28 +02:00
)
2022-05-24 01:13:21 +02:00
if op_code in OpCodes.DISABLE_REBOOT_FILE_HANDLING:
2022-07-04 17:59:09 +02:00
q.add_log_cmd("Disabling reboot file handling")
2022-09-26 22:25:47 +02:00
user_data = bytearray([0])
q.add_pus_tc(
make_fsfw_action_cmd(
object_id=CORE_CONTROLLER_ID,
action_id=ActionIds.SWITCH_REBOOT_FILE_HANDLING,
user_data=user_data,
)
2022-02-24 10:56:36 +01:00
)
2022-05-24 01:13:21 +02:00
if op_code in OpCodes.ENABLE_REBOOT_FILE_HANDLING:
2022-07-04 17:59:09 +02:00
q.add_log_cmd("Enabling reboot file handling")
2022-09-26 22:25:47 +02:00
user_data = bytearray([1])
q.add_pus_tc(
make_fsfw_action_cmd(
object_id=CORE_CONTROLLER_ID,
action_id=ActionIds.SWITCH_REBOOT_FILE_HANDLING,
user_data=user_data,
)
2022-02-24 10:56:36 +01:00
)
2022-05-24 01:13:21 +02:00
if op_code in OpCodes.RESET_ALL_REBOOT_COUNTERS:
2022-07-04 17:59:09 +02:00
q.add_log_cmd("Resetting all reboot counters")
2022-09-26 22:25:47 +02:00
q.add_pus_tc(
make_fsfw_action_cmd(
object_id=CORE_CONTROLLER_ID,
action_id=ActionIds.RESET_REBOOT_COUNTER,
)
2022-02-24 10:56:36 +01:00
)
2022-05-24 01:13:21 +02:00
if op_code in OpCodes.RESET_REBOOT_COUNTER_00:
2022-09-26 22:25:47 +02:00
reset_specific_boot_counter(q, 0, 0)
2022-05-24 01:13:21 +02:00
if op_code in OpCodes.RESET_REBOOT_COUNTER_01:
2022-09-26 22:25:47 +02:00
reset_specific_boot_counter(q, 0, 1)
2022-05-24 01:13:21 +02:00
if op_code in OpCodes.RESET_REBOOT_COUNTER_10:
2022-09-26 22:25:47 +02:00
reset_specific_boot_counter(q, 1, 0)
2022-05-24 01:13:21 +02:00
if op_code in OpCodes.RESET_REBOOT_COUNTER_11:
2022-09-26 22:25:47 +02:00
reset_specific_boot_counter(q, 1, 1)
if op_code in OpCodes.OBSW_UPDATE_FROM_SD_0:
q.add_log_cmd(Info.OBSW_UPDATE_FROM_SD_0)
q.add_pus_tc(pack_obsw_update_cmd(ActionIds.UPDATE_OBSW_FROM_SD_0))
if op_code in OpCodes.OBSW_UPDATE_FROM_SD_1:
q.add_log_cmd(Info.OBSW_UPDATE_FROM_SD_1)
q.add_pus_tc(pack_obsw_update_cmd(ActionIds.UPDATE_OBSW_FROM_SD_1))
if op_code in OpCodes.OBSW_UPDATE_FROM_TMP:
q.add_log_cmd(Info.OBSW_UPDATE_FROM_TMP)
q.add_pus_tc(pack_obsw_update_cmd(ActionIds.UPDATE_OBSW_FROM_TMP))
2022-05-24 01:13:21 +02:00
if op_code in OpCodes.GET_HK:
2022-07-04 17:59:09 +02:00
q.add_log_cmd("Requesting housekeeping set")
2022-03-13 21:35:12 +01:00
sid = make_sid(object_id=CORE_CONTROLLER_ID, set_id=SetIds.HK)
2022-07-04 17:59:09 +02:00
q.add_pus_tc(generate_one_hk_command(sid))
2021-08-03 15:28:28 +02:00
2022-09-26 22:25:47 +02:00
def reset_specific_boot_counter(q: DefaultPusQueueHelper, chip: int, copy: int):
q.add_log_cmd(f"Resetting boot counter {chip} {copy}")
q.add_pus_tc(
make_fsfw_action_cmd(
object_id=CORE_CONTROLLER_ID,
action_id=ActionIds.RESET_REBOOT_COUNTER,
user_data=bytes([chip, copy]),
)
)
2021-08-03 15:28:28 +02:00
def determine_reboot_params() -> (bool, Chip, Copy):
chip_select = -1
copy_select = -1
2022-01-18 14:03:56 +01:00
reboot_self = input("Reboot self? [y/n]: ")
if reboot_self in ["y", "yes", "1"]:
LOGGER.info("Rebooting currently running image")
2021-08-03 15:28:28 +02:00
return True, chip_select, copy_select
2022-01-18 14:03:56 +01:00
LOGGER.info("Rebooting image specified by chip and copy")
2022-09-26 22:25:47 +02:00
return False, determine_chip_and_copy()
def determine_chip_and_copy() -> (int, int):
2021-08-03 15:28:28 +02:00
while True:
2022-01-18 14:03:56 +01:00
chip_select = input("Chip select [0/1]: ")
if chip_select in ["0", "1"]:
if chip_select == "0":
2021-08-03 15:28:28 +02:00
chip_select = Chip.CHIP_0
else:
chip_select = Chip.CHIP_1
break
else:
2022-01-18 14:03:56 +01:00
LOGGER.warning("Invalid chip select value. Try again")
2021-08-03 15:28:28 +02:00
while True:
2022-01-18 14:03:56 +01:00
copy_select = input("Copy select [0/1]: ")
if copy_select in ["0", "1"]:
if copy_select == "0":
2021-08-03 15:28:28 +02:00
copy_select = Copy.COPY_0_NOM
else:
copy_select = Copy.COPY_1_GOLD
break
else:
2022-01-18 14:03:56 +01:00
LOGGER.warning("Invalid copy select value. Try again")
2022-09-26 22:25:47 +02:00
return chip_select, copy_select
def pack_obsw_update_cmd(action_id: int) -> PusTelecommand:
chip, copy = determine_chip_and_copy()
user_data = bytes([chip, copy])
return make_fsfw_action_cmd(
object_id=CORE_CONTROLLER_ID, action_id=action_id, user_data=user_data
)
2021-08-03 15:28:28 +02:00
def perform_reboot_cmd(
2022-08-08 16:32:18 +02:00
q: DefaultPusQueueHelper,
2022-01-18 14:03:56 +01:00
reboot_self: bool,
chip: Chip = Chip.NONE,
copy: Copy = Copy.NONE,
2021-08-03 15:28:28 +02:00
):
tc_data = bytearray()
if reboot_self:
2022-07-04 17:59:09 +02:00
q.add_log_cmd("Packing reboot command for current image")
2021-08-03 15:28:28 +02:00
tc_data.append(True)
else:
tc_data.append(False)
tc_data.append(chip)
tc_data.append(copy)
2022-07-04 17:59:09 +02:00
q.add_log_cmd(f"Packing reboot command for chip {chip} and copy {copy}")
q.add_pus_tc(
2022-08-24 11:24:25 +02:00
make_fsfw_action_cmd(
2022-07-04 17:59:09 +02:00
object_id=CORE_CONTROLLER_ID,
action_id=ActionIds.XSC_REBOOT,
2022-08-25 16:14:21 +02:00
user_data=tc_data,
2021-08-03 15:28:28 +02:00
)
)