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

AP_NavEKF: Fix bug in median filter code

Browse Source
This commit is contained in:
priseborough 2016-10-19 21:32:28 +11:00 committed by Randy Mackay
parent 83b8208b8b
commit d0ba259d0d
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_core.cpp
View File

@ -5137,8 +5137,8 @@ void NavEKF_core::readRangeFinder(void)
minIndex = 1; minIndex = 1;
maxIndex = 0; maxIndex = 0;
} else { } else {
maxIndex = 0; minIndex = 0;
minIndex = 1; maxIndex = 1;
} }
if (storedRngMeas[2] > storedRngMeas[maxIndex]) { if (storedRngMeas[2] > storedRngMeas[maxIndex]) {
midIndex = maxIndex; midIndex = maxIndex;