eive-tmtc/tmtc/power/pdu1.py

# -*- coding: utf-8 -*-
"""PDU1 is mounted on the X2 slot of the P60 dock
@author J. Meier
@date   17.12.2020
"""
from config.object_ids import PDU_1_HANDLER_ID
from tmtc.power.common_power import (
    pack_gomspace_cmds,
    req_hk_cmds,
    PowerOpCodes,
    generic_on_cmd,
    generic_off_cmd,
)

from gomspace.gomspace_common import *
from gomspace.gomspace_pdu_definitions import *
from tmtccmd.config import OpCodeEntry


class Pdu1InfoBase:
    TCS = "Switch TCS Board"
    SYRLINKS = "Switch Syrlinks (COM)"
    STR = "Switch Startracker"
    MGT = "Switch Magnetorquer"
    SUS_N = "Switch Sun Sensor Board Nominal"
    SCEX = "Switch Solar Cell Experiment"
    PLOC = "Switch Payload On-Board Computer"
    ACS_A = "Switch ACS Board A-Side"


class Pdu1ChIndex(enum.IntEnum):
    TCS = 0
    SYRLINKS = 1
    STR = 2
    MGT = 3
    SUS_N = 4
    SCEX = 5
    PLOC = 6
    ACS_A = 7


class PDU1TestProcedure:
    """
    @brief  Use this class to define the tests to perform for the PDU2.
    @details    Setting all to True will run all tests.
                Setting all to False will only run the tests set to True.
    """

    all = False
    reboot = False
    ping = False
    read_temperature = False
    turn_channel_2_on = False  # Star Tracker connected to this channel (5V)
    turn_channel_2_off = False
    turn_channel_3_on = False  # MTQ connected to this channel (5V)
    turn_channel_3_off = False


def pack_pdu1_commands(object_id: ObjectIdU32, q: DefaultPusQueueHelper, op_code: str):
    q.add_log_cmd("Commanding PDU1")
    objb = object_id.as_bytes
    pdu1_cmds(q, op_code)
    pdu1_req_hk_cmds(q, op_code)
    pack_gomspace_cmds("PDU1", object_id, q, op_code)
    if PDU1TestProcedure.all or PDU1TestProcedure.ping:
        q.add_log_cmd("PDU1: Ping Test")
        ping_data = bytearray([0, 1, 2, 3, 4, 5, 6, 7, 8, 9])
        q.add_pus_tc(pack_ping_command(object_id, ping_data))
    if PDU1TestProcedure.all or PDU1TestProcedure.read_temperature:
        q.add_log_cmd("PDU1: Testing temperature reading")
        q.add_pus_tc(
            pack_get_param_command(
                objb,
                TableIds.hk,
                PduHkTable.temperature.parameter_address,
                PduHkTable.temperature.parameter_size,
            )
        )
    if PDU1TestProcedure.all or PDU1TestProcedure.turn_channel_2_on:
        q.add_log_cmd("PDU1: Turn channel 2 on (Star Tracker)")
        q.add_pus_tc(
            pack_set_param_command(
                objb,
                PduConfigTable.out_en_2.parameter_address,
                PduConfigTable.out_en_2.parameter_size,
                Channel.on,
            )
        )
    if PDU1TestProcedure.all or PDU1TestProcedure.turn_channel_2_off:
        q.add_log_cmd("PDU1: Turn channel 2 off (Star Tracker)")
        q.add_pus_tc(
            pack_set_param_command(
                objb,
                PduConfigTable.out_en_2.parameter_address,
                PduConfigTable.out_en_2.parameter_size,
                Channel.off,
            )
        )
    if PDU1TestProcedure.all or PDU1TestProcedure.turn_channel_3_on:
        q.add_log_cmd("PDU1: Turn channel 3 on (MTQ)")
        q.add_pus_tc(
            pack_set_param_command(
                objb,
                PduConfigTable.out_en_3.parameter_address,
                PduConfigTable.out_en_3.parameter_size,
                Channel.on,
            )
        )
    if PDU1TestProcedure.all or PDU1TestProcedure.turn_channel_3_off:
        q.add_log_cmd("PDU1: Turn channel 3 off (MTQ)")
        q.add_pus_tc(
            pack_set_param_command(
                objb,
                PduConfigTable.out_en_3.parameter_address,
                PduConfigTable.out_en_3.parameter_size,
                Channel.off,
            )
        )


def pdu1_req_hk_cmds(q: DefaultPusQueueHelper, op_code: str):
    req_hk_cmds(
        "PDU1", q, op_code, PDU_1_HANDLER_ID, [SetIds.PDU_1_CORE, SetIds.PDU_1_AUX]
    )


def info_on_pdu1(base: str) -> str:
    return "PDU1: " + base + " on"


def info_off_pdu1(base: str) -> str:
    return "PDU1: " + base + " off"


def pdu1_cmds(q: DefaultPusQueueHelper, op_code: str):
    if op_code in PowerOpCodes.TCS_ON:
        tcs_on_cmd(q)
    elif op_code in PowerOpCodes.TCS_OFF:
        tcs_off_cmd(q)
    elif op_code in PowerOpCodes.SYRLINKS_ON:
        syrlinks_on_cmd(q)
    elif op_code in PowerOpCodes.SYRLINKS_OFF:
        syrlinks_off_cmd(q)
    elif op_code in PowerOpCodes.STAR_TRACKER_ON:
        startracker_on_cmd(q)
    elif op_code in PowerOpCodes.STAR_TRACKER_OFF:
        startracker_off_cmd(q)
    elif op_code in PowerOpCodes.MGT_ON:
        mgt_on_cmd(q)
    elif op_code in PowerOpCodes.MGT_OFF:
        mgt_off_cmd(q)
    elif op_code in PowerOpCodes.SUS_N_ON:
        sun_sensor_nominal_on_cmd(q)
    elif op_code in PowerOpCodes.SUS_N_OFF:
        sun_sensor_nominal_off_cmd(q)
    elif op_code in PowerOpCodes.SCEX_ON:
        solar_cell_experiment_on_cmd(q)
    elif op_code in PowerOpCodes.SCEX_OFF:
        solar_cell_experiment_off_cmd(q)
    elif op_code in PowerOpCodes.PLOC_ON:
        ploc_on_cmd(q)
    elif op_code in PowerOpCodes.PLOC_OFF:
        ploc_off_cmd(q)
    elif op_code in PowerOpCodes.ACS_A_ON:
        acs_board_a_on_cmd(q)
    elif op_code in PowerOpCodes.ACS_A_OFF:
        acs_board_a_off_cmd(q)


def add_pdu1_common_defs(oce: OpCodeEntry):
    oce.add(keys=PowerOpCodes.TCS_ON, info=info_on_pdu1(Pdu1InfoBase.TCS))
    oce.add(keys=PowerOpCodes.TCS_OFF, info=info_off_pdu1(Pdu1InfoBase.TCS))
    oce.add(keys=PowerOpCodes.STAR_TRACKER_ON, info=info_on_pdu1(Pdu1InfoBase.STR))
    oce.add(keys=PowerOpCodes.STAR_TRACKER_OFF, info=info_off_pdu1(Pdu1InfoBase.STR))
    oce.add(keys=PowerOpCodes.SUS_N_ON, info=info_on_pdu1(Pdu1InfoBase.SUS_N))
    oce.add(keys=PowerOpCodes.SUS_N_OFF, info=info_off_pdu1(Pdu1InfoBase.SUS_N))
    oce.add(keys=PowerOpCodes.ACS_A_ON, info=info_on_pdu1(Pdu1InfoBase.ACS_A))
    oce.add(keys=PowerOpCodes.ACS_A_OFF, info=info_off_pdu1(Pdu1InfoBase.ACS_A))
    oce.add(keys=PowerOpCodes.SYRLINKS_ON, info=info_on_pdu1(Pdu1InfoBase.SYRLINKS))
    oce.add(keys=PowerOpCodes.SYRLINKS_OFF, info=info_off_pdu1(Pdu1InfoBase.SYRLINKS))
    oce.add(keys=PowerOpCodes.MGT_ON, info=info_on_pdu1(Pdu1InfoBase.MGT))
    oce.add(keys=PowerOpCodes.MGT_OFF, info=info_off_pdu1(Pdu1InfoBase.MGT))
    oce.add(keys=PowerOpCodes.PLOC_ON, info=info_on_pdu1(Pdu1InfoBase.PLOC))
    oce.add(keys=PowerOpCodes.PLOC_OFF, info=info_off_pdu1(Pdu1InfoBase.PLOC))
    oce.add(keys=PowerOpCodes.SCEX_ON, info=info_on_pdu1(Pdu1InfoBase.SCEX))
    oce.add(keys=PowerOpCodes.SCEX_OFF, info=info_off_pdu1(Pdu1InfoBase.SCEX))


def tcs_on_cmd(q: DefaultPusQueueHelper):
    generic_on_cmd(PDU_1_HANDLER_ID, q, Pdu1InfoBase.TCS, Pdu1ChIndex.TCS)


def tcs_off_cmd(q: DefaultPusQueueHelper):
    generic_off_cmd(PDU_1_HANDLER_ID, q, Pdu1InfoBase.TCS, Pdu1ChIndex.TCS)


def syrlinks_on_cmd(q: DefaultPusQueueHelper):
    generic_on_cmd(PDU_1_HANDLER_ID, q, Pdu1InfoBase.SYRLINKS, Pdu1ChIndex.SYRLINKS)


def syrlinks_off_cmd(q: DefaultPusQueueHelper):
    generic_off_cmd(PDU_1_HANDLER_ID, q, Pdu1InfoBase.SYRLINKS, Pdu1ChIndex.SYRLINKS)


def startracker_on_cmd(q: DefaultPusQueueHelper):
    generic_on_cmd(PDU_1_HANDLER_ID, q, Pdu1InfoBase.STR, Pdu1ChIndex.STR)


def startracker_off_cmd(q: DefaultPusQueueHelper):
    generic_off_cmd(PDU_1_HANDLER_ID, q, Pdu1InfoBase.STR, Pdu1ChIndex.STR)


def mgt_on_cmd(q: DefaultPusQueueHelper):
    generic_on_cmd(PDU_1_HANDLER_ID, q, Pdu1InfoBase.MGT, Pdu1ChIndex.MGT)


def mgt_off_cmd(q: DefaultPusQueueHelper):
    generic_off_cmd(PDU_1_HANDLER_ID, q, Pdu1InfoBase.MGT, Pdu1ChIndex.MGT)


def sun_sensor_nominal_on_cmd(q: DefaultPusQueueHelper):
    generic_on_cmd(PDU_1_HANDLER_ID, q, Pdu1InfoBase.SUS_N, Pdu1ChIndex.SUS_N)


def sun_sensor_nominal_off_cmd(q: DefaultPusQueueHelper):
    generic_off_cmd(PDU_1_HANDLER_ID, q, Pdu1InfoBase.SUS_N, Pdu1ChIndex.SUS_N)


def solar_cell_experiment_on_cmd(q: DefaultPusQueueHelper):
    generic_on_cmd(PDU_1_HANDLER_ID, q, Pdu1InfoBase.SCEX, Pdu1ChIndex.SCEX)


def solar_cell_experiment_off_cmd(q: DefaultPusQueueHelper):
    generic_off_cmd(PDU_1_HANDLER_ID, q, Pdu1InfoBase.SCEX, Pdu1ChIndex.SCEX)


def ploc_on_cmd(q: DefaultPusQueueHelper):
    generic_on_cmd(PDU_1_HANDLER_ID, q, Pdu1InfoBase.PLOC, Pdu1ChIndex.PLOC)


def ploc_off_cmd(q: DefaultPusQueueHelper):
    generic_off_cmd(PDU_1_HANDLER_ID, q, Pdu1InfoBase.PLOC, Pdu1ChIndex.PLOC)


def acs_board_a_on_cmd(q: DefaultPusQueueHelper):
    generic_on_cmd(PDU_1_HANDLER_ID, q, Pdu1InfoBase.ACS_A, Pdu1ChIndex.ACS_A)


def acs_board_a_off_cmd(q: DefaultPusQueueHelper):
    generic_on_cmd(PDU_1_HANDLER_ID, q, Pdu1InfoBase.ACS_A, Pdu1ChIndex.ACS_A)