David Forrest 2021-11-22 13:49:43 -05:00
parent 9b4ca0e5b6
commit a0eb0d6d82

View File

@ -82,9 +82,15 @@ bool PID::Compute()
/*Compute Rest of PID Output*/ /*Compute Rest of PID Output*/
output += outputSum - kd * dInput; output += outputSum - kd * dInput;
if(output > outMax) output = outMax; if(output > outMax){
else if(output < outMin) output = outMin; outputSum -= output - outMax; // backcalculate integral to feasability
*myOutput = output; output = outMax;
}
else if(output < outMin) {
outputSum += outMin - output; // backcalculate integral to feasability
output = outMin;
}
*myOutput = output;
/*Remember some variables for next time*/ /*Remember some variables for next time*/
lastInput = input; lastInput = input;