1
0
mirror of https://bitbucket.org/librepilot/librepilot.git synced 2025-02-20 10:54:14 +01:00

allow smaller nonzero variances during runtime

This commit is contained in:
Corvus Corax 2013-06-09 13:57:36 +02:00
parent 022f1a1ac0
commit a99255a36a

View File

@ -425,7 +425,7 @@ static int32_t filter(stateFilter *self, stateEstimation *state)
EKFStateVarianceSet(&vardata);
int t;
for (t = 0; t < EKFSTATEVARIANCE_P_NUMELEM; t++) {
if (invalid_var(vardata.P[t])) {
if (!IS_REAL(vardata.P[t]) || vardata.P[t] <= 0.0f) {
INSResetP(this->ekfConfiguration.P);
this->init_stage = -1;
break;