mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-27 21:43:33 +08:00
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:
@@ -434,9 +434,6 @@ bool Ekf::initialiseFilter(void)
|
|||||||
_baro_hgt_offset = 0.0f;
|
_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
|
// initialise the state covariance matrix
|
||||||
initialiseCovariance();
|
initialiseCovariance();
|
||||||
|
|
||||||
|
|||||||
Reference in New Issue
Block a user