《一级倒立摆系统分析报告.docx》由会员分享，可在线阅读，更多相关《一级倒立摆系统分析报告.docx（19页珍藏版）》请在taowenge.com淘文阁网|工程机械CAD图纸|机械工程制图|CAD装配图下载|SolidWorks_CaTia_CAD_UG_PROE_设计图分享下载上搜索。
1、. . .一级倒立摆的系统分析一、 倒立摆系统的模型建立如图 1-1 所示为一级倒立摆的物理模型l摆杆F小车导 轨x图 1-1 一级倒立摆物理模型对于上图的物理模型我们做以下假设：M：小车质量m：摆杆质量 b：小车摩擦系数l：摆杆转动轴心到杆质心的长度I：摆杆惯量F：加在小车上的力x：小车位置：摆杆与垂直向上方向的夹角：摆杆与垂直向下方向的夹角考虑到摆杆初始位置为竖直向下专业 专注.图1-2 是系统中小车和摆杆的受力分析图。其中，N 和P 为小车与摆杆相互作用力的水平和垂直方向的重量 。留意：实际倒立摆系统中的检测和执行装置的正负方向已经完全确定 ，因而矢量方向定义如下图，图示方向为矢量正方向
2、。PNFMBxXXIPmgN图 1-2 小车及摆杆受力分析分析小车水平方向受力，可以得到以下方程：M - -(1-1)由摆杆水平方向的受力进展分析可以得到以下方程：(1-2)即：(1-3)将这个等式代入式1-1中，可以得到系统的第一个运动方程： (1-4)为推出系统的其次个运动方程 ，我们对摆杆垂直方向上的合力进展分析，可以得出以下方程：(1-5) (1-6)利用力矩平衡方程可以有：(1-7)留意： 此方程中的力矩方向， 由于 ， ， ，所以等式前面含有负号。合并两个方程，约去P 和N 可以得到其次个运动方程： (1-8)设 ，假设 与 1单位是弧度相比很小，即 1，则可以进展近似处理： ，
3、， 。用 u 来代表被控对象的输入力F，线性化后的两个运动方程如下：(1-9)假设初始条件为 0，则对式1-9进展拉普拉斯变换，可以得到：(1-10)由于输出为角度 ，求解方程组的第一个方程，可以得到：(1-11)或改写为：(1-12)假设令 ,则有：(1-13) 假设将上式代入方程组的其次个方程，可以得到：(1-14)整理后可得传递函数：(1-15)其中假设系统状态空间方程为：(1-16)方程组对 ,解代数方程，可以得到解如下：(1-17)整理后可以得到系统状态空间方程：(1-18)由1-9的第一个方程为：对于质量均匀分布的摆杆可以有：于是可以得到：化简可以得到：(1-19)设 X=x, ,
4、 , ，则有：(1-20)以上公式推理是依据牛顿力学的微分方程验证的。在实际系统中模型参数如下：M 小车质量 1.096 Kgm 摆杆质量 0.109 Kgb 小车摩擦系数 0 .1N/m/secl 摆杆转动轴心到杆质心的长度 0.2 5mI 摆杆惯量 0.0034 kg*m*m将上述参数代入，就可以得到系统的实际模型。摆杆角度和小车位移的传递函数：(1-21)摆杆角度和小车加速度之间的传递函数为：(1-22) 摆杆角度和小车所受外界作用力的传递函数： (1-23)以外界作用力作为输入的系统状态方程：(1-24)以小车加速度作为输入的系统状态方程：1-25综述可知以上就是一级倒立摆系统的模型建
5、立过程 ，最终得出了实际模型的传递函数和状态空间方程。二、 系统模型的转换以小车加速度作为输入的系统状态方程为例 ，将系统状态方程转化为能控标准型，能观标准型和约当标准型。由系统状态方程可知：1、转化为能控标准型定出系统特征多项式： a=poly(A)a =1.0000-0.0000-29.400000由此可知 a0=0, a1=0, a2=-29.4, a3=0。 b3=C*Bb3 =00b2=C*A*B+a3*C*B b2 =13 b1=C*A2*B+a3*C*A*B+a2*C*B b1 =00 b0=C*A3*B+a3*C*A2*B+a2*C*A*B+a1*C*B b0 =-29.400
6、00所以系统的能控标准型为：2、转化为能观标准型利用对偶性求出能观标准型为：3、转化为约当标准型首先求出系统的特征值以及相应的特征向量：A=0 1 0 0;0 0 0 0;0 0 0 1;0 0 29.4 0 A =01.00000000000001.00000029.40000 V,D=eig(A) V =001.0000-1.00000000.00000.1814-0.1814000.98340.983400D =5.42220000-5.42220000000000其中D 表示A 全部特征值构成的对角阵，V 表示相对应的特征向量。求出变换矩阵V 的逆： V1=inv(V)Warning:
7、 Matrix is close to singular or badly scaled.Results may be inaccurate. RCOND = 1.720635e-292.V1 =1.0e+291 *000.00000.000000-0.00000.00000.00002.49480002.494800计算变换后的系数矩阵：5.42220000.0000-5.4222000000.00000000 A1=V1*A*V A1 =B1=V1*B B1 =1.0e+291 *0.00000.00002.49482.4948所以系统的约当标准型为：三、 开环阶跃响应曲线及分析利用的状态
8、空间方程来进展阶跃响应分析，在 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)可以看出，在单位阶跃响应作用下，小车位置和摆杆角度都是发散的。四、 推断系统稳定性推断系统的稳定性可以利用根轨迹来推断 ，实际系统的开环传递函数为：， 则其根轨迹图形可以 利用 MATLAB 键入如下命令来完成。 num=0.02725; den=0.0102125 0 -0.26705; z=roots(num) z =Empty matrix: 0-
9、by-1p=roots(den) p =5.1136-5.1136 rlocus(num,den)可以看出系统没有零点，有两个极点，并且有一个极点为正。由画出的根轨迹图形可以看出闭环传递函数的一个极点位于复平面的右半平面，这就意味着系统是一个不稳定的系统。五、 能控性和能观性分析对于系统的能控性和能观性分析 ，可以利用能控性秩判据和能观性秩判据。能控性秩判据：对于 n 维连续时间线性时不变系统，构成能控性判别矩阵：，则系统完全能控的充要条件为 ：能观性秩判据：对于 n 维连续时间线性时不变系统，构成能观性判别矩阵：，则系统完全能观的充要条件为：利用 MATLAB 键入以下命令来进展推断： A=
10、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 =01.0000001.000000003.0000088.20233.0000088.20230 R1=rank(Qc) R1 =4 Qo=C;C*A;C*A2;C*A3Qo =1000. . .0100010000000000000000000000 R2=rank(Qo) R2 =2可以看出，系统的完全能控矩阵的秩等于系统的状态变量维数 ，系统的输出完全能观测矩阵的秩等于系统输出向量 y 的维数，所以系
11、统是可以完全能控完全能观测的系统。六、 根轨迹校正以及仿真系统的传递函数：设计掌握器使得调整时间；最大超调。计算整理可得超前校正装置的零点和极点分别为： ；，由此可得校正后的传递函数：利用 MATLAB 命令观看校正后的根轨迹图形：专业 专注. . .图中可以看出，系统三条根轨迹都位于左半平面 ，只需要选定适当的K 就可以使得系统稳定。现在利用 MATLAN 仿真，选择不同的K 观看系统的阶跃响应曲线。K=141.137 时，画出闭环掌握系统：专业 专注.响应曲线图：K=120.115 时，响应曲线：K=50.129 时的响应曲线：K=10.110 时的响应曲线：K=1.137 时的响应曲线：比照不同的K 值变化可知，闭环掌握系统是稳定的。