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(¶ms, &state, y, delta_t); + if (t > 5.0 /* sec */) { + // give some time for other filters to settle first + aranovskiy_update(¶ms, &state, y, delta_t); + } double freq = state.f; if (first) {