aepko/Ardupilot2
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

AP_NavEKF : Relax aliasing check limits

Browse Source 
This reduces the chance of noisy data inhibiting GPS glitch protection
This commit is contained in:
priseborough 2014-04-02 17:11:18 +11:00 committed by Andrew Tridgell
parent 0ae736c3a0
commit 36b3cbc365
1 changed files with 2 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

4
libraries/AP_NavEKF/AP_NavEKF.cpp
View File

@ -1608,8 +1608,8 @@ void NavEKF::FuseVelPosNED()
// calculate innovations for height and vertical GPS vel measurements
float hgtErr = statesAtVelTime[9] - observation[5];
float velDErr = statesAtVelTime[6] - observation[2];
// check if they are the same sign and both more than 2-sigma out of bounds
if ((hgtErr*velDErr > 0.0f) && (sq(hgtErr) > 4.0f * (P[9][9] + R_OBS[5])) && (sq(velDErr) > 4.0f * (P[6][6] + R_OBS[2]))) {
// check if they are the same sign and both more than 3-sigma out of bounds
if ((hgtErr*velDErr > 0.0f) && (sq(hgtErr) > 9.0f * (P[9][9] + R_OBS[5])) && (sq(velDErr) > 9.0f * (P[6][6] + R_OBS[2]))) {
badIMUdata = true;
} else {
badIMUdata = false;