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