diff --git a/src/modules/ekf2/EKF/ekf.h b/src/modules/ekf2/EKF/ekf.h
index 41c5ee3df2..29ab18a8a9 100644
--- a/src/modules/ekf2/EKF/ekf.h
+++ b/src/modules/ekf2/EKF/ekf.h
@@ -853,7 +853,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 5033020428..08042e4e75 100644
--- a/src/modules/ekf2/EKF/mag_control.cpp
+++ b/src/modules/ekf2/EKF/mag_control.cpp
@@ -232,7 +232,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;
 	}
 }