mirror of
https://github.com/PX4/PX4-Autopilot.git
synced 2026-06-04 05:05:19 +08:00
ekf2: range, check if terrain valid for reset on fusion timeout
This commit is contained in:
@@ -187,7 +187,7 @@ void Ekf::controlRangeHaglFusion()
|
|||||||
|
|
||||||
} else if (is_fusion_failing) {
|
} else if (is_fusion_failing) {
|
||||||
// Some other height source is still working
|
// Some other height source is still working
|
||||||
if (_hagl_sensor_status.flags.flow) {
|
if (_hagl_sensor_status.flags.flow && isTerrainEstimateValid()) {
|
||||||
ECL_WARN("stopping %s fusion, fusion failing", HGT_SRC_NAME);
|
ECL_WARN("stopping %s fusion, fusion failing", HGT_SRC_NAME);
|
||||||
stopRngHgtFusion();
|
stopRngHgtFusion();
|
||||||
stopRngTerrFusion();
|
stopRngTerrFusion();
|
||||||
|
|||||||
Reference in New Issue
Block a user