ekf: clean uncorrelateQuatStates function

As the name can be ambiguous, it gets renamed
"uncorrelateQuatFromOtherStates".
Also replace the loops storing the values and reapplying them by simply
zeroing two slices (this also saves 130B of flash).
This commit is contained in:
bresch
2020-02-13 14:33:32 +01:00
committed by Mathieu Bresciani
parent c6d5a74685
commit 81c6d6655f
4 changed files with 8 additions and 27 deletions
+1 -1
View File
@@ -227,7 +227,7 @@ void Ekf::controlExternalVisionFusion()
// calculate initial quaternion states for the ekf
_state.quat_nominal = Quatf(euler_init);
uncorrelateQuatStates();
uncorrelateQuatFromOtherStates();
// adjust the quaternion covariances estimated yaw error
increaseQuatYawErrVariance(fmaxf(_ev_sample_delayed.angVar, sq(1.0e-2f)));