Browse Source

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>
mission-4.1.18
Andrew Tridgell 11 years ago
parent
commit
c6b24c521b
  1. 4
      libraries/AP_NavEKF/AP_NavEKF.cpp

4
libraries/AP_NavEKF/AP_NavEKF.cpp

@ -315,6 +315,10 @@ void NavEKF::ResetHeight(void) @@ -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();

Loading…
Cancel
Save