Browse Source

AP_NavEKF2: relax bias convergence check

Enables bias convergence check to pass within 30 seconds when vehicle is static.
master
priseborough 9 years ago committed by Andrew Tridgell
parent
commit
04e8726d8a
  1. 2
      libraries/AP_NavEKF2/AP_NavEKF2_Control.cpp

2
libraries/AP_NavEKF2/AP_NavEKF2_Control.cpp

@ -331,7 +331,7 @@ void NavEKF2_core::recordYawReset() @@ -331,7 +331,7 @@ void NavEKF2_core::recordYawReset()
bool NavEKF2_core::checkGyroCalStatus(void)
{
// check delta angle bias variances
const float delAngBiasVarMax = sq(radians(0.1f * dtEkfAvg));
const float delAngBiasVarMax = sq(radians(0.15f * dtEkfAvg));
delAngBiasLearned = (P[9][9] <= delAngBiasVarMax) &&
(P[10][10] <= delAngBiasVarMax) &&
(P[11][11] <= delAngBiasVarMax);

Loading…
Cancel
Save