一阶倒立摆控制系统设计.doc

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

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

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

4、行受力分析,其中,N和P为小车与摆杆相互作用力的水平和垂直方向的分量.-图1-2小车及摆杆受力图分析小车水平方向所受的合力,可以得到以下方程:(i-i)(1-2)(1-3)MxF-bx-N由摆杆水平方向的受力进行分析可以得到下面等式:屋N=m-+/sin0di2即：N=mx+mlOcos0mlO1sin0把这个等式代入式1-1中,就得到系统的第一个运动方程：+阳/gcose""g'sind=F“为了推出系统的第二个运动方程,我们对摆杆垂直方向上的合力进行分析,可以得到下面方程：P-mg-m-/cos1-5即：fP一次g=加8sm8-夕cos61.6力矩平衡方程如下：

5、-尸,§in8-A7co§8=10i1-7由于斤=TT+0,CO5.=-cossm0=-sin3,所以等式前面有负号合并这两个方程,约去P和N,得到第二个运动方程:(/+吊/)6+mglsin0-开点cos设夕二不十°,(小是摆杆与垂直向上方向之间的夹角),假设小<<1弧度,那么可以进行近似处理：cos1,sin,()20.用u代表被控对dt象的输入力F,利用上述近似进行线性化得直线一阶倒立摆的微分方程为：U+ml-节mg10=tn/x(1-9)(M+Hl)x+bx-=Li2. 一阶倒立摆的传递函数模型对式(1-9)进行拉普拉斯变换,得：(7+ml2卜

6、(5)*2区,力(5)=mlXss2(M+十hX(s)smAD(s)l=U(s)注意：推导传递函数时假设初始条件为0.由于输出为角度小,求解方程组的第一个方程,可得:小邛+?)_/($)nils或_mis2)(Z+ml2)52-mgl如果令错误！未找到引用源.,那么有：中_ml,(/+ml)s2nigl(2-2)(2-3)(2-4)把上式代入方程组(2-1)的第二个方程,得:mlml*一聊/1"匚=(2-5)(2-6)(3-1)I(7+mi)b1(M+m)+Mmlntfb/(Af+m)+Mml-0“g尸+刖)+Min!0mgl(M+ffl)+z?i)-Mini0屈(3-2)1M+m)

7、+Mini'/(AZ(3-3)整理后得到传递函数：ml7S-中q口4机7+机产)j(；W+m)mgl2bmgi5J5-.Sqqq其中q=(M+加)(/+根/)-0“/).3. 一阶倒立摆的状态空间模型设系统状态空间方程为:X二AX+BityCX+Du方程组2-9对乂解代数方程,得到解如下:人XX/-JH产出."Jg/工(,+加)M=X+7®+"1M+"+Mini1(M十"t)+1(M+和)+MmlJ=d(3-1)7-mlbmglM+n?),ml0=才X+-7+7TUl(Xf+m+/(Af+阳)+/(.W+-m)+Mml整理后得到系统状态

8、空间方程:1c摆杆的惯量为I'ml2,代入1-9的第一个方程为:3/+ml20_mgl(p=mix行：iY-ml1+mi2j-mgl=m/x3)化简得:=+i414/(3-4)设xxx1'.那么有:x,ux()03g4/()4/()“(3-5)4.实际系统的传递函数与状态方程实际系统的模型参数如下：MmblI小车质量摆杆质量小车摩擦系数0.5Kg0.2Kg0.1N/m/sec摆杆转动轴心到杆质心的长度0.3m摆杆惯量0.006kg*m*m代入上述参数可得系统的实际模型摆杆角度和小车位移的传递函数：5(s)0.06s2X(s)0.024s2-0.588(4-1)摆杆角度和小车加速

9、度之间的传递函数为:0(S)_0.06V(s)10,02+s2-0,5B3(4-2)摆杆角度和小车所受外界作用力的传递函数：0_4.S4S455S(5)S3+O,181818S2-31A818185-44S4S45(4-3)以外界作用力作为输入的系统状态方程:1-0.1818180-045454502.672727031181818(4-4).(p.以小车加速度为输入的系统状态方程:(4-5).(p.、一阶倒立摆matlab仿真实际系统参数如下,根据上面给出的例子求系统的传递函数、状态空间方程,并进行脉冲响应和阶跃响应的matlab仿真.M小车质量1.096Kgm摆杆质量0.109Kgb小车摩

10、擦系数0.1N/m/secl摆杆转动轴心到杆质心的长度0.25mI摆杆惯量0.0034kg*m*mT采样时间0.005秒1 .传递函数法Matlab程序如下：M=1.096;m=0.109;b=0.1;1=0.0034;g=9.8;L=0.25;q=(M+m)*(I+m*LA2)-(m*L)A2;num=m*L/q00den=1b*(I+m*LA2)/q-(M+m)*m*g*L/q-b*m*g*L/q0;r,p,k=residue(num,den);s=p;得到传递函数的分子：num=2.356600以及传递函数分母：den=1.00000.0883-27.8285-2.30940开环极点：s

11、=-5.27805.2727-0.08300由此可知,系统传递函数的多项式表达式为:(2-1)(s)2.3566s2UTs)s40.0883s327.8285s22.3094s系统的开环极点为s:s15.2780、s25.2727、00.0830、s40,由于有一个开环极点位于S平面的右半部,开环系统并不是稳定的系统的脉冲响应如下,由图也可见,系统并不稳定图2.1开环系统脉冲响应2 .状态空间法状态空间法可以进行单输入多输出系统设计,因此在这个实验中,我们将尝试同时对摆杆角度和小车位置进行限制.为了更具挑战性,给小车加一个阶跃输入信号.我们用Matlab求出系统的状态空间方程各矩阵,并仿真系统

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

13、293001.000027.8285010000010D=00matlab仿真的开环阶跃响应曲线如下列图所示,系统并不稳定图2.2系统开环阶跃响应曲线三、倒立摆系统的PID限制算法设计1 .实验要求与目的要求：设计PID限制器,使得当在小车上施加1N的脉冲信号时,闭环系统的响应指标为：(1)稳定时间小于5秒(2)稳态时摆杆与垂直方向的夹角变化小于0.1弧度并作PID限制算法的MATLAB仿真目的：进一步熟悉PID限制器的设计方法,步骤,以及P、I、D三参数的调节方法.2 .理论分析PID限制原理在模拟限制系统中,限制器最常用的限制规律是PID限制.常规PID限制系统原理框图如下列图所示.系统由

14、模拟PID限制器KD(S)和被控对象G(S)组成.PID限制器是一种线性限制器,它根据给定值r(t)与实际输出值y(t)构成限制偏差e(t)e(t)r(t)y(t)将偏差的比例(P)、积分(I)和微分(D)通过线性组合构成限制量,对被控对象进行限制,故称PID限制器.其限制规律为u(t)Kpe(t)Tit&t)dtTd0de(t)dt或写成传递函数的形式G(s)震Kp1E(s)-TdSTiS式中：Kp比例系数；Ti积分时间常数;Td微分时间常数.在限制系统设计和仿真中,也将传递函数写成KpKiKdS式中：Kp比例系数；K|积分系数;Kd微分系数.简单说来,PID限制器各校正环节的作用如

15、下:(1)比例环节：成比例地反映限制系统的偏差信号e(t),偏差一旦产生,限制器立即产生限制作用,以减少偏差.(2)积分环节：主要用于消除稳态误差,提升系统的型别.积分作用的强弱取决于积分时间常数T1,T|越大,积分作用越弱,反之那么越强.(3)微分环节：反映偏差信号的变化趋势(变化速率),并能在偏差信号值变得太大之前,在系统中引入一个有效的早期修正信号,从而加快系统的动作速度,减小调节时间.摆杆角度限制这个限制问题和我们以前遇到的标准限制问题有些不同,在这里输出量为摆杆的位置,它图中KD(s)是限制器传递函数,G(s)是被控对象传递函数.考虑到输入r(s)0,结构图可以很容易地变换成该系统的

16、输出为y(s)numG(s)KD(s)G(s)F(s)1(numS)(num)F(S)(denPID)(den)num(denPID)F(s)KD(s)KdSKpKi2KdSKpSKinumPIDdenPID(denPID)(den)(numPID)(num)其中：num被控对象传递函数的分子项den被控对象传递函数的分母项numPIDPID限制器传递函数的分子项denPIDPID限制器传递函数的分母项被控对象的传递函数是ml2s(s)qnum2U(s)4b(Iml)3(Mm)mgl2bmgldenssssqqq其中q(Mm)(Iml2)(ml)2PID限制器的传递函数为只需调节PID限制器的

17、参数,就可以得到满意的限制效果.小车位置限制小车位置作为输出时,系统框图如下:F'31t2咖其中,Gi(s)是摆杆传递函数,G2(s)是小车传递函数.由于输入信号r(s)0,所以可以把结构图转换成:其中,反应环代表我们前面设计的摆杆的限制器.从此框图我们可以看出此处只对摆杆角度进行了限制,并没有对小车位置进行限制.小车位置输出为:G2(s)X(s)F(s)-1KD(s)Gi(s)1num2den22F(s)(numPID)(numi)(denPID)(den1)(num2)(denPID)(den)(denPID)(deni)(den2)(numPID)(num1)(den2)F(s)

18、其中,numi,deni,num?,den?分别代表被控对象1和被控对象2传递函数的分子和分母.numPID和denPID代表PID限制器传递函数的分子和分母.下面我们来求G2(s),根据前面实验二的推导,有X(s)(Iml2)ml可以推出小车位置的传递函数为G2(s)2、.(Iml)2mglX(s)qSq,、；TU(s)4b(Iml)3(Mm)mgl2bmglsssqqq其中q(Mm)(Iml2)(ml)2可以看出,den1=den2=den,小车的算式可以简化成:X(s)(num2)(denPID)(denPID)(den)k(numPID)(numi)F(s)3. PID限制算法的MAT

19、LAB仿真实际系统参数如下：M小车质量1.096Kgm摆杆质量0.109Kgb小车摩擦系数0.1N/m/sec1 摆杆转动轴心到杆质心的长度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*LA2)-(m*L42;num1=m*L/q00;den1=1b*(I+m*LA2)/q-(M+m)*m*g*L/q-b*m*g*L/q0;Kp=1;Ki=1;Kd=1;numPID=KdKpKi;denPID=10;num=conv(num

20、1,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)axis(02010)运行程序得到:s=-6.41613.96930.001900并得到仿真图像如下:8:3u_pmATime(sec)图3.1kp=ki=kd=1时的仿真响应图可见此时系统并不稳定,此时应该首先调整kp,观察其响应的变化:讲kp设置为150,得到并观察响应图如下：s=-1.2224+18.0044i-1.2224-18.0044i-0.0000-0.0

21、000-0.0000图3-2,kp=150系统仿真图可见此时系统两个闭环极点均在S平面做平面,系统稳定,系统稳定时间约为4秒,满足要求.此时系统有极小的静态误差,根据系统对于精度的要求可酌情考虑是否添加积分限制,本文添加积分限制.将积分参数设为5,得到并观察闭环响应图.在笔者经过屡次尝试之后,发现积分限制对于系统响应的调节作用极小,笔者给出当积分参数分别设为10和50的响应图如下：图3-3,ki=10的响应Time(sec)图3-4,ki=50系统的响应积分作用通常是用来调整系统的静态误差,使之到达需要的范围,但是此处明显积分作用对系统的影响不大,并了解到被控对象的特性属于变化快的类型,应该考

22、虑改变微分限制,虽然微分限制在实际系统中运用并不多见.笔者将微分作用参数设置为10,20,50观察其效果图.ImpulseResponse00.5eaprpmA1.52.533.544.5Time(sec)图3-5,kp=150,ki=50,kd=10的仿真图像图3-6,kp=150,ki=50,kd=20的仿真图像0.2eaHTPmA-0.200.511.522.5Time(sec)33.544.5ImpulseResponse图3-7,kp=150,ki=50,kd=50的仿真图像当微分效果加上去的时候,系统闭环仿真图像结果得到了质的改善,瞬间取代了超调,不稳定,响应时间也迅速降到了0.5

23、秒,稳定时间在1秒,完美地完成了任务.其效果已经不能简单的用好来形容,但是微分作用并非如此普及,并且每次都效果如此良好,要根据不同的对象来判断用什么作用.必须要说的是,微分作用在物理实现中是并不容易的,如果只有比例调节和积分调节就能到达预想的效果,那就不要使用微分调节.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*

24、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);%显

25、示闭环系统极点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,阶跃响应仿真曲线如下列图所示：-115.0953-2.4030-0.417700)图3-8,小车位置仿真由仿真结果能够看出,当摆杆角度处于很好的闭环限制下时,小车位置虽然处于失控状态,但是上升速度不快.四、倒立摆系统的最优限制算法设计1.设计目的与要求现代限制理论的最突出特点就是将限制对象用状态空间表达式的形式表示出来,这样便于对

26、多输入多输出系统进行分析和设计.线性二次型最优限制算法LQR是现代限制理论中一种重要的、根本的方法,LQR算法的目的是在一定的性能指标下,使系统的限制效果最正确,即利用最少的限制能量,来到达最小的状态误差.本章主要利用最优限制算法实现对一阶倒立摆系统的摆杆角度和小车位置的同时限制.设计目的：学习如何使用状态空间法设计系统的限制算法.设计要求：用状态空间法设计限制器,使得当在小车上施加0.2N的阶跃信号时,闭环系统的响应指标为：(1)摆杆角度和小车位移x的稳定时间小于5秒(2) x的上升时间小于1秒(3) 的超调量小于20度(0.35弧度)(4) 稳态误差小于2%.2.最优限制器的设计在PID调

27、节中,我们的输入是脉冲量,并且在设计限制器时,只对摆杆角度进行限制,而不考虑小车的位移.然而,对一个倒立摆系统来说,把它作为单输出系统是不符合实际的,如果把系统当作多输出系统的话,用状态空间法分析要相对简单一些,在这一章我们将设计一个对摆杆位置和小车位移都进行限制的限制器.系统状态方程为XAXBuYCXDu在倒立摆相关参数为：M小车质量m摆杆质量b小车摩擦系数l摆杆转动轴心到杆质心的长度I摆杆惯量T采样时间的条件下,状态方程系数矩阵如下：01.0000；1.000001.096Kg0.2109Kg0.1N/m/sec0.25m0.0034kg*m*m0.005秒0.08830.235727.8

28、28500.8832B；C02.356610000010最优限制的前提条件是系统是能控的,下面来判断一下系统的能控能观性.Matlab仿真程序如下：A=0100;0-(I+m*LA2)*b/p(mA2*g*LA2)/p0;0001;0-(m*L*b)/pm*g*L*(m+M)/p0B=0;(I+m*LA2)/p;0;(m*L)/pC=1000;0010D=0;0Qc=ctrb(A,B);/判断能控性K=rank(Qc)Qo=obsv(A,C);/判断能观性I=rank(Qo)1.Matlab仿真结果为：K=4I=4即：系统的能控矩阵的秩rankBABA2BA3B4.系统的能观矩阵的秩rankC

29、CACA2CA34.故系统是能控能观的.因此可以给系统加上最优限制器使得系统闭环稳定,且满足暂态性能指标.在运用线性二次型最优限制算法进行限制器设计时,主要的目的就是获得反应向量K的值.由上一小节的推导知道,设计系统状态反应限制器时,一个关键的问题就是二次型性能指标泛函中加权矩阵Q和R的选取为了使问题简化及加权矩阵具有比拟明确的物理意义,我们将Q取为对角阵.假设Q11000Rr0Q220000Q330000Q44这样得到的性能指标泛函为22Q11X1Q22x2_2_22Q33x3Q44X4rudt由上式可以看出,Qii是对xi的平方的加权,QH的相对增加就意味着对xi的要求相对其它状态变量严格

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