From a6bbafc7b00245d176cc53077c77d2c7793e8bb5 Mon Sep 17 00:00:00 2001 From: kamilritz Date: Tue, 17 Dec 2019 18:55:51 +0100 Subject: [PATCH] Remove unnecessary initialiseCovariance It is already called in reset() --- EKF/ekf.cpp | 2 -- 1 file changed, 2 deletions(-) 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) {