diff --git a/src/modules/ekf2/EKF/ekf.h b/src/modules/ekf2/EKF/ekf.h index 9684acdca6..4158b9ffc6 100644 --- a/src/modules/ekf2/EKF/ekf.h +++ b/src/modules/ekf2/EKF/ekf.h @@ -859,7 +859,6 @@ private: void check3DMagFusionSuitability(); void checkYawAngleObservability(); void checkMagBiasObservability(); - bool isYawAngleObservable() const { return _yaw_angle_observable; } bool isMagBiasObservable() const { return _mag_bias_observable; } bool canUse3DMagFusion() const; diff --git a/src/modules/ekf2/EKF/mag_control.cpp b/src/modules/ekf2/EKF/mag_control.cpp index a165549ad1..35a343d836 100644 --- a/src/modules/ekf2/EKF/mag_control.cpp +++ b/src/modules/ekf2/EKF/mag_control.cpp @@ -218,7 +218,7 @@ void Ekf::check3DMagFusionSuitability() checkYawAngleObservability(); checkMagBiasObservability(); - if (isMagBiasObservable() || isYawAngleObservable()) { + if (isMagBiasObservable() || _yaw_angle_observable) { _time_last_mov_3d_mag_suitable = _imu_sample_delayed.time_us; } }