Mirror
/
ardupilot
mirror of https://github.com/ArduPilot/ardupilot
5
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

Plane: dynamic notch setting via FFT

This commit is contained in:
Andy Piper 2020-01-16 17:32:07 +00:00 committed by Andrew Tridgell
parent 0e9b2a26c5
commit 3832bc455d
1 changed files with 6 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

6
ArduPlane/system.cpp
View File

@ -491,6 +491,12 @@ void Plane::update_dynamic_notch()
case HarmonicNotchDynamicMode::UpdateBLHeli: // BLHeli based tracking
ins.update_harmonic_notch_freq_hz(MAX(ref_freq, AP_BLHeli::get_singleton()->get_average_motor_frequency_hz() * ref));
break;
#endif
#if HAL_GYROFFT_ENABLED
case HarmonicNotchDynamicMode::UpdateGyroFFT: // FFT based tracking
// set the harmonic notch filter frequency scaled on measured frequency
ins.update_harmonic_notch_freq_hz(gyro_fft.get_weighted_noise_center_freq_hz());
break;
#endif
case HarmonicNotchDynamicMode::Fixed: // static
default: