二级倒立摆数学模型的建立与仿真

二级倒立摆数学模型的建立与仿真专业：控制工程姓名：淡丹学号：1406073摘要本文用分析力学中牛顿力学法及拉格朗日方程建立了二级倒立摆的数学模型。根据已经建立的倒立摆数学模型，对其进行了可控性，可观测性及稳定性的分析与研究，并对状态反馈及状态观测器进行了仿真模拟，分析研究。并通过分析比较得出，加状态观测器并不影响系统的输出的结论。关键词：倒立摆状态空间极点配置状态反馈ABSTRACTNewtonianmechanicsanalysismethodandtheLagrangeequationofamathematicalmodelofdoubleinvertedpendulumhasbeenusedinthispaper.Accordingtotheestablishedmathematicalmodelofinvertedpendulumonthecontrollability,observabilityandstabilityoftheanalysisandresearch,andthestateobserverandstatefeedbackiscarriedonthesimulation,analysisandresearch.Andthroughtheanalysisandcomparisonofresults,plusstateobserverdoesnotaffecttheconclusionsoftheoutputofthesystem.KEYWORDS:invertedpendulumstatespacepoleallocationstatefeedback一、二级倒立摆系统的组成二级倒立摆主要由以下四部分组成:1.在有限长的轨道L上作直线运动的小车;2.与小车铰接在一起，并能在竖直平面内分别绕q，q点转动的下、上摆;3.驱动小车的直流力矩电机和转轮、钢丝等传动部分;4.使上、下摆稳定在垂直向上的平衡位置，且使小车稳定在轨道中心位置附近的控制器。二级倒立摆的结构简图如图1的监督管理功能，如实时画面，数据采集等;数据采集卡安装在计算机内，用完成模/数、数/模转换;功率放大器用于电压和功率放大;电机是系统的执行元件;电位计是系统的测量元件，它分别检测小车相对于轨道中心点的相对位置、下摆相对于铅垂线的角位移、上摆相对于下摆延长线方向的角位移。图1倒立摆系统的计算机控制系统二级倒立摆系统的整套机械部件安装在一个钢架上，上面固定着导轨、电机底座和转轮等装置。通过导轨支架安装好小车滑行的导轨，小车用电机和转轮通过传动钢丝实现运动。2、结构参数通过实际物理测量，得到二级倒立摆系统的参数如下:小车的等效质量:M=1.0kg;小车与轨道间的滑动摩擦系数:b=5.0kg/s;下摆的质量:m=0.1481kg;下摆半长:1l=0.18m;下摆绕其重心的转动惯量:1j=0.00192kgm;上摆质量:2m=0.0998kg;上摆半长:2l=0.24m;上摆绕其重心的转动惯量:2j=0.00182kgm;上、下摆重心之间的距离:1L=0.29m;上、下摆之间的转动摩擦系数:2F=0.0l2kgm/s;下摆和小车之间的转动摩擦系数:1F=0.012kgm/s;电机及功率放大器的增益:uK=15Nt/V。3、Lagrange方程介绍Lgarnage方程为..11(1,2,...,)1iqdTTVDFikdtqqiqq(1-1)式中T—系统的动能函数，.1q，q，—Lganarge变量，分别成为广义坐标和广义速度Qi—作用于系统上的广义力1(1,2,...,)iqVQiFikq，(1-2)式中：V—系统的势能函数1Vq—有势力的广义力iqF—非有势力的广义力将式(2-2)代入式(2-l)得.11(1,2,...,)1iqdTTVFikdtqqq二、二级倒立摆数学模型的推导二级倒立摆是一个多变量、快速、非线性、强耦合、和绝对不稳定的系统，为了简化建立数学模型的过程，我们做了以下假设:1.上摆、下摆都是一个均匀的刚体;2.力矩电机的输出驱动力与其输入电压成正比，且无滞后地直接作用在小车上;3.车与轨道间的摩擦力仅与小车的速度成正比，下摆与车绞接处的摩擦力仅与摆的角速度成正比，上、下摆绞接处的摩擦力仅与摆的角速度成正比;4.忽略电机的电感;5.忽略钢丝的弹性。在以上假设前提下，我们采用分析力学中的Lganarge方程来建立系统的数学模型。令:为水平导轨运动的位移，拭、氏分别为下摆和上摆偏移竖直方向的角度。由于系统存在着摩擦力，属于一个耗散系统，因此式(2-3)部分应该加上耗能部分，对于同时受到保守力和耗散力作用的倒立摆系统的Lagrange方程为:..11(1,2,...,)1iqdTTVDFikdtqqiqq式中：iq—广义坐标，即r、1、2iqF—非有势广义力，当iq=r时，iqF=0GU,U为控制量，0G为增益常数，当iq=1、2时，iqF=0T、V、D—分别是系统的动能、势能和消耗能0niiTT、0niiVV、0niiDD(1-5)式中：n—倒立摆的级数，这里n=2iT—小车和各级倒摆的动能iV—小车和各级倒摆的势能iD—小车和各级倒摆的消耗能将上述各式iT，iV，iD(i=0，1，2)代入式(2-4)，得二级倒立摆的数学模型为式(2-6)式是一个非线性向量微分方程。考虑到系统工作时，是在平衡位置附近运动，可将式(2-6)在u=0的平衡位置r=1=2=.r=.1=.2=0附近线性化，以线性化后的方程来代替式(2-6)的非线性向量微分方程。具体线性化是忽略二次以上的项(或因为1，2在5。以内，故sin，cos1)，可求出关于dr，d1，d2的线性化微分方程，而后将dr，d1，d2改写成r，1，2，便可得到系统的状态方程。根据物理模型的实测数据，可求得平衡点处的常数阵:利用Matlab中的求逆命令，可以解得1(0,0)M阵所以，对式（2-6）进行线性化后，系统状态方程为：对于下摆有转角1时，取上摆的相对角位移为21，故令故式（2-7）可改写为定义状态向量x为则由式（2-8）可得将物理模型的实测参数代入式（2-9），得到二级倒立摆的系数矩阵为由此可知，二级倒立摆系统的数学模型为.xAxBuyCx式中：A=0001.00000000001.00000000001.00000-1.96000.0940-4.80000.0040-0.0040046.1200-25.010018.7600-0.13000.24000-51.010078.1600-20.75000.2400-0.5700B=00014.4137-52.286462.2532C=100000010000001000三．二级倒立摆稳定性，可控性及可观测性分析3.1系统的稳定性，可控性，可观测性（1）系统的稳定性在设计和分析线性控制系统时，首先要考虑的是控制系统的稳定性[18-19]。一个线性控制系统能够正常工作的首要条件就是它必须是稳定的。由于控制系统在实际运行中，不可避免的会受到外界或内部一些扰动因素的影响，比如系统负载或能源的波动、系统参数和环境条件的变化等，从而会使系统各物理量偏离原来的工作状态。如果系统是稳定的，那么随着时间的推移系统的各物理量就会恢复到原来的工作状态。如果系统不稳定即使扰动很微弱，也会使系统中的各物理量随时间的推移而发散，即使在扰动因素消失后，系统也不可能再恢复到原来的工作状态，显然不稳定的控制系统是无法正常工作的。由于稳定性的研究角度不同，线性控制系统稳定性在不同意义下的描述不尽相同，但是不同意义下稳定性描述的本质是相同的。当线性系统用输入输出模型（微分方程或传递函数）表示时，其稳定性定义通常有如下两种：第一种描述：如果线性系统受到扰动的作用而使被控量产生偏差，当扰动消失后，随着时间的推移，该偏差逐渐减小并趋向于零，即被控量趋向于原来的工作状态，则称该系统稳定。反之，若在扰动的影响下，系统的被控量随着时间的推移而发散，则称该系统不稳定。第二种描述：若线性系统在有界的输入量或干扰量的作用下，其输出量的幅值也是有界的，则称系统是稳定的。否则如果系统在有界输入下，产生无界的输出，则称系统是不稳定的。线性控制系统稳定性的充分必要条件：系统的所有极点必须位于s左半平面。（2）系统的可控性线性定常连续系统DuCxyBuAxx（3-1）如果存在一个分段连续的输入u(t)，能在有限时间区间（t0,tf）内，使一系统由某一初始状态x(t0)，转移到指定的任一终端状态x(tf)，则称此状态是能控的。如果系统的所有状态都是能控的，则称此系统是状态完全能控的，或简称系统是能控的。能控性判据能控性判据一：线性定常连续系统（如（3-1）式）状态完全可控的条件为：当且仅当向量组BAABBn1,...,,是线性无关的，或n×n维矩阵[BAABBn1,...,,]的秩为n。能控性判据二：（1）当系统特征值互异时，若线性定常连续系统的特征值n,,,21互异，则状态完全可控的充分必要条件是系统经非奇异线性变换后的对角线标准型：uBxxn21（3-2）的矩阵B中不包含元素全为零的行。（2）当系统含有重特征值时，其重特征值，时，且当重重重ji12211;,,,,jinmmmmkiikk也就是说每一个重特征值只用一个约当块表示。则系统状态完全能控的充分必要条件为，系统经非奇异变换后的约定标准型uBxJJJxk21（3-3）中，和每个约当块Ji(i=1,2,,k)的最后一行相对应的B矩阵中的所有那些行，其元素不全为零。能控标准型:tutxaaaatxn10001000010000101210（3-4）txbbbyn121（3）系统的可观测性线性定常连续系统CxyAxx（3-5）如果对任意给定的输入u，都存在一有限观测时间tft0，使得根据[t0,tf]期间的输出y唯一的确定系统在初始时刻的状态x(t0)，则称此状态x(t0)是能观测的。如果系统的所有状态都是能观测的，则称此系统是状态完全能观测的，或简称系统是能观测的。能观测性判据能观测性判据一：线性定常连续系统如式（3-5）状态完全可观测的充分必要条件是其能观测矩阵1nOCACACQ满秩。能观测性判据二：（1）当系统特征值互异时，若线性定常连续系统的特征值n,,,21互异，则状态完全能观测的充分必要条件是系统经非奇异线性变换后的对角线标准型xCyxxn21（3-6）的矩阵C中不包含元素全为零的列。（3）当系统含有重特征值时，其重特征值，时，且当重重重ji12211;,,,,jinmmmmkiikk则系统状态完全能观测的充分必要条件为，系统经非奇异变换后的约定标准型xCyxJJJxk21（3-7）中，和每个约当块kiJi,,2,1的首列相对应的C矩阵中的所有那些列，其元素不全为零。能观测标准型:txtytubbbtxaaaatxnn1000100010001-001211210（3-8）3.2二级倒立摆的可控性、可观测性及稳定性分析（1）二级倒立摆系统的可控性、可观测性程序如下：A=[000100;000010;000001;0-1.960.094-4.80.004-0.