1、一级倒立摆的系统分析一、 倒立摆系统的模型建立如图 1-1 所示为一级倒立摆的物理模型小 车 导 轨xlF摆杆图 1-1 一级倒立摆物理模型对于上图的物理模型我们做以下假设：M：小车质量m：摆杆质量b：小车摩擦系数l：摆杆转动轴心到杆质心的长度I：摆杆惯量F：加在小车上的力x：小车位置：摆杆与垂直向上方向的夹角：摆杆与垂直向下方向的夹角（考虑到摆杆初始位置为竖直向下）图 1-2 是系统中小车和摆杆的受力分析图。其中，N 和 P 为小车与摆杆相互作用力的水平和垂直方向的分量。注意：实际倒立摆系统中的检测和执行装置的正负方向已经完全确定，因而矢量方向定义如图所示，图示方向为矢量正方向。FNPMXB
2、xXmg NPI图 1-2 小车及摆杆受力分析分析小车水平方向受力，可以得到以下方程：M - - (1-1) 由摆杆水平方向的受力进行分析可以得到以下方程：(1-2)=22(+sin)即： (1-3)=+cos2sin将这个等式代入式（1-1）中，可以得到系统的第一个运动方程：(1-4)（ +） +cos2sin=为推出系统的第二个运动方程，我们对摆杆垂直方向上的合力进行分析，可以得出以下方程：(1-5)=22(cos)(1-6)= sin2cos利用力矩平衡方程可以有：(1-7)sincos=注意：此方程中的力矩方向，由于 ， ，=+ cos=cos，所以等式前面含有负号。sin=sin合并
3、两个方程，约去 P 和 N 可以得到第二个运动方程：(1-8)（ +2） +sin=cos设 ，假设 与 1（单位是弧度）相比很小，即 1，则=+可以进行近似处理： ， ， 。用 u 来cos=1 sin= （） 2=0代表被控对象的输入力 F，线性化后的两个运动方程如下：(1-9)（ +2） =(+)+=假设初始条件为 0，则对式（1-9）进行拉普拉斯变换，可以得到：(1-10)（ +2） ()2()=()2(+)()2+()()2=()由于输出为角度 ，求解方程组的第一个方程，可以得到：(1-11)（ ） =(+2)2()或改写为： (1-12)()（ ） = 2(+2)2如果令 ,则有：
4、 (1-13)=()（ ） = (+2)2如果将上式代入方程组的第二个方程，可以得到：（ +） (+2)()2+(+2)+2()()2=()(1-14)整理后可得传递函数：(1-15)()()= 24+(+2)3（ +） 2其中 =(+)(+2)()2假设系统状态空间方程为：=+(1-16) =+方程组对 , 解代数方程，可以得到解如下：(1-17)= (+2)(+)+2+ 22(+)+2+ (+2)(+)+2= (+)+2+ (+)(+)+2+ (+)+2 整理后可以得到系统状态空间方程：=0 1 0 00 (+2)(+)+2 22(+)+2 00 0 0 10 (+)+2 (+)(+)+2
5、 0+0(+2)(+)+20(+)+2(1-18)=1 0 0 00 0 1 0+00由（1-9）的第一个方程为：（ +2） =对于质量均匀分布的摆杆可以有：=132于是可以得到： （132+2） =化简可以得到： (1-19)=34+34设 X=x, , , ， 则有： = =0 1 0 00 0 0 00 0 0 10 0 34 0+01034(1-20)=1 0 0 00 0 1 0+00以上公式推理是根据牛顿力学的微分方程验证的。在实际系统中模型参数如下：M 小车质量 1.096 Kgm 摆杆质量 0.109 Kgb 小车摩擦系数 0 .1N/m/secl 摆杆转动轴心到杆质心的长度
6、0.2 5mI 摆杆惯量 0.0034 kg*m*m将上述参数代入，就可以得到系统的实际模型。摆杆角度和小车位移的传递函数：(1-21)()（ ） = 0.0272520.010212520.26705摆杆角度和小车加速度之间的传递函数为：(1-22)()（ ） = 0.027250.010212520.26705摆杆角度和小车所受外界作用力的传递函数：(1-23)()（ ） = 2.356553+0.0883167227.91692.30942以外界作用力作为输入的系统状态方程： =0 1 0 00 0.08831670.62931700 0 0 10 0.23565527.82850+00
7、.88316702.35655(1-24)=1 0 0 00 0 1 0+00 以小车加速度作为输入的系统状态方程： =0 1 0 00 0 0 00 0 0 10 0 29.40+0103（1-25）=1 0 0 00 0 1 0+00综述可知以上就是一级倒立摆系统的模型建立过程，最终得出了实际模型的传递函数和状态空间方程。二、 系统模型的转换以小车加速度作为输入的系统状态方程为例，将系统状态方程转化为能控标准型，能观标准型和约当标准型。由系统状态方程可知：=0 1 0 00 0 0 00 0 0 10 0 29.40=0103=1 0 0 00 0 1 0=001、 转化为能控标准型定出系
8、统特征多项式： a=poly(A) a =1.0000 -0.0000 -29.4000 0 0由此可知 a0=0, a1=0, a2=-29.4, a3=0。 b3=C*Bb3 =00b2=C*A*B+a3*C*Bb2 =13 b1=C*A2*B+a3*C*A*B+a2*C*Bb1 =00 b0=C*A3*B+a3*C*A2*B+a2*C*A*B+a1*C*Bb0 =-29.40000所以系统的能控标准型为：11 11=0 1 0 00 0 1 00 0 0 10 0 29.401111+ 0001=29.40 1 00 0 3 01111+002、 转化为能观标准型利用对偶性求出能观标准型
9、为：11 11=0 0 0 01 0 0 00 1 0 29.40 0 1 01111+ 0 29.40 03 30 0 =0 0 0 111113、 转化为约当标准型首先求出系统的特征值以及相应的特征向量：A=0 1 0 0;0 0 0 0;0 0 0 1;0 0 29.4 0A =0 1.0000 0 00 0 0 00 0 0 1.00000 0 29.4000 0 V,D=eig(A)V =0 0 1.0000 -1.00000 0 0 0.00000.1814 -0.1814 0 00.9834 0.9834 0 0D =5.4222 0 0 00 -5.4222 0 00 0 0
10、00 0 0 0其中 D 表示 A 全部特征值构成的对角阵， V 表示相对应的特征向量。求出变换矩阵 V 的逆： V1=inv(V)Warning: Matrix is close to singular or badly scaled.Results may be inaccurate. RCOND = 1.720635e-292. V1 =1.0e+291 *0 0 0.0000 0.00000 0 -0.0000 0.00000.0000 2.4948 0 00 2.4948 0 0计算变换后的系数矩阵： A1=V1*A*VA1 =5.4222 0 0 00.0000 -5.4222 0
11、 00 0 0 0.00000 0 0 0B1=V1*BB1 =1.0e+291 *0.00000.00002.49482.4948所以系统的约当标准型为：11 11=5.4222 0 0 00 5.4222 0 00 0 0 00 0 0 01111+ 1.0+291 002.49482.4948三、 开环阶跃响应曲线及分析利用已知的状态空间方程来进行阶跃响应分析，在 MATLAB 中可以写入以下命令： A=0 1 0 0;0 0 0 0;0 0 0 1;0 0 29.4 0； B=0;1;0;3； C=1 0 0 0;0 1 0 0； D=0;0； step(A,B,C,D)可以看出，在单
12、位阶跃响应作用下，小车位置和摆杆角度都是发散的。四、 判断系统稳定性判断系统的稳定性可以利用根轨迹来判断，已知实际系统的开环传递函数为： ，则其根轨迹图形可以利用()（ ） = 0.027250.010212520.26705MATLAB 键入如下命令来完成。 num=0.02725; den=0.0102125 0 -0.26705; z=roots(num)z =Empty matrix: 0-by-1 p=roots(den)p =5.1136-5.1136 rlocus(num,den)可以看出系统没有零点，有两个极点，并且有一个极点为正。由画出的根轨迹图形可以看出闭环传递函数的一个极
13、点位于复平面的右半平面，这就意味着系统是一个不稳定的系统。五、 能控性和能观性分析对于系统的能控性和能观性分析，可以利用能控性秩判据和能观性秩判据。能控性秩判据：对于 n 维连续时间线性时不变系统，构成能控性判别矩阵： ，则系统完全能控的充要条件为：=1=1=能观性秩判据：对于 n 维连续时间线性时不变系统，构成能观性判别矩阵： ，则系统完全能观的充要条件为：= 1= 1=利用 MATLAB 键入以下命令来进行判断： A=0 1 0 0;0 0 0 0;0 0 0 1;0 0 29.4 0; B=0;1;0;3; C=1 0 0 0;0 1 0 0; D=0;0; Qc=B A*B A2*B
14、A3*BQc =0 1.0000 0 01.0000 0 0 00 3.0000 0 88.20003.0000 0 88.2000 0 R1=rank(Qc)R1 =4 Qo=C;C*A;C*A2;C*A3Qo =1 0 0 00 1 0 00 1 0 00 0 0 00 0 0 00 0 0 00 0 0 00 0 0 0 R2=rank(Qo)R2 =2可以看出，系统的完全能控矩阵的秩等于系统的状态变量维数，系统的输出完全能观测矩阵的秩等于系统输出向量 y 的维数，所以系统是可以完全能控完全能观测的系统。六、 根轨迹校正以及仿真已知系统的传递函数：（ ） = 0.027250.01021
15、2520.26705设计控制器使得调整时间 ；最大超调 。=0.5(2%) 10%计算整理可得超前校正装置的零点和极点分别为：； ，由此可得校正后的传递函数：=6.92214=26.4568=（ ） ()=(+6.92214)+26.4568 0.027250.010212520.26705利用 MATLAB 命令观察校正后的根轨迹图形：图中可以看出，系统三条根轨迹都位于左半平面，只需要选定适当的 K 就可以使得系统稳定。现在利用 MATLAN 仿真，选择不同的 K 观察系统的阶跃响应曲线。K=141.137 时，画出闭环控制系统：响应曲线图：K=120.115 时，响应曲线：K=50.129 时的响应曲线：K=10.110 时的响应曲线：K=1.137 时的响应曲线：对比不同的 K 值变化可知，闭环控制系统是稳定的。
