Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-03-11 17:13:56 -03:00
Code Issues Packages Projects Releases Wiki Activity

Filter: only update notch on init if fixed

Browse Source
This commit is contained in:
Andrew Tridgell 2024-09-08 18:10:57 +10:00 committed by Peter Barker
parent 1ef89d31f2
commit 9726e8e218
1 changed files with 4 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

3
libraries/Filter/HarmonicNotchFilter.cpp
View File

@ -191,9 +191,12 @@ void HarmonicNotchFilter<T>::init(float sample_freq_hz, HarmonicNotchFilterParam
NotchFilter<T>::calculate_A_and_Q(center_freq_hz, bandwidth_hz / _composite_notches, attenuation_dB, _A, _Q); NotchFilter<T>::calculate_A_and_Q(center_freq_hz, bandwidth_hz / _composite_notches, attenuation_dB, _A, _Q);
_initialised = true; _initialised = true;
// ensure static notches are allocated and working // ensure static notches are allocated and working
if (params->tracking_mode() == HarmonicNotchDynamicMode::Fixed) {
update(center_freq_hz); update(center_freq_hz);
} }
}
/* /*
allocate a collection of, at most HNF_MAX_FILTERS, notch filters to be managed by this harmonic notch filter allocate a collection of, at most HNF_MAX_FILTERS, notch filters to be managed by this harmonic notch filter