mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-14 04:03:34 +08:00
EKF: initialize the newest attitude estimate to a valid quaternion
Signed-off-by: CarlOlsson <carlolsson.co@gmail.com>
This commit is contained in:
committed by
Paul Riseborough
parent
6cf512f103
commit
ea259d358d
@@ -60,6 +60,7 @@ bool Ekf::init(uint64_t timestamp)
|
||||
_output_new.vel.setZero();
|
||||
_output_new.pos.setZero();
|
||||
_output_new.quat_nominal.setZero();
|
||||
_output_new.quat_nominal(0) = 1.0f;
|
||||
|
||||
_delta_angle_corr.setZero();
|
||||
_imu_down_sampled.delta_ang.setZero();
|
||||
|
||||
Reference in New Issue
Block a user