EKF: do not update the newest attitude estimate in initialiseFilter(). Is is now done in alignOutputFilter()

This commit is contained in:
CarlOlsson
2019-03-12 19:07:55 +11:00
committed by Paul Riseborough
parent 96c5c14041
commit 000aa0de5d
-1
View File
@@ -249,7 +249,6 @@ bool Ekf::initialiseFilter()
// calculate initial tilt alignment
Eulerf euler_init(roll, pitch, 0.0f);
_state.quat_nominal = Quatf(euler_init);
_output_new.quat_nominal = _state.quat_nominal;
// update transformation matrix from body to world frame
_R_to_earth = quat_to_invrotmat(_state.quat_nominal);