diff --git a/src/modules/ekf2/EKF/covariance.cpp b/src/modules/ekf2/EKF/covariance.cpp index 9bc7bde143..d7c8ec7b19 100644 --- a/src/modules/ekf2/EKF/covariance.cpp +++ b/src/modules/ekf2/EKF/covariance.cpp @@ -105,7 +105,7 @@ void Ekf::initialiseCovariance() #endif // CONFIG_EKF2_WIND #if defined(CONFIG_EKF2_TERRAIN) - // use the ground clearance value as our uncertainty. TODO: wouldn't it make more sense to use the noise value instead? + // use the noise value as our uncertainty P.uncorrelateCovarianceSetVariance(State::terrain.idx, sq(_params.ekf2_rng_noise)); #endif // CONFIG_EKF2_TERRAIN }