AP_FrSky_Telem: fixed sign of vertical velocity (+ve up)

This commit is contained in:
Florent Martel 2016-12-04 14:49:22 -06:00 committed by Tom Pittenger
parent f9c8827809
commit abc2cdb61b

View File

@ -731,7 +731,7 @@ uint32_t AP_Frsky_Telem::calc_velandyaw(void)
// if we can't get velocity then we use zero for vertical velocity
_ahrs.get_velocity_NED(velNED);
// vertical velocity in dm/s
velandyaw = prep_number(roundf(velNED.z * 10), 2, 1);
velandyaw = prep_number(roundf(-velNED.z * 10), 2, 1);
// 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()) {