Save 1 divide

emuflight · May 24, 2022 · c1fde63 · c1fde63
1 parent 1ed4f89
commit c1fde63
Showing 1 changed file with 2 additions and 4 deletions.
diff --git a/src/main/flight/dyn_notch_filter.c b/src/main/flight/dyn_notch_filter.c
@@ -349,10 +349,8 @@ static FAST_CODE_NOINLINE void dynNotchProcess(void)
 
                     // Estimate true peak position
                     const float denom = y0 + y1 + y2;
-                    if (denom != 0.0f) {
-                        float upper_ratio = y2 / denom;
-                        float lower_ratio = y0 / denom;
-                        meanBin += upper_ratio - lower_ratio;
+                    if (denom != 0.0f) { 
+                        meanBin += (y2 - y0) / denom;
                     }
 
                     // Convert bin to frequency: freq = bin * binResoultion (bin 0 is 0Hz)