rooty/LibrePilot
1
0
Fork 0
mirror of https://bitbucket.org/librepilot/librepilot.git synced 2025-02-27 16:54:15 +01:00
Code Issues Releases Activity

allow smaller nonzero variances during runtime

Browse Source
This commit is contained in:
Corvus Corax 2013-06-09 13:57:36 +02:00
parent 022f1a1ac0
commit a99255a36a
1 changed files with 1 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

2
flight/modules/StateEstimation/filterekf.c
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;