gps non diag hk

pus_tc/devs/rtd.py

@@ -37,12 +37,14 @@ class OpCodes:
     ON = ["0", "on"]
     OFF = ["1", "off"]
     NORMAL = ["2", "normal"]
+    CONFIG_CMD = ["3", "Write config"]
 
 
 class Info:
     ON = "Switch handler on"
     OFF = "Switch handler off"
     NORMAL = "Switch handler normal"
+    WIRTE_CONFIG = "Write config"
 
 
 def specify_rtd_cmds(cmd_dict: ServiceOpCodeDictT):
@@ -90,6 +92,10 @@ def pack_rtd_commands(op_code: str, object_id: Optional[ObjectId], tc_queue: TcQ
             service=200, subservice=Subservices.TC_MODE_COMMAND, app_data=app_data
         )
         tc_queue.appendleft(cmd.pack_command_tuple())
+    if op_code in OpCodes.CONFIG_CMD:
+        command = object_id + CommandIds.PRINT_CLCW
+        command = PusTelecommand(service=8, subservice=128, ssc=30, app_data=command)
+        tc_queue.appendleft(command.pack_command_tuple())
 
 
 def prompt_rtd_idx():