Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-01-10 18:08:30 -04:00
Code Issues Packages Projects Releases Wiki Activity

SITL: add wait_sim_seconds and get_sim_time

Browse Source
This commit is contained in:
Randy Mackay 2015-04-08 08:24:39 +09:00
parent 2799d15427
commit 9e1502e54a
1 changed files with 12 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

12
Tools/autotest/common.py
View File

@ -55,6 +55,18 @@ def wait_seconds(seconds_to_wait):
while tstart + seconds_to_wait > tnow: while tstart + seconds_to_wait > tnow:
tnow = time.time() tnow = time.time()
def wait_sim_seconds(mav, seconds_to_wait):
m = mav.recv_match(type='SYSTEM_TIME', blocking=True)
tstart = m.time_boot_ms / 1000;
tnow = tstart
while tstart + seconds_to_wait > tnow:
m = mav.recv_match(type='SYSTEM_TIME', blocking=True)
tnow = m.time_boot_ms / 1000;
def get_sim_time(mav):
m = mav.recv_match(type='SYSTEM_TIME', blocking=True)
return m.time_boot_ms / 1000;
def wait_altitude(mav, alt_min, alt_max, timeout=30): def wait_altitude(mav, alt_min, alt_max, timeout=30):
climb_rate = 0 climb_rate = 0
previous_alt = 0 previous_alt = 0