Temporary disable compass smoothing

jgauchia · Jul 9, 2023 · 1c3fae5 · 1c3fae5
1 parent f22465c
commit 1c3fae5
Showing 1 changed file with 3 additions and 3 deletions.
diff --git a/src/hardware/compass.h b/src/hardware/compass.h
@@ -66,9 +66,9 @@ int read_compass()
 #endif
   float heading_no_filter = atan2(y, x);
   heading_no_filter += declinationAngle;
-  //heading_smooth = heading_no_filter;
-  heading_smooth = (heading_no_filter * SMOOTH_FACTOR) + (heading_previous * SMOOTH_PREVIOUS_FACTOR);
-  heading_previous = heading_smooth;
+  heading_smooth = heading_no_filter;
+  //heading_smooth = (heading_no_filter * SMOOTH_FACTOR) + (heading_previous * SMOOTH_PREVIOUS_FACTOR);
+  //heading_previous = heading_smooth;
 
   if (heading_smooth < 0)
     heading_smooth += 2 * M_PI;