版权声明:本文为博主原创文章,遵循 CC 4.0 BY-SA 版权协议,转载请附上原文出处链接和本声明。
1.增量式PID
Error=Set_Value - Current_Value;
result= p * (Error - LastError)
+ i * Error
+ d * (Error - 2*LastError + PrevError);
PrevError = LastError;
LastError = Error;
SumError = SumError + result;
2.位置式PID
Error=Set_Value - Current_Value;
SumError += Error;
dError = LastError - PrevError;
PrevError = LastError;
LastError = Error;
result= p * Error
+ i * SumError
+ d * dError;