mirror of
https://github.com/PX4/PX4-Autopilot.git
synced 2026-05-22 06:14:14 +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) {
|
||||
// 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);
|
||||
stopRngHgtFusion();
|
||||
stopRngTerrFusion();
|
||||
|
||||
Reference in New Issue
Block a user