aepko/Ardupilot2
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

autotest: improve diagnostics when waiting for EKF state

Browse Source
This commit is contained in:
Peter Barker 2023-05-05 10:42:47 +10:00 committed by Peter Barker
parent 871797d436
commit 74b23adfac
1 changed files with 6 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

6
Tools/autotest/common.py
View File

@ -7486,6 +7486,7 @@ Also, ignores heartbeats not from our target system'''
self.progress("Waiting for EKF value %u" % required_value) self.progress("Waiting for EKF value %u" % required_value)
last_print_time = 0 last_print_time = 0
tstart = self.get_sim_time() tstart = self.get_sim_time()
m = None
while timeout is None or self.get_sim_time_cached() < tstart + timeout: while timeout is None or self.get_sim_time_cached() < tstart + timeout:
m = self.mav.recv_match(type='EKF_STATUS_REPORT', blocking=True, timeout=timeout) m = self.mav.recv_match(type='EKF_STATUS_REPORT', blocking=True, timeout=timeout)
if m is None: if m is None:
@ -7501,6 +7502,11 @@ Also, ignores heartbeats not from our target system'''
if everything_ok: if everything_ok:
self.progress("EKF Flags OK") self.progress("EKF Flags OK")
return True return True
m_str = str(m)
if m is not None:
m_str = self.dump_message_verbose(m)
self.progress("Last EKF_STATUS_REPORT message:")
self.progress(m_str)
raise AutoTestTimeoutException("Failed to get EKF.flags=%u" % raise AutoTestTimeoutException("Failed to get EKF.flags=%u" %
required_value) required_value)