资源描述
系统的建模及性能分析倒立摆系统的构成及其参数1倒立摆系统的基本结构本设计所用到的倒立摆模型直线一级倒立摆系统。整个系统是由6大部分所 组成的一个闭环系统,包括计算机、数据采集卡、电源及功率放大器、直流伺服 电机、倒立摆本体和两个光电编码器等模块。如图2.1所示:图2.1倒立摆系统的结构组成示意图Fig 2.1 Structure of the lin ear sin gle in verted pen dulum system2系统主要组成部分简介直线一级倒立摆装置如图2.2所示13:图2.2直线一级倒立摆装置Fig 2.2 Straight lin ear 1-stage in verted pen dulum deviceQua nser倒立摆系统包含倒立摆本体、数据采集电控模块以及控制平台等三 大部分,其中控制平台是由装有 Qua nser专用实时控制软件的通用PC机组成。1.直线倒立摆主体倒立摆主体是由Quanser直线运动控制伺服单元IP02与直线一级摆杆组成, 并配有专用的小车直线轨道。这里主要介绍下Qua nser直线运动控制伺服单元IP02(即倒立摆运动小车)及导轨的组成:图2.3伺服单元IP02的组成Fig 2.3 Servo un it IP02 parts编号名称英文(01)IP02小车IP02 Cart(02)不锈钢滑轨Stai nl ess Steel Shaft(03)齿轮导轨Rack(04)小车位移齿轮Cart Position Pinion(05)小车电机传动齿轮Cart Motor Pinion(06)小车电机传动齿轮轴Cart Motor Pin io n Shaft(07)摆杆传动轴Pen dulum Axis(08)IP02小车位移编码器IP02 Cart En coder(09)IP02摆杆角度编码器IP02 Pen dulum En coder(10)IP02小车位移编码器接口IP02 Cart En coder Co nn ector(11)IP02摆杆角度编码器接口IP02 Pen dulum En coder Conn ector(12)电机接口Motor Conn ector(13)直流伺服电机DC Motor(14)变速器Pla netary Gearbox(15)直线滑轨支撑轴Lin ear Beari ng(16)摆杆连接套Pen dulum Socket(17)IP02配重模块IP02 Weight图2.4系统导轨结构图Fig 2.4 System guide rail structure编号名称英文(22)导轨末端挡板Rack End Plate(23)导轨固定螺丝Rack Set Screw(24)小车运动限位Track Disc ontinuity直线一级倒立摆系统的倒立摆的摆杆连接在IP02小车的摆杆连接套上,IP02小车由电机通过齿轮传动机构在导轨上来回运动,保持摆杆平衡。系统的直流电机采用的是Faulhaber 2338S006型号的无刷直流电机,这种电机不仅具有结构简 单、运行可靠的优点,而且还比传统的直流电机具有更快的反应速度。电机还配有Faulhaber的变速箱,可以提供3.71:1的减速比。(2) .数据采集模块电控箱安装了本系统用到的各种电气元件,其中包括了有5针数字I/0接口的数据采集卡、开关电源、电源及功率放大器、指示灯和开关等。控制信号需要 通过电源及功率放大器对控制信号进行处理,然后再输送至小车的直流伺服电 机。(3) .控制平台控制平台主要由以下部分组成:通用PC机;实时控制软件QUARC控制平台的是倒立摆伺服系统的核心,是实现系统闭环的关键环节。它通过 PC机的USB接口接收数据采集卡传输过来的位移和角度数据, 进一步处理得到 小车速度和摆杆角速度,同时将输入量根据所设计的控制算法计算出控制量,控 制小车的运动,维持倒立摆的平衡。而控制平台的实时控制软件QUARC可以和 MATLAB/Simulink完美联动,操作起来非常的方便。MATLAB是美国MathWorks公司出品的商业数学软件,用于算法开发、数 据可视化、数据分析以及数值计算的高级技术计算语言和交互式环境。而Simulink是MATLAB最重要的组件之一,它提供一个动态系统建模、仿 真和综合分析的集成环境。在该环境中,无需大量书写程序,而只需要通过简单 直观的鼠标操作,就可构造出复杂的系统。Simulink具有适应面广、结构和流程 清晰及仿真精细、贴近实际、效率高、灵活等优点,并基于以上优点Simuli nk已被广泛应用于控制理论和数字信号处理的复杂仿真和设计。同时有大量的第三方软件和硬件可应用于或被要求应用于Simuli nk。3系统性能参数小车及配重质量M=0.94kg ;摆杆质量m=0.230kg;摆杆长 L=0.6413m;摆杆转动轴心到杆质心的长度l=0.3302m;重力加速度g=9.81N/s202.2 一级倒立摆系统的模型建立2.2.1 Lagra nge方程建立模型由于倒立摆的多变量、非线性的特点,同时也为了减少实验设计的盲目性, 先建立系统的数学模型,然后才进行仿真实验和实时控制。 使用牛顿运动定理来 求解这样一个复杂的系统的数学模型,势必会产生大量的微分方程的计算。并且, 在实际系统中,当质点存在约束情况的时候,计算量将会更大。所以,在本设计 中,采用的是Lagrange方程来推导倒立摆系统的系统模型。Lagra nge方程是以能量观点建立起来的运动方程式,为了列出系统的运动方 程式,只需要从两个方面去分析,一个是表征系统运动的动力学量一一系统的动 能和势能,另一个是表征主动力作用的动力学量一一广义力。因此用Lagra nge方程来求解系统的动力学方程可以大大简化建模过程。将直线一级倒立摆系统抽象成小车和匀质杆组成的系统,并将倒立摆的物理 模型分解为小车和摆杆的两部分分别进行受力分析。如图2.5所示。图2.5直线一级倒立摆分析图Fig 2.5 Lin ear in verted pen dulum an alysis chart图2.5中,F为加在小车上的力,M为小车质量,m为摆杆质量,I为摆杆转动轴心到杆质心的长度,x为小车位置, 为摆杆与垂直向上方向的夹角为了方便在数学上推导和处理问题,可作出如下假设:(1)摆杆在运动中是不变形的刚体;(2)齿型带与轮之间无相对滑动,齿型带无拉长现象;(3)忽略空气阻力;由n个关节部件组成的机械系统,其Lagra nge方程应为:dTTVD Fqdtqiqiqiqi(2-1)其中,q为系统的广义坐标,表示系统中线位移和角度的变量;T为倒立摆系统的动能,V为倒立摆系统的势能,D为倒立摆系统中的耗散能那么,可以根据分析得出,上式中小车和摆杆的各部分能量的表达式为:To - Mx22(2-2)V。D。0(2-3)T -Ic 2 -m-(x Isin )2 f (I cos )22 dtdt(2-4)Di-b(2-5)V1 mgl cos(2-6)这里,To,Vo,Do分别代表小车的动能,势能及耗散能;Ti,Vi,Di分别代表摆杆的动能,势能及耗散能。所以,由上面各式,可以得到:TTo T-;Mx2 彳 Ic 2 (x Isin )2 d; (I cos )222 dtdtV Vo V mglcos(2-8)当qi x的时候,即对小车而言:D DoD1 2(2-9)就)(Mm)xml cosmls in 2(2-10)0-Vx(2-11)而,当qj 的时候,即对摆杆而言:I c ml (x cosxsin(2-12)mlxsinmglsi n(2-13)根据上面各式综合,可以得到直线一级倒立摆的系统动力学方程为:M m ml cos x 0mls inxu2ml cos Ic ml0 bmgl sin(2-14)这里,进行线性化处理。根据分析可知,在接近平衡位置时,与l相比很小,即1。则可进行近似处理:cos1,sin,sin0因此,将(2-14)式简化后得到的动力学方程:M mmlx00 xumlIc ml20bmgl因为摆体绕支点的转动惯量I与摆体绕质心转动惯量Ic关系为:I I c ml2(2-16) 将(2-16)代入到式(2-15)后,可以得到:M mmlmlIx000 xb000 xmgl0 u0(2-17)M m ml00000设 Q=.,P=W=Z=mlI0b ,0mgl ,0 ,则有:xxxQPWZu(2-18)变换(2-18)得至U:1 x I x 1Q 1P Q W Q 1Zu(2-19)012)b02002n(Imlm2glx nI mlI(Mm)Mml2I(Mm)Mml2xI(Mm)Mml2u00010nmlbmgl(Mm)nml0I(Mm)Mml2I(Mm)Mml20I(Mm)Mml2(2-20)xx100 0x0yu001 00所以,接下来就可以得出系统的状态空间方程。 要用到的直线一级倒立摆系统的状态空间方程:代入相关数据,可以得到所xx(2-21)所以,代入小车的实际各项参数值,可以得出小车的状态空间方程。即:x0100 x0x00.002411.725470 x1.00503u0001000.0055626.5819902.32597(2-23)1000x00102.2.2 系统的性能分析对于一个连续的时间系统AxCxBuDu系统的完全可控性的充分必要条件2 n 1是: Sc A AB A B .A B ,该系统可控矩阵满秩,即 rank Sc=n。系统的输出可控性充要条件是:当且仅当矩CB CAB CA2B . CAn 1B D 的秩等于 y 的维数,则系统的输出可控。根据上面可控性的原理,对系统进行可控性分析,将 (2-22)中的 AB 代入 Sc 式后,输入到 MATLAB 中进行计算可以得到:2 n 1Sc A AB A2B .An 1B =4(2-24)2n 1Qc CB CAB CA2B . CAn 1B D =2 (2-25)由上式结得出结论,该系统是一个可控系统。所以,可以应用该系统作为 控制对象系统,进行控制器的设计,使之稳定。
展开阅读全文