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

EKF: Don't use optical flow if GPS is good and the vehicle is not using range finder for height

Browse Source
This commit is contained in:
Paul Riseborough
2018-04-18 08:26:03 +10:00
parent 389786ef1b
commit 82de3141f0
1 changed files with 7 additions and 2 deletions
Download Patch File Download Diff File Expand all files Collapse all files
EKF/control.cpp
+7 -2
View File
@@ -352,8 +352,13 @@ void Ekf::controlOpticalFlowFusion()
}
} else {
_time_bad_motion_us = 0;
_time_good_motion_us = _imu_sample_delayed.time_us;
// inhibit flow use if GPS quality is good and we are not using range aiding
// this enables use of optical flow to improve station keeping when low and slow
if (_control_status.flags.gps && (_time_last_imu - _last_gps_fail_us > (uint64_t)5e6) && !_in_range_aid_mode) {
_time_bad_motion_us = _imu_sample_delayed.time_us;
} else {
_time_good_motion_us = _imu_sample_delayed.time_us;
}
}
// Inhibit flow use if on ground and motion is excessive