eive-tmtc/pus_tc/devs/gps.py

import enum

from config.definitions import CustomServiceList
from tmtccmd.config import TmTcDefWrapper, OpCodeEntry
from tmtccmd.tc import QueueHelper
from tmtccmd.tc.pus_3_fsfw_hk import make_sid, generate_one_hk_command
from tmtccmd.logging import get_console_logger


LOGGER = get_console_logger()


class OpCodes:
    REQ_OS_HK = ["0", "hk-os"]
    RESET_GNSS = ["5", "reset"]


class Info:
    REQ_OS_HK = "Request One-Shot HK"
    RESET_GNSS = "Reset GNSS using reset pin"


class SetIds:
    HK = 0


def add_gps_cmds(defs: TmTcDefWrapper):
    oce = OpCodeEntry()
    oce.add(keys=OpCodes.RESET_GNSS, info=Info.RESET_GNSS)
    oce.add(keys=OpCodes.REQ_OS_HK, info=Info.REQ_OS_HK)
    defs.add_service(
        name=CustomServiceList.GPS_CTRL.value,
        info="GPS/GNSS Controller",
        op_code_entry=oce,
    )


def pack_gps_command(object_id: bytes, q: QueueHelper, op_code: str):
    if op_code in OpCodes.RESET_GNSS:
        # TODO: This needs to be re-implemented
        LOGGER.warning("Reset pin handling needs to be re-implemented")
    if op_code in OpCodes.REQ_OS_HK:
        q.add_log_cmd(f"GMSS: {Info.REQ_OS_HK}")
        q.add_pus_tc(
            generate_one_hk_command(sid=make_sid(object_id=object_id, set_id=SetIds.HK))
        )