Update AranovskiyFilter.h

bareboat-necessities · Sep 10, 2024 · 0197963 · 0197963
1 parent bff1c8c
commit 0197963
Showing 1 changed file with 3 additions and 0 deletions.
diff --git a/bbn_wave_freq_m5atomS3/AranovskiyFilter.h b/bbn_wave_freq_m5atomS3/AranovskiyFilter.h
@@ -32,6 +32,7 @@
 
   unsigned long now = 0UL, last_update = 0UL;
 
+  double t = t_0;
   last_update = millis();
   while(1) {
     delay(4);
@@ -46,6 +47,8 @@
     aranovskiy_update(&params, &state, y, delta_t);
 
     // state.f contains estimated frequency
+
+    t = t + delta_t;
   }
 
   Use double instead of float to avoid float overflows with higher Aranovskiy gain values