直线型倒立摆的力学分析.pdf

倒立摆的力学应用一、综述、杂技表演中，艺人用手托起一根立起的竹竿时，他会通过手臂的不断移动来保持平衡，使竹竿不倒， 人和竹竿组成的这个系统就叫做一级倒立摆系统假如两根竹竿上下立在一起（自由连接） ，下面一根杆和作直线运动的小车自由连接，这个就叫做二级倒立摆系统倒立摆是常用的进行控制理论教学及开展各种控制实验的理想实验平台，是检验各种控制理论的重要工具同时，倒立摆在实际应用中也有着广泛的应用如：机器人的站立于行走问题类似于双倒立摆系统；在火箭飞行器的飞行过程中保持正确姿态；通信卫星保持稳定姿态以使卫星天线一直指向地球，并使太阳能电池板指向太阳；多极火箭发射的垂直度问题也可以简化为一个多级倒立摆模型作为控制课的一部分，我们于本学期开始进行在直线型倒立摆上开展控制实验，为了解决状态空间法设计控制算法的基本问题，对倒立摆进行力学建模是必要的用于倒立摆系统建模的主要方法有两种:一种是采用牛顿力学的分析方法，分别对小车和倒立摆进行动力学分析，列出其动力学方程，联立采用小角度线性化得到倒立摆系统的近似线性模型 另一种是拉格朗日方法，将倒立摆系统作为一个整体分析，建立系统的动态微分方程， 再采用小角度线性化的方法得到倒立摆系统的近似模型。

下面将先后用这两种方法分别对一级和二级倒立摆进行建模二、力学分析1、用动力学方程求解一级倒立摆的运动微分方程直线型电机一级倒立摆由直线运动的摆杆底座和一级摆杆组成如图1：图 1 其中， 为了简化模型， 可以认为摆杆和底座为刚体，忽略空气阻力和摆杆与底座轴承的摩擦力图中， m 为摆杆质量，M 为摆杆底座的质量，L 为摆杆转动轴心到摆杆质心的长度，I为摆杆惯量 ,F为加在小车上的力，x 为小车在x 轴上的的位移，Φ为摆杆与y 轴正方向的夹角小车与摆杆的受力分析如图2 所示其中N 和 P 为小车与摆杆相互作用力的水平和垂直方向的分量，b 为小车的阻尼系数θ为摆杆与 y 轴负方向的夹角对摆杆水平方向进行受力分析可得：22 (sin)tdNmxld（1）即：2cossinNmxmlml（2）对底座水平方向进行受力分析可得：MxFNbx（ 3）将（ 2）式代入（ 3）得2()sinMm xbxmlmlF（4）对摆杆垂直方向上的合力进行分析可得：22( cos )dPmgmldt（5）对于摆杆，力矩平衡方程为：sincosPlNlI（6）再从几何关系分析：+π,coscos，sinsin，故等式前面有号负号。

合并（ 5） （6） ，有22()sincosImlmglmlx因为是小角度变化，故设Φ约等于 0 图 2 所以，cos1，sin，2 0ddt按照惯例，把控制输入力F 记为 u线性化后可得2()()mM xmlbxuImlmglmlx接下来，用控制方面的知识进行状态空间计算：对上式进行拉普拉斯变化（初始条件为0） ，可得：22222() ( )( )( )()( )( )( )( )Imls smglsmglX s sMm X s smls sbX s sU s由于输出角度为Φ ，求解第一行可得：222()( )[] ( )ImlgX ssmls即22( )( )()smlsX sImlsmgl再令ax，有22( )( )()smla sImlsmgl将该式代入方程组（10）的第二个方程，可得：2232 4( )/()()( )lg/smlsqb ImlsMm mglsU ssbms q其中22[()()()]qmMImlml设系统的状态空间方程为：XAXBuyCXDu去状态变量：1xx，2xx，3x，4x，则状态向量为，[]TXxx对方程2()()mM xmlbxuImlmglmlx求代数方程，可得22 22222222()()()()()()()()()xxImlbxm l gImluxMm IMmlMm IMmlMm IMmlmlbxmlgMmmluMm IMmlMm IMmlMm IMml2、用拉格朗日方程来求解二级倒立摆的运动微分方程为了简化模型，作如下假设：小车在水平导轨上作直线运动;各摆杆及小车均为刚体；由于采用磁悬浮轨道，小车所受摩擦力忽略不计；两摆杆之间的连接处无摩擦且质量不计；两摆杆质量及绕其质心转动的转动惯量相同，长度为2l；质量为m,转动惯量为J。

小车质量为M，水平方向上的位移为x，计摆杆质心坐标为Gi（xi,yi） ，摆杆与竖直方向的夹角为 θ，记顺时针为正小车所受控制力合力为u小车的动能为：2 012TMx摆杆的动能为：22211()22iiiiTm xyJ系统的总动能为：2222222 01211122211111()()22222TTTTMxm xyJm xyJ总势能为：1122Vm gym gy第 1 级摆杆的质心坐标为：11111(sin,cos)Gxll第 2 级摆杆的质心坐标为：211221122(sinsin,coscos)Gxllll把坐标代入原式，可得：22 22 22 1211221 212222 1212121211()2coscoscos cos22 11sinsin()2coscos22LTVMm xm lm lmx lmx lllJmglmgl对各项求变分有：0dLdx222 111 2121 2121212 1112sinsin coscos sin2sinsin sin22dLmx lllmglld222 221 2121 2121112 211sincos sinsin cossinsin sin22dLmx lllmglld22 11112222x(2)2cos2sincossinLdMm xm lmlmlmldt12222 1111212212221122sin2coscos cossin cossin cos2Ldm lmxlmxllllJdt22222 22221121121212sincoscos cossin cossin cos2Ldm lmxlmxllllJdt根据拉格朗日方程LdqLQdtq，可得：22 11112222(2)2cos2sincossinMm xm lmlmlmlu222 111 2121 21212122222 11112122122211112sinsin coscos sin2sinsin sin22(22sin2coscos cossin cossin cos2)mx lllmgllm lmxlmxllllJu2222 22221121121212222 22121212121112sincoscoscossincossincos211(sincossinsincossinsinsin)22mlmxlmxllllJmxlllmgllu假设初始状态下1、2均为 0；且在平衡位置有微小的转动，故：112212sin;sin;cos1;cos1略去二阶小项：2 1、2 2代入上式化简：12(2)2Mm xm lmlu22 1212(2)2lmlxJmlmlmg22 212()2lmlxJmlmlmg这就是二级倒立摆的基本方程,该系统状态空间方程的求解与一级倒立摆的求解方式相同，这里已重点解决了力学推导问题，不再赘述拉普拉斯变化等控制方程求解过程。

通过查阅相关资料， 发现用动力学基本方程分析该问题可以得到与上式相同的结果这也进一步验证了拉格朗日方法的正确性对于大摆幅的二级倒立摆系统，带有三角函数的运动微分方程无疑给出了更精确的描述方式，给非线性控制提供了基础三、分析结论本文对一级和二级倒立摆的力学建模为设计控制算法提供了基本模型通过比较可以发现，拉格朗日方程在对复杂结构与系统的建模中更加简洁方便:用拉格朗日方法可以避免对系统内力进行分析相对较为简单、 有效用拉格朗日方程建立数学模型是，不必去分析作用于系统各个质点或刚体上的力、力矩、速度、 加速度等物理量、而将力学的基本定律表现为数学形式拉格朗日方程具有如下特点：（1）它以广义坐标表示运动方程式，方程式的数目和系统的自由度是一样的 （2） 只用分析已知的主动力，而不必分析未知的约束反力 （3）拉格朗日方程是以能量观点建立起的运动方程只用从系统的动能与势能，还有主动力， 从而大大简化了建模过程通过查阅相关文献可以看到，一些专家学者也是利用拉格朗日方程和矩阵的一些技巧推出了n 阶倒立摆的力学模型， 这也反映出了拉格朗日方程在工程中的广泛应用。