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

View File

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