Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-01-18 06:38:29 -04:00
Code Issues Packages Projects Releases Wiki Activity

AP_NavEKF2: Group GPS innovation tests when compiling error score

Browse Source
This commit is contained in:
priseborough 2016-11-24 08:55:55 +11:00 committed by Randy Mackay
parent e9ea06bd10
commit 7d48054e6f
1 changed files with 4 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

6
libraries/AP_NavEKF2/AP_NavEKF2_Outputs.cpp
View File

@ -45,9 +45,11 @@ float NavEKF2_core::errorScore() const
{ {
float score = 0.0f; float score = 0.0f;
if (tiltAlignComplete && yawAlignComplete) { if (tiltAlignComplete && yawAlignComplete) {
score = MAX(score, velTestRatio); // Check GPS fusion performance
score = MAX(score, posTestRatio); score = MAX(score, 0.5f * (velTestRatio + posTestRatio));
// Check altimeter fusion performance
score = MAX(score, hgtTestRatio); score = MAX(score, hgtTestRatio);
// Check attitude corrections
const float tiltErrThreshold = 0.05f; const float tiltErrThreshold = 0.05f;
score = MAX(score, tiltErrFilt / tiltErrThreshold); score = MAX(score, tiltErrFilt / tiltErrThreshold);
} }