rusefi
/
custom-board-bundle-sample-fork-of-rusefi
mirror of https://github.com/rusefi/custom-board-bundle-sample-fork-of-rusefi.git
1
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

PidIndustrial does not limit iTerm #1599

This commit is contained in:
rusefi 2020-07-11 15:05:18 -04:00
parent c2a96f21b4
commit 88bbd25042
1 changed files with 4 additions and 4 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

8
firmware/util/math/pid.cpp
View File

@ -251,9 +251,6 @@ float PidIndustrial::getOutput(float target, float input, float dTime) {
float error = (target - input) * errorAmplificationCoef;
float pTerm = parameters->pFactor * error;
// update the I-term
iTerm += parameters->iFactor * dTime * error;
// calculate dTerm coefficients
if (fabsf(derivativeFilterLoss) > DBL_EPSILON) {
// restore Td in the Standard form from the Parallel form: Td = Kd / Kc
@ -272,11 +269,14 @@ float PidIndustrial::getOutput(float target, float input, float dTime) {
// (error - previousError) = (target-input) - (target-prevousInput) = -(input - prevousInput)
dTerm = dTerm * ad + (error - previousError) * bd;
// update the I-term
iTerm += parameters->iFactor * dTime * error;
// calculate output and apply the limits
float output = pTerm + iTerm + dTerm + getOffset();
float limitedOutput = limitOutput(output);
// apply the integrator anti-windup
// apply the integrator anti-windup on top of the "normal" iTerm change above
// If p.antiwindupFreq = 0, then iTerm is equal to PidParallelController's
iTerm += dTime * antiwindupFreq * (limitedOutput - output);