二级倒立摆数学模型的建立与仿真(共21页).doc

精选优质文档-倾情为你奉上二级倒立摆数学模型的建立与仿真 专业：控制工程姓名：淡丹 学号：摘要本文用分析力学中牛顿力学法及拉格朗日方程建立了二级倒立摆的数学模型。根据已经建立的倒立摆数学模型，对其进行了可控性，可观测性及稳定性的分析与研究，并对状态反馈及状态观测器进行了仿真模拟，分析研究。并通过分析比较得出，加状态观测器并不影响系统的输出的结论。关键词：倒立摆 状态空间 极点配置 状态反馈ABSTRACTNewtonian mechanics analysis method and the Lagrange equation of a mathematical model of double inverted pendulum has been used in this paper. According to the established mathematical model of inverted pendulum on the controllability, observability and stability of the analysis and research, and the state observer and state feedback is carried on the simulation ,analysis and research. And through the analysis and comparison of results, plus state observer does not affect the conclusions of the output of the system.KEY WORDS: inverted pendulum state space pole allocation state feedback一、二级倒立摆系统的组成二级倒立摆主要由以下四部分组成:1.在有限长的轨道L上作直线运动的小车;2.与小车铰接在一起，并能在竖直平面内分别绕q，q点转动的下、上摆;3.驱动小车的直流力矩电机和转轮、钢丝等传动部分;4.使上、下摆稳定在垂直向上的平衡位置，且使小车稳定在轨道中心位置附近的控制器。二级倒立摆的结构简图如图1的监督管理功能，如实时画面，数据采集等;数据采集卡安装在计算机内，用完成模/数、数/模转换;功率放大器用于电压和功率放大;电机是系统的执行元件;电位计是系统的测量元件，它分别检测小车相对于轨道中心点的相对位置、下摆相对于铅垂线的角位移、上摆相对于下摆延长线方向的角位移。图1 倒立摆系统的计算机控制系统二级倒立摆系统的整套机械部件安装在一个钢架上，上面固定着导轨、电机底座和转轮等装置。通过导轨支架安装好小车滑行的导轨，小车用电机和转轮通过传动钢丝实现运动。2、结构参数通过实际物理测量，得到二级倒立摆系统的参数如下:小车的等效质量: =1.0kg;小车与轨道间的滑动摩擦系数:=5.0kg/s;下摆的质量:=0.1481kg;下摆半长:=0.18m;下摆绕其重心的转动惯量:=0.0019;上摆质量:=0.0998kg;上摆半长:=0.24m;上摆绕其重心的转动惯量: = 0.0018;上、下摆重心之间的距离: =0.29m;上、下摆之间的转动摩擦系数: =0.0l/s;下摆和小车之间的转动摩擦系数:=0.01/s;电机及功率放大器的增益: =15Nt/V。3、Lagrange方程介绍Lgarnage方程为(1-1)式中T系统的动能函数，q，Lganarge变量，分别成为广义坐标和广义速度作用于系统上的广义力，(1-2)式中：V系统的势能函数有势力的广义力非有势力的广义力将式(2-2)代入式(2-l)得二、二级倒立摆数学模型的推导二级倒立摆是一个多变量、快速、非线性、强耦合、和绝对不稳定的系统，为了简化建立数学模型的过程，我们做了以下假设:1.上摆、下摆都是一个均匀的刚体;2.力矩电机的输出驱动力与其输入电压成正比，且无滞后地直接作用在小车上;3.车与轨道间的摩擦力仅与小车的速度成正比，下摆与车绞接处的摩擦力仅与摆的角速度成正比，上、下摆绞接处的摩擦力仅与摆的角速度成正比;4.忽略电机的电感;5.忽略钢丝的弹性。在以上假设前提下，我们采用分析力学中的Lganarge方程来建立系统的数学模型。令:为水平导轨运动的位移，拭、氏分别为下摆和上摆偏移竖直方向的角度。由于系统存在着摩擦力，属于一个耗散系统，因此式(2-3)部分应该加上耗能部分，对于同时受到保守力和耗散力作用的倒立摆系统的Lagrange方程为:式中： 广义坐标，即r、非有势广义力，当=r时，=,U为控制量，为增益常数，当=、时，=0T、V、D分别是系统的动能、势能和消耗能、 (1-5)式中： n倒立摆的级数，这里n=2小车和各级倒摆的动能小车和各级倒摆的势能小车和各级倒摆的消耗能将上述各式，(i=0，1，2)代入式(2-4)，得二级倒立摆的数学模型为式(2-6)式是一个非线性向量微分方程。考虑到系统工作时，是在平衡位置附近运动，可将式(2-6)在u=0的平衡位置r=0附近线性化，以线性化后的方程来代替式(2-6)的非线性向量微分方程。具体线性化是忽略二次以上的项(或因为，在以内，故，)，可求出关于dr，d，d的线性化微分方程，而后将dr，d，d改写成r，便可得到系统的状态方程。根据物理模型的实测数据，可求得平衡点处的常数阵: 利用Matlab中的求逆命令，可以解得阵所以，对式（2-6）进行线性化后，系统状态方程为：对于下摆有转角时，取上摆的相对角位移为，故令故式（2-7）可改写为定义状态向量x为则由式（2-8）可得将物理模型的实测参数代入式（2-9），得到二级倒立摆的系数矩阵为由此可知，二级倒立摆系统的数学模型为式中：A= 0 0 0 1.0000 0 0 0 0 0 0 1.0000 0 0 0 0 0 0 1.0000 0 -1.9600 0.0940 -4.8000 0.0040 -0.0040 0 46.1200 -25.0100 18.7600 -0.1300 0.2400 0 -51.0100 78.1600 -20.7500 0.2400 -0.5700B= 0 0 0 14.4137 -52.2864 62.2532C= 1 0 0 0 0 0 0 1 0 0 0 0 0 0 1 0 0 0三二级倒立摆稳定性，可控性及可观测性分析 3.1 系统的稳定性，可控性，可观测性（1）系统的稳定性在设计和分析线性控制系统时，首先要考虑的是控制系统的稳定性18-19。一个线性控制系统能够正常工作的首要条件就是它必须是稳定的。由于控制系统在实际运行中，不可避免的会受到外界或内部一些扰动因素的影响，比如系统负载或能源的波动、系统参数和环境条件的变化等，从而会使系统各物理量偏离原来的工作状态。如果系统是稳定的，那么随着时间的推移系统的各物理量就会恢复到原来的工作状态。如果系统不稳定即使扰动很微弱，也会使系统中的各物理量随时间的推移而发散，即使在扰动因素消失后，系统也不可能再恢复到原来的工作状态，显然不稳定的控制系统是无法正常工作的。由于稳定性的研究角度不同，线性控制系统稳定性在不同意义下的描述不尽相同，但是不同意义下稳定性描述的本质是相同的。当线性系统用输入输出模型（微分方程或传递函数）表示时，其稳定性定义通常有如下两种：第一种描述：如果线性系统受到扰动的作用而使被控量产生偏差，当扰动消失后，随着时间的推移，该偏差逐渐减小并趋向于零，即被控量趋向于原来的工作状态，则称该系统稳定。反之，若在扰动的影响下，系统的被控量随着时间的推移而发散，则称该系统不稳定。第二种描述：若线性系统在有界的输入量或干扰量的作用下，其输出量的幅值也是有界的，则称系统是稳定的。否则如果系统在有界输入下，产生无界的输出，则称系统是不稳定的。线性控制系统稳定性的充分必要条件：系统的所有极点必须位于s左半平面。（2）系统的可控性线性定常连续系统 （3-1）如果存在一个分段连续的输入u(t)，能在有限时间区间（t0,tf）内，使一系统由某一初始状态x(t0)，转移到指定的任一终端状态x(tf)，则称此状态是能控的。如果系统的所有状态都是能控的，则称此系统是状态完全能控的，或简称系统是能控的。能控性判据能控性判据一：线性定常连续系统（如（3-1）式）状态完全可控的条件为：当且仅当向量组是线性无关的，或n×n维矩阵的秩为n。能控性判据二：（1）当系统特征值互异时，若线性定常连续系统的特征值互异，则状态完全可控的充分必要条件是系统经非奇异线性变换后的对角线标准型： （3-2）的矩阵中不包含元素全为零的行。（2） 当系统含有重特征值时，其重特征值也就是说每一个重特征值只用一个约当块表示。则系统状态完全能控的充分必要条件为，系统经非奇异变换后的约定标准型 （3-3）中，和每个约当块Ji(i=1,2,k)的最后一行相对应的矩阵中的所有那些行，其元素不全为零。能控标准型: （3-4）（3）系统的可观测性线性定常连续系统 （3-5）如果对任意给定的输入u，都存在一有限观测时间tf>t0，使得根据t0,tf期间的输出y唯一的确定系统在初始时刻的状态x(t0)，则称此状态x(t0)是能观测的。如果系统的所有状态都是能观测的，则称此系统是状态完全能观测的，或简称系统是能观测的。能观测性判据能观测性判据一：线性定常连续系统如式（3-5）状态完全可观测的充分必要条件是其能观测矩阵满秩。能观测性判据二：（1）当系统特征值互异时，若线性定常连续系统的特征值互异，则状态完全能观测的充分必要条件是系统经非奇异线性变换后的对角线标准型 （3-6）的矩阵中不包含元素全为零的列。（3） 当系统含有重特征值时，其重特征值则系统状态完全能观测的充分必要条件为，系统经非奇异变换后的约定标准型 （3-7）中，和每个约当块的首列相对应的矩阵中的所有那些列，其元素不全为零。能观测标准型: （3-8）3.2二级倒立摆的可控性、可观测性及稳定性分析（1）二级倒立摆系统的可控性、可观测性程序如下：A=0 0 0 1 0 0;0 0 0 0 1 0;0 0 0 0 0 1;0 -1.96 0.094 -4.8 0.004 -0.004;0 46.12 -25.01 18.76 -0.13 0.24;0 -51.01 78.16 -20.75 0.24 -0.57;B=0 0 0 14.4137 -52.2864 62.2532;B1=B'C=1 0 0 0 0 0;0 1 0 0 0 0;0 0 1 0 0 0;rct=rank(ctrb(A,B1)OB=C;C*A;C*A*A;C*A*A*AQ=rank(OB)rct =6OB = 1.0000 0 0 0 0 0 0 1.0000 0 0 0 0 0 0 1.0000 0 0 0 0 0 0 1.0000 0 0 0 0 0 0 1.0000 0 0 0 0 0 0 1.0000 0 -1.9600 0.0940 -4.8000 0.0040 -0.0040 0 46.1200 -25.0100 18.7600 -0.1300 0.2400 0 -51.0100 78.1600 -20.7500 0.2400 -0.5700 0 9.7965 -0.8639 23.1980 -1.9807 0.1164 0 -55.0076 23.7731 -97.4668 46.2695 -25.2530 0 80.8145 -52.5041 115.9299 -51.2610 78.6255>>Q = 6由以上可知系统是可控和可观测的。（2）二级倒立摆系统的稳定性用函数eig（）求矩阵A的特征值与特征向量A=0 0 0 1 0 0;0 0 0 0 1 0;0 0 0 0 0 1;0 -1.96 0.094 -4.8 0.004 -0.004;0 46.12 -25.01 18.76 -0.13 0.24;0 -51.01 78.16 -20.75 0.24 -0.57;V,D=eig(A)V = 1.0000 -0.0006 -0.0069 -0.0015 -0.0265 0.1019 0 0.0420 0.1606 0.0399 0.0795 0.2483 0 -0.0942 0.1362 -0.0846 0.1503 0.0825 0 -0.0059 -0.0319 0.0156 0.1516 -0.3481 0 0.4053 0.7453 -0.4246 -0.4553 -0.8487 0 -0.9083 0.6318 0.9004 -0.8603 -0.2821D = 0 0 0 0 0 0 0 9.6476 0 0 0 0 0 0 4.6397 0 0 0 0 0 0 -10.6452 0 0 0 0 0 0 -5.7244 0 0 0 0 0 0 -3.4177由此可知系统有两个极点位于s右半平面，有一个极点位于坐标原点，所以系统不稳定。因此可以对系统进行控制器的设计，使系统稳定。四：系统反馈矩阵的设计及状态图：首先，使用MATLAB，判断系统的能控性矩阵是否为满秩。程序如下：A=0 0 0 1 0 0;0 0 0 0 1 0 ;0 0 0 0 0 1;0 -1.96 0.094 -4.8 0.004 -0.004; 0 46.12 -25.01 18.76 -0.13 0.24;0 -51.01 78.16 -20.75 0.24 -0.57;B=0 0 0 14.4137 -52.2864 62.2532;B1=B'C=1 0 0 0 0 0;0 1 0 0 0 0;0 0 1 0 0 0;rct=rank(ctrb(A,B1)计算结果为：rct = 6根据判别系统能控性的定理，该系统的能控性矩阵满秩，所以该系统是能控的。因为系统是能控的，所以，可以通过状态反馈来任意配置极点。不失一般性，不妨将极点配置在 s1=-6,s2=-6.5,s3=-7,s4=-7.5,s5=-8,s6=-8.5在MATLAB中输入程序：A=0 0 0 1 0 0;0 0 0 0 1 0 ;0 0 0 0 0 1;0 -1.96 0.094 -4.8 0.004 -0.004; 0 46.12 -25.01 18.76 -0.13 0.24;0 -51.01 78.16 -20.75 0.24 -0.57;B=0 0 0 14.4137 -52.2864 62.2532;B1=B'P=-6 -6.5 -7 -7.5 -8 -8.5 ;K=place(A,B1,P)计算结果为：K = 4.8696 28.2425 36.0516 6.3136 7.8320 5.7267因此，求出状态反馈矩阵为 K = 4.8696 28.2425 36.0516 6.3136 7.8320 5.7267采用MATLAB/Simulink构造二级倒立摆状态反馈控制系统的仿真模型，如下图所示。 五、 状态观测器实现状态反馈极点配置及其仿真首先，使用MATLAB，判断系统的能观性矩阵是否为满秩。输入以下程序 A=0 0 0 1 0 0;0 0 0 0 1 0 ;0 0 0 0 0 1;0 -1.96 0.094 -4.8 0.004 -0.004; 0 46.12 -25.01 18.76 -0.13 0.24;0 -51.01 78.16 -20.75 0.24 -0.57;B=0 0 0 14.4137 -52.2864 62.2532;B1=B'C=1 0 0 0 0 0;0 1 0 0 0 0;0 0 1 0 0 0;rob=rank(obsv(A,C)rob = 6因为该系统的能观测性矩阵满秩，所以该系统是能观测的。因为系统是能观测的，所以，可以设计状态观测器。而系统又是能控的，因此可以通过状态观测器实现状态反馈。设计状态观测器矩阵，使的特征值的实部均为负，且其绝对值要大于状态反馈所配置极点的绝对值。通过仿真发现，这样才能保证状态观测器有足够快的收敛速度，才能够保证使用状态观测器所观测到的状态与原系统的状态充分接近。不妨取状态观测器的特征值为： 输入以下命令：A=0 0 0 1 0 0;0 0 0 0 1 0 ;0 0 0 0 0 1;0 -1.96 0.094 -4.8 0.004 -0.004; 0 46.12 -25.01 18.76 -0.13 0.24;0 -51.01 78.16 -20.75 0.24 -0.57;A1=A'C=1 0 0 0 0 0;0 1 0 0 0 0;0 0 1 0 0 0;C1=C'P=-20 -21 -22 -23 -24 -25;G1=place(A1,C1,P);G=G1'求出状态观测器矩阵为：G = 38.2600 0.1197 -0.2836 17.7903 44.7264 0.7555 -17.4652 0.6889 46.5137 275.9610 1.1437 -5.5261 690.8092 544.3198 -7.4808 -704.7150 -33.5983 609.9059采用MATLAB/Simulink构造具有状态观测器的二级倒立摆状态反馈控制系统的仿真模型，如下图所示。 六总结。 倒立摆作为一个多变量、非线性、不稳定的典型系统，是控制领域重要的研究对象，是验证各种控制算法的理想模型;很多抽象的概念如系统的稳定性、可控性、可观性、鲁棒性和系统的抗干扰能力等，都可以通过对倒立摆的控制直观的表现出来。针对倒立摆控制方法的研究对两轮自平衡小车及其它相似实验设备的开发都具有重要的研究意义。本文用分析力学中牛顿力学法及拉格朗日方程建立了二级倒立摆的数学模型。根据已经建立的倒立摆数学模型，对其进行了可控性，可观测性及稳定性的分析与研究，并对状态反馈及状态观测器进行了仿真模拟，分析研究。通过比较得出具有状态观测器的二级倒立摆状态反馈系统的控制效果和没有状态观测器的控制系统的控制效果是一样的。可见，加状态观测器并不影响系统的输出。感言通过本学期线性系统理论的学习使我受益良多，线性系统理论这门课理论性较强学起来非常吃力，加之之前本科是学电气工程的对控制类学科基础知识了解甚少，在刚开始学习时的确遇到了不少困难。很多时候都会产生放弃学习这门课的念头而去学习自己感兴趣的东西，但是最后还是一步步坚持了下来，从一开始的什么都不懂，到后来逐渐建立起概念，一直到现在开始去喜欢这门课，其实兴趣也是建立在你去了解的基础之上的，只有你去了解你才谈得上是否对它感兴趣，而从一开始遇到困难就觉得没兴趣就是典型的知难而退。通过对本次二级倒立摆的仿真控制的学习研究，使自己深深认识到，理论终究还要付诸于实践，只有自己亲自尝试去做一遍才能真正检验自己知识是否真正掌握，好多书上不理解的东西通过这样一次实践，然后回过头再去看理论知识时你会有一种豁然开朗的感觉，而且往往还有额外的收获，通过仿真分析对比研究会使你知识更加准确清晰，往往通过这样一个环节下来，你会有这样的自信：对这块知识的掌握，我相信没有人会比我更清楚。刚开始做二级倒立摆时也遇到过许多难题，比如模型的建立，matlab的掌握与应用，必备的基础知识等，而这些的学习往往需要收集资料，看别人以前做过的东西，然后自己研究，先完成别人做过的，然后在添加自己的东西，这的确需要时间和一定的工作量，有时候即使是别人已经做好的东西看的时候也许要翻阅很多资料，因为它里面也会涉及好多陌生的概念，你必须去阅读才能一步步搞懂。科研本来就是一件苦差事，你必须耐得住寂寞，静得心来去研究，否则怎么会有成果呢？由于时间和学习精力有限，我选择做了二级倒立摆，但是在以后的学习中我会更加完善自我，精益求精，希望做到最后，我会向更高一级奋斗。很喜欢以前一位数学老师说过的话，奋斗后的成果最甜密，其实当你为追求某件事而全力以赴，当你站在某一个路口回头眺望时，心里的收获却是满满的，这就是奋斗后的喜悦。努力将会一直存在，转眼间研一的上半学期学习生涯即将结束，很感谢郑老师陪我们度过了研一的上半学期生活，在郑老师的课堂上我们学到的不仅仅是基本理论知识，更重要的是他还向我们传递了正能量。在课堂上，他鼓励我们搞科研，引领我们进入学术的海洋，向我们传递最新的科研信息，也向我们介绍最新的就业需求，告诉我们社会需要什么样的人才，教会我们要有目标，要有方向。刚来的时候的确很迷茫，也不知道研究生三年将如何度过，也厌倦了现有的教学体制及教学方式，在课堂上很少学到知识，感觉就是浪费时间，但是在郑老师的课堂上更坚定了我走科研之路的信念，他严谨的治学态度及学术造诣更是令我深深折服。求学，科研必将是一场孤独的旅行，路上少不了质疑和嘲笑，但那又怎样？即使遍体鳞伤，也要坚持到底。有时候不是看到了希望才去坚持，而是坚持了才看到希望。参 考 文 献 1刘时鹏.MATLAB环境下直线单级倒立摆系统实时控制实验的研究与设计R.重庆大学自动化学院,2004.62实验室.倒立摆系统实验指导书R.3张晓华.控制系统数字仿真与CADM.北京:机械工业出版社,1999.104 任祖华.倒立摆系统的智能控制研究D.武汉：华中科技大学.20065 李春文，冯元现.多变量非线性控制的逆系统方法M.北京:清华人学出版 社，1991.18-87.6 郭钊，侠方，建安苗.倒立摆系统及其智能控制研究J.东华大学学报，2003, 29(2):122-126.7 田明，戴汝为.基于动态BP神经网络得系统辨识方法J.自动化学报，1993, 19(4):450-453.8 张丽娟，涂亚庆.小车一二级倒立摆系统的仿人智能控制策略和算法J. 自动化与仪器仪表，2006，5:1-5.9 张乃尧，ElbertC,BelsehheR,StrahH.倒立摆的双闭环模糊控制J. 控制与决策，1996,11(1):85-88.10 张明廉，郝健康，孙昌龄.拟人控制与三级倒立摆J.航空学报，1995, 16(6):654-661.11 张志涌.精通Matlab6.5版M.北京:北京航空航大大学出版社,2003.9-101. 专心-专注-专业