all import changes

eive_tmtc/tmtc/acs/gps.py

@@ -0,0 +1,84 @@
+import logging
+import struct
+
+from eive_tmtc.config.definitions import CustomServiceList
+from eive_tmtc.pus_tm.defs import PrintWrapper
+from tmtccmd.config import TmtcDefinitionWrapper, OpCodeEntry
+from tmtccmd.config.tmtc import tmtc_definitions_provider
+from tmtccmd.tc import DefaultPusQueueHelper
+from tmtccmd.tc.pus_3_fsfw_hk import make_sid, generate_one_hk_command
+from tmtccmd.util.tmtc_printer import FsfwTmTcPrinter
+
+_LOGGER = logging.getLogger(__name__)
+
+
+class OpCode:
+    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 SetId:
+    HK = 0
+
+
+@tmtc_definitions_provider
+def add_gps_cmds(defs: TmtcDefinitionWrapper):
+    oce = OpCodeEntry()
+    oce.add(keys=OpCode.RESET_GNSS, info=Info.RESET_GNSS)
+    oce.add(keys=OpCode.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: DefaultPusQueueHelper, op_code: str):
+    if op_code in OpCode.RESET_GNSS:
+        # TODO: This needs to be re-implemented
+        _LOGGER.warning("Reset pin handling needs to be re-implemented")
+    if op_code in OpCode.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=SetId.HK))
+        )
+
+
+def handle_gps_data(printer: FsfwTmTcPrinter, hk_data: bytes):
+    pw = PrintWrapper(printer)
+    pw.dlog(f"Received GPS data, HK data length {len(hk_data)}")
+    current_idx = 0
+    fmt_str = "!ddddBBBHBBBBBI"
+    inc_len = struct.calcsize(fmt_str)
+    (
+        lat,
+        long,
+        alt,
+        speed,
+        fix,
+        sats_in_use,
+        sats_in_view,
+        year,
+        month,
+        day,
+        hours,
+        minutes,
+        seconds,
+        unix_seconds,
+    ) = struct.unpack(fmt_str, hk_data[current_idx : current_idx + inc_len])
+    current_idx += inc_len
+    date_string = f"{day}.{month}.{year} {hours}:{minutes}:{seconds}"
+    pw.dlog(f"Lat: {lat} deg")
+    pw.dlog(f"Long: {long} deg")
+    pw.dlog(f"Altitude: {alt} m | Speed: {speed} m/s")
+    pw.dlog(
+        f"Fix Type: {fix} | Sats in View {sats_in_view} | Sats in Use {sats_in_use}"
+    )
+    pw.dlog(f"GNSS Date: {date_string}")
+    pw.dlog(f"Unix seconds {unix_seconds}")
+    printer.print_validity_buffer(validity_buffer=hk_data[current_idx:], num_vars=14)

eive_tmtc/tmtc/acs/gyros.py

@@ -1,7 +1,7 @@
 import enum
 import struct
 
-import config.objects as obj_ids
+import eive_tmtc.config.object_ids as obj_ids
 
 from eive_tmtc.pus_tm.defs import PrintWrapper
 from tmtccmd.util import ObjectIdU32

eive_tmtc/tmtc/acs/mgms.py

@@ -1,7 +1,7 @@
 import enum
 import struct
 
-import config.object_id as obj_ids
+import eive_tmtc.config.object_ids as obj_ids
 
 from eive_tmtc.pus_tm.defs import PrintWrapper
 from tmtccmd.util import ObjectIdU32

eive_tmtc/tmtc/acs/str_img_helper.py

@@ -0,0 +1,40 @@
+# -*- coding: utf-8 -*-
+"""
+@file   str_img_helper.py
+@brief  Commanding of the star tracker image helper object which is responsible for uploading
+        and downloading images to/from the star tracker.
+@details    Images to uplaod must be previously transferred to the OBC with the CFDP protocol.
+            Also downloaded images will be stored on the filesystem of the OBC and can be transferred via CFDP.
+@author J. Meier
+@date   29.11.2021
+"""
+import struct
+
+from spacepackets.ecss.tc import PusTelecommand
+from tmtccmd.tc import DefaultPusQueueHelper
+from tmtccmd.util import ObjectIdU32
+
+
+class Commands:
+    UPLOAD_IMAGE = 0
+    DOWNLOAD_IMAGE = 1
+
+
+class ImagePathDefs:
+    uploadFile = "/mnt/sd0/startracker/gemma.bin"
+
+
+def pack_str_img_helper_command(
+    object_id: ObjectIdU32, q: DefaultPusQueueHelper, op_code: str
+):
+    q.add_log_cmd(
+        f"Testing star tracker image helper object id: {object_id.as_hex_string}"
+    )
+    if op_code == "0":
+        q.add_log_cmd("Star tracker image helper: Upload image")
+        command = (
+            object_id.as_bytes
+            + struct.pack("!I", Commands.UPLOAD_IMAGE)
+            + bytearray(ImagePathDefs.uploadFile, "utf-8")
+        )
+        q.add_pus_tc(PusTelecommand(service=8, subservice=128, app_data=command))

eive_tmtc/tmtc/acs/sus.py

@@ -0,0 +1,29 @@
+import struct
+
+from eive_tmtc.pus_tm.defs import PrintWrapper
+from tmtccmd.util import ObjectIdU32
+from tmtccmd.util.tmtc_printer import FsfwTmTcPrinter
+
+
+class SetId:
+    HK = 3
+
+
+def handle_sus_hk(
+    object_id: ObjectIdU32, hk_data: bytes, printer: FsfwTmTcPrinter, set_id: int
+):
+    pw = PrintWrapper(printer)
+    pw.dlog(f"Received SUS HK data from {object_id}")
+    if set_id == SetId.HK:
+        current_idx = 0
+        temperature = struct.unpack("!f", hk_data[current_idx : current_idx + 4])[0]
+        current_idx += 4
+        channels = []
+        for _ in range(6):
+            channels.append(struct.unpack("!H", hk_data[current_idx : current_idx + 2]))
+            current_idx += 2
+        pw.dlog(f"Temperature: {temperature} C")
+        pw.dlog(f"AIN Channel | Raw Value (hex) | Raw Value (dec)")
+        for idx, val in enumerate(channels):
+            pw.dlog(f"{idx} | {val[0]:#06x} |" + str(val[0]).ljust(5))
+        printer.print_validity_buffer(validity_buffer=hk_data[current_idx:], num_vars=7)