|
( Z. o" Q0 z U) c- j: ? 基于STM32和PID算法的小车车速控制, s3 i7 j, H. y 四轴飞行器飞行原理与双闭环PID控制9 X$ e& w( Q: O7 n PID程序实例 该文档总结于以下两个博文:; i4 q$ b% `, V: @, @ http://www.moz8.com/thread-36004-1-1.html 和http://www.eeboard.com/bbs/thread-32321-1-3.html & @% E5 S, w! g% j0 L7 c! h 为了更好的理解这个视频和PID参数的作用,特意根据多轴飞行器的原理和PID理论,编写了一个EXCEL图表,直观的来理解PID参数的作用。 在这个模型中:- [* f8 U0 K# E& ]) ~9 p" D7 I 1、假设输出是力,作用在一个质块上,使用加速度、速度、位移积分计算,评估输出对测量值产生的影响,跟多轴飞行器的运动模式比较接近。* r! v) X& z5 D( X! E- K 2、让速度响应慢一个拍子,模拟电调和电机的响应滞后。- J6 \6 ~. {. ?( `( c5 [ 3、加入阻尼,模拟空气的衰减作用 4、引入偏差,用于体现I的作用,从中间加入,代表一个系统误差或外作用力+ y8 R3 n6 D7 F: B/ f( {8 S6 r4 l % V+ D6 H% C( v2 ~/ i9 v PID的作用概述:- J9 ]9 G: `4 N: H$ V7 G7 I 1、P产生响应速度和力度,过小响应慢,过大会产生振荡,是I和D的基础。5 Q9 j, u- L2 l# | 2、I在有系统误差和外力作用时消除偏差、提高精度,同时也会增加响应速度,产生过冲,过大会产生振荡。 3、D抑制过冲和振荡,过小系统会过冲,过大会减慢响应速度。D的另外一个作用是抵抗外界的突发干扰,阻止系统的突变。' k9 O6 |3 o7 o: ]5 }! A7 O/ O+ P . H1 c; M# X5 {. P! q( V8 R/ ] 通过这个模型和图表,一步步演示PID参数的作用和调试方法:3 T3 @& r$ r; `$ O L( r% t 1、逐步增大P,看P对响应速度和力度的影响,调到系统发生振荡,再减少一点P 当P=0.1时,响应很慢,但不会振荡$ R% F3 i9 L+ ^- ~* Q8 }# Y ' i4 M d0 D6 V0 x2 `粗黑线是系统响应,洋红线是目标值。 ! c2 @2 R: _* B 逐步增大P,P=1,有振荡,但慢慢在衰减 6 }/ F4 Z. d# T7 R+ |; s" y8 v! q2 S; r8 } 继续增大P,P=3,振荡会逐步加大 取振荡但会衰减的P=1继续调整- L3 j& }5 V1 U0 P 在多轴调试时,当振荡发生时,再稍微减小一点P。* p# J' w B6 R9 a) Y 2、加入D,看D对振荡的控制能力,D过小会发生过冲,D过大会迟滞,以稍微有点过冲为最佳 D=0.5,有较大的过冲和少量振荡,衰减很快8 s8 w: |" h9 n' Y D=1.3,基本没过冲 / t! l( u# o2 _ D=2,响应迟滞,减慢了响应速度9 a& W. V; z' o7 t# M6 j" F , s+ n+ T$ Z8 d! g3 z. z z 取以稍微有点过冲的D=1.3为最佳 在多轴调试时,用手拍一下机臂或倾斜启动,机臂在复位时有少量过冲为宜。(不过我喜欢基本没过冲时的参数,这样在悬停时更稳)& b- O. c7 v" ^ 3、可以继续增大P和D,让响应更快但过冲也不大。 P=2 D=1.8 8 y: E( ]/ i: c, T- D7 K# Q# j8 d, F 在理论上可以这样演示,但在实际多轴的调试时,这一步一般不做,这是为了更安全和稳定。 $ X" s4 q* D. U. r 4、加入0.2的偏差,看偏差对位移的影响! z4 ]" Y) _; @7 t6 s3 x 从中间加入,代表一个外作用力。8 a* x& ^$ n9 n$ p . R2 u. F" @, J ^# d可以看到,如果没有I的作用,偏差将一直存在,尽管P产生了一个抵抗力,但只是阻止了系统继续运动,但偏差一直在。, W) q4 y$ l4 S# F 在多轴调试时,如果持续的抬起一个机臂,机臂会持续的转动,抵抗力很小,放手后也不会回复。. l1 }2 {1 W6 z: T1 O: o9 W " ?8 k! A, i, P 5、加I,看I对偏差的修正能力,I加快了响应速度,但也会导致过冲或振荡 I=0.3 基本可以消除偏差产生的影响,产生了少量过冲,但提高了在有偏差时系统的精度' g$ N& Y- ?1 S3 z + M4 D4 p; E' P$ M# j8 w/ KI=3 进一步加快响应速度,但产生了振荡 取基本能纠正偏差的I=0.3 在多轴调试时,油门开至悬停油门,用手持续的抬起一个机臂,可以感到随着I的增加,抵抗力会逐步增大,持续时间加长。% ]3 F. d9 q5 e: T9 w& k9 e 因为多轴的长期稳定由姿态模式的LEVEL参数来解决,所以I不用太大,取缺省参数就可以了,大概可以抵抗1-2秒左右。6 S) E: ]" H, J- ~; ^ / w$ j; t- y/ P* S/ P! t% Y 6、增大一点D,减小一点I产生的过冲 取消偏差,因为I的加入,有一点过冲 * \; Z" u, Q- T- j( L' _$ P增大D,D=2.2,减小过冲 ; m3 t+ h( O L. d+ y0 h4 J3 l ^3 ?3 l( p5 d& m4 E 在实际多轴调试时,这一步一般不用,但是如果有必要,可以试一下。/ M' {. w0 Y, w% G% \ G 好了,曲线演示完了,这同时也是多轴PID参数的调试过程,结合视频一起看,能更好的理解这一过程,希望对大家理解PID有所帮助。* }8 d" [: c$ A, J |% P 附:多轴飞行器PID调试演示器.xls ; A* n$ c7 Z2 T4 P# U 另外,试了一下,下载的文件名可能有问题,自己把文件名改为"多轴飞行器PID调试演示器.xls"就可以用了 ) P* [, W& b& c& i PID的代码其实也很简单,主要是要了解其中的原理,才能更好地调整参数。为了方便新手们理解,楼主建立了一个数学模型来让大家了解。(只针对新手,老手就算了)* V: b6 q% J1 O. t5 X9 g: @ ========圆点博士小四轴之PID控制模式分析=======* B- M; q2 N" Z7 Z' k PID控制的P是Proportional的缩写, 是比例的意思,I是Integral的缩写,是积分的意思,D是Derivative的缩写,是微分的意思。所以,PID就是我们常说的比例,积分,微分控制。 我们首先来看一个PID控制模型曲线图:! F7 Y3 W5 @: Q+ c# O. ^5 E# d 该图包含了比例控制,比例+积分控制,比较+积分+微分控制的电机响应图的对比。' p7 v* g* w- q0 J: s ! R+ y- d/ n* k: I& n' @ 2014-5-29 13:22 上传下载附件 (37.76 KB) PID模型 + q+ w7 s0 A! D# U5 U& T' s 下面我们对曲线进行具体分析:3 ^/ S {1 b; \" z" d PID中的比例控制是最容易理解的,比例控制就是把角度的误差乘以一个常数作为输出驱动。假定我们有一个理想模型的电机,1V电压的变化会带来小四轴1度的角度改变。假定现在电机控制电压是5V,小四轴在某一轴上的偏角是5度,目标角度是100度。我们把当前的电压量定义为Vin,把输出控制量定义为Vout。假定P等于0.2,那么比例控制的结果就是:9 t/ h) j4 l" A: E5 { 第一次:Vout=Vin+(100-5)*P=5V+19V=24V,得到电机电压是24V,对应的小四轴角度是24度,距离目标角度的误差是100-24=76度。( W2 {: z3 t3 D7 q) _ 第二次:Vout=Vin+(100-24)*P=24V+15V=39V, 从而引起的角度是39度。" M5 \& s1 D9 T5 s6 O! F' u 我们看到,在这么的一个比例控制系统下,小四轴角度在慢慢地向目标角度靠近。 PID中的积分控制就是把把所有角度误差相加起来,然后乘上一个常数作为输出驱动。在上述例子中,假定I=0.2, 我们来看看比例和积分控制同时起作用下的系统反应。; R& p) D1 t& \! v% S 第一次:Vout=Vin+(100-5)*P+(100-5)*I=5V+19V+19V=43V,这时候小四轴角度为43度。 由于第一次控制前的误差是100-5=95,第二次控制前的误差是100-43=57,所以积分结果是152。 第二次:Vout=Vin+(100-43)*P+((100-5)+(100-43))*I=43V+11V+30V=84V, 这时候小四轴角度变为84度。 第三次:Vout=Vin+(100-84)*P+((100-5)+(100-43)+(100-84))*I=84+3V+33V=120V。这时小四轴角度变为120度。4 ~( j+ z: b0 W5 T5 C2 ]3 ]8 R 我们看到,在增加了积分控制后,小四轴角度在快速向目标角度靠近。 PID中的微分控制就是把角度的变化乘上一个常数来作为电机驱动输出。在上述例子中,假定D=0.2, 我们来看看比例,积分和微分共同控制下的系统反应。假定第一次前,电机转速保持5转,那么第一次前的角度变化为0。 第一次:Vout=Vin+(100-5)*P+(100-5)*I-(5-5)*D=5V+19V+19V-0V=43V,这时候小四轴角度为43度。5 O9 B* z; U5 I1 W 和上一次相比,角度从5度变化到了43度,所以小四周角度变化是43-5=38度。 第二次:Vout=Vin+(100-43)*P+((100-5)+(100-43))*I-(43-5)*D=43V+11V+30V-7V=77V, 这时候小四周角度77度。! _) { E+ C l$ [, a4 d! d 把上述的计算结果列出来,我们看到:# l* z# L' Y) `* Y3 |9 f 2014-5-29 13:23 上传下载附件 (39.13 KB) PID计算 : `' Q' j9 E( T4 P& }; b+ N " E1 J- P7 x( K: x3 c9 _ : R: f' s2 |4 i T; h# }3 i + c N# F! e0 V( s0 W 4 N! A0 K3 ^: [3 T- R2 W* [2 K, R 从上面的数据,我们可以看到:, N; S. g. x6 Y5 A9 f 1,单独比例控制的时候,数据慢慢接近目标 (图表中的红色线)- H( a, Y# Z2 M" a2 X% e 2,加入积分控制之后,数据快速接近目标 (图表中的蓝色线) 3,微分控制起到抑制变化的作用。(图表中的绿色线)3 h( F: I. r+ d0 T X: ^# U 有了这些理论基础,就可以写PID控制代码拉。2 E: \8 C4 k/ O |
PID.zip
下载23.06 KB, 下载次数: 1561
微信公众号
手机版
中级的pid调节,需要根据控制模型建模,然后零极点对消,等效1型或2型系统,根据最佳整定法计算pi参数,这是掌握一些自控原理的基础了。
高级一些的应该都是用自抗扰控制器,抗饱和积分(anti-windup)等,尤其是飞行器。