From b24e9388887a936e53383656bb7294cbc46442f1 Mon Sep 17 00:00:00 2001
From: Mikhail Grushinskiy <mgrouch@users.noreply.github.com>
Date: Tue, 10 Sep 2024 20:22:46 -0400
Subject: [PATCH] Update bbn_wave_freq_m5atomS3.ino

---
 bbn_wave_freq_m5atomS3/bbn_wave_freq_m5atomS3.ino | 5 ++++-
 1 file changed, 4 insertions(+), 1 deletion(-)

diff --git a/bbn_wave_freq_m5atomS3/bbn_wave_freq_m5atomS3.ino b/bbn_wave_freq_m5atomS3/bbn_wave_freq_m5atomS3.ino
index 24e6256..87add6f 100644
--- a/bbn_wave_freq_m5atomS3/bbn_wave_freq_m5atomS3.ino
+++ b/bbn_wave_freq_m5atomS3/bbn_wave_freq_m5atomS3.ino
@@ -187,7 +187,10 @@ void repeatMe() {
     float speed = waveState.vert_speed;
 
     float y = heave;
-    aranovskiy_update(&params, &state, y, delta_t);
+    if (t > 5.0 /* sec */) {
+      // give some time for other filters to settle first
+      aranovskiy_update(&params, &state, y, delta_t);
+    }
     double freq = state.f;
 
     if (first) {