42 lines
1.8 KiB
Python
42 lines
1.8 KiB
Python
# -*- coding: utf-8 -*-
|
|
"""
|
|
@file tmtcc_tc_service200_mode.py
|
|
@brief PUS Service 200: PUS custom service 200: Mode commanding
|
|
@author R. Mueller
|
|
@date 02.05.2020
|
|
"""
|
|
from tmtccmd.config.definitions import QueueCommands
|
|
from spacepackets.ecss.tc import PusTelecommand
|
|
from tmtccmd.tc.packer import TcQueueT
|
|
from tmtccmd.tc.pus_200_fsfw_modes import pack_mode_data, Modes
|
|
from config.object_ids import TEST_DEVICE_ID
|
|
|
|
TEST_DEVICE_OBJ_ID = TEST_DEVICE_ID
|
|
|
|
|
|
def pack_service200_test_into(tc_queue: TcQueueT) -> TcQueueT:
|
|
tc_queue.appendleft((QueueCommands.PRINT, "Testing Service 200"))
|
|
# Object ID: Dummy Device
|
|
obj_id = TEST_DEVICE_OBJ_ID
|
|
# Set On Mode
|
|
tc_queue.appendleft((QueueCommands.PRINT, "Testing Service 200: Set Mode On"))
|
|
mode_data = pack_mode_data(obj_id, Modes.ON, 0)
|
|
command = PusTelecommand(service=200, subservice=1, ssc=2000, app_data=mode_data)
|
|
tc_queue.appendleft(command.pack_command_tuple())
|
|
# Set Normal mode
|
|
tc_queue.appendleft((QueueCommands.PRINT, "Testing Service 200: Set Mode Normal"))
|
|
mode_data = pack_mode_data(obj_id, Modes.NORMAL, 0)
|
|
command = PusTelecommand(service=200, subservice=1, ssc=2010, app_data=mode_data)
|
|
tc_queue.appendleft(command.pack_command_tuple())
|
|
# Set Raw Mode
|
|
tc_queue.appendleft((QueueCommands.PRINT, "Testing Service 200: Set Mode Raw"))
|
|
mode_data = pack_mode_data(obj_id, Modes.RAW, 0)
|
|
command = PusTelecommand(service=200, subservice=1, ssc=2020, app_data=mode_data)
|
|
tc_queue.appendleft(command.pack_command_tuple())
|
|
# Set Off Mode
|
|
tc_queue.appendleft((QueueCommands.PRINT, "Testing Service 200: Set Mode Off"))
|
|
mode_data = pack_mode_data(obj_id, Modes.OFF, 0)
|
|
command = PusTelecommand(service=200, subservice=1, ssc=2030, app_data=mode_data)
|
|
tc_queue.appendleft(command.pack_command_tuple())
|
|
return tc_queue
|