changes to imtq (added dipole command packing as PUS) and proc (added MGT proc)
This commit is contained in:
parent
095cf822ee
commit
931cbe26e6
@ -211,7 +211,6 @@ def pack_imtq_test_into(
|
||||
z_dipole = 0
|
||||
duration = 0 # ms
|
||||
command = pack_dipole_command(object_id, x_dipole, y_dipole, z_dipole, duration)
|
||||
command = PusTelecommand(service=8, subservice=128, ssc=20, app_data=command)
|
||||
tc_queue.appendleft(command.pack_command_tuple())
|
||||
|
||||
if op_code == "0" or op_code == "8":
|
||||
@ -225,7 +224,7 @@ def pack_imtq_test_into(
|
||||
|
||||
def pack_dipole_command(
|
||||
object_id: bytearray, x_dipole: int, y_dipole: int, z_dipole: int, duration: int
|
||||
) -> bytearray:
|
||||
) -> PusTelecommand:
|
||||
"""This function packs the command causing the ISIS IMTQ to generate a dipole.
|
||||
@param object_id The object id of the IMTQ handler.
|
||||
@param x_dipole The dipole of the x coil in 10^-4*Am^2 (max. 2000)
|
||||
@ -242,4 +241,5 @@ def pack_dipole_command(
|
||||
command.extend(y_dipole.to_bytes(length=2, byteorder="big"))
|
||||
command.extend(z_dipole.to_bytes(length=2, byteorder="big"))
|
||||
command.extend(duration.to_bytes(length=2, byteorder="big"))
|
||||
command = PusTelecommand(service=8, subservice=128, ssc=22, app_data=command)
|
||||
return command
|
||||
|
||||
@ -29,6 +29,7 @@ from pus_tc.devs.imtq import ImtqSetIds
|
||||
from pus_tc.system.tcs import pack_tcs_sys_commands
|
||||
from pus_tc.system.controllers import pack_controller_commands
|
||||
from pus_tc.system.acs import pack_acs_command
|
||||
from pus_tc.devs.imtq import pack_dipole_command
|
||||
|
||||
|
||||
class OpCodes:
|
||||
@ -67,6 +68,8 @@ PROC_INFO_DICT = {
|
||||
KAI.TCS_FT_ON[0]: [OpCodes.TCS_FT_ON, KAI.TCS_FT_ON[1], 120.0, 10.0],
|
||||
KAI.TCS_FT_OFF[0]: [OpCodes.TCS_FT_OFF, KAI.TCS_FT_OFF[1], 120.0, 10.0],
|
||||
KAI.ACS_FT[0]: [OpCodes.ACS_FT, KAI.ACS_FT[1], 120.0, 10.0],
|
||||
KAI.MGT_FT[0]: [OpCodes.MGT_FT, KAI.MGT_FT[1], 120.0, 10.0],
|
||||
KAI.MGT_FT_DP[0]: [OpCodes.MGT_FT_DP, KAI.MGT_FT_DP[1], 120.0, 10.0],
|
||||
}
|
||||
|
||||
|
||||
@ -77,7 +80,7 @@ def generic_print(tc_queue: TcQueueT, info: dict):
|
||||
|
||||
|
||||
def pack_generic_hk_listening_cmds(
|
||||
tc_queue: TcQueueT, proc_key: str, sid_list: list[bytearray], diag: bool
|
||||
tc_queue: TcQueueT, proc_key: str, sid_list: list[bytearray], diag: bool, mgt: bool,
|
||||
):
|
||||
info = PROC_INFO_DICT[proc_key]
|
||||
collection_time = info[2]
|
||||
@ -92,6 +95,15 @@ def pack_generic_hk_listening_cmds(
|
||||
interval_seconds=info[3],
|
||||
)
|
||||
|
||||
if mgt is True:
|
||||
activate_mgts_alternately(
|
||||
tc_queue=tc_queue,
|
||||
)
|
||||
|
||||
else:
|
||||
pass
|
||||
|
||||
# collection_time maybe be reduced as a full 120seconds is not needed after MGTs are tested
|
||||
tc_queue.appendleft((QueueCommands.WAIT, collection_time))
|
||||
|
||||
for sid in sid_list:
|
||||
@ -105,32 +117,20 @@ def pack_generic_hk_listening_cmds(
|
||||
sid_list.clear()
|
||||
|
||||
|
||||
""" OLD
|
||||
listen_to_hk_for_x_seconds(
|
||||
diag=diag,
|
||||
tc_queue=tc_queue,
|
||||
device=proc_key,
|
||||
sid=sid,
|
||||
interval_seconds=info[3],
|
||||
collection_time=info[2],
|
||||
)
|
||||
"""
|
||||
|
||||
|
||||
def pack_proc_commands(tc_queue: TcQueueT, op_code: str):
|
||||
sid_list = []
|
||||
if op_code in OpCodes.BAT_FT:
|
||||
key = KAI.BAT_FT[0]
|
||||
sid_list.append(make_sid(oids.BPX_HANDLER_ID, BpxSetIds.GET_HK_SET))
|
||||
pack_generic_hk_listening_cmds(
|
||||
tc_queue=tc_queue, proc_key=key, sid_list=sid_list, diag=False
|
||||
tc_queue=tc_queue, proc_key=key, sid_list=sid_list, diag=False, mgt=False
|
||||
)
|
||||
|
||||
if op_code in OpCodes.CORE_FT:
|
||||
key = KAI.CORE_FT[0]
|
||||
sid_list.append(make_sid(oids.CORE_CONTROLLER_ID, CoreSetIds.HK))
|
||||
pack_generic_hk_listening_cmds(
|
||||
tc_queue=tc_queue, proc_key=key, sid_list=sid_list, diag=False
|
||||
tc_queue=tc_queue, proc_key=key, sid_list=sid_list, diag=False, mgt=False
|
||||
)
|
||||
|
||||
if op_code in OpCodes.PCDU_FT:
|
||||
@ -144,14 +144,14 @@ def pack_proc_commands(tc_queue: TcQueueT, op_code: str):
|
||||
sid_list.append(make_sid(oids.PDU_2_HANDLER_ID, GsSetIds.PDU_2_AUX))
|
||||
sid_list.append(make_sid(oids.ACU_HANDLER_ID, GsSetIds.ACU_AUX))
|
||||
pack_generic_hk_listening_cmds(
|
||||
tc_queue=tc_queue, proc_key=key, sid_list=sid_list, diag=False
|
||||
tc_queue=tc_queue, proc_key=key, sid_list=sid_list, diag=False, mgt=False
|
||||
)
|
||||
|
||||
if op_code in OpCodes.RAD_SEN_FT:
|
||||
key = KAI.RAD_SEN_FT[0]
|
||||
sid_list.append(make_sid(oids.RAD_SENSOR_ID, RadSetIds.RAD_SEN_CORE))
|
||||
pack_generic_hk_listening_cmds(
|
||||
tc_queue=tc_queue, proc_key=key, sid_list=sid_list, diag=False
|
||||
tc_queue=tc_queue, proc_key=key, sid_list=sid_list, diag=False, mgt=False
|
||||
)
|
||||
|
||||
if op_code in OpCodes.TCS_FT_ON:
|
||||
@ -177,7 +177,7 @@ def pack_proc_commands(tc_queue: TcQueueT, op_code: str):
|
||||
# GNSS0
|
||||
sid_list.append(make_sid(oids.GPS_HANDLER_0_ID, GnssSetIds_0.CORE_HK))
|
||||
pack_generic_hk_listening_cmds(
|
||||
tc_queue=tc_queue, proc_key=key, sid_list=sid_list, diag=False
|
||||
tc_queue=tc_queue, proc_key=key, sid_list=sid_list, diag=False, mgt=False
|
||||
)
|
||||
|
||||
pack_acs_command(tc_queue=tc_queue, op_code="acs-off")
|
||||
@ -194,7 +194,7 @@ def pack_proc_commands(tc_queue: TcQueueT, op_code: str):
|
||||
# GNSS1
|
||||
sid_list.append(make_sid(oids.GPS_HANDLER_1_ID, GnssSetIds_1.CORE_HK))
|
||||
pack_generic_hk_listening_cmds(
|
||||
tc_queue=tc_queue, proc_key=key, sid_list=sid_list, diag=False
|
||||
tc_queue=tc_queue, proc_key=key, sid_list=sid_list, diag=False, mgt=False
|
||||
)
|
||||
|
||||
pack_acs_command(tc_queue=tc_queue, op_code="acs-off")
|
||||
@ -217,7 +217,7 @@ def pack_proc_commands(tc_queue: TcQueueT, op_code: str):
|
||||
sid_list.append(make_sid(oids.GPS_HANDLER_0_ID, GnssSetIds_0.CORE_HK))
|
||||
sid_list.append(make_sid(oids.GPS_HANDLER_1_ID, GnssSetIds_1.CORE_HK))
|
||||
pack_generic_hk_listening_cmds(
|
||||
tc_queue=tc_queue, proc_key=key, sid_list=sid_list, diag=False
|
||||
tc_queue=tc_queue, proc_key=key, sid_list=sid_list, diag=False, mgt=False
|
||||
)
|
||||
|
||||
pack_acs_command(tc_queue=tc_queue, op_code="acs-off")
|
||||
@ -225,27 +225,37 @@ def pack_proc_commands(tc_queue: TcQueueT, op_code: str):
|
||||
if op_code in OpCodes.MGT_FT:
|
||||
key = KAI.MGT_FT[0]
|
||||
|
||||
# missing imtq to ON
|
||||
# mgt 1: imtq und hk
|
||||
|
||||
# MISSING: imtq board activation to ON (implementation pending by Jakob)
|
||||
|
||||
sid_list.append(make_sid(oids.IMTQ_HANDLER_ID, ImtqSetIds.ENG_HK_SET))
|
||||
sid_list.append(make_sid(oids.IMTQ_HANDLER_ID, ImtqSetIds.CAL_MTM_SET))
|
||||
sid_list.append(make_sid(oids.IMTQ_HANDLER_ID, ImtqSetIds.RAW_MTM_SET))
|
||||
pack_generic_hk_listening_cmds(
|
||||
tc_queue=tc_queue, proc_key=key, sid_list=sid_list, diag=False
|
||||
tc_queue=tc_queue, proc_key=key, sid_list=sid_list, diag=False, mgt=False
|
||||
)
|
||||
|
||||
# mgt 1: imtq und hk
|
||||
# MISSING: imtq board deactivation to OFF (implementation pending by Jakob)
|
||||
|
||||
# missing imtq to ON
|
||||
# mgt 2.: imtq + dual side + dipole
|
||||
|
||||
if op_code in OpCodes.MGT_FT_DP:
|
||||
key = KAI.MGT_FT[0]
|
||||
pack_acs_command(tc_queue=tc_queue, op_code="acs-a")
|
||||
key = KAI.MGT_FT_DP[0]
|
||||
pack_acs_command(tc_queue=tc_queue, op_code="acs-d")
|
||||
|
||||
# MISSING: imtq board activation to ON (implementation pending by Jakob)
|
||||
|
||||
sid_list.append(make_sid(oids.IMTQ_HANDLER_ID, ImtqSetIds.ENG_HK_SET))
|
||||
sid_list.append(make_sid(oids.IMTQ_HANDLER_ID, ImtqSetIds.CAL_MTM_SET))
|
||||
sid_list.append(make_sid(oids.IMTQ_HANDLER_ID, ImtqSetIds.RAW_MTM_SET))
|
||||
pack_generic_hk_listening_cmds(
|
||||
tc_queue=tc_queue, proc_key=key, sid_list=sid_list, diag=False
|
||||
tc_queue=tc_queue, proc_key=key, sid_list=sid_list, diag=False, mgt=True
|
||||
)
|
||||
|
||||
# MISSING: imtq board deactivation to OFF (implementation pending by Jakob)
|
||||
pack_acs_command(tc_queue=tc_queue, op_code="acs-off")
|
||||
|
||||
|
||||
@ -301,3 +311,31 @@ def disable_listen_to_hk_for_x_seconds(
|
||||
disable_periodic_hk_command(diag=diag, sid=sid, ssc=0).pack_command_tuple()
|
||||
)
|
||||
|
||||
|
||||
def activate_mgts_alternately(
|
||||
tc_queue: TcQueueT,
|
||||
):
|
||||
|
||||
command = pack_dipole_command(object_id=oids.IMTQ_HANDLER_ID, x_dipole=2000, y_dipole=0, z_dipole=0, duration=30000)
|
||||
tc_queue.appendleft(command.pack_command_tuple())
|
||||
tc_queue.appendleft((QueueCommands.WAIT, 10.0))
|
||||
|
||||
command = pack_dipole_command(object_id=oids.IMTQ_HANDLER_ID, x_dipole=-2000, y_dipole=0, z_dipole=0, duration=30000)
|
||||
tc_queue.appendleft(command.pack_command_tuple())
|
||||
tc_queue.appendleft((QueueCommands.WAIT, 10.0))
|
||||
|
||||
command = pack_dipole_command(object_id=oids.IMTQ_HANDLER_ID, x_dipole=0, y_dipole=2000, z_dipole=0, duration=30000)
|
||||
tc_queue.appendleft(command.pack_command_tuple())
|
||||
tc_queue.appendleft((QueueCommands.WAIT, 10.0))
|
||||
|
||||
command = pack_dipole_command(object_id=oids.IMTQ_HANDLER_ID, x_dipole=0, y_dipole=-2000, z_dipole=0, duration=30000)
|
||||
tc_queue.appendleft(command.pack_command_tuple())
|
||||
tc_queue.appendleft((QueueCommands.WAIT, 10.0))
|
||||
|
||||
command = pack_dipole_command(object_id=oids.IMTQ_HANDLER_ID, x_dipole=0, y_dipole=0, z_dipole=2000, duration=30000)
|
||||
tc_queue.appendleft(command.pack_command_tuple())
|
||||
tc_queue.appendleft((QueueCommands.WAIT, 10.0))
|
||||
|
||||
command = pack_dipole_command(object_id=oids.IMTQ_HANDLER_ID, x_dipole=0, y_dipole=0, z_dipole=-2000, duration=30000)
|
||||
tc_queue.appendleft(command.pack_command_tuple())
|
||||
tc_queue.appendleft((QueueCommands.WAIT, 10.0))
|
||||
|
||||
Loading…
Reference in New Issue
Block a user