一级倒立摆系统分析

1、一级倒立摆的系统分析一、 倒立摆系统的模型建立如图1-1所示为一级倒立摆的物理模型小 车导 轨xlF摆杆图1-1 一级倒立摆物理模型对于上图的物理模型我们做以下假设：M：小车质量m：摆杆质量b：小车摩擦系数l：摆杆转动轴心到杆质心的长度I：摆杆惯量F：加在小车上的力x：小车位置：摆杆与垂直向上方向的夹角：摆杆与垂直向下方向的夹角（考虑到摆杆初始位置为竖直向下）图1-2是系统中小车和摆杆的受力分析图。其中，N和P为小车与摆杆相互作用力的水平和垂直方向的分量。注意：实际倒立摆系统中的检测和执行装置的正负方向已经完全确定，因而矢量方向定义如图所示，图示方向为矢量正方向。FNPMXBxXmgNPI图1

2、-2 小车及摆杆受力分析分析小车水平方向受力，可以得到以下方程：Mx-x- (1-1)由摆杆水平方向的受力进行分析可以得到以下方程：N=md2dt2(x+lsin) (1-2)即： N=mx+mlcos-ml2sin (1-3)将这个等式代入式（1-1）中，可以得到系统的第一个运动方程：M+mx+bx+mlcos-ml2sin=F (1-4)为推出系统的第二个运动方程，我们对摆杆垂直方向上的合力进行分析，可以得出以下方程：P-mg=md2dt2(lcos) (1-5)P-mg=- mlsin-ml2cos (1-6)利用力矩平衡方程可以有：-Plsin-Nlcos=I (1-7)注意：此方程中

3、的力矩方向，由于=+，cos=-cos，sin=-sin，所以等式前面含有负号。合并两个方程，约去P和N可以得到第二个运动方程：I+ml2+mglsin=-mlxcos (1-8)设=+，假设与1（单位是弧度）相比很小，即1，则可以进行近似处理：cos=-1，sin=-，（ddt）2=0。用u来代表被控对象的输入力F，线性化后的两个运动方程如下：I+ml2-mgl=mlxM+mx+bx-ml=u (1-9)假设初始条件为0，则对式（1-9）进行拉普拉斯变换，可以得到：I+ml2ss2-mgls=mlX(s)s2M+mXss2+bXss-mlss2=U(s) (1-10)由于输出为角度，求解方程

4、组的第一个方程，可以得到：Xs=I+ml2ml-gs2s (1-11)或改写为：sXs=mls2I+ml2s2-mgl (1-12)如果令v=x,则有：sV（s）=mlI+ml2s2-mgl (1-13)如果将上式代入方程组的第二个方程，可以得到：M+mI+ml2ml-gsss2+bI+ml2ml+gs2ss-mlss2=U(s) (1-14)整理后可得传递函数：sU(s)=mlqs2s4+bI+ml2qs3-M+mmglqs2-bmglqs (1-15)其中 q=M+mI+ml2-(ml)2假设系统状态空间方程为：X=AX+Bu y=CX+Du (1-16)方程组对x,解代数方程，可以得到解

5、如下：x=xx=-I+ml2bIM+m+Mml2x+m2gl2IM+m+Mml2+I+ml2IM+m+Mml2u=-mlbIM+m+Mml2x+mgl(M+m)IM+m+Mml2+mlIM+m+Mml2u (1-17)整理后可以得到系统状态空间方程：xx=01000-I+ml2bIM+m+Mml2m2gl2IM+m+Mml2000010-mlbIM+m+Mml2mgl(M+m)IM+m+Mml20xx+0I+ml2IM+m+Mml20mlIM+m+Mml2u y=x=10000010xx+00u (1-18)由（1-9）的第一个方程为：I+ml2-mgl =mlx对于质量均匀分布的摆杆可以有：

6、I=13ml2于是可以得到：13ml2+ml2-mgl =mlx化简可以得到：=3g4l+34lx (1-19)设X=x, x, , ，u=x则有： y=x=10000010xx+00u (1-20)以上公式推理是根据牛顿力学的微分方程验证的。在实际系统中模型参数如下：M 小车质量 1.096 Kgm 摆杆质量 0.109 Kgb 小车摩擦系数 0 .1N/m/secl 摆杆转动轴心到杆质心的长度 0.2 5mI 摆杆惯量 0.0034 kg*m*m将上述参数代入，就可以得到系统的实际模型。摆杆角度和小车位移的传递函数：sXs=0.02725s20.0102125s2-0.26705 (1-2

7、1)摆杆角度和小车加速度之间的传递函数为：sV（s）=0.027250.0102125s2-0.26705(1-22)摆杆角度和小车所受外界作用力的传递函数：sU（s）=2.35655ss3+0.0883167s2-27.9169s-2.30942(1-23)以外界作用力作为输入的系统状态方程：xx =01000-0.08831670.629317000010-0.23565527.82850xx+00.88316702.35655uy=x=10000010xx+00u (1-24)以小车加速度作为输入的系统状态方程：y=x=10000010xx+00u （1-25）综述可知以上就是一级倒立摆

8、系统的模型建立过程，最终得出了实际模型的传递函数和状态空间方程。二、 系统模型的转换以小车加速度作为输入的系统状态方程为例，将系统状态方程转化为能控标准型，能观标准型和约当标准型。由系统状态方程可知：B=0103C=10000010D=001、 转化为能控标准型定出系统特征多项式： a=poly(A) a =1.0000 -0.0000 -29.4000 0 0由此可知a0=0, a1=0, a2=-29.4, a3=0。 b3=C*Bb3 = 0 0b2=C*A*B+a3*C*Bb2 = 1 3 b1=C*A2*B+a3*C*A*B+a2*C*Bb1 = 0 0 b0=C*A3*B+a3*C

9、*A2*B+a2*C*A*B+a1*C*Bb0 = -29.4000 0所以系统的能控标准型为：x1x1 11=0 10000 1000010029.40x1x111+ 0001uy=-29.40100030x1x111+00u2、 转化为能观标准型利用对偶性求出能观标准型为：x1x1 11=0 00010 0001029.40010x1x111+ 0-29.4003300uy=0001x1x1113、 转化为约当标准型首先求出系统的特征值以及相应的特征向量：A=0 1 0 0;0 0 0 0;0 0 0 1;0 0 29.4 0A = 0 1.0000 0 0 0 0 0 0 0 0 0 1

10、.0000 0 0 29.4000 0 V,D=eig(A)V = 0 0 1.0000 -1.0000 0 0 0 0.0000 0.1814 -0.1814 0 0 0.9834 0.9834 0 0D = 5.4222 0 0 0 0 -5.4222 0 0 0 0 0 0 0 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

11、. V1 = 1.0e+291 * 0 0 0.0000 0.0000 0 0 -0.0000 0.0000 0.0000 2.4948 0 0 0 2.4948 0 0计算变换后的系数矩阵： A1=V1*A*VA1 = 5.4222 0 0 0 0.0000 -5.4222 0 0 0 0 0 0.0000 0 0 0 0B1=V1*BB1 = 1.0e+291 * 0.0000 0.0000 2.49482.4948所以系统的约当标准型为：x1x1 11=5.4222 0000-5.4222 0000000000x1x111+ 1.0e+291 *002.49482.4948u三、 开环阶

12、跃响应曲线及分析利用已知的状态空间方程来进行阶跃响应分析，在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)可以看出，在单位阶跃响应作用下，小车位置和摆杆角度都是发散的。四、 判断系统稳定性判断系统的稳定性可以利用根轨迹来判断，已知实际系统的开环传递函数为：sV（s）=0.027250.0102125s2-0.26705，则其根轨迹图形可以利用MATLAB键入如下命令来完成。 num=0.02725; den=0.0102125 0

13、-0.26705; z=roots(num)z = Empty matrix: 0-by-1 p=roots(den)p = 5.1136 -5.1136 rlocus(num,den)可以看出系统没有零点，有两个极点，并且有一个极点为正。由画出的根轨迹图形可以看出闭环传递函数的一个极点位于复平面的右半平面，这就意味着系统是一个不稳定的系统。五、 能控性和能观性分析对于系统的能控性和能观性分析，可以利用能控性秩判据和能观性秩判据。能控性秩判据：对于n维连续时间线性时不变系统，构成能控性判别矩阵：Qc=BABAn-1B，则系统完全能控的充要条件为：rankQc=rankBABAn-1B=n能观性

14、秩判据：对于n维连续时间线性时不变系统，构成能观性判别矩阵：Qo=CCACAn-1，则系统完全能观的充要条件为：rankQo=rankCCACAn-1=n利用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 A3*BQc = 0 1.0000 0 0 1.0000 0 0 0 0 3.0000 0 88.2000 3.0000 0 88.2000 0 R1=rank(Qc)R1 = 4 Qo=C;C*A;C*A2;C*A3Qo =

15、 1 0 0 0 0 1 0 0 0 1 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 R2=rank(Qo)R2 = 2可以看出，系统的完全能控矩阵的秩等于系统的状态变量维数，系统的输出完全能观测矩阵的秩等于系统输出向量y的维数，所以系统是可以完全能控完全能观测的系统。六、 根轨迹校正以及仿真已知系统的传递函数：Gs=0.027250.0102125s2-0.26705设计控制器使得调整时间ts=0.5s(2%)；最大超调Mp10%。计算整理可得超前校正装置的零点和极点分别为：zc=-6.92214；zp=-26.4568，由此可得校正后的传递函数：Q=GsKs=K(s+6.92214)s