Browse Source

EKF: Don't initialise velocity to GPS on initial alignment

For initial alignment the velocity and position should start at zero
master
Paul Riseborough 9 years ago
parent
commit
9f3b1351f7
  1. 3
      EKF/ekf.cpp

3
EKF/ekf.cpp

@ -434,9 +434,6 @@ bool Ekf::initialiseFilter(void) @@ -434,9 +434,6 @@ bool Ekf::initialiseFilter(void)
_baro_hgt_offset = 0.0f;
}
// set the velocity to the GPS measurement (by definition, the initial position and height is at the origin)
resetVelocity();
// initialise the state covariance matrix
initialiseCovariance();

Loading…
Cancel
Save