PID控制算法之C语言学习(一)

电机控制中绝对少不了PID控制,这里讲一下PID的C语言实现过程;
关于PID的公式推导,太多了,就不做详细说明了,这里只给出实际控制的实现方式,可以在其中更改参数值再结合理论作进一步的学习;
位置型PID C语言实现
这里贴上公式:
PID公式

 Kp=2.0f;
 Ki =0.18f;
 Kd=10;
{
	err = set - actual;
	integral + = err;
	PID_Value = Kp*err + Ki * integral + Kd(err - err_last);
	err_last = err ;
}

很多人就会有疑惑了,这个PID计算出来的东西,怎么用,或者怎么应用到自己的实际的场景中
最简单的办法就是把这个值,加权转化到你的PWM中;
你要知道你程序中的err 最大会是多少,根据你的PID计算出来的值会是多少去做转化,eg:你的PWM值最大是100,可是你的PID计算出来会达到2000,那你就不能直接让PWM = PID_Value ;这里可以通过转化PWM = PID_Value / X去实现;当然这里只是打比方,也可以是其他的方式,X可以等于20,也可以是10,然后最后做一个PWM上限:if(PWM >100) PWM = 100 ; 具体X的值就看你的应用了;这样就可以实现PID的控制了,这时你的PID就直接影响到你的输出了,你就要在这个过程中去调节Kp ,Ki,Kd;
调节PID参数的步骤就去看口诀吧,什么,口诀是啥?那你该百度了;
增量型PID C语言实现
公式:
增量型PID公式

 Kp=2.0f;
 Ki =0.18f;
 Kd=10;
{
	err = set - actual;
	Increment = Kp * ( err - err_next ) + Ki * err + Kd * ( err - 2 * err_next + err_last );
	PID_Value += Increment ; //**注意!注意!注意!增量式 这里是+=** ;
	err_last = err_next ;//前两次偏差
	err_next = err ;//前一次偏差
}

代码注释中写了,一定注意增量式是+=,也很好理解,这个推导过程就是两次的差值产生的;
至于PID参数值的调节方式,就在过程中慢慢去调试吧,主要是先跑起来,在调试中结合理论学习巩固;
接下来会继续讲解积分饱和,积分分离,以及PID每一个参数的实际用途吧。。。

  • 3
    点赞
  • 7
    收藏
    觉得还不错? 一键收藏
  • 0
    评论
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值