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

AP_Frsky_Telem: use airspeed value w/o constraints of ground speed and AHRS_WIND_MAX

Browse Source
This commit is contained in:
floaledm 2016-10-26 14:22:40 -05:00 committed by Lucas De Marchi
parent 217da05c64
commit 7045013933
1 changed files with 4 additions and 4 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

8
libraries/AP_Frsky_Telem/AP_Frsky_Telem.cpp
View File

@ -735,10 +735,10 @@ uint32_t AP_Frsky_Telem::calc_velandyaw(void)
_ahrs.get_velocity_NED(velNED);
// vertical velocity in dm/s
velandyaw = prep_number(roundf(velNED.z * 10), 2, 1);
// horizontal velocity in dm/s (use airspeed if available, otherwise use groundspeed)
float aspeed;
if (_ahrs.airspeed_estimate(&aspeed)) { // send airspeed estimate from ahrs if available
velandyaw |= prep_number(roundf(aspeed * 10), 2, 1)<<VELANDYAW_XYVEL_OFFSET;
// horizontal velocity in dm/s (use airspeed if available and enabled - even if not used - otherwise use groundspeed)
const AP_Airspeed *aspeed = _ahrs.get_airspeed();
if (aspeed && aspeed->enabled()) {
velandyaw |= prep_number(roundf(aspeed->get_airspeed() * 10), 2, 1)<<VELANDYAW_XYVEL_OFFSET;
} else { // otherwise send groundspeed estimate from ahrs
velandyaw |= prep_number(roundf(_ahrs.groundspeed() * 10), 2, 1)<<VELANDYAW_XYVEL_OFFSET;
}