diff --git a/libraries/Filter/DerivativeFilter.cpp b/libraries/Filter/DerivativeFilter.cpp index 351ee7f0cd..4a796f9b32 100644 --- a/libraries/Filter/DerivativeFilter.cpp +++ b/libraries/Filter/DerivativeFilter.cpp @@ -52,7 +52,7 @@ float DerivativeFilter::apply(T sample, uint32_t timestamp) case 9: result = 2*14*(f(1) - f(-1)) / (x(1) - x(-1)) + 4*14*(f(2) - f(-2)) / (x(2) - x(-2)) - + 6* 6*(f(3) - f(-3)) / (x(3) - x(-3)); + + 6* 6*(f(3) - f(-3)) / (x(3) - x(-3)) + 8* 1*(f(4) - f(-4)) / (x(4) - x(-4)); result /= 128; break;