Merge pull request #7578 from joelucid/rpm_filter_bugfix
Hotfix for rpm filter
This commit is contained in:
commit
b9375d6974
|
@ -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 = ¤tFilter->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); */
|
||||
|
|
Loading…
Reference in New Issue