diff --git a/EKF/ekf.cpp b/EKF/ekf.cpp index 14a1e26fa0..25f721aafd 100644 --- a/EKF/ekf.cpp +++ b/EKF/ekf.cpp @@ -411,8 +411,8 @@ bool Ekf::initialiseFilter(void) // initialise the state covariance matrix initialiseCovariance(); - // initialise the terrain estimator - initHagl(); + // try to initialise the terrain estimator + _terrain_initialised = initHagl(); // reset the essential fusion timeout counters _time_last_hgt_fuse = _time_last_imu;