一阶倒立摆控制系统设计

1、倒立摆课程设计报告课程设计说明书课程名称：控制系统课程设计 设计题目：一阶倒立摆控制器设计 院 系:信息与电气工程学院班 级：设计者：学 号：指导教师：设计时间：2013年2月25日到2013年3月8号课程设计(论文)任务书专业自动化班级0902101学生指导教师题目一阶倒立摆课程设计子题设计时间2013年2 月25日至 2013年3月8 日共2 周设计要求设计(论文)的任务和基本要求，包括设计任务、查阅文献、方案设 计、说明书(计算、图纸、撰写内容及规范等)、工作量等内容。1.建立一阶倒立摆数学模型2 做模型仿真试验(1) 给出Matlab仿真程序。(2) 给出仿真结果和响应曲线。3.倒立摆

2、系统的PID控制算法设计设计PID控制器，使得当在小车上施加1N的脉冲信号时，闭环系统的响应指标为：(1) 稳定时间小于5秒(2) 稳态时摆杆与垂直方向的夹角变化小于0.1弧度并作PID控制算法的MATLAB仿真4倒立摆系统的最优控制算法设计用状态空间法设计控制器，使得当在小车上施加0.2m的阶跃信号时，闭环系统的响应指标为：(1 )摆杆角度和小车位移x的稳定时间小于 5秒(2) x的上升时间小于1秒(3) 的超调量小于20度(0.35弧度)(4) 稳态误差小于 2%。指导教师签字:系(教研室)主任签字:2013年 3月 5日目录一、 建立一阶倒立摆数学模型 41. 一阶倒立摆的微分方程模型

3、42. 一阶倒立摆的传递函数模型 63. 一阶倒立摆的状态空间模型 7二、 一阶倒立摆 matlab 仿真 9三、倒立摆系统的 PID 控制算法设计 13四、倒立摆系统的最优控制算法设计 23五、总结 错 误 !未定义书签。六、参考文献 2919、建立一阶倒立摆数学模型首先建立一阶倒立摆的物理模型。在忽略空气阻力和各种摩擦之后, 将直线一级倒立摆系统抽象成小车和匀质杆组成的系统，如图1所示系统内部各相关参数定义如下：M小车质量m摆杆质量b小车摩擦系数l摆杆转动轴心到杆质心的长度I摆杆惯量F加在小车上的力x 小车位置©摆杆与垂直向上方向的夹角0摆杆与垂直向下方向的夹角（考虑到摆杆初始位

4、置为竖直向下）1. 一阶倒立摆的微分方程模型对一阶倒立摆系统中的小车和摆杆进行受力分析，其中，N和P为小车与摆杆相互作用力的水平和垂直方向的分量。T图1-2小车及摆杆受力图分析小车水平方向所受的合力，可以得到以下方程:(i-i)(1-2)(1-3)MxF-bx-N由摆杆水平方向的受力进行分析可以得到下面等式:N m （x + / si n &）di2即：N = mx + mlO cos 0 mlO1 sin 0把这个等式代入式（1-1）中，就得到系统的第一个运动方程：+ m+ bx + cos- sin - F （ 1-4）为了推出系统的第二个运动方程，我们对摆杆垂直方向上的合力进行分

5、析, 可以得到下面方程：P - /ng - m （Icosff）d 广（1-5）即：11 r(1-6)(1-7)P 一 mg = -ml6 sin 3 - ml6 cos 3力矩平衡方程如下：Pf sin 0 Nicos0 10由于B = x +=仇sin 0 = -sin 3所以等式前面有负号合并这两个方程，约去P和N，得到第二个运动方程:(1-8)(/ + mF )0 + mg! sin 0 - m/xcosO设；二；T十0 , (©是摆杆与垂直向上方向之间的夹角)，假设© <<1 弧度，则可以进行近似处理：cos1,sin,()2 0。用u代表被控对dt象

6、的输入力F,利用上述近似进行线性化得直线一阶倒立摆的微分方程为：(1-9)f(/ + ml2 $ mix(M 十 m)x + bx -川/0 = u2. 一阶倒立摆的传递函数模型对式(1-9)进行拉普拉斯变换，得:(/ + ml2一 用g?二 mLX(s)s2(M + m)X(s)s2 +hJr(5)5-m®(s)52 =U(s)注意：推导传递函数时假设初始条件为 0。由于输出为角度©，求解方程组的第一个方程，可得:/(打二" + ：广)寻")nil s或Qi s) _mis2X(£)(/ + ml2)52 mgl如果令错误!未找到引用源。，则

7、有：ml(/ + m/2)s2 mgl1/打+加)g(/ + tnl1)£1 ° jWrrf m!_ ml?把上式代入方程组(2-1 )的第二个方程，得:(2-2)(2-3)(2-4)(2-5)整理后得到传递函数：ml 7s "($)q&4 方(/ + “，)j (；W + m)mgl 2 hmg55 '、-.Sqqq其中g = W +讪/ + l)-(ml)2 o3. 一阶倒立摆的状态空间模型设系统状态空间方程为:(2-6)(3-1)方程组（2-9）对解代数方程，得到解如下:IM +加+忖用尸/(.V/ + 川)十 Mm!X AX + Bu yC

8、X + Du(3-1)0 = d-mlb mglM + m) ,mlh x H齐 & i-；I(M + m) + Mnilf (Af + 冏)十 M/uh I Xi 冈)+ Xlml(3-3)X* F Xro0I(J + ml2 )b0«rg/:(f0LXi+ 0 r / + W11(M + m) + MmlI(M u) + Min!7(Af +m) + Mnil''二itd001d0d0-ntlbrnl(Xf + nt)0rtti1/(A/ +m) + M-1(M + m)+.Wm/21一了 1+m) + MjhI整理后得到系统状态空间方程:(3-2)摆杆的

9、惯量为11 23ml，代入（1-9）的第一个方程为:(/ + ml2 /) mgl(p =Hllx得: ml1 + mi2 $ - mgl = mix3丿化简得:(3-4)= + i则有:,u X414/X'0 1 0 0",X'0_1 IX0 0 0 0X110 0 0 1+0U0 0禮03L4Z9_4/_设 x Xx()0()”(3-5)4. 实际系统的传递函数与状态方程实际系统的模型参数如下：M小车质量0.5 Kgm摆杆质量0.2 Kgb小车摩擦系数0 .1N/m/secl摆杆转动轴心到杆质心的长度 0.3mI摆杆惯量0.006 kg*m*m代入上述参数可得系统

10、的实际模型 摆杆角度和小车位移的传递函数：5 (s)0.06s2X(s)0.024s2-0.588(4-1)摆杆角度和小车加速度之间的传递函数为:0(耳0.06V(s)0.02 + sz-0,58S(4-2)摆杆角度和小车所受外界作用力的传递函数：0(幻 _4.S4S455S(5) S3 +O,181818S2-31.1818185-4,4445(4-3)XX©0001-0.181818002.6727270O'01XX<p+ 0 11.8181820u.0-045454531.1818180_<p.4545455-以外界作用力作为输入的系统状态方程:(4-4)m

11、 i: a<p.<p.以小车加速度为输入的系统状态方程:(4-5)<P,(p.、一阶倒立摆matlab仿真实际系统参数如下,按照上面给出的例子求系统的传递函数、状态空间方程,并进行脉冲响应和阶跃响应的 matlab仿真。1.096Kg0.109Kg0.1 N/m/sec0.25m0.0034 kg*m*m0.005 秒M 小车质量m摆杆质量b小车摩擦系数l 摆杆转动轴心到杆质心的长度I摆杆惯量T采样时间1. 传递函数法Matlab 程序如下：M=1.096;m=0.109;b=0.1;I=0.0034;g=9.8;L=0.25;q=(M+m)*(I+m*LA2)-(m*L)A

12、2;num=m*L/q 0 0den=1 b*(I+m*LA2)/q -(M+m)*m*g*L/q -b*m*g*L/q 0;r,p,k=residue(num,den);s=p;得到传递函数的分子：num =2.3566 0 0 以及传递函数分母 :den =1.0000 0.0883 -27.8285 -2.3094 0 开环极点：s =-5.27805.2727-0.08300由此可知，系统传递函数的多项式表达式为：2Gs 上32.3566s 2（ 2-1）U （s） s4 0.0883s3 27.8285s2 2.3094s系统的开环极点为（s）: s15.2780、s2 5.2727

13、、昂 0.0830、S4 0，由于有一个开环极点位于S平面的右半部，开环系统并不是稳定的。系统的脉冲响应如下，由图也可见，系统并不稳定。50/ISystemn: sysTime (sec): 0.916SysAmplsyde: 27.6Time (sec): 0.885Amplitude: 23.4/Impulse Resp onse4540533052205O5eanMlpmA图2.1开环系统脉冲响应2.状态空间法状态空间法可以进行单输入多输出系统设计，因此在这个实验中，我们将尝试 同时对摆杆角度和小车位置进行控制。为了更具挑战性，给小车加一个阶跃输 入信号。我们用Matlab求出系统的状态

14、空间方程各矩阵，并仿真系统的开环阶跃响应。在这里给出一个state.m文件，执行这个文件，Matlab将会给出系统状态 空间方程的A，B, C和D矩阵，并绘出在给定输入为一个 0.2 N的阶跃信号时 系统的响应曲线。state.m程序如下：p=l*(M+m)+M*m*L2;>> A = 0 1 0 0;0 -(I+m*LA2)*b/p(mA2*g*LA2)/p0;0 0 0 1;0-(m*L*b)/pm*g*L*(M+m)/p0A =01.00000 -0.08830 00 -0.2357>> B=0;(I+m*LA2)/p;0;m*L/pB =00.883202.35

15、66>> C=1 0 0 0;0 0 1 0D=0;0C =0 00.629300 1.000027.82850D =00matlab 仿真的开环阶跃响应曲线如下图所示，系统并不稳定1009080706050403020100/. cart positionf/i/r/z/0.511.522.5图2.2系统开环阶跃响应曲线0三、倒立摆系统的PID控制算法设计1. 实验要求与目的要求：设计PID控制器，使得当在小车上施加1N的脉冲信号时，闭环系统的响应指 标为：(1) 稳定时间小于5秒(2) 稳态时摆杆与垂直方向的夹角变化小于0.1弧度并作PID控制算法的MATLAB仿真目的：进一步

16、熟悉PID控制器的设计方法，步骤，以及P、I、D三参数的调节方法。2. 理论分析PID控制原理在模拟控制系统中，控制器最常用的控制规律是PID控制。常规PID控制系统原理框图如下图所示。系统由模拟 PID控制器KD(S)和被控对象G(S)组成。PID控制器是一种线性控制器，它根据给定值r(t)与实际输出值y(t)构成控制偏差e(t)e(t) r(t) y(t)将偏差的比例(P)、积分(I)和微分(D)通过线性组合构成控制量，对被控对象进行控制，故称PID控制器。其控制规律为u(t) Kp e(t)Tie(t)dtoTdde(t)dt或写成传递函数的形式G(s)U(s)E(S)Kp 1TdS式中

17、：Kp 比例系数；Ti 积分时间常数； Td 微分时间常数。在控制系统设计和仿真中，也将传递函数写成G(s) ES)KpKiKdS式中：Kp 比例系数；Ki 积分系数；Kd 微分系数。简单说来，piD控制器各校正环节的作用如下:(1)比例环节：成比例地反映控制系统的偏差信号e(t)，偏差一旦产生，控制器立即产生控制作用，以减少偏差。(2)积分环节：主要用于消除稳态误差，提高系统的型别。积分作用的强弱取决于积 分时间常数，Ti越大，积分作用越弱，反之则越强。(3)微分环节：反映偏差信号的变化趋势 (变化速率)，并能在偏差信号值变得太大之前，在系统中引入一个有效的早期修正信号，从而加快系统的动作速

18、度， 减小调节时间。摆杆角度控制 这个控制问题和我们以前遇到的标准控制问题有些不同，在这里输出量为摆杆的位置，它的初始位置为垂直向上，我们给系统施加一个扰动，观察摆杆的响应。系统框图如下:十ControllerPlantKIX)图中KD(s)是控制器传递函数，G(s)是被控对象传递函数。考虑到输入r(s) 0 ,结构图可以很容易地变换成倒立摆课程设计报告25该系统的输出为numy(s)G(s)KD(s)G(s)F(s)1 (nundPin)(num)F(s) (de nPID)(den)num(de nPID)(de nPID)(den) (nu mPID)( num)其中：num被控对象传递

19、函数的分子项den 被控对象传递函数的分母项numPID pid控制器传递函数的分子项denPID pid控制器传递函数的分母项被控对象的传递函数是ml 2 s(s)qnumU(s)24 b(I ml ) 3 ss(Mm)mgl jbmgl denqqq其中q(M m)(I ml )(ml)2PID控制器的传递函数为KD(s)KiKdS Kps2KdSKpSKi nu mPIDsden PID只需调节PID控制器的参数，就可以得到满意的控制效果。小车位置控制小车位置作为输出时，系统框图如下:由于输入信号r(s) 0,所以可以把结构图转换成:其中，反馈环代表我们前面设计的摆杆的控制器。从此框图我

20、们可以看出此处只对摆杆角度进行了控制，并没有对小车位置进行控制。小车位置输出为:X(s)G2(s)KD(s)Gi(s)F(s)num2den21 (nu mPID)( nu mi)(de nPID)(de nJF(s)(nu m2)(de nPID )(denJ(denPID )(deni )(den2) (numPID )(numiMden?)其中，numi， deni， num：， den：分别代表被控对象 1和被控对象2传递函数的分 子和分母。numPID和denPID代表pid控制器传递函数的分子和分母。 下面我们来 求G2(S)，根据前面实验二的推导，有x(s)耳(s)ml s可以推

21、出小车位置的传递函数为G2 (s)X(s)U(s)(Iml2) 2s qmglq24 b( I ml ) sqs3 (Mm)mgl yqbmgl s q其中q (Mm)(Iml2) (ml)2可以看出，dem =den2 = den，小车的算式可以简化成:X(s)(nu m2)(de nPID)(denPID)(den ) k(numPID)(num) 3. PID控制算法的MATLAB仿真实际系统参数如下：M小车质量1.096 Kgm摆杆质量0.109 Kgb小车摩擦系数0 .1N/m/secl摆杆转动轴心到杆质心的长度0.25mI摆杆惯量0.0034kg*m*mF加在小车上的力x小车位置T

22、米样时间摆杆的matlab仿真程序代码如下：M=0.5;m=0.2;b=0.1;1=0.006;g=9.8;L=0.3;q=(M+m)*(I+m*LA2)-(m*L)A2;num仁m*L/q 0 0;den仁1 b*(l+m*LA2)/q -(M+m)*m*g*L/q -b*m*g*L/q 0;Kp=1;Ki=1;Kd=1;numPID= Kd Kp Ki;den PID=1 0;num=conv(nu m1,de nPID);den=polyadd(c on v(de nPID,de n1),c onv(nu mPID ,nu ml); r,p,k=residue( nu m,de n);s

23、=pt=0:0.005:5;impulse( nu m,de n,t)倒立摆课程设计报告axis(O 2 0 10)运行程序得到:s =-6.41613.96930.001900并得到仿真图像如下:eanMupmATime (sec)图3.1 kp=ki=kd=1时的仿真响应图可见此时系统并不稳定，此时应该首先调整kp,观察其响应的变化:讲kp设置为150,得到并观察响应图如下：-1.2224 +18.0044i-1.2224 -18.0044i-0.0000-0.0000-0.0000图3-2, kp=150系统仿真图可见此时系统两个闭环极点均在 S平面做平面，系统稳定，系统稳定时间约 为4

24、秒，满足要求。此时系统有极小的静态误差，根据系统对于精度的要求可 酌情考虑是否添加积分控制，本文添加积分控制。将积分参数设为5,得到并观察闭环响应图。在笔者经过多次尝试之后，发现积分控制对于系统响应的调节作用极小，笔 者给出当积分参数分别设为10和50的响应图如下：图3-3，ki=10的响应27倒立摆课程设计报告Time (sec)图3-4 , ki=50系统的响应积分作用通常是用来调整系统的静态误差，使之达到需要的范围，但是此处 明显积分作用对系统的影响不大，并了解到被控对象的特性属于变化快的类型, 应该考虑改变微分控制，虽然微分控制在实际系统中运用并不多见。笔者将微分作用参数设置为10,2

25、0,50观察其效果图。0.2OeaupmAO-0.20-0.150.511.522.53Time (sec)3.544.55Impulse Response5T05O05-2图 3-5 , kp=150,ki=50,kd=10 的仿真图像倒立摆课程设计报告2922.53Time (sec)0505o-0Impulse Response1.522.53Time (sec)3.544.55Impulse Response11.53.544.552 5OO05O05-05-图 3-6 , kp=150,ki=50,kd=20的仿真图像图 3-7, kp=150,ki=50,kd=50 的仿真图像当微

26、分效果加上去的时候，系统闭环仿真图像结果得到了质的改善，瞬间取 代了超调，不稳定，响应时间也迅速降到了0.5秒，稳定时间在1秒，完美地 完成了任务。 其效果已经不能简单的用好来形容， 但是微分作用并非如此普及， 并且每次都效果如此良好，要根据不同的对象来判断用什么作用。必须要说的 是，微分作用在物理实现中是并不容易的，如果只有比例调节和积分调节就能 达到预想的效果，那就不要使用微分调节。4.小车位置控制算法仿真pid2.m 是仿真小车位置变化的 m 文件，文件如下：% 小车位置 PID 控制% 输入倒立摆传递函数 G1(s)=num1/den1,G2(s)=num2/den2M = 1.096

27、; m = 0.109; b = 0.1; I = 0.0034; g = 9.8; l= 0.25;q = (M+m)*(l+m*L2) -(m*l)A2;num1 = m*l/q 0 0;den1 = 1 b*(l+m*lA2)/q-(M+m)*m*g*l/q -b*m*g*l/q 0;num2 = -(l+m*lA2)/q0 m*g*l/q;den2 = den1;% 输入控制器 PlD 数学模型 Gc(s)=numPlD/denPlDKp = 150; Ki = 50; Kd = 50;numPlD = Kd Kp Ki;denPlD = 1 0;% 计算闭环系统传递函数 G(s)=n

28、um/den% 多项式相乘num = conv(num2,denPlD);% 多项式相加den = polyadd(conv(denPlD,den2),conv(numPlD,num1 );% 求闭环系统极点r,p,k = residue(num,den);% 显示闭环系统极点s = p% 求取多项式传函的脉冲响应t=0:0.005:5;impulse(num,den,t)% 显示范围：横坐标 0-5，纵坐标 0-10，此条语句参数可根据仿真输出曲线调 整axis(0 5 -0.1 0.5)grid此时系统取Kp=150, Ki=50 , Kd=50,阶跃响应仿真曲线如下图所示：倒立摆课程设计

29、报告-115.0953-2.4030-0.417700Impulse Resp onse图3-8，小车位置仿真由仿真结果能够看出，当摆杆角度处于很好的闭环控制下时，小车位置虽然处 于失控状态，但是上升速度不快。四、倒立摆系统的最优控制算法设计1.设计目的与要求现代控制理论的最突出特点就是将控制对象用状态空间表达式的形式表示出 来，这样便于对多输入多输出系统进行分析和设计。线性二次型最优控制算法（LQR）是现代控制理论中一种重要的、基本的方法，LQR算法的目的是在一定的性能指标下，使系统的控制效果最佳，即利用最少的控制能量，来达到最 小的状态误差。本章主要利用最优控制算法实现对一阶倒立摆系统的摆

30、杆角度 和小车位置的同时控制。设计目的：学习如何使用状态空间法设计系统的控制算法。设计要求：用状态空间法设计控制器，使得当在小车上施加0.2N的阶跃信号时，闭环系 统的响应 指标为：（1）摆杆角度 和小车位移x的稳定时间小于5秒（2）x的上升时间小于1秒（3）的超调量小于 20度（0.35弧度）（ 4）稳态误差小于 2%。2. 最优控制器的设计在 PID 调节中，我们的输入是脉冲量，并且在设计控制器时，只对摆杆角度进行控制，而不考虑小车的位移。然而，对一个倒立摆系统来说， 把它作为单输出系统是不符合实际的，如果把系统当作多输出系统的话， 用状态空间法分析要相对简单一些，在这一章我们将设计一个对

31、摆杆位置 和小车位移都进行控制的控制器。系统状态方程为X AX BuY CX Du在倒立摆相关参数为：1.096Kg0.2109Kg0.1 N/m/sec0.25 m0.0034 kg*m*m0.005 秒M 小车质量m 摆杆质量b 小车摩擦系数l 摆杆转动轴心到杆质心的长度I 摆杆惯量T 采样时间 的条件下，状态方程系数矩阵如下：0100000.088301.00000.8832A；B；C0001.0000000.235727.828502.35660D10000010033倒立摆课程设计报告37最优控制的前提条件是系统是能控的， 下面来判断一下系统的能控能观性。Matlab 仿真程序如下

32、：A=0 1 0 0;0 -(I+m*LA2)*b/p(mA2*g*LA2)/p 0;0 0 0 1;0 -(m*L*b)/pm*g*L*(m+M)/p 0B=0;(I+m*LA2)/p;0;(m*L)/pC=1 0 0 0;0 0 1 0D=0;0Qc=ctrb(A,B);/ 判断能控性K=rank(Qc)Qo=obsv(A,C)；/ 判断能观性I=rank(Qo)1. Matlab 仿真结果为：K =4I =4即：系统的能控矩阵的秩 rank B AB A2B A3B 4 。系统的能观矩阵的秩 rank C CA CA2 CA3 4 。 故系统是能控能观的。因此可以给系统加上最优控制器使得

33、系统闭环稳定，且 满足暂态性能指标。在运用线性二次型最优控制算法进行控制器设计时，主要 的目的就是获得反馈向量 K 的值。由上一小节的推导知道，设计系统状态反馈 控制器时，一个关键的问题就是二次型性能指标泛函中加权矩阵Q和R的选取为了使问题简化及加权矩阵具有比较明确的物理意义，我们将 Q取为对角阵。假设Q110000Q2200Q； R r00Q330000Q44这样得到的性能指标泛函为 由上式可以看出，Qii是对xi的平方的加权，Qh的相对增加就意味着对xi的要 求相对其它状态变量严格，在性能指标中的比重大，X的偏差状态相对减小。r 是对控制量u的平方加权，当r相对较大时，意味着控制费用增加，

34、使得控制能 量较小，反馈减弱，而 r 取值较小时，系统控制费用减小，反馈增加，系统动 态响应迅速。Q11x1Q22x22 2 2 Q33 x3Q44x4ru dt考虑到一阶倒立摆系统在运行过程中，主要的被控量为系统的输出量x和，因此在选取加权对角阵Q的各元素值时，由于Qu代表小车位置的权重，而Q33是 摆杆角度的权重，所以只选取 Q11、Q33，而Q22 Q440。选取Q和R时需要注意的几个方面：（1） 由于我们采用的系统模型是线性化的结果，为使系统个状态量能够在线性 范围工作，要求各状态量不应过大。（2）闭环系统最好能有一对共轭复数极点， 这样有利于克服系统的非线性摩擦，但系统主导极点的模不应太大以免系统频带过宽，使得系统对噪声太敏感，以 致系统不能正常工作。（3）加权矩阵R的减小，会导致大的控制能量，应注意控制 U的大小，不要超 过系统执行机构的能力，使得放大器处于饱和状态。控制系统如下图所示，图中 R是施加在小车上的阶跃输入，四个状态量 x、x、 和 分别代表小车位移、 小车速