机器人柔性臂动力学建模的d

1、机器人柔性臂动力学建模的D              摘要从改进柔性臂的模化原则出发，提出了多连杆复杂的柔性臂系统动力学建模的更为一般化的简单有效的D-Holzer法。用该法推导了两连杆柔性臂系统的动力学模型，并进行了动力学仿真。叙词：柔性臂动力学建模非线性仿真中图分类号：TP242A NEW DYNAMIC MODELINGMETHOD OF D-HOLZER OF THEFLEXIBLE MANIPULATORDing XilunZhang Qixian(Beijing

2、University of Aeronauticsand Astronautics)AbstractBased on the Holzer method, a new efficiency dynamic modeling method of D-Holzer for multilink flexible manipulators is proposed by improving the assumed principle of modeling. The dynamic model of a two flexible link manipulator system is obtained w

3、ith this method, and then the dynamic simulation is done with the nonlinear modelKey words：Flexible manipulatorDynamic modelingNonlinearSimulation0前言机器人柔性臂是一个非常复杂的动力学系统，存在着严重的非线性。进行机器人柔性臂动力学问题的研究，其模型的建立是极其重要的。在柔性臂的建模上，其关键一点是对分布柔性的有限维近似。这些近似方法中，有当作分布参数系统1，3来处理的Rayleigh法、Ritz方法、Galerkin方法、假定模态法，还有当作集中

4、参数系统2，4来处理的Holzer法、Myklestad法、有限元素法等，其在建模的方法上各具特点。集中参数系统把弹性体分为几个元素，求各个元素的振动方程式，然后用矩阵集合起来，构成整体的振动方程。其对密度和质量不均匀的物体来说，是很有效的。而分布参数系统是把相对密度、质量比较均匀的系统作为研究对象来处理。如何对系统进行合理假设与近似处理使建模简单有效是目前机器人柔性臂动力学建模所机器人柔性臂动力学建模的D-Holzer法 欢迎您访问范.文,之.家需要解决的主要问题。针对柔性臂建模研究的现状，对柔性臂建模的Holzer法进行了完善，提出了改进的D-Holzer法。1系统的模化由于影响柔性臂动力

5、学系统的因素较多，充分考虑各种影响，建立能够准确反映系统实际情况的精确的动力学模型一般是不可能的，同时，在许多情况下，由于所建立的模型比较复杂，不便于进行动力学分析与控制的研究，所以在建模时要做许多的假设与合理的近似处理。正因为这些假设与近似处理手段的不同，才产生了各种独具特点的建模方法。1.1方法描述本文中，把集中弹性质量模型应用于柔性臂的建模。柔性臂是由驱动器驱动的关节和与此相结合的连杆构成的，在此，各个关节均为旋转关节，各个连杆的长度近似不变。原Holzer法2的处理方法是，首先，把臂杆分割成适当的区间，把分割后的各区间的质量二等分，做为各区间两头的集中质量来对待，即在臂的切断点存在集中

6、质量，并考虑集中质量间是无质量的弹性体。在Holzer法中，把这个集中质量称作站点(Station)，无质量的弹性部分称为弹性域(Field)。柔性机械臂是按照把散布的各个关节和集中质量与无质量的弹性体相结合的构造体而模型化的。连杆分割成几部分是根据所研究的机械臂的特点、控制的方法以及所需的模型的精确程度等问题参考来决定的。例如，在具有很强的柔性的大连杆柔性臂的情况下，为得到高精度的近似模型，就有必要取足够的分割数；反之，在柔性臂的关节部分，末端具有较大的质量，而连杆的质量相对很小的情况下，即使考虑一个连杆对应一个弹性域的话，也可以得到十分近似的模型。1.2D-Holzer法根据具体情况，对臂

7、杆均匀细长，末端具有较大的集中质量的柔性臂，我们考虑一个臂杆对应一个弹性域，而且将Holzer法中，对弹性域端部的站点的质量分配的质量均分原则变为按照绕驱动其转动的关节惯量相当的原则。对臂杆不均匀的柔性臂，我们将其适当地分成有限个区间，每个区间作为一个弹性域，对其两端的站点的质量分配也是按照绕驱动其转动的关节惯量相当的原则进行处理。通过下面的简单比较，可以看出，经过这样处理以后，不仅使柔性臂建模过程简单，而且可以得到十分近似的模型，使建模方法更为方便有效。本文将改进后的建模方法，称为D-Holzer法。1.3方法比较下面我们就通过图1和表，对动力学建模的Holzer法和改进以后的D-Holze

8、r法做一下比较，这样两种方法的原理和各自的优缺点就一目了然。图1（省）Holzer法与D-Holzer法的系统简化的描述表2种方法的比较把该柔性臂看作是具有两个关节、二个弹性域和二个站点的集中参数系统。关节1和关节2的转动惯量分别为Ia1和Ia2，转角分别为1、2。站点1和站点2的质量、惯性张量分别为m1、m2和Iz1、Iz2，相应的变形和扭转角分别用u1、1和u2、2来表示。弹性域1和弹性域2的长度分别为l10、l2，其弹性变形的刚度系数分别为E1I1和E2I2。站点1和关节2之间的距离用l11表示。系统做小变形假设。2.1坐标变换关系弹性域k(k=1，2)与站点k的关系描述见图3所示。从关

9、节1到基坐标的坐标变换关系为：从站点1到关节1的坐标变换为弹性域1没有变形的情况下11弹性域1有变形的情况下111关节2到站点1的坐标变换为站点2到关节2的坐标变换为弹性域2没有变形的情况下22弹性域2有变形的情况下222所以，站点1到基坐标的坐标变换为站点2到基坐标的坐标变换为(8)式中=1+1+2Q1=l10cos 1-u1sin(1+1)+l11cos +l2cos Q2=l10sin 1+u1cos(1+1)+l11sin +l2sin 2.2动力学模型的建立站点1的位置矢量站点2的位置矢量其速度分别为所以，系统的动能为系统的势能为虚功为耗散能为式中>0小的阻尼系数以上各式(13

10、)(16)代入Lagrange第二方程，经过复杂的推导和整理得到系统的动力学方程为式中m6×6正定、对称、时变的质量矩阵6×1包含哥氏力、离心力和弹< 欢迎您访问机器人柔性臂动力学建模的D-Holzer法(3) /p>                              性力等的变

11、量耦合矩阵F6×1外加力矩列矩p=,u系统的广义坐标动力学方程式(17)中m及中的元素的具体表达式参见文献5。3动力学仿真柔性臂的非线性动力学模型式(17)进一步可以写成对图2所示的一平面两柔性杆空间机器人操作臂进行动力学仿真。已知柔性臂系统的臂杆长度分别为l1=l2=2.0 m，l10=1.9 m，l11=0.1 m，集中质量分别为m1=2.0 kg，m2=200.0 kg，臂杆的弯曲刚度均为EI1=EI2=EI=200.0 N*m2，关节的转动惯量分别为Ia1=1.0 kg*m2，Ia2=0.5 kg*m2，站点1、站点2绕各自坐标系中心的转动惯量分别为Iz1=0.02 kg*m

12、2，Iz2=0.05 kg*m2，弹性阻尼系数=0.005。在给出两个关节的驱动力矩分别为M1=0.6 N*m(0t2 s)4结论从以往柔性臂建模方法的研究，可以发现，假定模态法是分布参数系统的建模方法，对密度、质量、弹性等分布比较均匀的系统的建模非常有效，但其边界条件的处理较为复杂。而有限元素法和Holzer法对密度、质量和弹性等不均匀的集中参数系统建模非常方便有效，而且有限元素法对边界条件处理简单。另外，有限元素法与Holzer法比较，其建模过程十分有利于计算机来完成，所给出的模型信息，便于对柔性臂进行计算机图形动态仿真。但假定模态法和有限元素法对于复杂的多自由度柔性臂系统，不仅建模有困难

13、，而且，得到以模型为基础的控制规则也不是现实的事情。而Holzer法对典型的集中参数系统的建模比有限元法更为简单方便，但也存在着模化误差较大、处理方法不够完善的问题。经过改进以后的D-Holzer法，不仅适合于密度、质量和弹性等不均匀的集中参数系统建模，而且，其对密度、质量、弹性等分布比较均匀的系统的建模也非常有效，并且使柔性臂 （机器人柔性臂动力学建模的D-Holzer法(4) 建模更加准确、方便。注释：国家航天863青年基金资助项目。作者简介丁希仑，男，工学博士，1967年9月出生，北京航空航天大学机器人研究所副教授。主要研究方向：机器人柔性臂动力学与控制、复杂动力学系统的模糊与智能控制。

14、作者单位：北京航空航天大学机器人研究所北京100083参考文献1Cetinkunt S, Ittoop B.Computer automated symbolic modeling of dynamics of robotic manipulators with flexible links. IEEE Transactions on Robotics and Automation, 1992,8(1)941052Konno A, Uchiyama M. Modeling of a flexible man- ipulator dynamics based on the Holzer's method. J.of Japan Robot Institute, 1994,12(7)102110283Meirovitch L, Stemple T.Hybrid equations of motion for flexible multibody systems using quasi coordinates. J.of Guidance, Control, and Dynamics, 1995,18(4)6786884Yoshika