diff --git a/sw/airborne/subsystems/ins/ins_alt_float.c b/sw/airborne/subsystems/ins/ins_alt_float.c index 791a20fc7d..e72f84b28f 100644 --- a/sw/airborne/subsystems/ins/ins_alt_float.c +++ b/sw/airborne/subsystems/ins/ins_alt_float.c @@ -140,6 +140,9 @@ void ins_update_gps(void) { #if !USE_BAROMETER float falt = gps.hmsl / 1000.; EstimatorSetAlt(falt); + if (!alt_kalman_enabled) { + ins_alt_dot = -gps.ned_vel.z / 100.; + } #endif utm.alt = ins_alt; // set position