一阶倒立摆控制系统设计

倒立摆课程设计报告路甯城，//孝课程设计说明书课程名称：控制系统课程设计设计题目：二阶倒立摆控制器设计院系：信息与电气工程学院班级： 设计者：学号：指导教师:设计时间:2013年2月25日到2013年3月8号倒立摆课程设计报告课程设计(论文)任务书专业自动化班 级0902101学生指导教师题目一阶倒立摆课程设计子题设计时间2013年2月25日至2013年3月8日共2周设计要求设计(论文)的任务和基本要求，包括设计任务、查阅文献、方案设计、说明书(计算、图纸、撰写内容及规范等)、工作量等内容。.建立一阶倒立摆数学模型.做模型仿真试验(1)给出Matlab仿真程序。(2)给出仿真结果和响应曲线。.倒立摆系统的PID控制算法设计设计PID控制器，使得当在小车上施加1N的脉冲信号时，闭环系统的响应指标为：(1)稳定时间小于5秒(2)稳态时摆杆与垂直方向的夹角变化小于0.1弧度并作PID控制算法的MATLAB仿真.倒立摆系统的最优控制算法设计用状态空间法设计控制器，使得当在小车上施加0.2m的阶跃信号时，闭环系统的响应指标为：(1)摆杆角度9和小车位移工的稳定时间小于5秒(2)%的上升时间小于1秒(3)9的超调量小于20度(0.35弧度)(4)稳态误差小于2%。指导教师签字： 系(教研室)主任签字:2013年3月5日倒立摆课程设计报告目录TOC\o"1-5"\h\z\o"CurrentDocument"一、建立一阶倒立摆数学模型 4一阶倒立摆的微分方程模型 4一阶倒立摆的传递函数模型 6一阶倒立摆的状态空间模型 7\o"CurrentDocument"二、一阶倒立摆matlab仿真 9\o"CurrentDocument"三、倒立摆系统的PID控制算法设计 13\o"CurrentDocument"四、倒立摆系统的最优控制算法设计 23五、总结 错误!未定义书签。\o"CurrentDocument"六、参考文献 29倒立摆课程设计报告一、建立一阶倒立摆数学模型首先建立一阶倒立摆的物理模型。在忽略空气阻力和各种摩擦之后，可将直线一级倒立摆系统抽象成小车和匀质杆组成的系统，如图1所示。系统内部各相关参数定义如下：M 小车质量m摆杆质量b小车摩擦系数l 摆杆转动轴心到杆质心的长度I摆杆惯量F 加在小车上的力x小车位置“ 摆杆与垂直向上方向的夹角。 摆杆与垂直向下方向的夹角（考虑到摆杆初始位置为竖直向下）一阶倒立摆的微分方程模型对一阶倒立摆系统中的小车和摆杆进行受力分析，其中，N和P为小车与摆杆相互作用力的水平和垂直方向的分量。倒立摆课程设计报告图1-2小车及摆杆受力图分析小车水平方向所受的合力，可以得到以下方程:Mx^F-bx-N(1-1)倒立摆课程设计报告图1-2小车及摆杆受力图分析小车水平方向所受的合力，可以得到以下方程:Mx^F-bx-N(1-1)由摆杆水平方向的受力进行分析可以得到下面等式：（1-2）即:把这个等式代入式（1-1）中，就得到系统的第一个运动方程：一小占一府一小⑺一心门'=（（1-4）为了推出系统的第二个运动方程，我们对摆杆垂直方向上的合力进行分析，可以得到下面方程：P-mg-m（/cos日）（- （1-5）即：1一*二一："35—通力,C'S（1-6）力矩平衡方程如下：（1-7）-Plsin6-Nicos6-10（1-7）由于"二，二一"C0"二一"①、门c二一,所以等式前面有负号。

倒立摆课程设计报告合并这两个方程，约去P和N,得到第二个运动方程：\一一"叶内一门二 if设“二：一门，（“是摆杆与垂直向上方向之间的夹角），假设“<<1弧度，则可以进行近似处理：cos9=-1,sin9=R,（—）2=0。用u代表被控对dtI十ml20—dtI十ml20—mgl(/)—mix(1-9)mis(mis(2-3)TOC\o"1-5"\h\z\o"CurrentDocument"(M+m)x+bx- =u一阶倒立摆的传递函数模型对式（1-9）进行拉普拉斯变换，得：l/ihklJNVig中z二〃四NV （2-1）［（AY+m）X⑸/+bXC-"〃①⑸1 ?⑸注意：推导传递函数时假设初始条件为0。由于输出为角度中，求解方程组的第一个方程，可得：）仃心! （2-2）a.. --或①⑸X（x）（I+ml~）s~-mgl如果令错误!未找到引用源。，则有：「！E：I./- -仃口 （2-4）把上式代入方程组（2-1）的第二个方程，得：（M一例"""'一屋①（£）『+卜'+ '）+'①w）£—=U。） （2-5）fillS-

倒立摆课程设计报告整理后得到传递函数：ml2；1'：，_ J (2-6)t/(.v) 4h(Iml~)3(AZ+m)mgl2btngi1 l51 lS*q qq其中片[(初+〃])(！+初h-(初)21一阶倒立摆的状态空间模型设系统状态空间方程为:X=AX+Bu（3-1）方程组（2-9）对x解代数方程，得到解如下: -it十次）十A制 -it十次）十A制/（3-1）1(M^my+Mrnl-3=3■- -tnlb/(A/+m)'十整理后得到系统状态空间方程:OILr—{1+vi产)61(Al+用)+-OILr—{1+vi产)61(Al+用)+-mlb1/( +用)+血叫/41(M+m)+MmI（3-2）0“V+M+血调产“V+M+AJ调产2（A/+阴）+.包加产mgl(Af+m)布/摆杆的惯量为13m2，代入（1-9）的第一个方程为:倒立摆课程设计报告得:化简得:(3-4)设x=[xxC忸],u'=x则有:4.实际系统的传递函数与状态方程实际系统的模型参数如下：M 小车质量 0.5Kgm 摆杆质量 0.2Kgb 小车摩擦系数 0.1N/m/sec摆杆转动轴心到杆质心的长度0.3mI摆杆惯量 0.006kg*m*m

倒立摆课程设计报告代入上述参数可得系统的实际模型。摆杆角度和小车位移的传递函数：&（s） 0,06#x（5） 0,0Z4s2-0.58S摆杆角度和小车加速度之间的传递函数为:0.06摆杆角度和小车加速度之间的传递函数为:（4-1）（4-1）摆杆角度和小车所受外界作用力的传递函数:以外界作用力作为输入的系统状态方程:-0.181818-04545452.67272731.181818以小车加速度为输入的系统状态方程:U

+

K，x9-,s-

■.

0o

o1

oo

IQ--rxl单

--y二、一阶倒立摆matlab仿真实际系统参数如下，按照上面给出的例子求系统的传递函数、状态空间方程，并进行脉冲响应和阶跃响应的matlab仿真。

倒立摆课程设计报告1.096Kg0.109Kg0.1N/m/sec0.25m1.096Kg0.109Kg0.1N/m/sec0.25m0.0034kg*m*m0.005秒m 摆杆质量6 小车摩擦系数l 摆杆转动轴心到杆质心的长度I 摆杆惯量T 采样时间.传递函数法Matlab程序如下：M=1.096;m=0.109;b=0.1;I=0.0034;g=9.8;L=0.25;q=(M+m)*(I+m*「2)-(m*L)八2;num=[m*L/q00]den=[1b*(I+m*L^2)/q-(M+m)*m*g*L/q-b*m*g*L/q0];[r,p,k]=residue(num,den);s=p;得到传递函数的分子:num=2.3566 0 0以及传递函数分母：den=1.0000 0.0883-27.8285 -2.3094 0开环极点：s=10倒立摆课程设计报告-5.27805.2727-0.08300由此可知，系统传递函数的多项式表达式为：G(s).皿_2.3566s2 (2-1)U(s)s4+0,0883s3-27.8285s2—2.3094s系统的开环极点为(s):[=-5.2780、s2=5.2727、s3=-0.0830、s4=0，由于有一个开环极点位于S平面的右半部，开环系统并不是稳定的。系统的脉冲响应如下，由图也可见，系统并不稳定。图2.1开环系统脉冲响应2.状态空间法状态空间法可以进行单输入多输出系统设计，因此在这个实验中，我们将尝试同时对摆杆角度和小车位置进行控制。为了更具挑战性，给小车加一个阶跃输入信号。我们用Matlab求出系统的状态空间方程各矩阵，并仿真系统的开环阶跃响应。在这里给出一个state.m文件，执行这个文件，Matlab将会给出系统状态空间方程的A，B，C和D矩阵，并绘出在给定输入为一个0.2N的阶跃信号时系统的响应曲线。state.m程序如下：11倒立摆课程设计报告p=I*(M+m)+M*m*LA2;TOC\o"1-5"\h\z>A=[0 1 0 0;0-(I+m*LA2)*b/p(mA2*g*LA2)/p0;0 0 0 1;0 -(m*L*b)/p m*g*L*(M+m)/p 0]A=01.0000000-0.08830.629300001.00000-0.235727.82850>B=[0;(I+m*LA2)/p;0;m*L/p]B=00.883202.3566>C=[1000;0010]D二[0;0]C=10000010D=00matlab仿真的开环阶跃响应曲线如下图所示，系统并不稳定。12

倒立摆课程设计报告图2.2系统开环阶跃响应曲线三、倒立摆系统的PID控制算法设计.实验要求与目的•要求：设计PID控制器，使得当在小车上施加1N的脉冲信号时，闭环系统的响应指标为：(1)稳定时间小于5秒(2)稳态时摆杆与垂直方向的夹角变化小于0.1弧度并作PID控制算法的MATLAB仿真•目的：进一步熟悉PID控制器的设计方法，步骤，以及P、I、D三参数的调节方法。.理论分析•PID控制原理在模拟控制系统中，控制器最常用的控制规律是PID控制。常规PID控制系统原理框图如下图所示。系统由模拟PID控制器KD(S)和被控对象G(S)组成。PID控制器是一种线性控制器，它根据给定值厂(t)与实际输出值y(t)构成控制偏差e(t)将偏差的比例(P)、积分(I)和微分(D)通过线性组合构成控制量，对被控对象进行控制，故称PID控制器。其控制规律为13

倒立摆课程设计报告倒立摆课程设计报告e(t)+—fe(t)dt+Te((t)

T ddtI0或写成传递函数的形式G(s)=UsE(s)G(s)=UsE(s)=Kpf1+Ts+TDS式中：KP——比例系数；TI——积分时间常数；Td——微分时间常数。在控制系统设计和仿真中，也将传递函数写成式中：KP——比例系数；KI——积分系数；KD——微分系数。简单说来，PID控制器各校正环节的作用如下：（1）比例环节：成比例地反映控制系统的偏差信号e（t），偏差一旦产生，控制器立即产生控制作用，以减少偏差。（2）积分环节：主要用于消除稳态误差，提高系统的型别。积分作用的强弱取决于积分时间常数Tt,Ti越大，积分作用越弱，反之则越强。（3）微分环节：反映偏差信号的变化趋势（变化速率），并能在偏差信号值变得太大之前，在系统中引入一个有效的早期修正信号，从而加快系统的动作速度，减小调节时间。摆杆角度控制这个控制问题和我们以前遇到的标准控制问题有些不同，在这里输出量为摆杆的位置，它的初始位置为垂直向上，我们给系统施加一个扰动，观察摆杆的响应。系统框图如下:那）二FCentrailer那）二FCentrailer图中KD（s）是控制器传递函数，G（s）是被控对象传递函数。考虑到输入Ns）=0，结构图可以很容易地变换成14倒立摆课程设计报告Oontr口归rKDO)该系统的输出为numy(s)= G(^ F(s)= % F(s)1+KD(s)G(s) 1+(numPID)(num)(denPID)(den)num(denPID) F(s)(denPID)(den)+(numPID)(num)其中：num——被控对象传递函数的分子项den——被控对象传递函数的分母项numPID——pid控制器传递函数的分子项denPID——pid控制器传递函数的分母项被控对象的传递函数是mls20(s) q numU(s) b(I+ml2) (M+m)mgl bmgldenTOC\o"1-5"\h\zs4+ s3 s2 sq q q其中q-[(M+m)(I+ml2)-(ml)2]其中numPID

denPIDPID控制器的传递函数为numPID

denPID,"kKKs2+Ks+KKD(s)-Ks+K+—I-——d p 1DPs s只需调节PID控制器的参数，就可以得到满意的控制效果。小车位置控制小车位置作为输出时，系统框图如下：15

倒立摆课程设计报告其中，G(s)倒立摆课程设计报告其中，G(s)是摆杆传递函数，G(s)是小车传递函数。12由于输入信号r(s)=0，所以可以把结构图转换成:其中，反馈环代表我们前面设计的摆杆的控制器。从此框图我们可以看出此处只对摆杆角度进行了控制，并没有对小车位置进行控制。小车位置输出为:G2(s)1+KD(s)G1(sG2(s)1+KD(s)G1(s)(denPID)(den)i(num)(denPID)(den)

2 1 (denPID)(den)(den)+(numPID)(num)(den)其中，num1，den1，num2，den2分别代表被控对象1和被控对象2传递函数的分子和分母。numPID和denPID代表pid控制器传递函数的分子和分母。下面我们来求G2(s)，根据前面实验二的推导，有X(s)=[(I+ml2)-5]O(s)

mls2可以推出小车位置的传递函数为16

倒立摆课程设计报告倒立摆课程设计报告TOC\o"1-5"\h\z(I+ml2) mglG2G2(()=b(I+ml2) (M+m)mgl bmgls4+ s3 s2 sq q q其中q-[(M+m)(I+ml2)-(ml)2]可以看出，㈣=den2=以，小车的算式可以简化成:(num)(denPID) 2 (denPID)(den)+k(numPID)(num)13.PID控制算法的MATLAB仿真实际系统参数如下：M小车质量1.096Kgm摆杆质量0.109Kgb小车摩擦系数0.1N/m/secl摆杆转动轴心到杆质心的长度0.25mI摆杆惯量0.0034kg*m*mF加在小车上的力x小车位置T采样时间摆杆的matlab仿真程序代码如下:M=0.5;m=0.2;b=0.1;I=0.006;g=9.8;L=0.3;q=(M+m)*(I+m*L八2)-(m*L)八2;num1=[m*L/q00];den1=[1b*(I+m*L八2)/q-(M+m)*m*g*L/q-b*m*g*L/q0];Kp=1;Ki=1;Kd=1;numPID=[KdKpKi];denPID=[10];num=conv(num1,denPID);den=polyadd(conv(denPID,den1),conv(numPID,num1));[r,p,k]=residue(num,den);s=pt=0:0.005:5;impulse(num,den,t)17倒立摆课程设计报告axis([02010])运行程序得到：s=-6.41613.96930.001900并得到仿真图像如下：ImpulseResponse00 0.2 0.4 0.6 0.8 1 1.2 1.4 1.6 1.8 2Time(sec)图3.1kp=ki=kd=1时的仿真响应图可见此时系统并不稳定，此时应该首先调整kp,观察其响应的变化:讲kp设置为150，得到并观察响应图如下：s=-1.2224+18.0044i-1.2224-18.0044i-0.0000-0.0000-0.000018

倒立摆课程设计报告图3-2,kp=150系统仿真图可见此时系统两个闭环极点均在S平面做平面，系统稳定，系统稳定时间约为4秒，满足要求。此时系统有极小的静态误差，根据系统对于精度的要求可酌情考虑是否添加积分控制，本文添加积分控制。将积分参数设为5,得到并观察闭环响应图。在笔者经过多次尝试之后，发现积分控制对于系统响应的调节作用极小，笔者给出当积分参数分别设为10和50的响应图如下：-0.20 0.5 1 1.5 -0.20 0.5 1 1.5 22.5 3 3.5 4 4.5 5Time(sec)ImpulseResponse图3-3,ki=10的响应19倒立摆课程设计报告-0.20-0.150.511.5 22.5 33.5 44.5 -0.20-0.150.511.5 22.5 33.5 44.5 5ImpulseResponse51.100051.00.0-eaulDmATime(sec)图3-4,ki=50系统的响应积分作用通常是用来调整系统的静态误差，使之达到需要的范围，但是此处明显积分作用对系统的影响不大，并了解到被控对象的特性属于变化快的类型，应该考虑改变微分控制，虽然微分控制在实际系统中运用并不多见。笔者将微分作用参数设置为10,20,50观察其效果图。ImpulseResponse0.20.150.1图3-5，kp=150,ki=50,kd=100.1图3-5，kp=150,ki=50,kd=10的仿真图像2)倒立摆课程设计报告eau^umAO.20ImpulseResponse25150.10.00005150.5 1 1.5 2 2.5 3 3.5 4 4.5 eau^umAO.20ImpulseResponse25150.10.0000515Time(sec)ImpulseResponse00.511.522.533.544.55图3-6,kp=150,ki=50,kd=20的仿真图像ImpulseResponse00.511.522.533.544.55Time(sec)图3-7,kp=150,ki=50,kd=50的仿真图像当微分效果加上去的时候，系统闭环仿真图像结果得到了质的改善，瞬间取代了超调，不稳定，响应时间也迅速降到了0.5秒，稳定时间在1秒，完美地21倒立摆课程设计报告完成了任务。其效果已经不能简单的用好来形容，但是微分作用并非如此普及，并且每次都效果如此良好，要根据不同的对象来判断用什么作用。必须要说的是，微分作用在物理实现中是并不容易的，如果只有比例调节和积分调节就能达到预想的效果，那就不要使用微分调节。4.小车位置控制算法仿真pid2.m是仿真小车位置变化的m文件，文件如下：%小车位置PID控制%输入倒立摆传递函数G1(s)=num1/den1,G2(s)=num2/den2M=1.096;m=0.109;b=0.1;I=0.0034;g=9.8;l=0.25;q=(M+m)*(I+m*1A2)-(m*l)A2;num1=[m*1/q00];den1=[1b*(I+m*1A2)/q-(M+m)*m*g*1/q-b*m*g*1/q0];num2=[-(I+m*1A2)/q0m*g*1/q];den2=den1;%输入控制器PID数学模型Gc(s)=numPID/denPIDKp=150;Ki=50;Kd=50;numPID=[KdKpKi];denPID=[10];%计算闭环系统传递函数G(s)=num/den%多项式相乘num=conv(num2,denPID);%多项式相加den=po1yadd(conv(denPID,den2),conv(numPID,num1));%求闭环系统极点[r,p,k]=residue(num,den);%显示闭环系统极点s=p%求取多项式传函的脉冲响应t=0:0.005:5;impu1se(num,den,t)%显示范围：横坐标0-5,纵坐标0-10，此条语句参数可根据仿真输出曲线调整axis([05-0.10.5])grid此时系统取Kp=150，Ki=50，Kd=50，阶跃响应仿真曲线如下图所示s=22

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

倒立摆课程设计报告学习如何使用状态空间法设计系统的控制算法。设计要求：用状态空间法设计控制器，使得当在小车上施加0.2N的阶跃信号时，闭环系统的响应指标为：（1）摆杆角度9和小车位移x的稳定时间小于5秒（2）x的上升时间小于1秒（3）9的超调量小于20度（0.35弧度）（4）稳态误差小于2%。.最优控制器的设计在PID调节中，我们的输入是脉冲量，并且在设计控制器时，只对摆杆角度进行控制，而不考虑小车的位移。然而，对一个倒立摆系统来说，把它作为单输出系统是不符合实际的，如果把系统当作多输出系统的话，用状态空间法分析要相对简单一些，和小车位移都进行控制的控制器。系统状态方程为号AX+BuY=CX+Du在倒立摆相关参数为：M小车质量m摆杆质量小车摩擦系数l 摆杆转动轴心到杆质心的长度I摆杆惯量在这一章我们将设计一个对摆杆位置1.096Kg0.2109Kg0.1N/m/sec0.25m0.0034kg*m*m0.005秒-0在这一章我们将设计一个对摆杆位置1.096Kg0.2109Kg0.1N/m/sec0.25m0.0034kg*m*m0.005秒-0100一-000.088301.00000.8832A二0001.0000；B二00—0.235727.828502.3566的条件下，状态方程系数矩阵如下:；010000010倒立摆课程设计报告最优控制的前提条件是系统是能控的，下面来判断一下系统的能控能观性。Matlab仿真程序如下：A=[0100;0-(I+m*「2)*b/p(m^2*g*「2)/p0;0001;0-(m*L*b)/pm*g*L*(m+M)/p0]B=[0;(I+m*L^2)/p;0;(m*L)/p]C=[1000;0010]D=[0;0]Qc=ctrb(A,B);//判断能控性K=rank(Qc)Qo=obsv(A,C)；〃判断能观性I=rank(Qo)1.Matlab仿真结果为：K=4I=4即：系统的能控矩阵的秩rank[BABA2BA3B]=4。系统的能观矩阵的秩rank[CCACA2CA3]=4。故系统是能控能观的。因此可以给系统加上最优控制器使得系统闭环稳定，且满足暂态性能指标。在运用线性二次型最优控制算法进行控制器设计时，主要的目的就是获得反馈向量K的值。由上一小节的推导知道，设计系统状态反馈控制器时，一个关键的问题就是二次型性能指标泛函中加权矩阵Q和尺的选取。为了使问题简化及加权矩阵具有比较明确的物理意义，我们将Q取为对角阵。假设Q1100Q110000Q220000Q330000Q44」8IJ8IJ=JQx2+Q

111,x2+Qx2+Qx2+ru2d222 333 44425倒立摆课程设计报告由上式可以看出，Q,,是对号的平方的加权，Q,,的相对增加就意味着对X,的要求相对其它状态变量严格，在性能指标中的比重大，X的偏差状态相对减小。厂是对控制量u的平方加权，当厂相对较大时，意味着控制费用增加，使得控制能量较小，反馈减弱，而厂取值较小时，系统控制费用减小，反馈增加，系统动态响应迅速。考虑到一阶倒立摆系统在运行过程中，主要的被控量为系统的输出量x和*，因此在选取加权对角阵。的各元素值时，由于。11代表小车位置的权重，而Q33是摆杆角度的权重，所以只选取Q11、Q33，而Q22=Q44=0。选取Q和尺时需要注意的几个方面：（1）由于我们采用的系统模型是线性化的结果，为使系统个状态量能够在线性范围工作，要求各状态量不应过大。（2）闭环系统最好能有一对共轭复数极点，这样有利于克服系统的非线性摩擦，但系统主导极点的模不应太大以免系统频带过宽，使得系统对噪声太敏感，以致系统不能正常工作。（3）加权矩阵尺的减小，会导致大的控制能量，应注意控制。的大小，不要超过系统执行机构的能力，使得放大器处于饱和状态。控制系统