53 lines
1.6 KiB
Python
53 lines
1.6 KiB
Python
import json
|
|
import ctypes
|
|
|
|
from target_simulator.core.sfp_structures import (
|
|
SfpRisStatusPayload,
|
|
RisScenario,
|
|
RisTarget,
|
|
RisTargetsBlock,
|
|
DSP_RIS_MAX_TGT,
|
|
)
|
|
from target_simulator.gui.sfp_debug_window import DebugPayloadRouter
|
|
|
|
|
|
def build_test_payload():
|
|
# build a minimal payload with scenario + one target enabled
|
|
payload = SfpRisStatusPayload()
|
|
# fill scenario
|
|
payload.scenario.timetag = 123456
|
|
payload.scenario.platform_azimuth = 1.23
|
|
payload.scenario.vx = 10.0
|
|
payload.scenario.vy = -2.5
|
|
payload.scenario.vz = 0.0
|
|
payload.scenario.baro_altitude = 100.0
|
|
payload.scenario.true_heading = 45.0
|
|
payload.scenario.latitude = 12.345678
|
|
payload.scenario.longitude = 98.765432
|
|
|
|
# fill first target
|
|
payload.tgt.tgt[0].flags = 1
|
|
payload.tgt.tgt[0].heading = 90.0
|
|
payload.tgt.tgt[0].x = 1.0
|
|
payload.tgt.tgt[0].y = 2.0
|
|
payload.tgt.tgt[0].z = 3.0
|
|
|
|
return bytes(payload)
|
|
|
|
|
|
def test_ris_router_parsing():
|
|
router = DebugPayloadRouter()
|
|
data = build_test_payload()
|
|
# call handler directly
|
|
router._handle_ris_status(bytearray(data))
|
|
# retrieve latest payloads
|
|
latest = router.get_and_clear_latest_payloads()
|
|
# Expect RIS_STATUS textual summary or raw
|
|
assert "RIS_STATUS" in latest
|
|
# textual content should include timetag and heading
|
|
txt = latest["RIS_STATUS"].decode("utf-8")
|
|
assert "timetag" in txt.lower() or "timetag" in txt
|
|
|
|
# Note: _handle_ris_status also stores RIS_STATUS as text; JSON variant stored by SfpDebugWindow logic
|
|
# If JSON is not present in router (router stores only last payload per key) we at least ensure textual parse exists
|