ekf2: stop gps yaw fusion on numerical error

This commit is contained in:
Daniel Agar
2024-07-11 12:25:14 -04:00
parent 467f96f2a4
commit d5876ab0d2
@@ -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;
}