From 07381147f77e1ba51a2252e67e969703de4eb265 Mon Sep 17 00:00:00 2001 From: "Jakob.Meier" Date: Sat, 27 Feb 2021 13:09:55 +0100 Subject: [PATCH] syrlinks hk test wip --- config/tmtcc_object_ids.py | 2 ++ pus_tc/tmtcc_syrlinks_hk_handler.py | 31 +++++++++++++++++++++++++++++ pus_tm/tmtcc_pus_hk_handling.py | 30 ++++++++++++++++++++++++++-- 3 files changed, 61 insertions(+), 2 deletions(-) create mode 100644 pus_tc/tmtcc_syrlinks_hk_handler.py diff --git a/config/tmtcc_object_ids.py b/config/tmtcc_object_ids.py index 790f932..21e802c 100644 --- a/config/tmtcc_object_ids.py +++ b/config/tmtcc_object_ids.py @@ -21,6 +21,7 @@ class ObjectIds(enum.Enum): TMP1075_2_HANDLER_ID = auto() HEATER = auto() SOLAR_ARRAY_DEPLOYMENT_HANDLER = auto() + SYRLINKS_HK_HANDLER = auto() def set_object_ids(object_id_dict: Dict[ObjectIds, bytearray]): @@ -36,6 +37,7 @@ def set_object_ids(object_id_dict: Dict[ObjectIds, bytearray]): o_ids.TMP1075_2_HANDLER_ID: bytearray([0x44, 0x00, 0x00, 0x6]), o_ids.HEATER: bytearray([0x54, 0x00, 0x00, 0x3]), o_ids.SOLAR_ARRAY_DEPLOYMENT_HANDLER: bytearray([0x44, 0x00, 0x00, 0x8]), + o_ids.SYRLINKS_HK_HANDLER: bytearray([0x44, 0x00, 0x00, 0x9]), o_ids.INVALID: bytearray([0xFF, 0xFF, 0xFF, 0xFF]), } ) diff --git a/pus_tc/tmtcc_syrlinks_hk_handler.py b/pus_tc/tmtcc_syrlinks_hk_handler.py new file mode 100644 index 0000000..cb266de --- /dev/null +++ b/pus_tc/tmtcc_syrlinks_hk_handler.py @@ -0,0 +1,31 @@ +# -*- coding: utf-8 -*- +""" +@file tmtcc_tc_p60dock.py +@brief P60 Dock tests +@author J. Meier +@date 13.12.2020 +""" + +from tmtc_core.core.tmtc_core_definitions import QueueCommands +from tmtc_core.pus_tc.tmtcc_pus_tc_packer import TcQueueT +from tmtc_core.pus_tc.tmtcc_pus_tc_base import PusTelecommand +from tmtc_core.pus_tc.tmtcc_tc_service_3_housekeeping import * + + +class SetIds: + RX_REGISTERS_DATASET = bytearray(0x0, 0x0, 0x0, 0x1) + RX_REGISTERS_DATASET = bytearray(0x0, 0x0, 0x0, 0x2) + + +def pack_syrlinks_hk_handler_test_into(object_id: bytearray, tc_queue: TcQueueT) -> TcQueueT: + tc_queue.appendleft((QueueCommands.PRINT, "Syrlinks: Get RX Registers")) + sid = make_sid(object_id, SetIds.RX_REGISTERS_DATASET) + command = generate_one_hk_command(sid, 200) + tc_queue.appendleft(command.pack_command_tuple()) + + tc_queue.appendleft((QueueCommands.PRINT, "Syrlinks: Get TX Registers")) + sid = make_sid(object_id, SetIds.TX_REGISTERS_DATASET) + command = generate_one_hk_command(sid, 201) + tc_queue.appendleft(command.pack_command_tuple()) + + return tc_queue diff --git a/pus_tm/tmtcc_pus_hk_handling.py b/pus_tm/tmtcc_pus_hk_handling.py index 73eede3..68444b9 100644 --- a/pus_tm/tmtcc_pus_hk_handling.py +++ b/pus_tm/tmtcc_pus_hk_handling.py @@ -4,10 +4,12 @@ @details Template configuration file. Copy this folder to the TMTC commander root and adapt it to your needs. """ +import struct from typing import Tuple from tmtc_core.pus_tm.tmtcc_pus_service_3 import Service3Base from tmtc_core.utility.tmtcc_logger import get_logger +from config.tmtcc_object_ids import ObjectIds LOGGER = get_logger() @@ -22,5 +24,29 @@ def handle_user_hk_packet( @param service3_packet: @return: """ - LOGGER.info("Service3TM: Parsing for this SID has not been implemented.") - return [], [], bytearray() + if object_id == ObjectIds.SYRLINKS_HK_HANDLER.value: + return handle_syrlinks_hk_data(hk_data) + else: + LOGGER.info("Service 3 TM: Parsing for this SID has not been implemented.") + return [], [], bytearray(), 0 + + +def handle_syrlinks_hk_data(hk_data: bytearray) -> Tuple[list, list, bytearray, int]: + hk_header = [] + hk_content = [] + validity_buffer = bytearray() + hk_header = ["RX Status", "RX Sensitivity", "RX Frequency Shift", "RX IQ Power", "RX AGC Value", "RX Demod Eb", + "RX Demod N0", "RX Datarate"] + rx_status = hk_data[0] + rx_sensitivity = struct.unpack('!I', hk_data[1:5]) + rx_frequency_shift = struct.unpack('!I', hk_data[5:9]) + rx_iq_power = struct.unpack('!H', hk_data[9:13]) + rx_agc_value = struct.unpack('!H', hk_data[13:17]) + rx_demod_eb = struct.unpack('!I', hk_data[17:21]) + rx_demod_n0 = struct.unpack('!I', hk_data[21:25]) + rx_data_rate = hk_data[25] + hk_content = [rx_status, rx_sensitivity, rx_frequency_shift, rx_iq_power, rx_agc_value, rx_demod_eb, rx_demod_n0, + rx_data_rate] + validity_buffer.append(hk_data[26:]) + return hk_header, hk_content, validity_buffer, 8 +