diff --git a/libraries/Filter/HarmonicNotchFilter.cpp b/libraries/Filter/HarmonicNotchFilter.cpp index 06a2400a15ff3..c98a50eeac4ea 100644 --- a/libraries/Filter/HarmonicNotchFilter.cpp +++ b/libraries/Filter/HarmonicNotchFilter.cpp @@ -191,8 +191,11 @@ void HarmonicNotchFilter::init(float sample_freq_hz, HarmonicNotchFilterParam NotchFilter::calculate_A_and_Q(center_freq_hz, bandwidth_hz / _composite_notches, attenuation_dB, _A, _Q); _initialised = true; + // ensure static notches are allocated and working - update(center_freq_hz); + if (params->tracking_mode() == HarmonicNotchDynamicMode::Fixed) { + update(center_freq_hz); + } } /*