Reset init flags as well

This commit is contained in:
Lorenz Meier
2014-04-28 11:41:40 +02:00
parent 125f0b2f88
commit 0745334ac4
@@ -2407,6 +2407,19 @@ void AttPosEKF::InitializeDynamic(float (&initvelNED)[3])
// Clear the init flag
statesInitialised = false;
// Clear other flags, waiting for new data
fusionModeGPS = 0;
fuseVelData = false;
fusePosData = false;
fuseHgtData = false;
fuseMagData = false;
fuseVtasData = false;
// onGround(true),
// staticMode(true),
useAirspeed = true;
useCompass = true;
useRangeFinder = true;
ZeroVariables();
// Calculate initial filter quaternion states from raw measurements