mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-05-23 15:07:34 +08:00
EKF: relax terrain update requirements for continuing optical flow use
This commit is contained in:
+2
-2
@@ -441,8 +441,8 @@ void Ekf::controlOpticalFlowFusion()
|
|||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
// fuse the data if the terrain/distance to bottom is valid
|
// fuse the data if the terrain/distance to bottom is valid but use a more relaxed check to enable it to survive bad range finder data
|
||||||
if (_control_status.flags.opt_flow && get_terrain_valid()) {
|
if (_control_status.flags.opt_flow && (_time_last_imu - _time_last_hagl_fuse < (uint64_t)10e6)) {
|
||||||
// Update optical flow bias estimates
|
// Update optical flow bias estimates
|
||||||
calcOptFlowBias();
|
calcOptFlowBias();
|
||||||
|
|
||||||
|
|||||||
Reference in New Issue
Block a user