您的位置 首页 元件

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

这个程序应用在51单片机上的*************定义全局变量*****************ucharKp,Ti,TdintSet_speed;*************PID初始化函

这个程序应用在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;
}

声明:本文内容来自网络转载或用户投稿,文章版权归原作者和原出处所有。文中观点,不代表本站立场。若有侵权请联系本站删除(kf@86ic.com)https://www.86ic.net/xinpin/yuanjian/255035.html

为您推荐

联系我们

联系我们

在线咨询: QQ交谈

邮箱: kf@86ic.com

关注微信
微信扫一扫关注我们

微信扫一扫关注我们

返回顶部