mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-21 22:13:33 +08:00
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:
committed by
Mathieu Bresciani
parent
c6d5a74685
commit
81c6d6655f
+1
-1
@@ -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)));
|
||||
|
||||
Reference in New Issue
Block a user