Browse Source

AP_NavEKF : Fixes bug that causes accel bias to diverge in static mode, preventing copter arming

mission-4.1.18
Paul Riseborough 11 years ago committed by Andrew Tridgell
parent
commit
b2c0979947
  1. 2
      libraries/AP_NavEKF/AP_NavEKF.cpp

2
libraries/AP_NavEKF/AP_NavEKF.cpp

@ -1544,7 +1544,7 @@ void NavEKF::FuseVelPosNED() @@ -1544,7 +1544,7 @@ void NavEKF::FuseVelPosNED()
// because there may be no stored states due to lack of real measurements.
// in static mode, only position and height fusion is used
if (staticMode) {
for (uint8_t i=7; i<=9; i++) {
for (uint8_t i=0; i<=30; i++) {
statesAtPosTime[i] = states[i];
statesAtHgtTime[i] = states[i];
}

Loading…
Cancel
Save