先看一下梯形算法的积分环节公式

   作为PID控制律的积分项,其作用是消除余差,为了尽量减小余差,应提高积分项运算精度,为此可以将矩形积分改为梯形积分,具体实现的语句为:

pid.voltage=pid.Kp*pid.err+index*pid.Ki*pid.integral/2+pid.Kd*(pid.err-pid.err_last);  //梯形积分

其它函数请参见本系列教程六中的介绍

最后运算的稳定数据为:199.999878,较教程六中的199.9999390而言,精度进一步提高。

posted on 2019-04-25 23:12  IT观察者  阅读(96)  评论(0编辑  收藏  举报