1-球杆系统建模分析

《线性系统理论》课程设计报告书课题名称球杆系统姓名孟禹漆铖刘泽文孟凡强杨佐龙日期2013年2月25日老师陈玮1球杆系统建模分析本章将对球杆系统进行简单的介绍，然后采用拉格朗日方程建立其数学模型，并在此基础上分析其特性。1.1球杆系统介绍球杆系统（Ball&Beam）是由球杆执行系统、控制器和直流电源等部分组成。该系统对控制系统设计来说是一种理想的实验模型。正是由于系统的结构相对简单，因此比较容易理解该模型的控制过程。球杆执行系统（如图1所示）由一根V型轨道和一个不锈钢球组成。V型槽轨道一侧为不锈钢杆，另一侧为直线位移电阻器。当球在轨道上滚动时，通过测量不锈钢杆上输出电压可测得球在轨道上的位置。V型槽轨道的一端固定，而另一端则由直流电机（DCmotor）的经过两级齿轮减速，再通过固定在大齿轮上的连杆带动进行上下往复运动。V型槽轨道与水平线的夹角可通过测量大齿轮转动角度和简单的几何计算获得。这样，通过设计一个反馈控制系统调节直流电机的转动，就可以控制小球在轨道上的位置。图1球杆系统执行机构原理图1.2拉格朗日方程介绍建立一个力学体系的动力学方程所需要的独立坐标称为广义坐标，广义坐标一旦确定，体系在空间的位置状态也就可以唯一确定。广义坐标可以是坐标变量，也可能是是角动量或其他独立变量，凡能用来表述体系的位形、运动和动力学状态的独立参量都可作为广义坐标。广义坐标的条件是：互相独立、满足约束方程、唯一确定体系的位形式动力学状态。拉格朗日方程方法建模可以表述为：设一个机械系统的自由度为n，对于系统可以采用广义坐标12(,,...,)nqqqq，12(,,...)nqqqq来描述，记该系统的总体动能为(,)Tqq，总体势能为()Vq，系统的运动特性可以用以下的拉格朗日方程描述：d1,2,...,diiiLLintqq(1.1)其中，方程组中方程式的数目等于质点系的自由度数，i为作用在第i个广义坐标iq方向的外部力或力矩之和。若函数L表示系统动能T与势能V的差值即L=T—V，L称为拉格朗日函数。即：(,)(,)()LqqTqqVq。因势能不是广义速度iq的函数，所以0iVq这样，系统的拉格朗日方程用L表示为：d1,2,...,diiiiTTVintqqq(1.2)显然，拉格朗日函数具有能量的量纲。这不但在机械系统中成立，在电动力学中，有些问题也可求出拉格朗日函数，从而通过拉格朗日方程，来建立电动力学的运动微分方程，因此拉格朗日函数及拉格朗日方程，具有更为普遍的意义。1.3球杆系统建模过程为了简化和清晰建模过程，可将球杆系统分解为三个部分——球杆机械部分模型，球杆角度转换部分模型和直流电机部分模型。1.3.1球杆系统机械部分建模对于球杆系统中球和横杆的运动方程可以采用拉格朗日方法建模。定义广义坐标(x,)，x、分别表示小球相对固定轴端的位移和导轨相对水平位置绕固定轴逆时针方向的转角，x、分别表示相应的位移速度和角速度。表2.1球杆系统参数小球质量(Kg)m0.1齿轮半径(m)r0.04小球半径(m)R0.015齿轮转角小球转动惯量(2Kgm)mJ510连杆长度(m)l横杆质量(Kg)M0.4横杆转角横杆长度(m)L作用在横杆上的扭矩（Nm）横杆转动惯量(2Kgm)MJ当然，建立拉氏方程一般分以下四个步骤：1)用广义坐标表示笛卡尔坐标：12(,,...,)kknxxqqq2)用广义速度表示笛卡尔坐标下的速度：ddkkkxqxxqqtq3)(,)()LTVTqqVq4)求出iLq及iLq，按自由度数建立拉格朗日方程组。①求系统动能选取球杆系统的广义坐标为(,)qx，系统的自由度为2，用广义坐标表示笛卡尔坐标为：1cosxx，1sinyx，广义速度之间的关系为：1cossinxxx，(1.3)1sincosyxx(1.4)小球沿广义坐标1x方向运动的动能：221111()2Tmxy2221()2mxx(1.5)小球绕径向转动的动能为：2212mTJ(1.6)式中表示小球转动的角速度，由小球在横杆上的滚动速度和横杆的转动速度两部分组成，即：xR(1.7)22222xxxRRR(1.8)因数值很小，故可做一下近似22xR，故有：2212mxTJR(1.9)其中mJ为小球的转动惯量，225mJmR横杆绕固定端转动时的动能为：2312MTJ(1.10)其中MJ为横杆的转动惯量，213MJML故系统总动能：22222123111()222mMxTTTTmxxJJR(1.11)②求系统势能小球的势能：1sinVmgx(1.12)横杆本身引起的势能为：21sin2VMgL(1.13)故系统总势能：12VVV1sinsin2mgxMgL(1.14)对式1.11做以下处理，得到：222222111()222mMTxmxxJJmxxxR(1.15)222222111()222mmMTxJmxxJJmxxxRR(1.16)1sinsinsin2VmgxMgLmgxx(1.17)对式1.15做以下处理，得到：22ddddmmTJJmxmxtxtRR(1.18)根据式1.2，得到广义坐标下x的拉格朗日方程，即有：ddTTVtxxx(1.19)综合以上式1.14、1.15、1.16、1.17，得出关于广义坐标下x的方程为：22sinmJmxmxmgR(1.20)当系统处于平衡状态时，等于零，在零点附近对系统进行线性化处理，可取sin，cos1，2x表示离心加速度，实际中其数值很小，可忽略，于是可得到近似方程：2mJmxmgR(1.21)对上式进行拉氏变换即可得球杆系统机械部分模型为：xuKrL221mmgJsmR图2球杆系统的近似模型22()1()mXsmgJssmR(1.22)1.3.2球杆系统角度转换部分模型在球杆的执行机构中，横杆一端固定，大齿轮、连杆与横杆一起组成了一个四连杆结构，齿轮的转动就通过连杆作用到横杆上，从而使横杆绕固定轴转动。齿轮转角和横杆的转角之间的关系可以用下式表示：2221cos1cos(sinsin)LrLlrl(1.23)在横杆水平位置附近，齿轮转角在50之间，故可以将其近似为一个比例关系：rL(1.24)1.3.3球杆系统直流电机部分模型球杆系统中的电机由智能驱动器控制，其响应速度相当快且电机转角()t对电压()ut的响应时间常数也很小。因此可将直流伺服电机数学模型近似为一个纯增益K。1.4球杆系统状态空间描述根据以上模型的推导过程，整个球杆系统的模型可以近似为如图2所示。故整个系统的传递函数近似为：22()1()mXsmgrKJUssmLR线性化的系统方程还可以用状态空间方程来表示。我们将小球的位置(r)和速度(r的一阶导数)作为变量，将齿轮角度θ作为输入，状态方程如下所示：θm)RJL(mgd0rr0010rr2不过，在本实验中，我们不用角度θ，而是用α的二阶导数来控制小球位置，这本质上就是控制横梁的转矩。状态方程变为：u1000ααrr000010000mRJmg000010ααrr2ααrr0001y注意:对于本系统是采用电机在横杆上施加转矩来控制小球的位置的。2.球杆系统性能分析根据第一部分球杆系统的状态空间描述在这章中对球杆系统的能控性，能观性进行等方面进行分析。2.1球杆系统的能控能观性利用matlab工具箱对球杆系统进行的能控能观性分析如下：A=[0100;0010;0001;0000];B=[0;0;0;1];C=[1000];D=[0];N=size(A);n=N(1);CAM=ctrb(A,B);rcam=rank(CAM);ifrcam==ndisp('Systemiscontrolled');elseifrcamndisp('Systemisnotcontrolled');endob=obsv(A,C);roam=rank(ob);ifroam==ndisp('Systemisobservable');elseifrcamndisp('Systemisnotobservable');end结果为：所以系统是能控能观的。2.2球杆系统的稳定性分析根据系统的状态空间方程容易得知系统有四个特征根且四个特征跟均为零，对于高阶非线性系统的平衡状态Xe的稳定性要由高阶导数项G（y）来决定的；通过查取资料分析该球杆系统是非稳定的。（查取资料前用分别用李亚普诺夫第一方法和第二法进行了分析，在采取第二法分析中由于求取的矩阵P不唯一，得不到相关的结果，最后查取资料进行了分析，并将资料付在论文最后）。2.3球杆系统极点配置与控制器设计极点配置的方法就是通过一个适当的状态反馈增益矩阵的状态反馈方法,将闭环系统的极点配置到任意期望的位置。()()()XtAxtBut=+，其中x是状态变量（n维），u是控制信号，这里选取控制信号为uKx=-，)()()(txBKAtx，该方程的解为()()(0)ABKtxtex-=?，系统的稳态响应和瞬态响应特性由矩阵A-BK的特征决定。()1234KKKKKx=-?，闭环系统的方程为()xAxBfABKx=+=-，选取所希望的极点值为，1234pppp设计状态反馈阵时，要使系统的极点设计成具有两个主导极点，两个非主导极点，这样就可以用二阶系统的分析方法进行参数的确定。最大超调量小于等于10%，调节时间为5S，运用超调量的计算公式，21%100%ezpzd--=?，其中z为阻尼系数，有该公式可求得，阻尼系数z=0.59，小于1，是欠阻尼。33()sntszws==-为极点实部，可以求得nw=1.27则极点公式为WnzjzWnp2^12,1，得到两个共轭极点为P1=-0.75+j*0.125,P2=-0.75-j*0.125。配置非主导极点P3=P4=-10。在MATLAB的控制系统工具箱中提供了单变量系统极点配置acker(),其格式为：K=acker(A,B,p)程序如下及其运行结果如下：仿真如下仿真结果如下X4X3X2X1=Y从仿真效果来看，稳定时间约为4到5秒，超调也小于10%,基本上达到了系统的要求。3分析小结状态反馈增益矩阵按上述的方法确定，即可使误差（由扰动所引起的）以足够快的速度降到零。对于一个给定的系统，矩阵pK并不是唯一的，而是取决于所期望的闭环极点位置（它决定响应速度）的选择。选择期望的闭环极点或期望的特征方程是在误差矢量响应的快速性与对扰动和测量噪声敏感型之间的一个折衷方案。也就是说，如果我们使误差响应的速度提高，那么扰动和测量噪声的有害影响往往也会增强。在确定给定系统的状态反馈增益矩阵pK时，通常是通过比较按不同的期望闭环极点或期望特征方程得到的矩阵pK，并从中选出使整个系统达到的特性最好的那个矩阵pK。其实在设计过程中,结合智能控制这门课我们还用模糊控制，也差不多达到了预期的效果，但是鉴于在线性系统理论中没有详细讲述，所以这里也没具体阐明，所以重在过程，重在体会。（模糊控制的仿真图在附录）附录Tr