Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-01-09 17:38:32 -04:00
Code Issues Packages Projects Releases Wiki Activity

autotest: add diagnostics to frsky passthrough test

Browse Source
This commit is contained in:
Peter Barker 2020-07-20 16:25:46 +10:00 committed by Peter Barker
parent 2e69317c2c
commit 3b0524a7e1
1 changed files with 25 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

25
Tools/autotest/common.py
View File

@ -541,9 +541,11 @@ class FRSkySPort(FRSky):
self.state = self.state_WANT_FRAME_TYPE self.state = self.state_WANT_FRAME_TYPE
self.data_by_id = {} self.data_by_id = {}
self.dataid_counts = {}
self.bad_chars = 0 self.bad_chars = 0
self.poll_sent = 0 self.poll_sent = 0
self.sensor_id_poll_counts = {}
self.id_descriptions = { self.id_descriptions = {
0x5000: "status text (dynamic)", 0x5000: "status text (dynamic)",
@ -588,6 +590,17 @@ class FRSkySPort(FRSky):
def handle_data(self, dataid, value): def handle_data(self, dataid, value):
self.progress("%s (0x%x)=%u" % (self.id_descriptions[dataid], dataid, value)) self.progress("%s (0x%x)=%u" % (self.id_descriptions[dataid], dataid, value))
self.data_by_id[dataid] = value self.data_by_id[dataid] = value
if dataid not in self.dataid_counts:
self.dataid_counts[dataid] = 0
self.dataid_counts[dataid] += 1
def dump_dataid_counts_as_progress_messages(self):
for dataid in self.dataid_counts:
self.progress("0x%x: %u (%s)" % (dataid, self.dataid_counts[dataid], self.id_descriptions[dataid]))
def dump_sensor_id_poll_counts_as_progress_messages(self):
for sensor_id in self.sensor_id_poll_counts:
self.progress("(0x%x): %u" % (sensor_id, self.sensor_id_poll_counts[sensor_id]))
def read_bytestuffed_byte(self): def read_bytestuffed_byte(self):
if sys.version_info.major >= 3: if sys.version_info.major >= 3:
@ -634,6 +647,9 @@ class FRSkySPort(FRSky):
if self.state == self.state_SEND_POLL: if self.state == self.state_SEND_POLL:
sensor_id = self.next_sensor() sensor_id = self.next_sensor()
self.progress("Sending poll for 0x%02x" % sensor_id) self.progress("Sending poll for 0x%02x" % sensor_id)
if sensor_id not in self.sensor_id_poll_counts:
self.sensor_id_poll_counts[sensor_id] = 0
self.sensor_id_poll_counts[sensor_id] += 1
buf = struct.pack('<BB', self.START_STOP_SPORT, sensor_id) buf = struct.pack('<BB', self.START_STOP_SPORT, sensor_id)
self.port.sendall(buf) self.port.sendall(buf)
self.state = self.state_WANT_FRAME_TYPE self.state = self.state_WANT_FRAME_TYPE
@ -6426,6 +6442,11 @@ switch value'''
wants_copy = copy.copy(wants) wants_copy = copy.copy(wants)
t2 = self.get_sim_time_cached() t2 = self.get_sim_time_cached()
if t2 - tstart > 300: if t2 - tstart > 300:
self.progress("Failed to get frsky data")
self.progress("Counts of sensor_id polls sent:")
frsky.dump_sensor_id_poll_counts_as_progress_messages()
self.progress("Counts of dataids received:")
frsky.dump_dataid_counts_as_progress_messages()
raise AutoTestTimeoutException("Failed to get frsky data") raise AutoTestTimeoutException("Failed to get frsky data")
frsky.update() frsky.update()
for want in wants_copy: for want in wants_copy:
@ -6436,6 +6457,10 @@ switch value'''
if wants[want](data): if wants[want](data):
self.progress(" Fulfilled") self.progress(" Fulfilled")
del wants[want] del wants[want]
self.progress("Counts of sensor_id polls sent:")
frsky.dump_sensor_id_poll_counts_as_progress_messages()
self.progress("Counts of dataids received:")
frsky.dump_dataid_counts_as_progress_messages()
def tfs_validate_gps_alt(self, value): def tfs_validate_gps_alt(self, value):
self.progress("validating gps altitude integer part (0x%02x)" % value) self.progress("validating gps altitude integer part (0x%02x)" % value)