eive-tmtc/eive_tmtc/tmtc/power/power.py

157 lines
5.3 KiB
Python
Raw Normal View History

2023-01-24 13:06:08 +01:00
import enum
2023-02-01 11:17:04 +01:00
import logging
2023-01-24 13:06:08 +01:00
2022-11-29 16:53:29 +01:00
from eive_tmtc.tmtc.power.common_power import (
2022-08-11 18:10:15 +02:00
PowerOpCodes,
PowerInfo,
add_gomspace_cmd_defs,
2022-08-31 21:15:31 +02:00
pack_reset_gnd_wdt_cmd,
2022-08-11 18:10:15 +02:00
)
2022-11-29 16:53:29 +01:00
from eive_tmtc.config.definitions import CustomServiceList
from eive_tmtc.config.object_ids import (
2022-08-31 21:15:31 +02:00
P60_DOCK_HANDLER,
ACU_HANDLER_ID,
PDU_1_HANDLER_ID,
PDU_2_HANDLER_ID,
get_object_ids,
)
2022-11-29 16:53:29 +01:00
from eive_tmtc.tmtc.power.pdu1 import (
2022-10-18 10:44:32 +02:00
pdu1_req_hk_cmds,
2022-10-18 11:01:01 +02:00
pdu1_switch_cmds,
2022-10-18 10:44:32 +02:00
add_pdu1_common_defs,
add_pdu1_cmds,
)
2022-11-29 16:53:29 +01:00
from eive_tmtc.tmtc.power.pdu2 import (
2022-10-18 10:44:32 +02:00
pdu2_req_hk_cmds,
add_pdu2_common_defs,
2023-01-24 13:06:08 +01:00
pdu2_switch_cmds,
2022-10-18 10:44:32 +02:00
add_pdu2_cmds,
)
from tmtccmd.config import TmtcDefinitionWrapper, OpCodeEntry
2022-12-22 16:12:31 +01:00
from eive_tmtc.config.object_ids import PCDU_HANDLER_ID
2022-08-11 15:40:38 +02:00
2023-11-22 10:17:05 +01:00
from eive_tmtc.tmtc.power.p60dock import CmdString, CmdInfo, p60_dock_req_hk_cmds
2022-11-29 16:53:29 +01:00
from eive_tmtc.tmtc.power.acu import add_acu_cmds, acu_req_hk_cmds
2023-11-10 19:23:06 +01:00
from tmtccmd.pus.tc.s3_fsfw_hk import (
create_request_one_diag_command,
make_sid,
)
from tmtccmd.config.tmtc import tmtc_definitions_provider
2023-11-10 19:23:06 +01:00
from tmtccmd.tmtc import DefaultPusQueueHelper
2022-08-18 11:09:35 +02:00
2023-01-24 13:06:08 +01:00
class SetId(enum.IntEnum):
SWITCHER_SET = 0
2022-08-18 11:09:35 +02:00
2023-02-27 14:57:57 +01:00
class PcduSetIds(enum.IntEnum):
2022-12-22 16:12:31 +01:00
SWITCHER_SET = 0
2023-03-28 14:50:14 +02:00
class PcduSwitches(enum.IntEnum):
PDU1_CH0_TCS_BOARD_3V3 = 0
PDU1_CH1_SYRLINKS_12V = 1
PDU1_CH2_STAR_TRACKER_5V = 2
PDU1_CH3_MGT_5V = 3
PDU1_CH4_SUS_NOMINAL_3V3 = 4
PDU1_CH5_SOLAR_CELL_EXP_5V = 5
PDU1_CH6_PLOC_12V = 6
PDU1_CH7_ACS_A_SIDE_3V3 = 7
PDU1_CH8_UNOCCUPIED = 8
PDU2_CH0_Q7S = 9
PDU2_CH1_PL_PCDU_BATT_0_14V8 = 10
PDU2_CH2_RW_5V = 11
PDU2_CH3_TCS_BOARD_HEATER_IN_8V = 12
PDU2_CH4_SUS_REDUNDANT_3V3 = 13
PDU2_CH5_DEPLOYMENT_MECHANISM_8V = 14
PDU2_CH6_PL_PCDU_BATT_1_14V8 = 15
PDU2_CH7_ACS_BOARD_SIDE_B_3V3 = 16
PDU2_CH8_PAYLOAD_CAMERA = 17
P60_DOCK_5V_STACK = 18
2023-04-03 16:55:22 +02:00
P60_DOCK_3V3_STACK = 19
2023-03-28 14:50:14 +02:00
2023-11-22 10:17:05 +01:00
def pack_power_commands(q: DefaultPusQueueHelper, cmd_str: str):
pdu1_switch_cmds(q, cmd_str)
pdu2_switch_cmds(q, cmd_str)
if cmd_str in PowerOpCodes.SWITCHER_HK:
2022-12-22 16:12:31 +01:00
q.add_log_cmd("Requesting switcher state HK")
q.add_pus_tc(
2023-02-14 16:16:20 +01:00
create_request_one_diag_command(
make_sid(PCDU_HANDLER_ID, PcduSetIds.SWITCHER_SET)
)
2022-12-22 16:12:31 +01:00
)
2023-11-22 10:17:05 +01:00
if cmd_str in PowerOpCodes.INFO_CORE:
2022-10-18 10:44:32 +02:00
pdu1_req_hk_cmds(q, PowerOpCodes.REQUEST_CORE_HK_ONCE[0])
pdu2_req_hk_cmds(q, PowerOpCodes.REQUEST_CORE_HK_ONCE[0])
p60_dock_req_hk_cmds(q, PowerOpCodes.REQUEST_CORE_HK_ONCE[0])
acu_req_hk_cmds(q, PowerOpCodes.REQUEST_CORE_HK_ONCE[0])
2022-08-29 13:20:44 +02:00
q.add_wait_seconds(8.0)
2023-11-22 10:17:05 +01:00
elif cmd_str in PowerOpCodes.INFO_AUX:
2022-10-18 10:44:32 +02:00
pdu1_req_hk_cmds(q, PowerOpCodes.REQUEST_AUX_HK_ONCE[0])
pdu2_req_hk_cmds(q, PowerOpCodes.REQUEST_AUX_HK_ONCE[0])
p60_dock_req_hk_cmds(q, PowerOpCodes.REQUEST_AUX_HK_ONCE[0])
acu_req_hk_cmds(q, PowerOpCodes.REQUEST_AUX_HK_ONCE[0])
2022-08-29 13:20:44 +02:00
q.add_wait_seconds(8.0)
2023-11-22 10:17:05 +01:00
elif cmd_str in PowerOpCodes.INFO_ALL:
2022-10-18 10:44:32 +02:00
pdu1_req_hk_cmds(q, PowerOpCodes.REQUEST_CORE_HK_ONCE[0])
pdu2_req_hk_cmds(q, PowerOpCodes.REQUEST_CORE_HK_ONCE[0])
pdu1_req_hk_cmds(q, PowerOpCodes.REQUEST_AUX_HK_ONCE[0])
pdu2_req_hk_cmds(q, PowerOpCodes.REQUEST_AUX_HK_ONCE[0])
p60_dock_req_hk_cmds(q, PowerOpCodes.REQUEST_CORE_HK_ONCE[0])
p60_dock_req_hk_cmds(q, PowerOpCodes.REQUEST_AUX_HK_ONCE[0])
acu_req_hk_cmds(q, PowerOpCodes.REQUEST_CORE_HK_ONCE[0])
acu_req_hk_cmds(q, PowerOpCodes.REQUEST_AUX_HK_ONCE[0])
2022-08-29 13:20:44 +02:00
q.add_wait_seconds(8.0)
2023-11-22 10:17:05 +01:00
elif cmd_str in PowerOpCodes.RESET_ALL_GND_WDTS:
2022-08-31 21:15:31 +02:00
oids = get_object_ids()
pack_reset_gnd_wdt_cmd(q, "P60 Dock", oids[P60_DOCK_HANDLER])
pack_reset_gnd_wdt_cmd(q, "ACU", oids[ACU_HANDLER_ID])
pack_reset_gnd_wdt_cmd(q, "PDU1", oids[PDU_1_HANDLER_ID])
pack_reset_gnd_wdt_cmd(q, "PDU2", oids[PDU_2_HANDLER_ID])
2022-08-31 22:48:23 +02:00
q.add_wait_seconds(5.0)
2022-08-18 11:09:35 +02:00
if q.empty():
2023-02-01 15:58:34 +01:00
logging.getLogger(__name__).info(
2023-11-22 10:17:05 +01:00
f"Queue is empty, no stack for op code {cmd_str}"
2023-02-01 15:58:34 +01:00
)
2022-08-11 15:40:38 +02:00
@tmtc_definitions_provider
def add_p60_cmds(defs: TmtcDefinitionWrapper):
2022-08-11 15:40:38 +02:00
oce = OpCodeEntry()
2023-11-22 10:17:05 +01:00
oce.add(keys=CmdString.STACK_3V3_ON, info=CmdInfo.STACK_3V3_ON)
oce.add(keys=CmdString.STACK_3V3_OFF, info=CmdInfo.STACK_3V3_OFF)
oce.add(keys=CmdString.STACK_5V_ON, info=CmdInfo.STACK_5V_ON)
oce.add(keys=CmdString.STACK_5V_OFF, info=CmdInfo.STACK_5V_OFF)
add_gomspace_cmd_defs(oce)
2023-11-22 10:17:05 +01:00
oce.add(keys=CmdString.TEST, info="P60 Tests")
2022-08-11 15:40:38 +02:00
defs.add_service(
name=CustomServiceList.P60DOCK.value, info="P60 Device", op_code_entry=oce
)
2022-08-11 14:45:24 +02:00
@tmtc_definitions_provider
def add_power_cmd_defs(defs: TmtcDefinitionWrapper):
2022-08-11 18:10:15 +02:00
oce = OpCodeEntry()
add_pdu1_common_defs(oce)
add_pdu2_common_defs(oce)
2022-12-22 16:12:31 +01:00
oce.add(keys=PowerOpCodes.SWITCHER_HK, info=PowerInfo.SWITCHER_HK)
2022-08-11 18:10:15 +02:00
oce.add(keys=PowerOpCodes.INFO_ALL, info=PowerInfo.INFO_ALL)
oce.add(keys=PowerOpCodes.INFO_CORE, info=PowerInfo.INFO_CORE)
oce.add(keys=PowerOpCodes.INFO_AUX, info=PowerInfo.INFO_AUX)
2022-08-31 21:15:31 +02:00
oce.add(keys=PowerOpCodes.RESET_ALL_GND_WDTS, info=PowerInfo.RESET_ALL_GND_WDTS)
2022-08-11 18:10:15 +02:00
defs.add_service(
name=CustomServiceList.POWER.value,
info="Power Subsystem",
op_code_entry=oce,
)
def add_pcdu_cmds(defs: TmtcDefinitionWrapper):
2022-08-11 15:40:38 +02:00
add_p60_cmds(defs)
add_pdu1_cmds(defs)
add_pdu2_cmds(defs)
add_acu_cmds(defs)