mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-30 17:53:38 +08:00
EKF: Don't fallback when optical flow is lost if external vision data is being used
This commit is contained in:
+1
-1
@@ -336,7 +336,7 @@ void Ekf::controlOpticalFlowFusion()
|
|||||||
}
|
}
|
||||||
|
|
||||||
// handle the case when we are relying on optical flow fusion and lose it
|
// handle the case when we are relying on optical flow fusion and lose it
|
||||||
if (_control_status.flags.opt_flow && !_control_status.flags.gps) {
|
if (_control_status.flags.opt_flow && !_control_status.flags.gps && !_control_status.flags.ev_pos) {
|
||||||
// We are relying on flow aiding to constrain attitude drift so after 5s without aiding we need to do something
|
// We are relying on flow aiding to constrain attitude drift so after 5s without aiding we need to do something
|
||||||
if ((_time_last_imu - _time_last_of_fuse > 5e6)) {
|
if ((_time_last_imu - _time_last_of_fuse > 5e6)) {
|
||||||
// Switch to the non-aiding mode, zero the velocity states
|
// Switch to the non-aiding mode, zero the velocity states
|
||||||
|
|||||||
Reference in New Issue
Block a user