mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-05-23 15:57:35 +08:00
EKF: rework GPS quality check
This commit is contained in:
committed by
Lorenz Meier
parent
99a80387ed
commit
1cfe845751
+1
-1
@@ -373,7 +373,7 @@ void Ekf::controlOpticalFlowFusion()
|
|||||||
|
|
||||||
} else {
|
} else {
|
||||||
bool movement_ok = (_imu_sample_delayed.time_us - _time_bad_motion_us) > (uint64_t)5E6;
|
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) {
|
if (movement_ok || bad_gps_aiding) {
|
||||||
_inhibit_flow_use = false;
|
_inhibit_flow_use = false;
|
||||||
}
|
}
|
||||||
|
|||||||
Reference in New Issue
Block a user