单级倒立摆系统的分析与设计.docxVIP

单级倒立摆系统的分析与设计 小组成员：武锦张东瀛杨姣李邦志胡友辉倒立摆系统简介 倒立摆系统是一个典型的高阶次、多变量、不稳定和强耦合的非线性系统。由于它的行为与火箭飞行以及两足机器人行走有很大的相似性，因而对其研究具有重大的理论和实践意义。由于倒立摆系统本身所具有的上述特点，使它成为人们深入学习、研究和证实各种控制理论有效性的实验系统。 单级倒立摆系统(SimpleInvertedPendulumSystem)是一种广泛应用的物理模型，其结构和飞机着陆、火箭飞行及机器人的关节运动等有很多相似之处，因而对倒立摆系统平衡的控制方法在航空及机器人等领域有着广泛的用途，倒立摆控制理论产生的方法和技术将在半导体及精密仪器加工、机器入技术、导弹拦截控制系统、航空器对接控制技术等方面具有广阔的开发利用前景。 倒立摆仿真或实物控制实验是控制领域中用来检验某种控制理论或方法的典型方案。最初研究开始于二十世纪50年代，单级倒立摆可以看作是一个火箭模型，相比之下二阶倒立摆就复杂得多。1972年，Sturgen等采用线性模拟电路实现了对二级倒立摆的控制。目前，一级倒立摆控制的仿真或实物系统已广泛用于教学。 系统建模 1.单级倒立摆系统的物理模型 单级倒立摆系统是如下的物理模型：在惯性参考系下的光滑水平平面上，放置一个可以在平行于纸面方向左右自由移动的小车(cart)，一根刚性的摆杆(pendulumleg)通过其末端的一个不计摩擦的固定连接点(flexJoint)与小车相连构成一个倒立摆。倒立摆和小车共同构成了单级倒立摆系统。倒立摆可以在平行于纸面180°的范围内自由摆动。倒立摆控制系统的目的是使倒立摆在外力的摄动下摆杆仍然保持竖直向上状态。在小车静止的状态下，由于受到重力的作用，倒立摆的稳定性在摆杆受到微小的摄动时就会发生不可逆转的破坏而使倒立摆无法复位，这时必须使小车在平行于纸面的方向通过位移产生相应的加速度。依照惯性参考系下的牛顿力学原理，作用力与物体位移对时间的二阶导数存在线性关系，单级倒立摆系统是一个非线性系统。 各个参数的物理意义为： M一小车的质量m—倒立摆的质量 F—作用到小车上的水平驱动力L—倒立摆的长度 x—小车的位置。一某一时刻摆角 整个倒立摆系统就受到重力、驱动力和摩擦阻力的三个外力的共同作用。这里，驱动力F是由连接小车的传动装置提供，控制倒立摆的稳定实际上就是依靠控制驱动力F使小车在水平面上做与倒立摆运动相关的特定运动。为了简化模型以利于仿真，假设小车与导轨以及摆杆与小车铰链之间的摩擦均为0。 2.单级倒立摆系统的数学模型 令小车的水平位移为x，运动速度为v，加速度a。小车的动能为Ec=1M，选择特定的参考平面使得小车的势能为0。 摆杆的长度为L，某时刻摆角为。，在摆杆上与固定连接点距离为q(0ql)的位置处取一质量为^m的质元，则有h广*+qsin0[y=qcos0该质元的动能为：E=-Vm(+尬)=hm(+2qcos0X+q202)kVm2VmVm2势能为：E=Vm-g-qcos0，其中Vm=p?dq，9是摆杆的线密度pVm则系统的总动能可以通过对和从0到L积分获得： E=E+flEdq=!(M+m)+-kkc0kVm22 E=jlEdq=2mglcosO其中小车的动能和势能为：E=1MXkc2系统的拉格朗日方程可写为： L=E-E=2(M+m)X2+2mlcosOXO+6ml2O2-2mglcosO由欧拉一拉格朗日方程：d竺-竺=F,-|L-^=0dtddxdt渺SOL2为避免复杂的求解微分方程的运算倒立摆可以确定摆杆的运动方程：!(m+m)+：mcosOt-2mlsiny=fmlcosO敞+十ml2O-十mglsinO=032考虑摆角在0=0附近的微小变化， L2为避免复杂的求解微分方程的运算 倒立摆 在垂直位置可以近似为：cos0^1, sin0^0,运动方程可简化为: J(m+M)++ml俄=F(t)L+ml2(+1ml(一gO)=0I32令所有作用力、位移与角度参数为时间t的函数，则 曲t)=—[F(t)-(m+M)婀ml 2lml“八 一[F(t)-(m+M)婀+—(-gO)=0 32.?.=—4F(t)-3mgO(t)m+4Mm+4M 敝=2f(t)-2(m+M)[4f(t)-3mg-O(t)]mlmlm+4Mm+4M —6—F(t)+6g(m+M)O(t)l(m+4M)l(m+4M)将转换后的线性系统用两个2阶微分方程描述，系统的状态矢量为:令x=(O，供x,X)T,f=F(t)，则状态方程描述为：/Ax+BfIJ=Cx将相关参数带入，得到06g(m+M)l(m+4M)03mg—1000「1+「0一6l(m 1 0 0 0 「1 + 「0一 6 l(m+4M) x 0 「 「 4 _m+4M_ 0 0