diff --git a/EKF/ekf.cpp b/EKF/ekf.cpp index e821713420..51f01c02f1 100644 --- a/EKF/ekf.cpp +++ b/EKF/ekf.cpp @@ -202,8 +202,6 @@ bool Ekf::initialiseFilter() // calculate the initial magnetic field and yaw alignment _control_status.flags.yaw_align = resetMagHeading(_mag_lpf.getState(), false, false); - // initialise the state covariance matrix - initialiseCovariance(); // update the yaw angle variance using the variance of the measurement if (_params.mag_fusion_type <= MAG_FUSE_TYPE_3D) {