From c4e33d32ab71435df43c9ab830c17ef5e450b573 Mon Sep 17 00:00:00 2001
From: Jakob Meier <meier-jakob@gmx.de>
Date: Sun, 19 Dec 2021 14:49:22 +0100
Subject: [PATCH] write command

---
 config/hook_implementations.py |  2 ++
 pus_tc/star_tracker.py         | 27 ++++++++++++++++++++++++++-
 spacepackets                   |  2 +-
 3 files changed, 29 insertions(+), 2 deletions(-)

diff --git a/config/hook_implementations.py b/config/hook_implementations.py
index 690ac61..ab4a94b 100644
--- a/config/hook_implementations.py
+++ b/config/hook_implementations.py
@@ -315,6 +315,8 @@ def get_eive_service_op_code_dict(service_op_code_dict: ServiceOpCodeDictT):
         "29": ("Star Tracker: Set name of download image", {OpCodeDictKeys.TIMEOUT: 2.0}),
         "30": ("Star Tracker: Request histogram", {OpCodeDictKeys.TIMEOUT: 2.0}),
         "31": ("Star Tracker: Request contrast", {OpCodeDictKeys.TIMEOUT: 2.0}),
+        "32": ("Star Tracker: Set json filename", {OpCodeDictKeys.TIMEOUT: 2.0}),
+        "33": ("Star Tracker: Write", {OpCodeDictKeys.TIMEOUT: 2.0}),
     }
     service_star_tracker_tuple = ("Star tracker", op_code_dict_srv_star_tracker)
 
diff --git a/pus_tc/star_tracker.py b/pus_tc/star_tracker.py
index 6dc64ee..cd634f4 100644
--- a/pus_tc/star_tracker.py
+++ b/pus_tc/star_tracker.py
@@ -39,17 +39,21 @@ class StarTrackerActionIds:
     TRACKING = 47
     VALIDATION = 48
     ALGO = 49
+    CHECKSUM = 50
+    RAED = 51
+    WRITE = 52
     TAKE_IMAGE = 15
     STOP_IMAGE_LOADER = 55
     RESET_ERROR = 56
     CHANGE_DOWNLOAD_IMAGE = 57
+    SET_JSON_FILE_NAME = 58
 
 
 class ImagePathDefs:
     uploadFile = "/mnt/sd0/startracker/gemma.bin"
     downloadFile = "test_image.bin"
     downloadPath = "/mnt/sd0/startracker"
-    jsonFile = "/mnt/sd0/startracker/full.json"
+    jsonFile = "/mnt/sd0/startracker/test.json"
 
 
 def pack_star_tracker_commands(object_id: bytearray, tc_queue: TcQueueT, op_code: str) -> TcQueueT:
@@ -234,3 +238,24 @@ def pack_star_tracker_commands(object_id: bytearray, tc_queue: TcQueueT, op_code
         command = object_id + struct.pack('!I', StarTrackerActionIds.REQ_CONTRAST)
         command = PusTelecommand(service=8, subservice=128, ssc=56, app_data=command)
         tc_queue.appendleft(command.pack_command_tuple())
+    if op_code == "32":
+        tc_queue.appendleft((QueueCommands.PRINT, "Star tracker: Set json filename"))
+        command = object_id + struct.pack('!I', StarTrackerActionIds.SET_JSON_FILE_NAME) + \
+                  bytearray(ImagePathDefs.jsonFile, 'utf-8')
+        command = PusTelecommand(service=8, subservice=128, ssc=57, app_data=command)
+        tc_queue.appendleft(command.pack_command_tuple())
+    if op_code == "33":
+        tc_queue.appendleft((QueueCommands.PRINT, "Star tracker: Write"))
+        command = pack_write_command(object_id)
+        command = PusTelecommand(service=8, subservice=128, ssc=58, app_data=command)
+        tc_queue.appendleft(command.pack_command_tuple())
+
+
+def pack_write_command(object_id: bytearray) -> bytearray:
+    region = 1
+    address = 0
+    length = 1024
+    data = bytearray([1] * 1024)
+    command = object_id + struct.pack('!I', StarTrackerActionIds.WRITE) + struct.pack('!B', region) + \
+              struct.pack('I', address) + struct.pack('!H', length) + data
+    return command
diff --git a/spacepackets b/spacepackets
index 3265d5b..464274a 160000
--- a/spacepackets
+++ b/spacepackets
@@ -1 +1 @@
-Subproject commit 3265d5b780fb5a551962eb9126df3d7d5e70fbeb
+Subproject commit 464274a91ce31a28e3493a05089fcdbe0bdf285b