Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-03-05 13:14:03 -04:00
Code Issues Packages Projects Releases Wiki Activity

Tools: autotest: reduce verbosity of wait-for-heading

Browse Source
This commit is contained in:
Peter Barker 2018-08-17 12:48:36 +10:00 committed by Andrew Tridgell
parent 5c7e21d38f
commit f1a0ebfd10
1 changed files with 12 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

14
Tools/autotest/common.py
View File

@ -804,9 +804,19 @@ class AutoTest(ABC):
tstart = self.get_sim_time()
self.progress("Waiting for heading %u with accuracy %u" %
(heading, accuracy))
while self.get_sim_time() < tstart + timeout:
last_heading = -1
last_print_time = 0
while True:
now = self.get_sim_time_cached()
if now - tstart >= timeout:
break
m = self.mav.recv_match(type='VFR_HUD', blocking=True)
self.progress("Heading %u" % m.heading)
if (last_heading != m.heading or
now - last_print_time > 1):
self.progress("Heading %u (want %f +- %f)" % (
m.heading, heading, accuracy))
last_print_time = now
last_heading = heading
if math.fabs(m.heading - heading) <= accuracy:
self.progress("Attained heading %u" % heading)
return True