Update PID_v1.cpp

output = kp * error + ki*sumerror + kd * dInput;
This commit is contained in:
ouazaryahia 2013-09-10 20:33:18 -07:00
parent d21d7e3d09
commit ddd27a8704

View File

@ -60,7 +60,7 @@ bool PID::Compute()
double dInput = (input - lastInput);
/*Compute PID Output*/
double output = kp * error + ITerm- kd * dInput;
double output = kp * error + ITerm + kd * dInput;
if(output > outMax) output = outMax;
else if(output < outMin) output = outMin;