单击此处编辑母版标题样式,单击此处编辑母版文本样式,第二级,第三级,第四级,第五级,*,第三章 工业机器人静力计算及动力学分析,1,第三章 工业机器人静力计算及动力学分析1,本章将首先讨论与机器人速度和静力有关的雅可比矩阵，然后介绍工业机器人的静力学问题和动力学问题。机器人是一个多刚体系统，像刚体静力平衡一样，整个机器人系统在外载荷和关节驱动力矩,(,驱动力,),作用下将取得静力平衡；也像刚体在外力作用下发生运动变化一样，整个机器人系统在关节驱动力矩,(,驱动力,),作用下将发生运动变化。在本章中，我们不涉及较深的理论，将通过深入浅出的介绍使读者对工业机器人在实际作业中遇到的静力学问题和动力学问题有一个最基本的了解，也为以后“工业机器人控制”等章的学习打下一个基础,。,2,本章将首先讨论与机器人速度和静力有关的雅可比矩阵，然后介绍工,3-1,工业机器人速度雅可比与速度分析,一、工业机器人速度雅可比,数学上雅可比矩阵,(Jacobianmatrix),是一个多元函数的偏导矩阵。,假设有六个函数，每个函数有六个变量，即,3,3-1工业机器人速度雅可比与速度分析3,也可写成,将其微分，得,也可简写成,式,(3-3),中,(6x6),矩阵叫,F/X,做雅可比矩阵,4,也可写成将其微分，得也可简写成式(3-3)中(6x6)矩阵叫,在工业机器人速度分析和以后的静力分析中都将遇到类似的矩阵，我们称之为机器人雅可比矩阵，或简称雅可比。,图,3-1,为二自由度平面关节机器人。端点位置,x,y,与关节,1,、,2,的关系为,5,在工业机器人速度分析和以后的静力分析中都将遇,6,6,7,7,我们将,J,称为图,3-1,所示二自由度平面关节机器人的速度雅可比，它反映了关节空间微小运动,d,与手部作业空间微小位移,dx,的关系。,若对式,(3-7),进行运算，则,2R,机器人的雅可比写为,从,J,中元素的组成可见，,J,阵的值是,l,及,2,的函数。,对于,n,自由度机器人的情况，关节变量可用广义关节变量，,q,表示,q=q,1,q,2,.qn,T,，节为转动关节时，,q,i,=,i,当关节为移动关节时，,q,i,=d,i,dq=dq,1,dq,2,dqn,T,反映了关节空间的微小运动，机器人末端在操作空间的位置和方位可用来端手爪的位姿,X,表示，它是关节变量占的函数,x=x(q),并且是一个,6,维列矢量,8,我们将J称为图3-1所示二自由度平面关节机器,反映了操作空间的微小运动，它由机器人末端微小线位移和微小角位移,(,微小转动,),组成。因此，式,(3-8),可写为,式中,J(q),是,6n,的偏导数矩阵，称为,n,自由度机器人速度雅可比矩阵。它的第,i,行第,j,列元素为,9,9,二、工业机器人速度分析,对式,(3-10),左、右两边各除以,dt,得,或,10,二、工业机器人速度分析或10,对于图,3-1,所示,2R,机器人来说，,J(q),是式,(3-9),所示的,22,矩阵。若令,J,1,、,J,2,分别为式,(3-9),所示雅可比的第一列矢量和第二列矢量，则式,(3-13),可写成,.,式中右边第一项表示仅由第一个关节运动引起的端点速度；右边第二项表示仅由第二个关节运动引起的端点速度，总的端点速度为这两个速度矢量的合成。因此，机器人速度雅可比的每一列表示其它关节不动而某一关节运动产生的端点速度。,图,3-1,所示二自由度机器人手部速度为,11,对于图3-1所示2R机器人来说，J(q)是式,假如已知关节上,1,及,2,是时间的函数,1,=f,1,(t),2,=f,2,(t),则可求出该机器人手部在某一时刻的速度,y=r(Z),即手部瞬时速度。,反之,假如给定机器人手部速度,可由式,(3-13),解出相应的关节速度,:,12,假如已知关节上 1及 2是时间的函数 1=f,式中：,J,-l,称为机器人逆速度雅可比。,式,(3-14),是一个很重要的关系式。例如，我们希望工业机器人手部在空间按规定的速度进行作业，那么用式,(3-14),可以计算出沿路径上每一瞬时相应的关节速度。但是，一般来说，求逆速度雅可比,J,-1,是比较困难的，有时还会出现奇异解，就无法解算关节速度。,通常我们可以看到机器人逆速度雅可比,J,-l,出现奇异解的两种情况：,(1),工作域边界上奇异。当机器人臂全部伸展开或全部折回而使手部处于机器人工作域的边界上或边界附近时，出现逆雅可比奇异，这时机器人相应的形位叫做奇异形位。,(2),工作域内部奇异。奇异并不一定发生在工作域边界上，也可以是由两个或更多个关节轴线重合所引起的。,13,式中：J-l称为机器人逆速度雅可比。13,当机器人处在奇异形位时，就会产生退化现象，丧失一个或更多的自由度。这意味着在空间某个方向,(,或子域,),上，不管机器人关节速度怎样选择手部也不可能实现移动。,例,3-1,如图,3-2,所示二自由度机械手，手部沿固定坐标系,X0,轴正向以,1.0m/s,速度移动，杆长为,l,1,=l,2,=0.5m,。设在某瞬时,1,=,，,2,=-,，求相应瞬时的关节速度。,14,当机器人处在奇异形位时，就会产生退化现象，丧失一个或更多的自,15,15,奇异讨论：从式,(3-15),知，当,l,1,l,2,s,2,=0,时，式,(3-15),无解。当,即,2,=0,或,2,=180,。时,二自由度机器人逆速度雅可比,J,-1,奇异。这时，该机器人二臂完全伸直，或完全折回，机器人处于奇异形位。在这种奇异形位下，手部正好处在工作域的边界上,手部只能沿着一个方向,(,即与臂垂直的方向,),运动，不能沿其它方向运动，退化了一个自由度。,对于在三维空间中作业的一般六自由度工业机器人的情况，机器人速度雅可比,J,是一个,6X6,矩阵，在和,q,分别是,61,列阵，即,v,(6x1),=J(q),(6x6),q,(6x1),。手部速度矢量,y,是由,31,线速度矢量和,3X1,角速度矢量组合而成的,6,维列矢量。关节速度矢量生是由,6,个关节速度组合；而成的,6,维列矢量。雅可比矩阵,J,的前三行代表手部线速度与关节速度的传递比；后三行代表手部角速度与关节速度的传递比。而雅可比矩阵,J,的每一列则代表相应关节速度,q,i,对手部线速度和角速度的传递比。,16,奇异讨论：从式(3-15)知，当l1l2s,3-2,工业机器人力雅可比与静力计算,机器人作业时与外界环境的接触会在机器人与环境之间引起相互的作用力和力矩。机器辈人各关节的驱动装置提供关节力矩,(,或力,),，通过连杆传递到末端操作器，克服外界作用力和力摩矩,5,各关节的驱动力矩,(,或力,),与末端操作器施加的力,(,广义力，包括力和力矩,),之间的关系是机，因器人操作臂力控制的基础。本节讨论操作臂在静止状态下力的平衡关系。我们假定各关节“锁住”，机器人成为一个机构。这种“锁定用”的关节力矩与手部所支持的载荷或受到外界环境作用的力取得静力平衡。求解这种“锁定用”的关节力矩，或求解在已知驱动力矩作用下手部的输卡出力就是对机器人操作臂的静力计算。,一、操作臂中的静力胁这里以操作臂中单个杆件为例分析受力情况，如图,3-3,所示，杆件,i,通过关节,i,和,i+1,别与杆件,i-1,和,i+1,相连接,两个坐标系,i-1,和,i,分别如图所示。,17,3-2工业机器人力,18,18,19,19,假如己却才卡界环境对机器人最末杆的作用力和力矩，那么可以由最后一个连杆向零连杆,(,机座,),依次递推，从而计算出每个连杆上的受力情况。,为了便于去示机器人手部端点的力和力矩,(,简称为端点力,F),，可将,f,n,n+1,和,n,n,n+l,合并写一个,6,维矢量：,各关节驱动器驱动力或力矩可写成一个,n,维矢量的形式，即,20,假如己却才卡界环境对机器人最末杆的作用力和力,式中：,n,关节的个数,关节力矩（或关节力）矢量，简称广义关 节力矩,对于转动关节,i,表示关节驱动力矩，对于移动关节,i,表示关节驱动力。,二、机器人力雅可比,假定关节无摩擦，并忽略各杆件的重力，则广义关节力矩,与机器人手部端点力,F,的关系可用下式描述,：,=J,T,F (3-20),式中,J,T,为,n6,阶机器人力雅可比矩阵或力雅可比。,21,式中：n关节的个数21,22,22,上式可用下述虚功原理证明：,证明 考虑各个关节的虚位移为,q,i,，末端操作器的虚位移为,x,，如图,3-4,所示。,式中，,d=dx,dydz,T,和,=,x,y,z,分别对应于末端操作器的虚线位移；,q,为由各关节虚位移在,q,组成的机器人关节虚位移矢量。,假设发生上述虚位移时，各关节力矩为,i,(I=1,2,n),，环境作用在机器人手部端点上的力和力矩分别为,-,f,n,n+1,和,n,n,n+,l,。,由上述力和力矩所做的虚功可以由下式求出,:,23,上式可用下述虚功原理证明：式中，d=dx,24,24,三、机器人静力计算的两类,问题,i,从操作臂手部端点力,F,与广义关节力矩,之间的关系式,=J,T,F,可知，操作臂静力计算可分为两类问题：,(1),已知外界环境对机器人手部作用力,(,即手部端点力,F,=-),求相应的满足静力,1,平衡条件的关节驱动力矩,。,(2),已知关节驱动力矩,，确定机器人手部对外界环境的作用力,F,或负荷的质量。,这类问题是第一类问题的逆解。这时,F=(J,T,),-1,但是，由于机器人的自由度可能不是,6,，比如扫,6,，力雅可比短阵就有可能不是一个方阵，则,J,T,就没有逆解。所以，对这类问题的求解就困难得多，在一般情况下不一定能得到唯一的解。如果,F,的维数比,的维数低，且,J,是满秩的话，则可利用最小二乘法求得,F,的估值。,25,三、机器人静力计算的两类 但是,例,3-2,由图,3-5,所示的一个二自由度平面关节机械手，已知手部端点力,F=F,x,F,y,T,，求相应于端点力万的关节力矩（不考虑摩擦）。,26,例 3-2 由图3-5所示的一个二自由,27,27,3-3,工业机器人动力学分析,随着工业机器人向重载、高速、高精度以及智能化方向的发展，对工业机器人设计和控制都提出了新的要求。特别是在控制方面，机器人的动态实时控制是机器人发展的必然要求。因此，需要对机器人的动力学进行分析。机器人是一个非线性的复杂的动力学系统。动力学问题的求解比较困难，而且需要较长的运算时间。因此，简化解的过程，最大限度地减少工业机器人动力学在线计算的时间是一个受到关注的研究课题。,动力学研究物体的运动和作用力之间的关系。机器人动力学问题有两类：,(1),给出已知的轨迹点上的,、,及,即机器人关节位置、速度和加速度，求相应的关节力矩向量,。这对实现机器人动态控制是相当有用的。,(2),已知关节驱动力矩，求机器人系统相应的各瞬时的运动。也就是说，给出关节力矩向,28,3-3工业机器人动力学分析28,量,求机器人所产生的运动,、及,。这对模拟机器人的运动是非常有用的。,分析模拟机器人动力学特性的方法很多，有拉格朗日,(Lagrange),方法，牛顿,-,欧拉,(NewtonEuler),方法，高斯,(Gauss),方法，凯恩,(Kane),方法等。拉格朗日方法不仅能以最简单的形式求得非常复杂的系统动力学方程，而且具有显式结构，物理意义比较明确，对理解机器人动力学比较方便。因此，本节只介绍拉格朗日方法，而且用简单实例进行分析。,一、拉格朗日方程,1.,拉格朗日函数,拉格朗日函数,L,的定义是一个机械系统的动能,E,k,和势能,E,p,之差,即,L=E,k,一,E,p,(3-24),令，,q,i,(i=1,2,.n),是使系统具有完全确定位置的广义关节变量，,q,i,是相应的广义关节速度。由于系统动能,E,k,是,q,i,和,i,的函数，系统势能,E,q,和,q,i,的函数，因此拉格朗日函数也是,q,i,和,i,的函数。,29,量,求机器人所产生的运动 、及,2.,拉格朗日方程,系统的拉格朗日方程为,式中,F,i,