fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-05-23 17:37:34 +08:00
Code Issues Packages Projects Releases Wiki Activity

EKF: Fix GPS validity time check error

Browse Source
This commit is contained in:
Paul Riseborough
2018-05-15 10:07:57 +10:00
committed by Lorenz Meier
parent 0160aaa568
commit 092a8d8f21
1 changed files with 3 additions and 2 deletions
Download Patch File Download Diff File Expand all files Collapse all files
EKF/control.cpp
+3 -2
View File
@@ -1393,11 +1393,12 @@ void Ekf::controlMagFusion()
} }
// If optical flow is the only aiding source and GPS checks are failing, then assume that we are operating // If optical flow is the only aiding source and GPS checks are failing, then assume that we are operating
// indoors and the magnetometer is unreliable. // indoors and the magnetometer is unreliable. Becasue the optical flow sensor is body fixed, absolute yaw
// wrt North is not required for navigation and it is safer not to use the magnetometer.
if (_control_status.flags.opt_flow if (_control_status.flags.opt_flow
&& !_control_status.flags.gps && !_control_status.flags.gps
&& !_control_status.flags.ev_pos && !_control_status.flags.ev_pos
&& ((_last_gps_fail_us - _time_last_imu) < 5E6)) { && ((_time_last_imu - _last_gps_pass_us) > 5E6)) {
_mag_use_inhibit = true; _mag_use_inhibit = true;
} else { } else {
_mag_use_inhibit = false; _mag_use_inhibit = false;