直线一级倒立摆的仿真分析

直线一级倒立摆的仿真分析作者黄俊杰摘要:应用牛顿力学定律建立了直线一级倒立摆传递函数、状态空间表达式等数学模型,并分析其稳定性、可控性和可观测性。【1】在此基础上,分别研究经典控制方法和现代控制方法在一级倒立摆系统中的应用,包括跟PID控制算法、系统轨迹/频率响应分析与校正、线性二次最优控制算法等,并在MATLAB/SIMULINK仿真平台上对这些控制算法的效果进行仿真,可以取得不同的控制效果。关键词:直线一级倒立摆数学模型经典控制方法现代控制方法MATLAB/SIMULINK引言：倒立摆系统是研究控制理论的一种典型的实验装置,具有成本低廉,结构简单,参数和结构易于调整的优点。然而倒立摆系统具有高阶次、不稳定、多变量、非线性和强耦合特性,是一个绝对不稳定系统。倒立摆实物仿真实验是控制领域中用来检验某种控制理论或方法的典型方案,它对一类不稳定系统的控制以及对深入理解反馈控制理论具有重要的意义。倒立摆系统在研究双足机器人直立行走、火箭发射过程的姿态调整和直升机飞行控制领域中有重要的现实意义,相关的科研成果已经应用到航天科技和机器人学等诸多领域。【2】伴随着控制理论的不断发展,对倒立摆的控制也出现了采用经典控制理论、现代控制理论和人工智能控制理论等多种控制理论的方案和控制方法。本文首先建立了直线一级倒立摆的数学模型,PID控制算法、系统轨迹/频率响应分析与校正、线性二次最优控制算法对模型进行仿真分析。一、牛顿－欧拉方法建模在忽略了空气阻力和各种摩擦之后，可将直线一级倒立摆系统抽象成小车和匀质杆组成的系统，如图1-1所示。表1直线一级倒立摆系统的物理参数表M小车质量m摆杆质量b小车摩擦系数l摆杆转动轴心到杆质心的长度I摆杆惯量F加在小车上的力x小车位置摆杆与垂直向上方向的夹角摆杆与垂直向下方向的夹角（考虑到摆杆初始位置为竖直向下）图1直线一级倒立摆模型图1-2是系统中小车和摆杆的受力分析图。其中，N和P为小车与摆杆相互作用力的水平和垂直方向的分量。图2小车及摆杆受力分析图分析小车水平方向所受的合力，可以得到以下方程:NxbFxM(1)由摆杆水平方向的受力进行分析可以得到下面等式:)sin(2lxdtdmN(2)即:sincos2mlmlxmN(3)把这个等式代入(1)式中，就得到系统的第一个运动方程:FmlmlxbxmMsincos)(2(4)为了推出系统的第二个运动方程，我们对摆杆垂直方向上的合力进行分析，可以得到下面方程:)cos(2ldtdmmgP(5)cossin2mlmlmgP(6)力矩平衡方程如下:INlPlcossin(7)注意:此方程中力矩的方向，由于sinsin,coscos,,故等式前面有负号。合并这两个方程，约去P和N，得到第二个运动方程:cossin)(2xmlmglmlI(8)设,（是摆杆与垂直向上方向之间的夹角），假设与1（单位是弧度）相比很小，即1，则可以进行近似处理:0)(,sin,1cos2dtd用u来代表被控对象的输入力F，线性化后两个运动方程如下:umlxbxmMxmlmglmlI)()(2(9)对方程组(9)式进行拉普拉斯变换，得到方程组:)()()()()()()()()(2222sUssmlssbXssXmMssmlXsmglssmlI(10)注意:推导传递函数时假设初始条件为0。由于输出为角度，求解方程组的第一个方程，可以得到:)(])([)(22ssgmlmlIsX(11)如果令xv,则有:)()()(22sVmglsmlImls(12)把上式代入方程组的第二个方程，得到:)()()(])([)(])()[(22222sUssmlsssgmlmlIbsssgmlmlImM(13)整理后得到传递函数:sqbmglsqmglmMsqmlIbssqmlsUs23242)()()()((14)其中])())([(22mlmlImMq设系统状态空间方程为:DuCXyBuAXX(15)方程组对,x解代数方程，得到解如下:2222222222)()()()()()()()()(MmlmMImluMmlmMImMmglMmlmMIxmlbMmlmMIumlIMmlmMIglmMmlmMIxbmlIxxx(16)整理后得到以外界作用力(u来代表被控对象的输入力F)作为输入的系统状态方程:uMmlmMImlMmlmMImlIxxMmlmMImMmglMmlmMImlbMmlmMIglmMmlmMIbmlIxx2222222222)(0)(00)()()(010000)()()(00010(17)uxxxy0001000001(18)由方程组(9)得第一个方程为:xmlmglmlI)(2(19)对于质量均匀分布的摆杆有:231mlI(20)于是可以得到:xmlmglmlml)31(22(21)化简得到:xllg4343(22)设xuxxX',,,,,则可以得到以小车加速度作为输入的系统状态方程:'4301004300100000000010ulxxlgxx(23)'0001000001uxxxy(24)以小车加速度为控制量，摆杆角度为被控对象，此时系统的传递函数为:lgslsG4343)(2(25)表1.2便携式直线一级倒立摆实际系统的物理参数摆杆质量m摆杆长度L摆杆转轴到质心长度l重力加速度g0.0426kg0.305m0.152m9.812/sm将表1.1中的物理参数代入上面的系统状态方程和传递函数中得到系统精确模型。系统状态空间方程:'9.401003.4800100000000010uxxxx(26)'0001000001uxxxy(27)系统传递函数3.489.4)(2ssG(28)二、系统的阶跃响应分析与可控性分析2.1系统阶跃响应分析上面已经得到系统的状态方程式，对其进行阶跃响应分析，在MATLAB指令区中键入以下命令:其阶跃响应曲线如图：图3小车位置和摆杆角度阶跃响应曲线可以看出，在单位阶跃响应作用下，小车位置和摆杆角度都是发散的，即未校正前的系统是不稳定的。2.2系统可控性分析由（26）式和（27）式可以得到:03.4800100000000010A9.4010B01000001C00D在MATLAB中计算对应的秩。MATLAB计算过程如下:从计算结果可以看出，系统的状态完全可控性矩阵的秩4等于系统的状态变量维数4，系统的输出完全可控性矩阵的秩2等于系统输出向量y的维数2，所以系统是可控的，因此可以对系统进行控制器的设计，使系统稳定。三、根轨迹校正实验闭环系统瞬态响应的基本特性与闭环极点的位置紧密相关，如果系统具有可变的环路增益，则闭环极点的位置取决于所选择的环路增益，从设计的观点来看，对于有些系统，通过简单的增益调节就可以将闭环极点移到需要的位置，如果只调节增益不能满足所需要的性能时，就需要设计校正器，常见的校正器有超前校正、滞后校正以及超前滞后校正等。当系统的性能指标以时域形式提出时，通常用根轨迹法对系统进行校正。【3】基于根轨迹法校正的基本思想是：假设系统的动态性能指标可由靠近虚轴的一对共轭闭环主导极点来表征，因此，可把对系统提出的时域性能指标的要求转化为一对期望闭环主导极点。确定这对闭环主导极点的位置后，首先根据绘制根轨迹的相角条件判断一下它们是否位于校正前系统的根轨迹上。如果这对闭环主导极点正好落在校正前系统的根轨迹上，则无需校正，只需调整系统的根轨迹增益即可；否则，可在系统中串联一个超前校正装置:)1(11)(aTsaTssGc（29）通过引入新的开环零点和新的开环极点来改变系统原根轨迹的走向，使校正后系统的根轨迹经过这对期望闭环主导极点。3.1根轨迹分析前面我们已经得到了直线一级倒立摆系统的开环传递函数，输入为小车的加速度，输出为倒立摆系统摆杆的角度，被控对象的传递函数为：3.489.4)(2ssG可知系统没有零点，有两个极点9498.6,9498.621。画出系统传递函数的根轨迹如图1-8所示，可以看出传递函数的一个极点位于右半平面，并且有一条根轨迹起始于该极点，并沿着实轴向左到位于原点的零点处，然后沿着虚轴向上，这意味着无论增益如何变化，这条根轨迹总是位于右半平面，即系统总是不稳定的。MATLAB绘制未校正前的系统根轨迹程序如下:其根轨迹如图：1czaT1cpT图4未校正前的系统开环根轨迹MATLAB绘制未校正前的闭环系统阶跃响应曲线程序如下:3.2根轨迹校正器设计及仿真直线一级倒立摆的根轨迹校正可以转化为如下的问题【11】：对于传递函数为：3.489.4)(2ssG的系统，设计控制器使得校正后系统的性能指标如下：1.调节时间sts5.0；2.最大超调量0010pM；根轨迹设计步骤【5】如下：1.确定闭环期望极点ds的位置，由最大超调量：（30）可以得到，取，由得rad，其中为位于第二象限的极点和原点的连线与实轴负方向的夹角。所编程序为：2(1)10%pMe0.59120.6cos0.9273图5性能指标与根轨迹关系图又由，可以得到，取，于是可以得到期望的闭环极点ds=。所编程序为：2.未校正系统的根轨迹在实轴和虚轴上，不通过闭环期望极点，因此需要对系统进行超前校正，设控制器为：3.计算超前校正装置应提供的相角，已知系统原来的极点在主导极点产生的滞后相角和为：40.5snts13.3333n13.5n13.5(cossin)8.110.8jj1()(1)1cccszaTsGsaTssp（31）所以一次校正装置提供的相角为：4.设计超前校正装置，已知，对于最大的值的角度：图6根轨迹校正计算图求出超前校正装置的零点和极点，分别为：程序如下：校正后系统的开环传递函数为：3.489.424)7()()()(2sssKsGsKGsQc（32）5.由幅值条件1)()(ddsHsQ，并设反馈为单位反馈，即1)(dsQ。1113.5sin13.5sin()tantan13.5cos7.74613.5cos7.7462.1362dGs3.14162.13621.00540.9273a1()0.604527,24cpzz13.489.424)7()()(8.101.82jscsssKsGsKG（33）求得：71.52K6