diff --git a/src/modules/ekf2/EKF/aid_sources/gnss/gps_yaw_fusion.cpp b/src/modules/ekf2/EKF/aid_sources/gnss/gps_yaw_fusion.cpp
index d66fbac7c6..987d2ae3fc 100644
--- a/src/modules/ekf2/EKF/aid_sources/gnss/gps_yaw_fusion.cpp
+++ b/src/modules/ekf2/EKF/aid_sources/gnss/gps_yaw_fusion.cpp
@@ -100,6 +100,7 @@ void Ekf::fuseGpsYaw(float antenna_yaw_offset)
 		// we reinitialise the covariance matrix and abort this fusion step
 		initialiseCovariance();
 		ECL_ERR("GPS yaw numerical error - covariance reset");
+		stopGpsYawFusion();
 		return;
 	}