Browse Source

Initialize velNED fields correctly, preventing a bogus initial filter reset

sbg
Lorenz Meier 11 years ago
parent
commit
0673740e0e
  1. 5
      src/modules/ekf_att_pos_estimator/estimator_23states.cpp

5
src/modules/ekf_att_pos_estimator/estimator_23states.cpp

@ -35,8 +35,11 @@ AttPosEKF::AttPosEKF() @@ -35,8 +35,11 @@ AttPosEKF::AttPosEKF()
magDeclination = 0.0f;
dAngIMU.zero();
dVelIMU.zero();
ekfDiverged = false;
velNED[0] = 0.0f;
velNED[1] = 0.0f;
velNED[2] = 0.0f;
delAngTotal.zero();
ekfDiverged = false;
memset(&last_ekf_error, 0, sizeof(last_ekf_error));
ZeroVariables();

Loading…
Cancel
Save