MW23 delta scaling to cycletime
This commit is contained in:
parent
f5de06c59e
commit
df159d195d
|
@ -360,6 +360,9 @@ static void pidMultiWii23(pidProfile_t *pidProfile, controlRateConfig_t *control
|
||||||
lastErrorForDelta[axis] = gyroError;
|
lastErrorForDelta[axis] = gyroError;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
// Scale delta to looptime
|
||||||
|
delta = (delta * ((uint16_t) 0xFFFF)) / ((uint16_t)targetPidLooptime << 3);
|
||||||
|
|
||||||
if (deltaStateIsSet) {
|
if (deltaStateIsSet) {
|
||||||
DTerm = lrintf(applyBiQuadFilter((float) delta, &deltaBiQuadState[axis])) * 3; // Keep same scaling as unfiltered delta
|
DTerm = lrintf(applyBiQuadFilter((float) delta, &deltaBiQuadState[axis])) * 3; // Keep same scaling as unfiltered delta
|
||||||
} else {
|
} else {
|
||||||
|
|
Loading…
Reference in New Issue