单级旋转倒立摆系统资料

1、现代控制理论课程综合设计单级旋转倒立摆系统1 引言单级旋转倒立摆系统一种广泛应用的物理模型， 其物理模型如下： 图示为单 级旋转倒立摆系统原理图。 其中摆的长度 l1 =1m，质量 m1 =0.1kg ，横杆的长度 l2 2=1 m，质量 m2=0.1kg，重力加速度 g 0.98m / s2 。以在水平方向对横杆施加的力 矩M 为输入，横杆相对参考系产生的角位移 1为输出。控制的目的是当横杆在 水平方向上旋转时，将倒立摆保持在垂直位置上。图 1 单级旋转倒立摆系统模型单级旋转倒立摆可以在平行于纸面 3600 的范围内自由摆动。倒立摆控制系 统的目的是使倒立摆在外力的推动下， 摆杆仍然保持竖直

2、向上状态。 在横杆静止 的状态下， 由于受到重力的作用， 倒立摆的稳定性在摆杆微小的扰动下， 就会使 倒立摆的平衡无法复位， 这时必须使横杆在平行于纸面的方向通过位移产生相应 的加速度。 作用力与物体位移对时间的二阶导数存在线性关系， 故单级倒立摆系 统是一 个非线性系统。本文综合设计以以在水平方向对横杆施加的力矩 M 为输入，横杆相对参考 系产生的角位移 1 为输出，建立状态空间模型， 在原有系统上中综合带状态观测 器状态反馈系统，从而实现当横杆在旋转运动时，将倒立摆保持在垂直位置上。2 模型建立本文将横杆和摆杆分别进行受力分析， 定义以下物理量： 本文将横杆和摆杆分别进行受力分析， 定义以

3、下物理量： M 为加在横杆上的力矩； m1 为摆杆质量； l1为摆杆长度； I1为摆杆的转动惯量； m2 为横杆的质量； l2为横杆的长度； I2为 横杆的转动惯量； 1为横杆在力矩作用下转动的角度； 2 为摆杆与垂直方向的夹 角； N 和 H 分别为摆杆与横杆之间相互作用力的水平和垂直方向的分量。倒立 摆模型受力分析如图 2 所示。H图 2 倒立摆模型受力分析 摆杆水平方向受力平衡方程：d 2 lN m1 d 2 ( 1l 2 0 l1 sin 2 )1 dt 2 1 2 22( 1 l2 横杆的转动弧长即位移 )摆杆垂直方向受力平衡方程：H m1 gdt221 cos 2)摆杆转矩平衡方程

4、：J1 d 22 H l1 sin 2 N l1 cos 21 dt 2 22 22m1d2横杆转矩平衡方程：d 2 1M Nl2 J2 2122 dt2考虑到摆杆在设定点 1, 2=0 附近做微小振动，对上式进行线性化，即sin 22， cos21 ， &20，其中 Jml，近似线性化得到，2 223d2N 0.1d 2 1 0.5 2dt 2 1 2H 0.98 030 dt22 H 0.5 2 N 0.5 11 d 2M N 1 d 2130 dt2整理上式可得倒立摆的状态方程：11214.7 215M2114.7 215M4112 10M03 1 2本文参数代入计算可得：&am

5、p;&1 4.642 2 11.053M212.379 2 9.474M取状态变量如下：x1x&1x&2x&3x&40100x10004.6420x211.0530001x300012.3790x49.474Mx1x2y1x3x43 稳定性和能控性分析3.1 稳定性分析判断一个系统是否稳定，只需判断该系统传递函数的极点是否都在左半平面。编写 Matlab 语句可得该系统的传递函数，即A=0,1,0,0;0,0,-4.642,0;0,0,0,1;0,0,12.379,0;B=0;11.053;0;-9.474;C=1,0,0,0;D=0;Gss=ss(A,

6、B,C,D);G1=zpk(Gss)G1 =11.053 (s+2.898) (s-2.898)s2 (s-3.518) (s+3.518)Continuous-time zero/pole/gain model.从结果可以看出， 传递函数存在一个在复平面右半侧的极点， 故该系统是不 稳定的。3.2 能控性分析 判断系统是否完全能控，只需判断该系统能控性矩阵是否为满秩，即QCB AB A2B An 1B若 rankQC n ，则该系统是完全能控的。根据 Matlab 语句中 Qc=ctrb(A,B) ，即 A=0,1,0,0;0,0,-4.642,0;0,0,0,1;0,0,12.379,0;

7、B=0;11.053;0;-9.474;C=1,0,0,0;Qc=ctrb(A,B); n1=rank(Qc)n1 =4 从结果可以看出该系统是完全能控的，可以实现任意极点的配置。3.3 能观测性分析与判断能控性类似，只需判断该系统能观测性矩阵是否为满秩，即CCAQ0n1CAn1若 rankQ0 n ，该系统是完全能观测的。借用 Matlab语句中 Qo=obsv(A,C)，即A=0,1,0,0;0,0,-4.642,0;0,0,0,1;0,0,12.379,0;B=0;11.053;0;-9.474;C=1,0,0,0;Qo=obsv(A,C); n2=rank(Qo) n2 =4 从结果可

8、以看出该系统是完全能观测的，故可以配置状态观测器4 状态反馈分析4.1 原系统 Simulink 仿真及分析根据现代控制原理，绘制原系统的状态模拟图，如图 3 所示。x1x4x3图 3 原系统状态模拟图运用 MATLAB 中的 Simulink 来对原系统进行仿真， 首先可以得出原系统的 Simulink 仿真模型如下图 4 所示图 4 原系统 Simulink 仿真图通过 Simulink 仿真可以得到原系统的零状态响应，其中初始值 2 =0.174 ， M=0 ， 响应曲线如下图所示图 5 原系统 2 和 M 零状态响应曲线从仿真波形可以看出， 在初始扰动情况下， 摆杆不会稳定到垂直位置，

9、 横杆 会一直运动，故原系统不稳定，这与上文所述传递函数有左半平面极点符合4.2 状态反馈分析 由于原系统是不稳定的， 要使系统稳定， 需要加入状态反馈， 使系统的极点 全部位于左半平面，状态反馈的结构图如图 6 所示。图 6 状态反馈系统的结构图 控制系统的各种特性及其品质指标在很大程度上是由其闭环系统的零点和 极点的位置决定。 极点配置问题就是通过对状态反馈矩阵的选择， 使其闭环系统 的极点配置在所希望的位置上， 从而达到期望的性能指标的要求。 极点配置是一 个非常复杂的问题， 是一个工程实践与理论相结合的问题。 我们这里采用一种工 程实践中经常用到的简便方法 -主导极点法，其基本思路是先

10、根据期望的性能指 标和经验公式确定一对主导闭环极点， 然后将另外的非主导极点放在复平面上远 离主导极点的位置设倒立摆控制系统期望的性能指标为： 阻尼系数 =0.6，调节 时间 ts=2s。亦即控制系统在任意给定的初始条件下，能够以适当的阻尼=0.6 （大约 10%的超调），在 2s 钟内将摆杆恢复到垂直平衡位置。根据控制理 论的经验公式得到无阻尼自然频率为： n =4/ （ ts? ） =4/1.2=3.33P=wn? 由上述条件的很容易构建一个二阶系统，其两个极点为： p1 = -2.0000 +2 j p2 = -2.0000 -2 j它们就是需要的主导极点， 控制系统的性能主要由这两个主

11、导极点决定。 另 外两个非主导极点 （为简化取两个实数极点）经过反复试验整定，分别取距离 两个主导极点 4 倍和 5 倍的远处，即：p3 = -8.0000 p4=-10.0000 本文设计的状态反馈要求系统期望的特征值为： -10;-8;-2+j;-2-j 。手算求解 状态反馈阵 K 有待定系数法和直接法，由于矩阵 A 阶数较高，本文使用 Matlab 中 K=place（A,B,P1），求解 K 。A=0,1,0,0;0,0,-4.642,0;0,0,0,1;0,0,12.379,0;B=0;11.053;0;-9.474;P1=-10;-8;-2+2j;-2-2j;K=place(A,B

12、,P1)K =-6.8931 -4.9957 -26.2369 -8.1525状态反馈 K k1 k2 k3 k46.8931 4.9975 26.2369 8.1525运用MATLAB 中的 Simulink来对原系统进行仿真， 得到状态反馈模型仿真图 如下图 7所示。图 7 状态反馈 Simulink 仿真图8 所示。图 8 状态反馈系统 2 和 M 零状态响应曲线 从响应曲线可以看出，在 2 =0.174 ， M =0的初始扰动下，经过 3s左右的 时间，摆杆回到垂直的位置， 这说明加入状态反馈后可以使原系统达到稳定状态。5 带状态观测器状态反馈系统分析5.1 状态观测器的设计由于在系统

13、建模时状态变量并不是都是能直接测量， 因此人为地构建一个系 统来实现状态重构也即状态观测。状态观测器的结构图如下，即图 9 状态观测器的结构图观测器的状态方程为：x Ax G(y y) Bu (A GC)x Bu Gy 显然选择观测器的系数矩阵 A GC 的特征值均具有负复数，就可以使状态估计 逐渐逼近状态的真实值。本文设计全维状态观测器的特征值为： -10，-8，-2+2j ， -2-2j，同理根据语句 G=place(A',C',P2)可得G1G2G3G422.0000172.3790-158.6252-597.56135.2 带状态观测器状态反馈分析带观测器的状态反馈系统

14、由 3个部分组成，即原系统，观测器和状态反馈图 10 综合后 Simulink 仿真图 初始值 2 =0.174 ， M =0的零状态响应曲线如下图 11 综合后零状态响应曲线 从上面响应曲线可以看出， 加入观测器后系统在 3s左右达到稳定， 这是因为 观测器后极点特征值的实部更加偏离原点， 极点离远点越近， 达到稳定的时间越 短。此外，综合后超调量略有增加。综合后阶跃响应如图 12所示。图 12 综合后阶跃响应曲线从响应曲线可以看出，加入阶跃 M=1 后，摆杆发生左右来回振荡，振荡幅度 较大，最终摆杆处于垂直位置，横杆位于一个具体位置。6 总结单倒立摆是一个非线性系统， 通过近似线性变化， 得到一个单输入单输出的 线性定常系统。选择一组状态变量 x1= 1，x2= ，x3= 2 ， x4= &2 ，线性定 常系统做稳定性，能控性和能观测性分析，得出原系统是不稳定，完全能控的， 完全能观测的。原系统在参考输入为零的情况下，系统状态在初始扰动的响应不能衰减至 零，加入状态反馈后能够衰减至零。利用状态观测器构成的状态反馈闭环系统零输入响应与直接进行状态反馈 的闭环系统相比， 暂态过程持续时间较长， 这与极点的位置有关。 综合后的阶跃 响应达到稳定时间较长，还有剧烈的震荡，这符合实际情况。7 感