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

Filter: ensure the derivative filter never returns an invalid number

Browse Source
This commit is contained in:
Andrew Tridgell 2012-08-18 13:53:22 +10:00
parent 2e77691ca1
commit 81cd4b6c13
1 changed files with 5 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

5
libraries/Filter/DerivativeFilter.cpp
View File

@ -92,6 +92,11 @@ float DerivativeFilter<T,FILTER_SIZE>::slope(void)
break;
}
// cope with numerical errors
if (isnan(result) || isinf(result)) {
result = 0;
}
_new_data = false;
_last_slope = result;