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

一级倒立摆系统仿真及分析1.摘要本次课程设计，我们小组选择一级倒立摆系统作为物理模型，首先通过物理分析建立数学模型，得到系统的传递函数，通过对传递函数的极点，根轨迹，单位阶跃响应来分析系统稳定性。

建立状态空间模型，利用matlab进行能控能观性分析，输入阶跃信号，分析系统输出响应。

通过设定初始条件，查看系统稳定性，利用simulink绘制系统状态图。

再对系统进行极点配置，进行状态反馈，使得系统在初始状态下处于稳定状态，并绘制系统状态图。

2.;3.课程设计目的倒立摆系统是一个经典的快速、多变量、非线性、绝对不稳定系统，是用来检验某种控制理论或方法的典型方案。

倒立摆控制理论产生的方法和技术在半导体及精密仪器加工、机器人技术、导弹拦截控制系统和航空器对接控制技术等方面具有广阔的开发利用前景。

因此研究倒立摆系统具有重要的实践意义。

4.课程设计题目描述和要求本次课程设计我们小组选择环节项目三：系统状态响应、输出响应的测量。

<环节目的：1.利用MATLAB分析线性定常系统。

2.利用SIMULINK进行系统状态空间控制模型仿真，求取系统的状态响应及输出响应。

环节内容、方法：1.给定系统状态空间方程，对系统进行可控性、可观性分析。

并利用SIMULINK 绘制系统的状态图，求取给定系统输入信号和初始状态时的状态响应及输出响应。

}2.给定两个系统的状态空间模型，分别求两个系统的特征值；将两个系统的系统矩阵化为标准型；求出给定系统初始状态时，状态的零输入响应；求两个系统的传递函数并分析仿真结果。

4.课程设计报告内容数学模型的建立及分析对于倒立摆系统，由于其本身是自不稳定的系统，实验建模存在一定的困难。

但是经过小心的假设忽略掉一些次要的因素后，倒立摆系统就是一个典型的运动的刚体系统，可以在惯性坐标系内应用经典力学理论建立系统的动力学方程。

下面我们采用其中的牛顿－欧拉方法建立直线型一级倒立摆系统的数学模型。

~在忽略了空气阻力，各种摩擦之后，可将直线一级倒立摆系统抽象成小车和匀质杆组成的系统，如下图1所示图l 直线一级倒立摆系统我们不妨做以下假设：M小车质量、m摆杆质量、b小车摩擦系数、l摆杆转动轴心到杆质心的长度、I 摆杆惯、F加在小车上的力、x 小车位置、φ摆杆与垂直向上方向的夹角、θ摆杆与垂直向下方向的夹角（考虑到摆杆初始位置为竖直向下）。

\图2，图3分别是系统中小车和摆杆的受力分析图。

其中， N 和 P 为小车与摆杆相互作用力的水平和垂直方向的分量。

注意：在实际倒立摆系统中检测和执行装置的正负方向已经完全确定，因而矢量方向定义如图所示，图示方向为矢量正方向：图2 小车隔离受力图"图3 摆杆隔离受力图分析小车水平方向所受的合力，可以得到以下方程：N x b F x M --=（1）由摆杆水平方向的受力进行分析可以得到下面等式：()θsin 122l kd m N +=[即：θθθθsin cos 2 ml ml xm N -+= （2）把这个等式代入上式中，就得到系统的第一个运动方程：()()F ml m x b x M m =-+++θθθθsin cos 2（3）为了推出系统的第二个运动方程，我们对摆杆垂直方向上的合力进行分析，可以得到下面方程：()θcos 22l dtd m mg P =-<即：θθθθcos sin 2 ml ml mg P --=- (4)力矩平衡方程如下：θθθ I Nl Pl =--cos sin(5)方程中力矩的方向，由于θφθφφπθsin sin ,cos cos ,-=-=+=，故等式前面有负号。

合并这两个方程，约去P 和N ，得到第二个运动方程： ()θθθcos sin 2x ml mgl ml I -=++ (6)>设φπθ+=（φ是摆杆与垂直向上方向之间的夹角），假设φ与l （单位是弧度）相比很小，即φ《1，则可以进行近似处理：,sin ,1cos 2=⎪⎭⎫⎝⎛-=-=dt d θφθθ用u 代表被控对象的输入力F ，线性化后两个运动方程如下：()()⎩⎨⎧=-++=-+u ml x b x m M xml mgl ml I φφφ2(7)传递函数建立及分析 /对方程组(7)进行拉普拉斯变换，得到：()()()()()()()()()⎩⎨⎧=Φ-++=Φ-Φ+s U s s ml s s bX s s X m M s s mlX s mgl s s ml I 22222 (8) 注意：推导传递函数时假设初始条件为0。

由于输出为角度φ，求解方程组的第一个方程，可以得到：()()s s g mlml I s X Φ⎥⎦⎤⎢⎣⎡-+=22)( (9)}把上式代入方程组(8)的第二个方程，得到：()()()()()()()s U s s ml s s s g ml ml I b s s s g ml ml I m M =Φ-Φ⎥⎦⎤⎢⎣⎡+++Φ⎥⎦⎤⎢⎣⎡-++22222(10)整理后得到传递函数：()()()()s qbmgl s q mgl m M s qml I b s s qml s U s -+-++=Φ23242(11)&其中：[()()()]22ml mlI M m q-++=实际的系统模型如下： M 小车质量 Kg m 摆杆质量 Kgb 小车摩擦系数 0 .1N/m/sec*l 摆杆转动轴心到杆质心的长度 I 摆杆惯量 kg*m*m T 采样频率 秒将参数代入（11）中，求得q=，()()ss s s s s U s 31.283.270883167.035655.2342--+=Φ #利用MATLAB 求出该传递函数的极点为:s1= s2=S3= s4=0 由此可以看出存在正极点，故系统不稳定。

对该系统输入单位阶跃信号，其输出信号为： clearnum = [ 0 0] den = [1 0]。

g=tf(num,den) [y,t,x]=step(g) plot(t,y)再利用用MATLAB绘制出根轨迹：clearnum = [ 0 0]den = [1 0]rlocus(num,den)[k,poles]=rlocfind(num,den);]根轨迹如下图所示：通过对传递函数的分析，可知该系统是不稳定的，需要添加控制器来控制系统使其稳定。

状态空间结构方程建立及分析系统状态空间方程为"DnCX y Bu AX x+=+=(12)方程组（）对φ,x 解代数方程，得到解如下： ()()()()()()u Mmlm M I mlMml m M I m M mgl x Mml m M I mlb u Mml m M I ml I Mml m M I gl m x Mml m M I b ml I x x x2222222222)()()(+++++++++-==++++++++++-==φφφφφ(13)整理后得到系统状态空间方程：#()()()()()()()()22222222221000000000100I ml b x x I ml m gl I M m Mml x x I M m Mml I M m Mml u ml mgl M m mlbI M m Mml I M m Mml I M m Mml φφφφ⎡⎤⎡⎤⎢⎥⎢⎥-++⎡⎤⎡⎤⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥-+++++⎢⎥⎢⎥⎢⎥=+⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥+⎣⎦⎣⎦-⎢⎥⎢⎥⎢⎥++⎢⎥++++⎣⎦⎣⎦（14）u x x x y ⎥⎦⎤⎢⎣⎡+⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡⎥⎦⎤⎢⎣⎡=⎥⎦⎤⎢⎣⎡=0000000001φφφ （15）由公式的第一个方程为：()x ml mgl ml I =-+φφ2(16)：对于质量均匀分布的摆杆有：231ml I =(17)于是可以得到：x ml mgl ml ml =-⎪⎭⎫ ⎝⎛+φφ2231(18)化简得到：!xll g 4343+=φφ(19)设{}x u xx X ='=,,,,φφ，则有：u x x x y ul x x lg x x⎥⎦⎤⎢⎣⎡+⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡⎥⎦⎤⎢⎣⎡=⎥⎦⎤⎢⎣⎡=⎥⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎢⎣⎡+⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡⎥⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎢⎣⎡=⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡00010000014301004300100000000010φφφφφφφ(20)把上述参数代入，可以得到系统的实际模型 摆杆角度和小车位移的传递函数： `()()26705.00102125.00275.022-=Φs s s X s (21)摆杆角度和小车加速度之间的传递函数为：()()26705.00102125.002725.02-=Φs s V s (22) 摆杆角度和小车所受外界作用力的传递函数：()()ss s s s s U s 31.283.270883167.035655.2342--+=Φ (23)~以外界作用力作为输入的系统状态方程：u x x x y u x x x x⎥⎦⎤⎢⎣⎡+⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡⎥⎦⎤⎢⎣⎡=⎥⎦⎤⎢⎣⎡=⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡+⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡--=⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡000100000135655.20883167.0008285.27225655.0010000629317.00883167.000010φφφφφφφ (24)以小车加速度作为输入的系统状态方程：u x x xx ⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡+⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡=⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡301004.290010000000010φφφφu x x x y ⎥⎦⎤⎢⎣⎡+⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡⎥⎦⎤⎢⎣⎡=⎥⎦⎤⎢⎣⎡=0001000001φφφ （25），首先我们对以小车加速度作为输入的系统状态方程（25）式进行能控能观性分析。

⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡=04.2900100000000010A ⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡=3010B ⎥⎦⎤⎢⎣⎡=01000001C ⎥⎦⎤⎢⎣⎡=00D 利用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];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仿真观察系统单位阶跃响应。