forked from Archive/PX4-Autopilot
EKF: Don't report terrain estimate invalid immediately when HAGL observations fail checks
This commit is contained in:
parent
1119a9b0ac
commit
4db23b7b2e
|
@ -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 {
|
||||
|
|
Loading…
Reference in New Issue