mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-21 11:23:33 +08:00
Reset init flags as well
This commit is contained in:
@@ -2407,6 +2407,19 @@ void AttPosEKF::InitializeDynamic(float (&initvelNED)[3])
|
|||||||
// Clear the init flag
|
// Clear the init flag
|
||||||
statesInitialised = false;
|
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();
|
ZeroVariables();
|
||||||
|
|
||||||
// Calculate initial filter quaternion states from raw measurements
|
// Calculate initial filter quaternion states from raw measurements
|
||||||
|
|||||||
Reference in New Issue
Block a user