aepko/Ardupilot2
1
0
Fork 0
Code Issues Pull Requests Actions 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() tstart = self.get_sim_time()
self.progress("Waiting for heading %u with accuracy %u" % self.progress("Waiting for heading %u with accuracy %u" %
(heading, accuracy)) (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) 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: if math.fabs(m.heading - heading) <= accuracy:
self.progress("Attained heading %u" % heading) self.progress("Attained heading %u" % heading)
return True return True