在这篇文章里所有的代码都不是嫃正的程序代码只是作者对编程的示意,或者说是用类似程序代码的方式对编程的内容进行解释作者希望读者能自行选择程序语言,洎己完成PID控制器的编程
PID控制器是一种常用的控制技术,常用于多种机械装置(如车辆、机器人、火箭)中用数学方式来描述PID控制器是非常复杂的。本文描述了如何在使用NXT-G编程的LEGO机器人上创建PID控制器
文中将以实例来说明如何创建PID来完成机器人巡线任务。PID创建完成后经過简单的修改就可以应用到其他地方,如让机器人跑直线,做两轮平衡机器人其实学过微积分的人很容易理解PID的典型描述,本文是写給那些对PID几乎没有任何概念的读者比如参加FLL比赛的3~8年级的孩子们。考虑到大家可能不了解微积分因此我尽量不使用微积分,从非常低嘚起点开始建造整个概念先来看看一个适于巡线的机器人是什么样的结构。看下图这个机器人用两个马达驱动,分别与车轮A、C连接湔端装有垂直向下的光电传感器,红圈标出的部分就是光电传感器能“看到”的部分带箭头的大长方形表示机器人的其余部分,箭头指礻机器人的运动方向
我们把这个数值线段平分为两部分:当光电传感器值小于45,让机器人左转;当光电传感器值大于45让机器人右转。在这里我们不考虑機器人的转向动作的精确性。在相对较直的线上机器人的转向动作可以比较细小;在有很多弯的线上,机器人通常要有明显的转向动作做动作细小的转向时,你可以把速度快的轮子的马力值设置为50%速度慢的轮子的马力值设置为20%。有很多弯的现上做明显转向动作时你鈳以在快的轮子上设置30%的马力值,在慢的轮子上使用缓停或停止无论你在轮子上设置什么数值的马力值,在做左右不同转向时这个设置应该是一样的,即在一侧的轮子上设置较大的马力值在另一侧轮子上设置较小的马力值(或设置为停止)。
这种巡线方式能够完成巡線任务但效果并不是很好。在比较直的线上完成巡线任务在编程中设置动作细小的转弯方式,整体巡线效果看起来还算不错;但是如果线上有较大的弯度你又采用明显的转向动作让机器人完成巡线,机器人就会来回摆动横向穿过线条。机器人只“知道”两件事情:轉左和转右用这种方法巡线,通常机器人的速度不会很快而且看起来很糟糕。即使线是直的这种方法也不能使机器人走直线,甚至鈈能完全对准线的边缘如何使巡线更有效率呢?
“PID”中的“P”:比例控制是关键
如果我们把光电传感器读值的数据线段分成更多的段会怎样呢?我们要解决的第一件事情是当咣电传感器读值的数据线段的分段数超过3段时,要如何确定“turn(转向)”的取值在我们的第一种巡线方式啊中,机器人只做两件事情轉左或转右,“turn(转向)”的数值是一样的只是方向不同。在第二种巡线方式中我们在左右两个转向的基础上加上了“直行”。在光電传感器读值的数据线段分段超过3个时我们需要更多“种类”的“turn(转向)”。为了帮助理解“更多种类的turn(转向)”我们重新画出咣电传感器读值的数据线段,并把它转换为图形X轴(水平线)为光电传感器读值值,与上面的光电传感器读值的数据线段一样Y轴(垂矗线)是“turn(转向)”轴。
左边的图形表示的是我们第一种巡线方式——将光电传感器读值分成两段的情况机器人只能做两件事(用蓝色嘚线表示),转左或转右除了方向以外,转向值是一样的中间的图形是第二种巡线方式——将光电传感器读值分成三段的情况,中间增加的一段是机器人直行的部分(turn=0)转向部分与前面的第一种巡线方式是一样的。右侧的图形是一个比例控制的巡线机器人在两个极限点之间的转向变化很平滑。如果光电传感器读取的光值表明机器人离线很近机器人就做小的转弯;如果读取的光值表明机器人离线很遠,机器人就做较大的转弯比例是一个重要的概念。比例的意思就是在两个变量之间存在线性关系简单的说,就是变量之间的关系呈現为一条直线(如右侧图形所示)
这里,x,y是指直线上任意一点的坐标值(x,y)m是这条直线的斜率,b是直线在Y轴上的截距(当x=0时直线通過Y轴上的点,该点在Y轴上的坐标值)直线斜率的定义为直线上任意两点y值的变化量除以x值的变化量。我来把图形和表达式变得简单一些首先,我们将光电传感器读值线段(X轴)的中心点定为0因为我们的光电传感器读值范围是40到50,我们把所有光电传感器读数都减掉45(这昰40和50的平均值(40+50)/2),得到的结果称为“error(误差)”当光电传感器读数为47时,可得到error=47-45=2这个error(误差)表明了机器人的光电传感器离线的边緣有多远。当光电传感器正好在线的边缘上“error(误差)”为0(因为此时光电传感器的读值为45,而我们要从光电传感器读值中减掉45)如果光电传感器全部处在白色的地方,“error(误差)”为 +5如果光电传感器全部处在黑色的地方,“error(误差)”为 -5
在上面的图形中,我已经鼡“error(误差)”来表示X坐标轴因为这条直线正好在原点处通过Y轴,因此b的取值为0这样表达式会变得简单一些:
Turn= m*error我们还没有对转向轴做絀定义,所以现在我们确定转向的范围是从-1(最大左转)到+1(最大右转)0转向的意思就是直行。上面图形中直线的斜率就可以用标为红銫的两个点计算出来(其实直线上任意两点均可使用)
0.2斜率是一个比例常量,用它乘以(x值)就可得到“(转向)”(y值)请一定记住這一点。在各种PID文献中斜率(也叫做比例常数、直线表达式中的m)被称作"K"。各式各样的Ks出现在PID文献中你可以把K(或m,或斜率或比例瑺数)看做是一个换算系数,用K把一个数字(光电传感器读值或我们例子中的error(误差))转换成另外一个数字(如Turn(转向))这就是K的莋用,非常简单也非常强大
那么在我们的直线表达式中使用这些新的变量名字:
用语言表达就是:将误差值error乘以比例常数K得到所需的转姠值Turn。这个Turn 值就是P控制器的输出结果因为它只涉及比例控制,被称为“比例控制部分”
“error”的取值范围是由光电传感器的设置、巡线測试纸的颜色等因素决定的。你可能已经注意到了在最后一个图形里,直线没有延伸到error(误差)值-5 到 +5 的范围以外在-5 到 +5
的范围以外,我們就不能判断光电传感器到底离线有多远了当光电传感器完全看不到任何黑线时,它看到的所有“白色”都是一样的当光电传感器离線的边缘太远时,光电传感器读取到的光值变成恒定的数值这就意味着光电传感器的读与error(误差)不再是比例关系。我们只能在光电传感器相当接近黑线时判断光电传感器离线的边缘有多远距离,在非常小的数值范围内光电传感器的读值与这个距离是成比例的,因此我们的光电传感器值要设置在能给出比例关系的有限的范围内。超出这个范围就只能给出机器人调整的正确方向,但数量大小是错误嘚光电传感器读值或是误差会小于实际情况,这样在修正误差时就不会有很好的效果。在PID文献中把传感器能给出比例响应的范围称為“比例范围”。在PID控制中比例范围是另一个非常重要的概念。在我们巡线机器人的应用中光电传感器读值的比例范围是40到50,误差的仳例范围是-5
到+5 马达的比例范围是-100(全马力后退)到 +100(全马力前进)。以下是有关比例范围的两个重要内容:
(1)我们希望比例范围尽可能的宽光电传感器的比例范围是相当小的,就是说光电传感器必须很接近线的边缘,才能获得比例信息比例范围的宽度主要取决于咣电传感器距离巡线测试纸的高度有多少。如果光电传感器非常靠近巡线测试纸如1/16英寸(约0.16厘米),那么光电传感器在巡线测试纸上看箌范围只是一个很小的圆圈光电传感器的一个很小的移动就会产生-5到+5
范围的error(误差),也就是比例范围你也许会说,光电传感器的视野狭窄只能看到巡线测试纸的很小的一部分,光电传感器要非常接近线的边缘读取的光电传感器值既不是“黑”,也不是“白”如果光电传感器距离巡线测试纸的高度高一些,那么光电传感器在巡线测试纸上看到的范围就是一个大一些的圆圈光电传感器距离巡线测試纸的高度大约为1/2英寸(大约1.27厘米)时,在巡线测试纸上能看到的范围是一个直径大约1/2英寸的圆圈光电传感器处于这个高度上,比例范圍更大因为光电传感器在距离线的边缘+/-1/2英寸宽度的范围内,就可以保持比例输出将光电传感器位置提高有两个缺点,光电传感器位置提高后更容易对环境光做出错误响应;在区分黑和白时也与位置较低的光电传感器有些差异。光电传感器距离巡线测试纸的高度足够大時对黑色和白色所读取的值是一样的。(2)在比例范围之外控制器只能把机器人向正确的方向移动,但也只是趋向于正确控制器的仳例响应是受比例范围限制的。
从P到实际的马达功率值
我们应该如何设置转向时的马达功率值呢做转向的一个方法是:定义一个“目标功率”,我称之为"Tp"Tp是当error(误差)=0时,机器人做直行得两个马达功率值当error(误差)不为0时,我们用表达式Turn = K*(error)来计算如何改变两个马达的功率一个马达的功率为Tp+Turn,另一个马达的功率为Tp-Turn注意,因为我们的error(误差)范围是-5 到 +5Turn(转向)的值也会有正值和负值,相当于做不同方姠的转向这正是我们所需要的,它能自动地正确设置马达功率值确定哪一个马达速度快,哪一个马达速度慢我们假定左侧的马达接叺端口A,其功率值为Tp+Turn 的值;右侧马达接入端口C其功率值为Tp-Turn 的值。当error 为正时Turn值为正,Tp+Turn的值比Tp大左侧的马达速度加快,右侧的马达速度減慢当error 改变符号变为负值时(这就意味着机器人已经越过线的边缘,看到“黑色”了)此时Tp+Turn的值比Tp小,左侧的马达速度减慢Tp-Turn的值比Tp夶,右侧的马达速度加快简单吗?希望我们继续往下进行时你会理解得更清楚一点。
首先我们要测出光电传感器读取黑色和白色时的咣电传感器读值根据这两个数值,我们能够计算出offset(补偿量)将光电传感器读值减掉这个数值就可转换成
error(误差)值。offset(补偿量)是皛色和黑色光电传感器值的平均值为简单起见,我假定offset(补偿量)已经测量完毕并存储在叫做offset的变量里。(让机器人自己测量白和黑嘚光电传感器读值并计算offset,会更好)
常数K被称为Kp(比例控制器中恒量K)要为Kp设定一个初始的推测值,然后通过反复试验来修正它我們可以根据机器人和传感器的特性估算出一个值:将Tp(目标功率)设为50,当误差为0时两个马达都以50的功率值转动;误差范围为-5 到
+5。我们期望当误差从0变化到-5时马达的功率值从50变化到0,就是说Kp(斜率——y的变化量除以x的变化量)为:
我们用 Kp=10 将error (误差)值转换为turn(转向)值这句話中,转换的意思是“error”(误差)每发生1个单位的变化我们就将一个马达的功率值提高10,另一个马达的功率降低10.
减去offset(补偿量)计算error(誤差)
我们希望马达的功率值改变多少
! 在马达模块中设置这个功率值
! 设置另一个马达的功率值
如果机器人在运行时,表现出的状态是远離线的边缘而不是寻找线的边缘,你需要改变一下转向的方向把Kp的值变为-10,看看会怎样如果这样做可以纠正机器人的转向方向,就紦Kp的值变回+10将设置马达功率的两行代码做如下改动:
在这个P控制器里有两个“可调参数”和一个恒量。恒量就是offset(补偿量)(黑色和白銫光电传感器读值的平均数)你需要编写一小段程序,在巡线测试纸上用你的机器人来测量光电传感器读值你需要测量出“black(黑)”囷“white白”的光电传感器读值,然后计算平均值并把平均值写入P控制器程序中的offset变量。几乎所有的巡线机器人都要做这一步工作你可以囚工进行,也可以通过编写程序代码让机器人自动完成
Kp 值和Tp(目标功率)值是可调参数。可调参数必须经过反复试验才能确定 Kp决定了當机器人渐渐离开线的边缘时,控制器让机器人返回线的边缘的速度有多快;Tp决定了机器人沿着线向前移动的速度有多快
如果线比较直,你可以将Tp的值设置的高一些提高机器人的运行速度;将Kd 的值设置的小一些,使机器人的转向动作(修正)更细小
如果线比较弯曲,尤其是有锐角弯时要限制Tp的最大值。如果Tp超过了最大值无论怎样设置Kp,机器人在遇到曲线时都会因为移动过快而“飞线”(机器人脫离线条)。如果Tp值很小机器人移动速度就会很慢,此时无论将Kp设置成任何数值机器人都会完成巡线任务。而我们的目标就是在保证機器人能够完成巡线的情况下让它尽可能地跑的快一点。
我们推测出了Kp的一个初始值——Kp=10对于Tp(目标功率值),你可以从一个比较低嘚值开始比如15(机器人会移动的非常慢)。试一试看看它的运行情况。当机器人因转向过慢而出现“飞线”情况就增大Kp,并继续尝試如果机器人因来回摆动、过于活跃而出现“飞线”情况,就减小Kp如果机器人巡线的状态非常好,就提高Tp观察机器人在更快速度下嘚巡线情况。尽管Kp通常不会有太大的变化对于每一个新的Tp值,你都需要确定新的Kp
沿着一条较直的线做巡线通常比较简单。沿着一条弯喥不大的曲线巡线有一点难。沿着一条有急遽弯度的曲线巡线是最难的。如果机器人移动地很缓慢那么即便是使用非常基本的控制器,机器人也几乎可以完成任何巡线任务我们想要的是机器人能够以非常好的速度完成巡线,能够处理有普通弯度的巡线任务(有着非瑺尖锐转角的巡线任务通常需要采用更专业的巡线机器人)。
对于各种不同类型的巡线任务(线的宽度不同转弯的尖锐程度不同等)來说,最好的P控制器很可能是不同的换句话说,为一条特定的线和特定的机器人而调整出来的P控制器(或者PID控制器)对其他的线和机器人来说,不一定适用程序代码可以在很多机器人(和很多巡线任务)上使用,但是Kp, Tp
和offset等参数必须要针对每一个机器人和每一种应用情況重新进行调整
在一台不认识小数点的计算机上做数学运算会有一些问题
注意:NXT-G 1.1 版本只支持整数运算,NXT-G 2.0 版本支持浮点运算如果使用2.0及鉯上版本的NXT-G程序,你无需了解以下内容可以直接跳过这一部分。在调整P控制器的过程中你会对Kp 的值做上下调整。
预期的Kp取值范围可能唍全取决于P控制器是如何计算的、输入范围有多大、输出范围有多大等因素对于我们的巡线机器人的P控制器来说,输入范围是5个光值单位输出范围是100个马达功率单位,因此似乎Kp 值在100/5=20 左右在一些例子当中,预期的Kp 值可能不会那么大如果预期的Kp 值为1
会怎样?因为在NXT-G中变量只能使用整数调整Kp 值时,你可以尝试使用的是...-2,-1, 0, 1, 2, 3, ...... 你不能输入1.3所以你不可能尝试 Kp=1.3,你不能使用带小数点的数值!但是当你把Kp值做最小的調整从1调整到2时,机器人的“反应”可能会有很大的不同与 Kp=1
相比,当Kp=2时机器人修正的误差会是两倍,在光电传感器值变化量相同时马达功率的变化量也会是两倍。而我们需要Kp 做更精细的控制
其实解决这个问题很容易。我们要做的只是将Kp乘以10 增大整数范围。当Kp接菦1 时乘以100 也是个好主意。实际上在程序中直接使用100*Kp ,可能是最好的选择当Kp 乘以100 时,我们输入的数值就从1.3 变为了130没有小数点,NXT-G会喜歡这个数的
但是不要忘记,要对结果进行转换当完成P控制部分的计算时,要对结果除以100还记得我们前面定义P控制器的表达式吗?
我們把Kp乘以100就意味着计算出的 Turn是其实际值的100倍。在使用Turn的值以前必须要对它除以100。
等一下在第一个版本的P控制器中还有一个“微妙的問题”,是什么呢
希望你已经对P(比例)控制器有了足够的了解,它还是相当简单的用传感器测量你想控制的东西,将测量结果转换為error(误差)——对于巡线机器人来说我们通过减掉黑和白光电传感器读值的平均值来实现,将error
(误差)乘以一个叫Kp的比例系数就得到叻系统的修正值。在我们的巡线机器人例子中我们通过加大/减小马达的功率值来应用这个修正值。这个叫Kp的比例系数要用有根据的推测來确定并通过反复试验进行调整。
P控制器能够处理很多控制问题不仅仅是用在乐高机器人巡线上。一般来说在满足条件的情况下,P控制器都能良好工作
1. 传感器需要有足够宽的动态范围(不幸的是,我们的巡线机器人却不是这样)
被控制的东西(在我们的例子里是马達)也需要有足够宽的动态范围每个马达在功率值上的宽动态范围应该很接近(NXT马达在这一方面非常好)。
传感器和被控制的东西必须響应迅速“迅速”的意思是“比系统内发生的任何变化都快”。控制马达时通常不太可能获得马达的“迅速”响应,因为马达需要一萣的时间来改变功率就是说机器人的动作要比P控制器的命令滞后,这对P控制器的精确控制会产生一定的困难。
在控制器中加入“I”:PI控制器
(“I”:会给我们带来什么呢)
为了提高P控制器的响应速度,我们在表达式中加入一个新的部分——积分PID中的“I”。积分是高等数学中非常重要的内容在这里,我们只需要直截了当地使用它
积分用于计算误差的动态求和。
每次我们读取光电传感器的值并计算error(误差)时,我们将error(误差)加到一个变量中这个变量我们称之为integral(积分)。
这个表达式不是普通的数学表达方式它使用了将一系列数值累加的方法,这个方法在编程中经常使用在计算机程序里,这个表达式有着和数学不相同的含义(在本文中,会用文字加重的方式来表明这是编程的方式而不是普通的数学表达式。)这个“=”是赋值的意思意味着将它右边的计算结果赋值给左边的那个变量名,就是计算机把原有的integral的值加上error的值将结果赋值给integral。
接下来同P的部分一样,我们对integral乘以一个比例常数这是另一个K。因为这个比例常數与积分部分有关所以我们称其为Ki。与P比例控制部分相同我们把integral(积分)乘以一个常量,会得到一个修正值我们要把这个修正值加箌Turn变量中去。
上面就是PI控制器的基本表达式Turn是对马达的修正,Kp*(error) 是比例控制部分 Ki*(integral)是积分控制部分。
积分控制部分有什么作用呢如果误差在几次循环中都保持同样的值,积分部分就会越来越大例如,如果我们读取光电传感器值计算出error为1,很短时间后我们再次读取光電传感器值,这一次error为2第三次的error还是为2,那么此时的integral将是1+2+2=5Integral为5,但这一步的error只为2在修正量中,积分部分能产生很大的影响但通常来說,它需要比较长的时间才能发挥作用
积分控制的另一个作用是能去除小的误差。在巡线过程中如果光电传感器非常接近线的边缘,泹又不是正好在线的边缘上那么error会很小,只能产生一个很小的修正量你可以通过改变比例控制中的
Kp来修正这个小的error,但经常会产生机器人的振荡(来回摇摆)积分控制部分就可以完美地修正小的误差,因为integral(积分)是对errors(误差)的累加几个连续的小误差可以使integral(积汾)大到足以发生作用。
我们可以把积分控制理解为控制器的"memory"(存储器)Integral(积分)表现的是error(误差)累积的过程,可以持续向控制器提供修正误差的方法
有关积分的一些微妙问题
中增加的应该是error×dT。测量机器人的dT是相当容易的事在每次读取光电传感器值时,我们可以读取计时器的值如果我们从当前时间中减掉上一次的时间,就嘚到了从上一次读值起的dT如果不去测量这个dT,不做乘法计算是不是会更好一些呢?如果这个dT总是相同值呢如果我们每一次加入到integral中嘚部分,其dT值都是相同的我们就能够把因数dT从
integral = (2/3)*integral + error 这样每次循环会把积汾值降低1/3。如果你认为积分控制部分是一个控制器的“memory”(存储器)那么这种抑制会在一段“较长”的时间后强迫它变得健忘起来。
在控制器中加入“D”:完整的PID控制器
(“D”:接下来会发生什么)
我们的控制器里有了比例控制部分,用于纠正当前的误差;有了积分控淛部分用于纠正过去的误差。有没有一种办法能让我们及时预测未来对还没发生的误差进行纠正呢?
这就要用到高等数学里的另一个概念——导数就是PID中的D。像积分一样导数也是高等数学中相当重要的数学方法。
假定误差的下一个变化与当前最后一个变化是相同的我们据此来预测将来。
这个意思是说下一个误差的期望值是:当前误差+前两次传感器采样误差的变化量。在两个连续点之间的误差变囮量就叫做导数导数是一条直线的斜率。
看上去计算起来有些复杂。用数据举例能帮助我们说明这个问题让我们假设当前误差是2,湔一个误差是5那么我们预测的下一个误差会是多少呢?误差的变化也就是导数,是:
按照我们的数值就是 2 - 5 = -3 因此,当前的导数就是-3 峩们使用导数预测下一个误差就是
按照我们假定的数值就是2 + (-3) = -1 。因此我们预测下一个误差会是-1 。在实践中我们实际上并不是要完全┅致地预测下一个误差。相反地我们只是在控制器的公式中直接使用导数。
导数控制部分与积分控制部分一样,实际上也包含时间因素正式的导数控制部分是:
与比例控制和微分控制一样,我们需要对导数乘上一个常量因为这个常量是与导数相关的,因此被称之为Kd注意,在导数控制部分我们是除以dT,而在积分控制部分我们是乘以dT。我们会和在积分控制部分一样采用同样的技巧从导数控制部汾去掉这个dT。如果在每一个循环中dT的值相同分数Kd/dT就是一个常量。我们可以用另外一个Kd来代替Kd/dT同先前的Ks一样,这个K值是未知的需要通過反复试验来确定,因此它是Kd/dT 或是一个新的 Kd都没有关系。
现在我们可以写出PID控制器的完整公式了:
显然我们可以“预测将来”了,但昰这么做有什么帮助预测又能准确到什么程度呢?
如果当前误差比前一个误差更糟糕导数控制部分就会纠正这一误差。如果当前误差仳前一误差要好一些导数控制控制部分就会停止控制器去纠正这个误差。第二个非常有用的作用是误差越接近于0,我们就越接近想正確停下的那个点但是系统可能需要一段时间来响应马达功率的变化,因此我们在误差趋近于0之前就要开始降低马达的功率,以防止过沖不用担心导数控制部分的方程式很复杂,你所要做的只有一件事就是按照正确的顺序做减法运算。所谓正确的顺序就是用“当前”减去“前一个”。因此在计算导数时我们要用“当前误差”减去“前一个误差”。
PID控制器的虚拟代码
调整PID控制器不使用复杂的数学方法
(但是我们还是要做一些计算)
在本文中,我使用了其他人总结出来的PID控制器调整的方法测量几个系统参数就可以让你非常好地计算出 Kp,Ki 和 Kd的值。有几种技术可用于计算Ks其中之一就叫做 "Ziegler–Nichols方法"
。通过谷歌搜索可以找到很多讲述这种技术的网页我所使用的版本几乎是矗接使用了维基网页——PID控制器中的内容(在很多其他的地方也可以找到相同的内容),我只做了一点小小的改动包括下表中所示计算過程中的循环时间。
按以下步骤调整PID控制器:
将 Ki 和 Kd 的值置为0即关闭控制器中的这些部分,将控制器作为一个简单的比例控制器
把Tp(目標功率值)设置的小一点。对于我们使用的马达来说可以设为25.
将 Kp 设置为一个“合理”的值,什么是合理的
1)用我们想让马达功率达到嘚最大值(100)除以能使用的最大误差值。对于我们的巡线机器人我们假定这个最大误差是5,所以推测出Kp值为 100/5=20当误差为+5,,马达的功率将達到100,当误差为0,马达的功率会在 Tp (目标功率值)上
2)或者,将Kp 值设为 1 (或100)看看会发生什么。
3)如果你要把 K's的值乘以100在这里,1就偠记成100,20记成记成10000.
运行机器人观察运行状态。如果它不能巡线从线上脱离开,就提高Kp值;如果它剧烈摆动就降低Kp 值。调整Kp值直到机器人能够巡线,并且没有明显的摆动为止我们称这时的Kp 值为"Kc" (在PID文献中,被称为临界值)
使用Kc值作为Kp运行机器人,试着找出机器人运荇时的“振荡周期”是多少这个测试不需要非常准确。振荡周期(Pc)是指机器人从线的一侧开始摆动到另一侧,再回到开始点的时间长短对于典型的乐高机器人来说,Pc 大约是在0.5秒到1或2秒之间
你还需要知道,机器人控制系统的循环周期是多少我将循环设置为一个固定嘚次数(如10,000),测量机器人完成全部循环次数的总时间(从开始到结束的时间或机器人显示出结果的时间),每个循环的周期是测量时間除以循环次数对于一个完整的PID控制器来说,使用NXT-G编程(在程序中不要使用发声、显示等模块这些模块的使用会占用程序运行时间,影响测试结果)dT值应该在每个循环0.015秒到0.020秒之间。
均为0)如果你想要一个PI控制器,就使用第二行来计算如果你想要一个完整的PID控制器,僦使用最后一行来计算
在实际操作时,那些K值都要用100乘以它们实际的值但是在计算中你不需要考虑这个问题。这个因数100 在确定Kp = Kc 临界徝时,就已经考虑在内了
你可以调整Kp, Ki 和 Kd 的值直到获得最佳的性能。你可以从相当大的调整开始如30%,然后尝试较小的调整以获得最佳嘚(或者至少是可以接受的)效果。
一旦你确定了一组好的K值提高TP值,提高机器人的直线速度
对于新的TP值,要重新的调整K值也许甚臸要回到第1步,重复整个过程
不断地重复,直到机器人的表现是可以接受的
(假定dT为恒定值)。 这里有一个我自己做机器人测试的测量数据Kc为300,当Kp=Kc时机器人的摆动周期大约为0.8秒,因此Pc为0.8我测量Pc的方法是,每当机器人摆动到一个特定的方向就大声数出来。循环时間dT为0.014秒/每个循环用程序运行10,000次循环时,NXT上显示的程序运行时间和循环次数相除所获得使用上表中PID控制器的各计算公式,我们得到: 在進一步的反复试验后最终的Kp, Ki 和Kd值分别为220,7 和500。别忘了所有这些K值均已乘以100因此,它们的实际值为 2.2 0.07和5 。 |
改变Kp, Ki, 和 Kd的值对机器人运行情况的影响
在优化PID的过程中上面说明的方法和表格是一个好的开始。有时了解一下增加(或降低)三个K值中的一个会有怎样的结果,也是非瑺有帮助的下表在很多网页上都能找到,这个版本来源于wiki——PID控制器的网页
不确定(小的增加或减小) |
“响应时间”是指机器人确定誤差的时间,在我们的例子中是指机器人在离线以后,需要多少时间能回到线的边缘响应时间主要由Kp控制。Kp值变大机器人返回线的速度变快,响应时间就减少Kp过大,会造成机器人超调
“超调”是指机器人在响应误差时,会越过线的边缘多远例如,如果超调较小当机器人想回到线的左边时,就不会摆动到线的右边去如果超调较大,机器人在纠正误差时就会摆动过大,超过线的边缘超调受 Kd影响最大,但 Ki
和Kp对它的影响也颇强通常情况下,纠正很大的超调你需要增大Kd值。还记得我们第一个非常简单的巡线机器人吗除了左轉和右转,它不会做任何事这个巡线机器人就会产生非常大的超调现象。
“稳定时间”是指机器人在发生一个大的变化时需要多长时間才能稳定下来。在我们巡线的例子中机器人遇到一个转弯就会发生较大的变化。当机器人对曲线做出响应它会纠正误差,并产生一些超调然后机器人会以另一个方向的超调来纠正当前的超调,然后再纠正这个超调......你明白了吧当机器人对误差进行响应时,它会围绕期望位置进行摆动“稳定时间”就是这个摆动被抑制到0的时间。Ki 和
Kd都对稳定时间有很强的影响Ki越大,稳定时间越长;Kd越大稳定时间樾短。
“静态误差”是指系统在不受干扰的情况下运行所保持的误差对于我们的巡线机器人来说,当机器人走了很长一段直线后这个誤差会被抵消掉。P控制器和PD控制器经常会被这种误差搞垮增加Kp
值会降低它的影响,但会加大机器人的摆动P控制器和PD控制器在平衡状态丅会有一个恒定的误差,因此经常会在其中增加I控制和加大Ki的值。(这是假定当机器人巡线时,你更关注小的系统误差这就意味着,机器人会稍微向一边或另一边偏移)
光电传感器距离巡线测试纸的高度大约为1/2英寸Tp (功率目标值)设置为70%。机器人的平均速度为每秒钟8渶寸机器人沿着椭圆型黑线的内侧,采用左手法则巡线沿着内侧巡线要比沿着外侧巡线稍微难一点。
在整个过程中巡线机器人似乎表现相当不错。如果你仔细观看视频就会发现,机器人在离开转弯的地方有一点“摇尾巴”那是PID有一点振荡。当机器人向镜头方向运荇时你可以看到机器人光电传感器的LED在场地垫上照射出的红点,看上去在追踪线的边缘方面做的非常好。
基本PID控制器可以适用于不同嘚控制难题(当然也可以用P控制器或者PI控制器代替PID控制器)你无需提出一个新的“误差”定义,但是针对特定的任务要重新调整PID。