Merge pull request #7578 from joelucid/rpm_filter_bugfix

Hotfix for rpm filter
This commit is contained in:
Steffen Windoffer 2019-02-15 10:28:43 +01:00 committed by GitHub
commit b9375d6974
No known key found for this signature in database
GPG Key ID: 4AEE18F83AFDEB23
1 changed files with 4 additions and 1 deletions

View File

@ -171,7 +171,10 @@ void rpmFilterUpdate()
for (int i = 0; i < filterUpdatesPerIteration; i++) {
float frequency = constrainf((harmonic + 1) * motorFrequency[motor], 0.0f, currentFilter->minHz);
float frequency = (harmonic + 1) * motorFrequency[motor];
if (frequency < currentFilter->minHz) {
frequency = currentFilter->minHz;
}
biquadFilter_t* template = &currentFilter->notch[0][motor][harmonic];
// uncomment below to debug filter stepping. Need to also comment out motor rpm DEBUG_SET above
/* DEBUG_SET(DEBUG_RPM_FILTER, 0, harmonic); */