mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-15 05:13:35 +08:00
EKF: Don't report terrain estimate invalid immediately when HAGL observations fail checks
This commit is contained in:
@@ -159,7 +159,7 @@ void Ekf::fuseHagl()
|
||||
bool Ekf::get_terrain_valid()
|
||||
{
|
||||
if (_terrain_initialised && _range_data_continuous && !_rng_stuck &&
|
||||
!_innov_check_fail_status.flags.reject_hagl) {
|
||||
(_time_last_imu - _time_last_hagl_fuse < 5E6)) {
|
||||
return true;
|
||||
|
||||
} else {
|
||||
|
||||
Reference in New Issue
Block a user