EKF: rework GPS quality check

This commit is contained in:
Paul Riseborough
2018-05-18 14:07:22 +10:00
committed by Lorenz Meier
parent 99a80387ed
commit 1cfe845751
+1 -1
View File
@@ -373,7 +373,7 @@ void Ekf::controlOpticalFlowFusion()
} else {
bool movement_ok = (_imu_sample_delayed.time_us - _time_bad_motion_us) > (uint64_t)5E6;
bool bad_gps_aiding = _control_status.flags.gps && _gps_error_norm > gps_err_norm_lim;
bool bad_gps_aiding = !_control_status.flags.gps || _gps_error_norm > gps_err_norm_lim;
if (movement_ok || bad_gps_aiding) {
_inhibit_flow_use = false;
}