2022年倒立摆模型推导 .pdf

《2022年倒立摆模型推导 .pdf》由会员分享，可在线阅读，更多相关《2022年倒立摆模型推导 .pdf（10页珍藏版）》请在淘文阁 - 分享文档赚钱的网站上搜索。

1、倒立摆系统模型研究控制系统的数学模型是描述系统内部物理量或变量之间关系的数学表达式。在静态条件下(即变量各阶导数为零)，描述变量之间关系的代数方程称为静态数学模型；而描述变量各阶导数之间关系的微分方程称为动态数学模型。如果已知输入量及变量的初始条件，对微分方程求解， 则可以得到系统输出量的表达式，并由此对系统进行性能分析。因此， 建立控制系统的数学模型是进行控制系统分析和设计的首要工作。系统建模可以分为两种方式：实验建模和机理建模。实验建模是通过在研究对象上加入各种由研究者事先确定的输入信号，激励研究对象， 并通过传感器检测其可观测的输出，应用系统辩识的手法分析输入-输出关系，建立适当的数学模

2、型逼近实际系统。机理建模就是在了解研究对象的运动规律基础上，通过物理、 化学的知识和数学手段建立起系统的运动方程。对于倒立摆系统，由于其本身是自不稳定的系统，实验建模存在一定的困难，故而选用机理建模的方法。为了在数学上推导和分析的方便，可作出如下假设：1)摆杆在运动中是不变形的刚体；2)齿型带与轮之间无相对滑动，齿型带无拉长现象；3)各种摩擦系数固定不变；4)忽略空气阻力；在忽略掉这些次要的因素后，倒立摆系统就是一个典型的运动刚体系统，可以在惯性坐标系内应用经典力学理论建立系统的动力学方程。本文采用分析力学Lagrange方程建立一、二级倒立摆的数学模型。Lagrange方程有如下特点：1)它

3、是以广义坐标表达任意完整系统的运动方程式，方程的数目和系统的自由度数是一致的。2)理想的约束反力不出现在方程组中，因此在建立系统的运动方程时，只需分析已知的主动力，而不必分析未知的约束反力。3)Lagrange 方程是以能量的观点建立起来的运动方程式，为了列出系统的运动方程式，只需从两个方面进行分析，一个是表征系统运动的动力学能量系统的动能， 另一个是表征主动力作用的动力学量广义力。因此， 用 Lagrange建模可以大大简化系统的建模过程。采用拉格朗日的方法建立系统的数学模型。Lagrange 算子可以描述如下：( , )( , )( )L q qT q qV q(1.1) 其中：T ：系统

4、的动能V ：系统的势能q ：系统的广义坐标则系统的动力学方程可用Lagrange算子描述如下：dLLDUdtqqq(1.2) 名师资料总结 - - -精品资料欢迎下载 - - - - - - - - - - - - - - - - - - 名师精心整理 - - - - - - - 第 1 页，共 10 页 - - - - - - - - - Lagrange方程可以简单的理解为系统的能量的变化随着系统外加作用力的变化而变化。1.1 一级倒立摆系统1.1.1 拉格朗日方法建立一级倒立摆系统的数学模型可以将一级倒立摆系统抽象成小车和质量均匀的摆杆组成，小车以向左方向运动为正，摆杆角度以自然下垂位置

5、为零点，逆时针为正，如图2.1 所示。图 2.1 一级倒立摆示意图各参数的物理意义及取值如表2.1：表 2.1 倒立摆物理参数符号意义及取值符号物理意义取值及单位M 小车质量1.096 kg m 摆杆质量0.109 kg c0小车摩擦系数0.1 Nm-1sec-1 c1摆杆摩擦系数0.0022 Nm-1sec-1l 摆杆转动轴心到质心的长度0.25 m J 摆杆惯量0.0034 kgm2u 控制力N x 小车位移m 小车速度m sec-1摆杆角度rad 摆杆角速度rad sec-1首先计算小车的动能(MT)、摆杆的动能 (mT)和系统的总动能(T)：x名师资料总结 - - -精品资料欢迎下载

6、- - - - - - - - - - - - - - - - - - 名师精心整理 - - - - - - - 第 2 页，共 10 页 - - - - - - - - - 22221211(sin)(cos )22MmMmTMxd xldlTJmdtdtTTT(1.3) 不妨假定导轨所在的水平面势能为零，在一级倒立摆的运动过程中，小车的势能始终为零，系统的总势能为：(cos )Vmgl(1.4) 小车与导轨之间的摩擦力和摆杆与小车之间的摩擦力，使得系统能量的损失分别为：2102211212Dc xDc(1.5) 则系统总共损失的能量为：(1.6) 取系统的广义坐标系为：x 、，则拉格朗日算

7、子为：LTV(1.7) 则系统的拉格朗日方程可以表示为：0dLLDudtxxxdLLDdt(1.8) 借助 Mathemetica 软件，由以上方程组可以得到一级倒立摆系统的动力学方程，具体的推导过程可以参看附录一。021cossincossin0MmmlxxucmlmlmlJmglc(1.9) 1.1.2 一级倒立摆系统在倒立点附近线性化处理现行的许多一级倒立摆稳摆控制39需要将倒立摆在倒立点附近做近似线性化处理。首先由式 (2.9)可得：221022 2220122 22cos (sin)()(sin)()()coscos()(cos()sincossin)()()cosmlmglcJml

8、uc xmlxMm Jmlm lmlc xMm cmluMm gmlMm Jmlm l(1.10) 12DDD名师资料总结 - - -精品资料欢迎下载 - - - - - - - - - - - - - - - - - - 名师精心整理 - - - - - - - 第 3 页，共 10 页 - - - - - - - - - 在倒立点附近，摆杆角度接近为零，角速度也较小，可以认为：2sin0 , sin ,cos1(1.11) 将式 (2.11)代入式 (2.10)，可得22 22012012()()()()()()Jmlc xm l gJmluc mlxMm JMmlmlc xumlMm m

9、glMm cMm JMml(1.12) 令 ：TXxx(1.13) 将 2.12 写成矩阵形式，可以得到一级倒立摆在倒立点附近线性化模型的状态空间方程，如下：XAXBuYCXDu(1.14) 其中：22201222012220100()0()()()0001()()0()()()Jmlcc mlm l gMm JMmlMm JMmlMm JMmlAmlcMm cMm mglMm JMmlMm JMmlMm JMml2220()0()JmlMm JMmlBmlMm JMml10000010C00D1.2 二级倒立摆系统1.2.1 拉格朗日方法建立二级倒立摆系统的数学模型将二级倒立摆系统抽象成小车

10、和质量均匀的内、外摆杆组成， 小车以向左方向运动为正，摆杆角度以自然下垂位置为零点，逆时针为正，如图2.2 所示。各参数的物理意义及取值如表 2.2 所示。名师资料总结 - - -精品资料欢迎下载 - - - - - - - - - - - - - - - - - - 名师精心整理 - - - - - - - 第 4 页，共 10 页 - - - - - - - - - 图 2.2 二级倒立摆示意图表 2.2 倒立摆物理参数符号意义及取值符号物理意义取值及单位M 小车质量1.32 kg m1内杆质量0.04 kg m2外杆质量0.132 kg m3质量块质量0.208 kg c0小车摩擦系数0

11、.1 N/m/sec c1内杆 -小车摩擦系数0 N/m/sec c2内-外杆摩擦系数0 N/m/sec l1内杆转动轴心到质心的长度0.09 m L1内杆长度0.18 m l2外杆转动轴心到质心的长度0.27 m J1内杆惯量0.000108 kg*m2 J2外杆惯量0.0034 kg*m2 u 控制力N x 小车位移m 小车速度m/sec 内杆角度rad 内杆角速度rad/sec 外杆角度rad 外杆角速度rad/sec 首先计算小车的动能(MT)和内、外摆杆的动能(1mT、2mT)以及质量块的动能3mTx名师资料总结 - - -精品资料欢迎下载 - - - - - - - - - - -

12、 - - - - - - - 名师精心整理 - - - - - - - 第 5 页，共 10 页 - - - - - - - - - 222211111222121222221123312(sin)(cos)1122(sinsin)(cos)1122(sin)(coscos)12MmmmTMxd xldlTJmdtdtd xLldLTJmdtdtd xLdLlTmdtdt(1.15) 则总动能为：123MmmmTTTTT(1.16) 不妨假定导轨所在的水平面势能为零，在二级倒立摆的运动过程中，小车的势能始终为零，可以计算内外杆、质量块势能分别为：111222333mmmVm gYVm gYVm

13、 gY(1.17) 则总势能为：(1.18) 小车 -导轨、内杆 -小车、外杆 -内杆之间的摩擦力，使得系统能量的损失分别为：20021122212121()2Dc xDcDc(1.19) 故系统总共损失的能量为：123DDDD(1.20) 取系统的广义坐标系为：x 、，则则拉格朗日算子为：LTV系统的拉格朗日方程可以表示为：123mmmVVVV名师资料总结 - - -精品资料欢迎下载 - - - - - - - - - - - - - - - - - - 名师精心整理 - - - - - - - 第 6 页，共 10 页 - - - - - - - - - 00dLLDudtxxxdLLDd

14、tdLLDdt(1.21) 借助 mathemetica 软件， 由以上方程组可以得到二级倒立摆系统的动力学方程，具体的推导过程可以参看附录二。( )( , )( )M qC q qF q(1.22) 其中：Tqx1.2.2 二级倒立摆系统在倒立点附近线性化处理实现二级倒立摆稳摆控制的LQR40方法，需要对系统模型做线性化处理，在倒立点附近近似为线性时不变系统。在本文所规定的符号与方向的情况下，线性化结果如下：在倒立点附近存在：0,sin,cos1,0,sin,cos1,cos()1(1.23) 将式 (2.23)代入式 (2.22)，二级倒立摆系统动力学方程可以近似为：?( )( , )(

15、)M qC q qF q(1.24) 其中：1231 1232 22221 12311 1232 222 22 222 2()?()Mmmmmlm Lm Lm lMmlm Lm LJm lm Lm Lm l Lm lm l LJm l1231 1232 22221 12311 1232 222 22 222 2()coscos( )()coscos()coscos()Mmmmmlm Lm Lm lM qmlm Lm LJm lm Lm Lm l Lm lm l LJm l01 1232 2122 222 222()sinsin( , )0sin()0sin()cm lm Lm Lm lC q

16、qccm l Lcm l Lcc1 12322( )()sinsinuF qm lm Lm L gm gl名师资料总结 - - -精品资料欢迎下载 - - - - - - - - - - - - - - - - - - 名师精心整理 - - - - - - - 第 7 页，共 10 页 - - - - - - - - - 01222200?00cCccccc112322000?0()000Gmlm Lm L gm gl1?qMFuCqGq可以发现式 (2.24)是二级倒立摆在倒立点附近线性化处理后的系统方程，若令：1212TXxx(1.25) 1212TXxx(1.26) 则可以得到二级倒立摆

17、在倒立点附近线性化模型的状态空间方程：3 311100?IXXuMFMGMC(1.27) 1.3 倒立摆微分方程数值解法对倒立摆系统的仿真分析，实质上是对系统数学模型求数值解的过程。对于这样的常微分方程数值解法按照求解步数可以分为单步法和多步法，单步法的代表是Runge-Kutta 法，多步法的代表是Adms 法；按照求解步长可以分为固定步和变步长的求解方式；按照求解精度可以将求解方法归为2 阶、3 阶、4 阶等。下面不加推导的给出4 阶经典 Runge-Kutta 法的计算格式和Adms 可变步长的4 阶预测校正法的计算流程。已知微分方程初值条件，若x 在区间 a，b 取(N+1)个等距节点

18、，求对应的y 的近似值。( , ) , ,( )yfx yaxby a(1.28) 对于这样一个常微分方程的数值解问题，取步长h=(b-a)/N，4 阶经典 Runge-Kutta 法求解格式如下41：112341212233(22)6,22,22,iiiiiiiiiihyyKKKKKfx yhhKfxyKhhKfxyKKfxh yhK(1.29) Adams变步长的 4阶预测校正算法的思路是：先用给定的初始步长， 采用 4阶 Runge-Kutta法求出最初的三个节点，接着依据采用Adams-Bashforth 4 步显式方法 (式 3.10)预测下一个节点的值， 用 Adams-Bashf

19、orth 3 步隐式方法 (式 3.11)校正下一个节点的值。采用两种不同的方式计算的同一个节点的值，两个计算结果之差若在合理的范围内，则认为计算精度满足要求，无需改变步长； 若过大则认为计算精度不够，需减小步长以提高计算的准确性；若过小则认名师资料总结 - - -精品资料欢迎下载 - - - - - - - - - - - - - - - - - - 名师精心整理 - - - - - - - 第 8 页，共 10 页 - - - - - - - - - 为计算精度超标， 需增大步长以提高计算效率。若步长合适则保存结果，并采取当前步长继续预测、校正下一个节点。否则，改变步长重新采用Runge-

20、Kutta 法计算前面三个节点，然后对新步长做评价，不断的重复这一过程直到找到合适的步长为止。在计算快要结束时应当注意选取合适的步长以包含最后一个节点。Adams-Bashforth 4 步显式方法：111223355,59,37,9,24iiiiiiiiiihyyfx yfxyfxyfxy(1.30) Adams-Bashforth 3 步隐式方法：11111229,19,5,24iiiiiiiiiihyyfxyfxyfxyfxy(1.31) 通常高阶方法可能拥有更好的计算精度41，比如二、三、四阶方法对应的局部截断误差是分别是O(h2)、O(h3)、O(h4)。但并不是说高阶的方法拥有更好

21、的效果。这是由于插值多项式并不是次数越高逼近精度越好。另外，高阶的方法将花费更多的求解次数42，如表 2.3。因此，常微分方程的数值解通常采用小于5 阶的求解方法。表 2.3 求解次数与截断误差每步求解次数2 3 4 5n7 8n9 10n最佳可能的截断误差O(h2) O(h3) O(h4) O(hn-1) O(hn-2) O(hn-3) 在 MATLAB当中能方便的实现微分方程的数值解，常用的求解器及说明如表2.4：表 2.4 解常微分方程初值问题MATLAB的求解器求解器含义ode23 2、3 阶 Runge-Kutta 法ode45 4、5 阶 Runge-Kutta 法ode113 多

22、步 Adams 法ode23t 适度刚性问题梯形法ode15s 刚性微分方程组多步法ode23s 刚性微分方程组2 阶 Rosenbrock 法ode23tb 刚性微分方程组低精度算法odeset ode 命令选项设置对常微分方程初值问题，MATLAB的求解指令具有相同的格式，以最常用的ODE45为例说明如下：常用格式t，y = ode45(odefun， tspan，y0) 完整格式t，y = ode45(odefun， tspan，y0， options，p1，p2， ) 详细的参数说明如表2.5：表 2.5 ODE求解指令参数说明参数含义名师资料总结 - - -精品资料欢迎下载 - -

23、- - - - - - - - - - - - - - - - 名师精心整理 - - - - - - - 第 9 页，共 10 页 - - - - - - - - - odefun f(t，y)的函数句柄或内嵌函数tspan 自变量的初值和终值y0 初值向量t 标量，返回节点列向量y 标量或向量，返回数值解矩阵options 设置的计算参数，默认可用空矩阵表示p1，p2，为附加传递参数， 这时 odefun 必须表示为f(t， y， p1， p2， ) 可以在 MATLAB当中可以编写m 文件求解一、二级倒立摆系统的微分方程组。求解器选取 ODE45的详细程序清单见附录三。1.4 本章小结本章

24、介绍了建立一、二级倒立摆系统的数学模型的拉格朗日方法，借助 mathemetica 软件得到相应的微分方程组，并在倒立点附近做了近似线性化处理。在倒立摆的仿真过程当中，摆起过程采用微分方程组构建建立倒立摆的准确模型，稳摆过程可允许采用线性化处理后的模型。并简单介绍了几种微分方程数值解法的思想和在MATLAB 中的数值求解命令。采用MATLAB(求解器为 ODE45)分别编写了一、二级倒立摆微分方程的求解程序。名师资料总结 - - -精品资料欢迎下载 - - - - - - - - - - - - - - - - - - 名师精心整理 - - - - - - - 第 10 页，共 10 页 - - - - - - - - -