倒立摆系统的建模(拉格朗日方程)

系统的建模及性能分析倒立摆系统的构成及其参数1倒立摆系统的基本结构本设计所用到的倒立摆模型直线一级倒立摆系统。整个系统是由6大部分所组成的一个闭环系统，包括计算机、数据采集卡、电源及功率放大器、直流伺服电机、倒立摆本体和两个光电编码器等模块。如图2.1所示：图2.1倒立摆系统的结构组成示意图Fig2.1Structureofthelinearsingleinvertedpendulumsystem2系统主要组成部分简介直线一级倒立摆装置如图2.2所示[13]：图2.2直线一级倒立摆装置Fig2.2Straightlinear1-stageinvertedpendulumdeviceQuanser倒立摆系统包含倒立摆本体、数据采集电控模块以及控制平台等三大部分，其中控制平台是由装有Quanser专用实时控制软件的通用PC机组成。1．直线倒立摆主体倒立摆主体是由Quanser直线运动控制伺服单元IP02与直线一级摆杆组成，并配有专用的小车直线轨道。这里主要介绍下Quanser直线运动控制伺服单元IP02(即倒立摆运动小车)及导轨的组成：图2.3伺服单元IP02的组成Fig2.3ServounitIP02parts编号名称英文(01)IP02小车IP02Cart(02)不锈钢滑轨StainlessSteelShaft(03)齿轮导轨Rack(04)小车位移齿轮CartPositionPinion(05)小车电机传动齿轮CartMotorPinion(06)小车电机传动齿轮轴CartMotorPinionShaft(07)摆杆传动轴PendulumAxis(08)IP02小车位移编码器IP02CartEncoder(09)IP02摆杆角度编码器IP02PendulumEncoder(10)IP02小车位移编码器接口IP02CartEncoderConnector(11)IP02摆杆角度编码器接口IP02PendulumEncoderConnector(12)电机接口MotorConnector(13)直流伺服电机DCMotor(14)变速器PlanetaryGearbox(15)直线滑轨支撑轴LinearBearing(16)摆杆连接套PendulumSocket(17)IP02配重模块IP02Weight图2.4系统导轨结构图Fig2.4Systemguiderailstructure编号名称英文(22)导轨末端挡板RackEndPlate(23)导轨固定螺丝RackSetScrew(24)小车运动限位TrackDiscontinuity直线一级倒立摆系统的倒立摆的摆杆连接在IP02小车的摆杆连接套上，IP02小车由电机通过齿轮传动机构在导轨上来回运动，保持摆杆平衡。系统的直流电机采用的是Faulhaber2338S006型号的无刷直流电机，这种电机不仅具有结构简单、运行可靠的优点，而且还比传统的直流电机具有更快的反应速度。电机还配有Faulhaber的变速箱，可以提供3.71:1的减速比。（2）．数据采集模块电控箱内安装了本系统用到的各种电气元件，其中包括了有5针数字I/0接口的数据采集卡、开关电源、电源及功率放大器、指示灯和开关等。控制信号需要通过电源及功率放大器对控制信号进行处理，然后再输送至小车的直流伺服电机。（3）．控制平台控制平台主要由以下部分组成：(1)通用PC机；(2)实时控制软件QUARC控制平台的是倒立摆伺服系统的核心，是实现系统闭环的关键环节。它通过PC机的USB接口接收数据采集卡传输过来的位移和角度数据，进一步处理得到小车速度和摆杆角速度，同时将输入量根据所设计的控制算法计算出控制量，控制小车的运动，维持倒立摆的平衡。而控制平台的实时控制软件QUARC可以和MATLAB/Simulink完美联动，操作起来非常的方便。MATLAB是美国MathWorks公司出品的商业数学软件，用于算法开发、数据可视化、数据分析以及数值计算的高级技术计算语言和交互式环境。而Simulink是MATLAB最重要的组件之一，它提供一个动态系统建模、仿真和综合分析的集成环境。在该环境中，无需大量书写程序，而只需要通过简单直观的鼠标操作，就可构造出复杂的系统。Simulink具有适应面广、结构和流程清晰及仿真精细、贴近实际、效率高、灵活等优点，并基于以上优点Simulink已被广泛应用于控制理论和数字信号处理的复杂仿真和设计。同时有大量的第三方软件和硬件可应用于或被要求应用于Simulink。3系统性能参数小车及配重质量M=0.94kg；摆杆质量m=0.230kg；摆杆长L=0.6413m；摆杆转动轴心到杆质心的长度l=0.3302m；重力加速度g=9.81N/s2。2.2一级倒立摆系统的模型建立2.2.1Lagrange方程建立模型由于倒立摆的多变量、非线性的特点，同时也为了减少实验设计的盲目性，先建立系统的数学模型，然后才进行仿真实验和实时控制。使用牛顿运动定理来求解这样一个复杂的系统的数学模型，势必会产生大量的微分方程的计算。并且，在实际系统中，当质点存在约束情况的时候，计算量将会更大。所以，在本设计中，采用的是Lagrange方程来推导倒立摆系统的系统模型。Lagrange方程是以能量观点建立起来的运动方程式，为了列出系统的运动方程式，只需要从两个方面去分析，一个是表征系统运动的动力学量——系统的动能和势能，另一个是表征主动力作用的动力学量——广义力。因此用Lagrange方程来求解系统的动力学方程可以大大简化建模过程。将直线一级倒立摆系统抽象成小车和匀质杆组成的系统，并将倒立摆的物理模型分解为小车和摆杆的两部分分别进行受力分析。如图2.5所示。图2.5直线一级倒立摆分析图Fig2.5Linearinvertedpendulumanalysischart图2.5中，F为加在小车上的力，M为小车质量，m为摆杆质量，l为摆杆转动轴心到杆质心的长度，x为小车位置，为摆杆与垂直向上方向的夹角。为了方便在数学上推导和处理问题，可作出如下假设：（1）摆杆在运动中是不变形的刚体；（2）齿型带与轮之间无相对滑动，齿型带无拉长现象；（3）忽略空气阻力；由n个关节部件组成的机械系统，其Lagrange方程应为：iqiiiiFqDqVqTqTdtd(2-1)其中，q为系统的广义坐标，表示系统中线位移和角度的变量；T为倒立摆系统的动能，V为倒立摆系统的势能，D为倒立摆系统中的耗散能。那么，可以根据分析得出，上式中小车和摆杆的各部分能量的表达式为：2021xMT(2-2)000DV(2-3))]}cos([)]sin({[2121221ldtdlxdtdmITc(2-4)2121bD(2-5)cos1mglV(2-6)这里，000,,DVT分别代表小车的动能，势能及耗散能；111,,DVT分别代表摆杆的动能，势能及耗散能。所以，由上面各式，可以得到：)]}cos([)]sin({[21212122210ldtdlxdtdmIxMTTTc(2-7)cos10mglVVV(2-8)21021bDDD(2-9)当xqi的时候，即对小车而言：2sincos)()(mlmlxmMxTdtd(2-10)0xT，0xV，0xD(2-11)而，当iq的时候，即对摆杆而言：)sincos()(lxxmlITdtdc(2-12)sinxmlT，sinmglV，bD(2-13)根据上面各式综合，可以得到直线一级倒立摆的系统动力学方程为：sin0sin0coscos2mgluxbmlxmlImlmlmMc(2-14)这里，进行线性化处理。根据分析可知，在接近平衡位置时，与l相比很小，即1。则可进行近似处理：1cos，sin，0sin因此，将(2-14)式简化后得到的动力学方程：mgluxbxmlImlmlmMc0002(2-15)因为摆体绕支点的转动惯量I与摆体绕质心转动惯量cI关系为：2mlIIc(2-16)将(2-16)代入到式(2-15)后，可以得到：uxmglxbxImlmlmM00000000(2-17)设Q=ImlmlmM，P=b000，W=mgl000，Z=00，则有：ZuxWxPxQ(2-18)变换(2-18)得到：ZuQxWQxPQx111(2-19)所以，接下来就可以得出系统的状态空间方程。代入相关数据，可以得到所要用到的直线一级倒立摆系统的状态空间方程：uMmlmMImlMmlmMImlIxxMmlmMImMmglMmlmMImlbMmlmMIglmMmlmMIbmlIxx2222222222)(0)(00)()()(010000)()()(00010(2-20)uxxxy0001000001(2-21)所以，代入小车的实际各项参数值，可以得出小车的状态空间方程。即：uxxxx32597.2000503.10058199.2600556.001000072547.100241.000010(2-22)uxxxy0001000001(2-23)2.2.2系统的性能分析对于一个连续的时间系统DuCxyBuAxx，系统的完全可控性的充分必要条件是：BABAABASnc12...，该系统可控矩阵满秩，即rankSc=n。系统的输出可控性充要条件是：当且仅当矩DBCABCACABCBn12...的秩等于y的维数，则系统的输出可控。根据上面可控性的原理，对系统进行可控性分析，将(2-22)中的AB代入Sc式后，输入到MATLAB中进行计算可以得到：BABAABASnc12...=4(2-24)DBCABCACABCBQnc12...=2(2-25)由上式结得出结论，该系统是一个可控系统。所以，可以应用该系统作为控制对象系统，进行控制器的设计，使之稳定。