Browse Source

fixed wrong condition on which gps height would be fused (#180)

- this solves the issue where height innovations would jump
between two regimes

Signed-off-by: Roman <bapstroman@gmail.com>
master
Roman Bapst 9 years ago committed by Lorenz Meier
parent
commit
df0f8fed45
  1. 2
      EKF/control.cpp

2
EKF/control.cpp

@ -398,7 +398,7 @@ void Ekf::controlGpsFusion()
} }
// Determine if GPS should be used as the height source // Determine if GPS should be used as the height source
if (((_params.vdist_sensor_type == VDIST_SENSOR_GPS) || _control_status.flags.gps) && !_gps_hgt_faulty) { if (((_params.vdist_sensor_type == VDIST_SENSOR_GPS)) && !_gps_hgt_faulty) {
_control_status.flags.baro_hgt = false; _control_status.flags.baro_hgt = false;
_control_status.flags.gps_hgt = true; _control_status.flags.gps_hgt = true;
_control_status.flags.rng_hgt = false; _control_status.flags.rng_hgt = false;

Loading…
Cancel
Save