举个例子,参与讨论
中颖 SH79F168 实现温度 PID 控制
float Kp=50, Ki=0.5, Kd=10;
float PID_Calc(float set, float act) {
static float err_sum, last_err;
float err = set - act;
err_sum += err;
float out = Kp*err + Ki*err_sum + Kd*(err-last_err);
last_err = err;
return out;
}
|