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