AP_NavEKF: force healthy false when initialising

this prevents us feeding off our own values when booting

Pair-Programmed-With: Paul Riseborough <p_riseborough@live.com.au>
This commit is contained in:
Andrew Tridgell 2014-02-15 09:25:03 +11:00
parent be33a9634e
commit c6b24c521b
1 changed files with 4 additions and 0 deletions

View File

@ -315,6 +315,10 @@ void NavEKF::ResetHeight(void)
void NavEKF::InitialiseFilterDynamic(void)
{
// this forces healthy() to be false so that when we ask for ahrs
// attitude we get the DCM attitude regardless of the state of AHRS_EKF_USE
statesInitialised = false;
// Set re-used variables to zero
ZeroVariables();