Browse Source

AP_NavEKF3: Allow smaller dvel bias state variances for improved tuning

gps-1.3.1
Paul Riseborough 4 years ago committed by Andrew Tridgell
parent
commit
72dc998509
  1. 4
      libraries/AP_NavEKF3/AP_NavEKF3_core.cpp

4
libraries/AP_NavEKF3/AP_NavEKF3_core.cpp

@ -1885,11 +1885,11 @@ void NavEKF3_core::ConstrainVariances() @@ -1885,11 +1885,11 @@ void NavEKF3_core::ConstrainVariances()
zeroRows(P,10,12);
}
const ftype minStateVarTarget = 1E-8;
const ftype minStateVarTarget = 1E-11;
if (!inhibitDelVelBiasStates) {
// Find the maximum delta velocity bias state variance and request a covariance reset if any variance is below the safe minimum
const ftype minSafeStateVar = 1e-9;
const ftype minSafeStateVar = minStateVarTarget * 0.1f;
ftype maxStateVar = minSafeStateVar;
bool resetRequired = false;
for (uint8_t stateIndex=13; stateIndex<=15; stateIndex++) {

Loading…
Cancel
Save