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: only report terrain estimator innovations with valid rng value

Browse Source
This commit is contained in:
Pierre Kancir 2017-12-14 00:01:53 +01:00 committed by Francisco Ferreira
parent 2732226664
commit 171e80d8dc
1 changed files with 1 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

2
libraries/AP_NavEKF2/AP_NavEKF2_Outputs.cpp
View File

@ -579,7 +579,7 @@ void NavEKF2_core::send_status_report(mavlink_channel_t chan)
// height estimation or optical flow operation. This prevents false alarms at the GCS if a // height estimation or optical flow operation. This prevents false alarms at the GCS if a
// range finder is fitted for other applications // range finder is fitted for other applications
float temp; float temp;
if ((frontend->_useRngSwHgt > 0) || PV_AidingMode == AID_RELATIVE || flowDataValid) { if (((frontend->_useRngSwHgt > 0) && activeHgtSource == HGT_SOURCE_RNG) || (PV_AidingMode == AID_RELATIVE && flowDataValid)) {
temp = sqrtf(auxRngTestRatio); temp = sqrtf(auxRngTestRatio);
} else { } else {
temp = 0.0f; temp = 0.0f;