一级倒立摆系统仿真及分析

1、一级倒立摆系统仿真及分析1.摘要本次课程设计，我们小组选择一级倒立摆系统作为物理模型，首先通过物理分析建立数学模型，得到系统的传递函数，通过对传递函数的极点，根轨迹，单位阶跃响应来分析系统稳定性。建立状态空间模型，利用matlab进行能控能观性分析，输入阶跃信号，分析系统输出响应。通过设定初始条件，查看系统稳定性，利用simulink绘制系统状态图。再对系统进行极点配置，进行状态反馈，使得系统在初始状态下处于稳定状态，并绘制系统状态图。2.;3. 课程设计目的3.倒立摆系统是一个经典的快速、多变量、非线性、绝对不稳定系统，是用来检验某种控制理论或方法的典型方案。倒立摆控制理论产生的方法和技术在

2、半导体及精密仪器加工、机器人技术、导弹拦截控制系统和航空器对接控制技术等方面具有广阔的开发利用前景。因此研究倒立摆系统具有重要的实践意义。4. 课程设计题目描述和要求本次课程设计我们小组选择环节项目三：系统状态响应、输出响应的测量。<环节目的：1. 利用MATLAB分析线性定常系统。2. 利用SIMULINK进行系统状态空间控制模型仿真，求取系统的状态响应及输出响应。环节内容、方法：1. 给定系统状态空间方程，对系统进行可控性、可观性分析。并利用SIMULINK绘制系统的状态图，求取给定系统输入信号和初始状态时的状态响应及输出响应。2. 给定两个系统的状态空间模型，分别求两个系统的特征值

3、；将两个系统的系统矩阵化为标准型；求出给定系统初始状态时，状态的零输入响应；求两个系统的传递函数并分析仿真结果。4.课程设计报告内容数学模型的建立及分析对于倒立摆系统，由于其本身是自不稳定的系统，实验建模存在一定的困难。但是经过小心的假设忽略掉一些次要的因素后，倒立摆系统就是一个典型的运动的刚体系统，可以在惯性坐标系内应用经典力学理论建立系统的动力学方程。下面我们采用其中的牛顿欧拉方法建立直线型一级倒立摆系统的数学模型。在忽略了空气阻力，各种摩擦之后，可将直线一级倒立摆系统抽象成小车和匀质杆组成的系统，如下图1所示我们不妨做以下假设：M小车质量、m摆杆质量、b小车摩擦系数、I摆杆转动轴心到杆质

4、心的长度、I摆杆惯、F加在小车上的力、x小车位置、©摆杆与垂直向上方向的夹角、e摆杆与垂直向下方向的夹角（考虑到摆杆初始位置为竖直向下）。1)图2，图3分别是系统中小车和摆杆的受力分析图。其中，N和P为小车与摆杆相互作用力的水平和垂直方向的分量。注意在实际倒立摆系统中检测和执行装置的正负方向已经完全确定，因而矢量方向定义如图所示，图示方向为矢量正方向：p图2小车隔离受力图图3摆杆隔离受力图分析小车水平方向所受的合力，可以得到以下方程MX二F-bx-N由摆杆水平方向的受力进行分析可以得到下面等式：G+1sin0)N=mx+ml0cos0一ml02sin02）把这个等式代入上式中，就得到

5、系统的第一个运动方程：(m+M)x+bX+mCcos0一ml02sin0)=（3）为了推出系统的第二个运动方程，我们对摆杆垂直方向上的合力进行分析可以得到下面方程：即：P一mg=m(lcos0)dt2P一mg=一ml0sin0一ml02cos0(4)力矩平衡方程如下：一Plsin0一Nlcos0=I0（5）方程中力矩的方向，由于0=k+,cos©=-cos0,sin=-sin0,故等式前面有负号。合并这两个方程，约去P和N,得到第二个运动方程：（+ml21+mglsin0=一mlxcos0(6)>设0=兀+©（©是摆杆与垂直向上方向之间的夹角），假设

6、9;与I（单位是弧度）相比很小，即©1,则可以进行近似处理：cos0=-1,sin0=-©,d=0（dt丿用u代表被控对象的输入力F，线性化后两个运动方程如下：G+ml2一mgl©=mix(M+mx)+bx-ml©=u(7)传递函数建立及分析对方程组(7)进行拉普拉斯变换，得到：JY+ml22一mgl(s)=mlX(s)s2(8)I(M+m)X(s)s2+bX(s)s一mlO(s)s2=U(s)注意：推导传递函数时假设初始条件为0。由于输出为角度©，求解方程组的第一个方程，可以得到:X(s)=得到：(9)把上式代入方程组(8)的第二(M+m)+

7、ml2ml©(s)s2+b+ml2mlgS2(11)&©(s)sm(10)整理后得到传递函数：C)U(S)=+ml2)s3一mls2+mbmgls2一sqq其中q=(m+M)C+ml)_(ml实际的系统模型如下：M小车质量Kgm摆杆质量Kgb小车摩擦系数0.1N/m/sec*l摆杆转动轴心到杆质心的长度I摆杆惯量kg*m*mT采样频率秒将参数代入(11)中，求得q=,(s)_2.35655s2U()_s4+0.0883167s3-27.83s-2.31s#利用MATLAB求出该传递函数的极点为:s1=s2=S3=s4=0由此可以看出存在正极点，故系统不稳定。对该系统

8、输入单位阶跃信号，其输出信号为：clearnum=00den=10g=tf(num,den)y,t,x=step(g)plot(t,y)0.40.3503250.1Q.05020-05D.10-15D.2D.250.3D.350.40.45再利用用MATLAB绘制出根轨迹:clearnum=00den=10rlocus(num,den)k,poles=rlocfind(num,den);根轨迹如下图所示通过对传递函数的分析，可知该系统是不稳定的，需要添加控制器来控制系(12)统使其稳定。状态空间结构方程建立及分析系统状态空间方程为x=AX+Buy=CX+Dn方程组（）对X,d解代数方程，得到解

9、如下:x=x.G+ml2)m2gl2G+ml2)X=X+Q+uAM+m丿+Mml2IXM+m丿+Mml2IXM+m丿+Mml2Q=Q一mlb.mgl(M+m)丄Q=f)x+Q+uIM+m)+Mml2I(M+m)+Mml2I(M+m)+Mml2(13)ml-0100_01x00-(I+ml2)bm2gl200xI+ml2xI(M+m)+Mml2I(M+m)Mml2x-I(M+m)+Mml2Q0001Q+0Q_0一mlbmgl(M+m)0QmlI(M+m)+Mml2I(M+m)+Mml2-I(M+m)+Mml2整理后得到系统状态空间方程：u14)x1x10001x01y=_Q_0000_Q+_0_

10、LQJu15）由公式的第一个方程为：G+ml2乂一mglQ=mlX(16)对于质量均匀分布的摆杆有：于是可以得到：化简得到：ml2+ml2e13丿mgie=mix_竺e+-x4l4l，u'-_x，则有x01001-x0000ee_000103g0_Y_0石-xx+e设x=x,e,e4l把上述参数代入，可以得到系统的实际模型摆杆角度和小车位移的传递函数：(s)_Xt)-0.0102125s2-0.267050.0275s2摆杆角度和小车加速度之间的传递函数为C)_V(s)0.0102125s20.267050.02725摆杆角度和小车所受外界作用力的传递函数(s)_U(s)s4+0.08

11、83167s3-27.83s-2.31s2.35655s2(17)(18)(19)(20)(21)(22)(23)以外界作用力作为输入的系统状态方程：x0100ixx0-0.08831670.6293170x00010-0.22565527.828500x100000100.8831672.35655(24)以小车加速度作为输入的系统状态方程：u1x0x00_e_0xiy=100000029.410-0025)首先我们对以小车加速度作为输入的系统状态方程25）式进行能控能观性分析。29.4Qi利用matlab对系统进行仿真求系统能观能控性代码：A=0,1,0,0,;0,0,0,0;0,0,0,

12、1;0,0,0;B=0;1;0;3;C=1,0,0,0;0,0,1,0;D=0;0;Qc=ctrb(A,B);n=rank(Qc);if(n=4),disp('系统能控');else,disp('系统不能控');endQo=obsv(A,C);m=rank(Qo);if（m=4）,disp（'系统能观'）;else,disp（'系统不能观'）;End运行结果如下：<系统能控系纟莖能观利用matlab中的simulink绘制系统状态图$现在我们向系统输入单位阶跃信号，利用matlab仿真观察系统单位阶跃响应。代码：A=0,1,

13、0,0,;0,0,0,0;0,0,0,1;0,0,0;B=0;1;0;3;C=1,0,0,0;0,0,1,0;#D=0;0;step(A,B,C,D)运行结果如下：Ms电代们远里1口囲CFFi-gure1fileEditViewnG&rtTooIfDecktcip世indowHElp邑弓口口一)由此可以看出输出的x与©均偏向于无穷大，故可以看出系统是不稳定的。给系统一个初始状态x0=3;0;2;0,利用matlab仿真求出系统输出响应代码：A=0,1,0,0,;0,0,0,0;0,0,0,1;0,0,0;|B=0;1;0;3;C=1,0,0,0;0,0,1,0;D=0;0;x

14、0=3;0;2;0;sys=ss(A,B,C,D);y,t,x=initial(sys,x0,0:5);plot(t,x);运行结果如下：20：f52.534.553.5<FileEditViewInsertToolsDesktopWindowHelp创u白c由上文得出该系统的极点为:s1=s2=S3=由于存在正极点，故引起该系统的不稳定，现利用极点配置法来重修配置系统极点，使系统能够处于稳定状态。对于直线一级倒立摆的极点配置转化来说：要按上述系统设计控制器。则要求具有较短，约3s的调整时间和合适的阻尼比g=.要使系统具备能控，能观且易验证。步骤为：计算特征值。根据要求，设调整时间为3s

15、，并留有一定的余量，选择期望的闭环极点：s=口i（i=1，2，3，4）,其中：u=-10,u=-10,u=-2+2：'3j，u=223j，其中口3，口4是一对具有g1234J=，3n=4的主导闭环极点。口1，口2位于主导闭环极点的左边，其影响较小，因此期望的特征跟方程为：(25)s4+24s3+196s2+720s+1600=0由此得到：a24,a=196,a=720,a=16001234系统的特征方程为：s100110s0000s-1|_0029.4s=s4-29.4s2si-A=(31)(27)因此a=0,a=-29.4,a=0,a=01234系统的反馈增益矩阵为：aaaa'

16、;aafat-i44132211确定使状态方程变为可控标准型的变换矩阵T=MW,于是可得:K=afABA2BA3bL88.2(28)088.20'o29.401029.4010ai11001001000_1000_3(30)-0.0S400.01130=10-0.03400.0113-0000.3333_控制量为IK=a吕4吕吕-a2aaJT'1二卩00-0720-0196+29.424-0TL=-54.4218-24.489893.273916.1633状态反儻壇益矩阵为：KX=54.4218k+24.45&5x-93.2739心16丄£33电下面我们利用matlab对极点配置状态反馈系统进行仿真代码：A=0,1,0,0,;0,0,0,0;0,0,0,1;0,0,0;B=0;1;0;3;C=1,0,0,0;0,0,1,0;D=0;0;x0=10;0;0;p=-10-10-2+;K=acker(A,B,p);A_c=A-B*K;sys=ss(A_c,B,C,D);y,t,x=initial(sys,x0,0:5);plot(t,x);运行结果：进行极点