forked from Archive/PX4-Autopilot
EKF: Don't initialise velocity to GPS on initial alignment
For initial alignment the velocity and position should start at zero
This commit is contained in:
parent
687fcc70be
commit
9f3b1351f7
|
@ -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…
Reference in New Issue