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

Tools:autotest: added test for FRSky PassThrough WIND frame 0x500C

Browse Source
This commit is contained in:
yaapu 2021-06-18 18:36:42 +02:00 committed by Andrew Tridgell
parent 617b023c6f
commit 17cdb07bd5
1 changed files with 17 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

17
Tools/autotest/common.py
View File

@ -877,6 +877,7 @@ class FRSkySPort(FRSky):
0x5007: "parameters",
0x500A: "rpm",
0x500B: "terrain",
0x500C: "wind",
# SPort non-passthrough:
0x082F: "GALT", # gps altitude integer cm
@ -9829,6 +9830,21 @@ switch value'''
return True
return False
def tfp_validate_wind(self, value):
self.progress("validating wind(0x%02x)" % value)
speed_m = self.bit_extract(value, 8, 7) * (10 ^ self.bit_extract(value, 7, 1)) * 0.1 # speed in m/s
wind = self.mav.recv_match(
type='WIND',
blocking=True,
timeout=1
)
if wind is None:
raise NotAchievedException("Did not get WIND message")
self.progress("WIND mav==%f frsky==%f" % (speed_m, wind.speed))
if abs(speed_m - wind.speed) < 0.5:
return True
return False
def test_frsky_passthrough_do_wants(self, frsky, wants):
tstart = self.get_sim_time_cached()
@ -9958,6 +9974,7 @@ switch value'''
0x5003: self.tfp_validate_battery1,
0x5007: self.tfp_validate_params,
0x500B: self.tfp_validate_terrain,
0x500C: self.tfp_validate_wind,
}
self.test_frsky_passthrough_do_wants(frsky, wants)