fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-10-26 01:53:34 +08:00
Code Issues Packages Projects Releases Wiki Activity

EKF: Fix bug causing repeated resets if GPS sensor disconnected

Browse Source
This commit is contained in:
Paul Riseborough
2016-11-05 09:36:06 +11:00
parent 2bc50489fd
commit 8aee45dd96
1 changed files with 2 additions and 2 deletions
Download Patch File Download Diff File Expand all files Collapse all files
EKF/control.cpp
+2 -2
View File
@@ -405,8 +405,8 @@ void Ekf::controlGpsFusion()
} }
} else { } else {
// handle the case where we do not have GPS and have not been using it for an extended period // handle the case where we do not have GPS and have not been using it for an extended period, but are still relying on it
if ((_time_last_imu - _time_last_gps > 10e6) && (_time_last_imu - _time_last_airspeed > 1e6) && (_time_last_imu - _time_last_optflow > 1e6)) { if ((_time_last_imu - _time_last_gps > 10e6) && (_time_last_imu - _time_last_airspeed > 1e6) && (_time_last_imu - _time_last_optflow > 1e6) && _control_status.flags.gps) {
// if we don't have a source of aiding to constrain attitude drift, // if we don't have a source of aiding to constrain attitude drift,
// then we need to switch to the non-aiding mode, zero the velocity states // then we need to switch to the non-aiding mode, zero the velocity states
// and set the synthetic GPS position to the current estimate // and set the synthetic GPS position to the current estimate