mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-11-09 16:11:35 +08:00
ekf2: stop flow fusion on numerical error
This commit is contained in:
@@ -63,6 +63,7 @@ bool Ekf::fuseOptFlow(VectorState &H, const bool update_terrain)
|
|||||||
// we need to reinitialise the covariance matrix and abort this fusion step
|
// we need to reinitialise the covariance matrix and abort this fusion step
|
||||||
ECL_ERR("Opt flow error - covariance reset");
|
ECL_ERR("Opt flow error - covariance reset");
|
||||||
initialiseCovariance();
|
initialiseCovariance();
|
||||||
|
stopFlowFusion();
|
||||||
return false;
|
return false;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|||||||
Reference in New Issue
Block a user