AP_NavEKF: Fix bug affecting in-flight GPS acquisition

This bug caused velocities to be reset to zero
This commit is contained in:
Paul Riseborough 2015-03-16 10:51:19 -07:00 committed by Andrew Tridgell
parent b9b6938b1d
commit 1c244af3d8

View File

@ -4014,6 +4014,7 @@ void NavEKF::readGpsData()
if (vehicleArmed && _fusionModeGPS != 3) {
constPosMode = false;
PV_AidingMode = AID_ABSOLUTE;
gpsNotAvailable = false;
// Initialise EKF position and velocity states
ResetPosition();
ResetVelocity();