diff --git a/src/modules/ekf2/EKF/covariance.cpp b/src/modules/ekf2/EKF/covariance.cpp index 4b0357b14c..45d66797f6 100644 --- a/src/modules/ekf2/EKF/covariance.cpp +++ b/src/modules/ekf2/EKF/covariance.cpp @@ -54,7 +54,7 @@ void Ekf::initialiseCovariance() { P.zero(); - resetQuatCov((_params.mag_fusion_type != MagFuseType::NONE) ?_params.mag_heading_noise : NAN); + resetQuatCov(); // velocity P(4,4) = sq(fmaxf(_params.gps_vel_noise, 0.01f));