最简单的单片机PID控制算法程序

最简单的单片机PID控制算法程序,第1张

这个程序应用在51单片机上的

/*************定义全局变量*****************/

uchar Kp,TI,Td

int Set_speed;

/*************PID初始化函数***************/

void PID_init(void){

Serror=0;

FError=0;

Kp=30;

TI=500;

Td=10;

}

int PID_control(int Now_speed)

{

int Error,Serror,result;

Error=Now_speed-Set_speed;

Serror=Serror+Error;

result=(Kp*Error+Kp*0.05/TI*Serror+Kp*Td/0.05*(Error-FError));

FError=Error;

//对占空比进行限幅处理

if(result《10)

{result=0;} else

if(result》1000)

{result=1000;}

return result;

}

欢迎分享,转载请注明来源:内存溢出

原文地址: http://outofmemory.cn/dianzi/2558359.html

(0)
打赏 微信扫一扫 微信扫一扫 支付宝扫一扫 支付宝扫一扫
上一篇 2022-08-06
下一篇 2022-08-06

发表评论

登录后才能评论

评论列表(0条)

保存