机器人雅可比矩阵2

,单击此处编辑母版标题样式,*,单击此处编辑母版文本样式,第二级,第三级,第四级,第五级,4.1.,1,雅可比矩阵,两空间之间速度的,线性映射关系,雅可比矩阵（简称,雅可比,）。它可以看成是从关节空间到操作空间运动速度的,传动比,，同时也可用来表示两空间之间,力的传递关系。,v,x,v,y,存在怎样的关系,第四章 机器人雅可比,4.1微分变换与雅可比矩阵,首先来看一个两自由度的平面机械手，如图3-17所示。,图3-17 两自由度平面机械手,容易求得,将其微分得,写成矩阵形式,假设关节速度为 ，手爪速度为 。,简写成：,dx=Jd,。,式中,J,就称为机械手的雅可比（,Jacobian）,矩阵,，它由函数,x，y,的偏微分组成，反映了关节微小位移,d,与手部（手爪）微小运动,dx,之间的关系。,对,dx=Jd,两边同除以,dt，,得,可以更一般的写成 。,因此机械手的雅可比矩阵定义为它的操作空间速度与关节空间速度的线性变换。,（或,v）,称为手爪在操作空间中的广义速度，简称操作速度，为关节速度。,J,若是,6n,的偏导数矩阵，它的第,i,行第,j,列的元素为：,式中，,x,代表操作空间，,q,代表关节空间。,若令,J,1,，J,2,分别为上例中雅可比矩阵的第一列矢量和第二列矢量，即,可以看出，,雅可比矩阵的每一列表示其它关节不动而某一关节以单位速度运动产生的端点速度。,由 ，可以看出，,J,阵的值随手爪位置的不同而不同，即,1,和,2,的改变会导致,J,的变化。,对于关节空间的某些形位，机械手的雅可比矩阵的秩减少，这些形位称为操作臂（机械手）的,奇异形位。,上例机械手雅可比矩阵的行列式为：,det(J)=,l,1,l,2,s,2,当,2,=0,或,2,=180,时，机械手的雅可比行列式为0，矩阵的秩为1，因此处于奇异状态。在奇异形位时，,机械手在操作空间的自由度将减少。,只要知道机械手的雅可比,J,是满秩的方阵，相应的关节速度即可求出，即 。,上例平面2,R,机械手的逆雅可比,于是得到与末端速度 相应的关节速度：,显然，当,2,趋于0（或180）时，机械手接近奇异形位，相应的关节速度将趋于无穷大。,4.1.,2,微分变换,为了补偿机器人,末端执行器位姿与目标物体之间的误差,，以及解决,两个不同坐标系之间的微位移关系,问题，需要讨论机器人杆件在作微小运动时的位姿变化。,一.变换的微分,假设一变换的元素是某个变量的函数，对该变换的微分就是,该变换矩阵各元素对该变量的偏导数所组成的变换矩阵乘以该变量的微分,。,若它的元素是变量,x,的函数，则变换,T,的微分为:,例如给定变换,T,为：,二.微分运动,所以得,设机器人某一杆件相对于基坐标系的位姿为,T，,经过微运动后该杆件相对基坐标系的位姿变为,T+dT，,若这个微运动是,相对于基坐标系（静系）进行的(左乘),，,总可以用微小的平移和旋转来表示，即,根据齐次变换的相对性，若微运动是,相对某个杆件坐标系,i（,动系）进行的(右乘),，,则,T+dT,可以表示为,则相对基系有,dT=,0,T，,相对,i,系有,dT=T,i,。,这里,的下标不同是由于微运动相对不同坐标系进行的。,所以得,令 为微分算子,三.微分平移和微分旋转,由于微分旋转,0，,所以,sind，cos1，Vers0，,将它们代入旋转变换通式,(p27),中得微分旋转表达式:,微分平移变换与一般平移变换一样，其变换矩阵为:,于是得微分算子,四.微分旋转的无序性,当,0,时，有,sind，cos1,若令,x=d,x,，y=d,y,，z=d,z,，,则绕三个坐标轴,(p16),的微分旋转矩阵分别为,略去高阶无穷小量,两者结果相同，可见这里,左乘与右乘等效,。,同理可得,结论：,微分旋转其结果与转动次序无关，这是与有限转动（一般旋转）的一个重要区别。,若,Rot（x，y，z）,和,Rot（x，y，z）,表示两,个不同的微分旋转，则两次连续转动的结果为：,上式表明：,任意两个微分旋转的结果为绕每个轴转动的元素的代数和，即微分旋转是可加的。,k,x,d=x,，,k,y,d=y,，,k,z,d=z,所以有,由等效转轴和等效转角与 等效，有,即,将它们代入,得,因此,可以看成由 和 两个矢量组成，叫,微分转动矢量,，叫,微分平移矢量,。分别表示为,和 合称为,微分运动矢量,，可表示为,解：,例：已知一个坐标系,A，,相对固定系的微分平移矢量 ，微分旋转矢量 ，求微分变换,dA。,五.两坐标系之间的微分关系,因为,将它们代入前面的方程,现在讨论,i,系和,j,系之间的微分关系。不失一般性，假定,j,系就是固定系（基系）,0,系。,整理得到：,得,其中,上式简写成,对于任何三维矢量 ，其反对称矩阵 定义为：,相应地，任意两坐标系,A,和,B,之间广义速度的坐标变换为：,例：,知坐标系,A,及相对于固定系的微分平移矢量 ，微分旋转矢量 ，求,A,系中等价的微分平移矢量,d,A,和微分旋转矢量,A,。,解：,因为已知 ，可以根据前面的公式求得,d,A,和,A,。,也可根据与它一样的另一组表达式（写法不同）求解，即,求得 ，,代入,4.2,机器人的静力学,机器人与外界环境相互作用时，在接触的地方要产生力 和力矩，统称为,末端广义（操作）力矢量,。记为,n,个关节的驱动力（或力矩）组成的,n,维矢量,称为关节力矢量,y,0,x,0,存在怎样的关系,利用虚功原理，令各关节的虚位移为,q,i,，,末端执行器相应的虚位移为,D。,根据虚位移原理，各关节所作的虚功之和与末端执行器所作的虚功应该相等，即,简写为:,又因为,所以得到 与 之间的关系,式中 称为,机械手的力雅可比。它表示在静态平衡状态下，操作力向关节力映射的线性关系。,若,J,是,关节空间,向,操作空间,的映射（微分运动矢量），则 把,操作空间的广义力矢量,映射到,关节空间的关节力矢量,。,关节空间,操作空间,雅可比,J,力雅可比,J,T,若已知,则有,T,0,0,T,B,A,A,B,J,T,J,根据前面导出的两坐标系,A,和,B,之间广义速度的坐标变换关系，可以导出,A,和,B,之间广义操作力的坐标变换关系。,解：,由前面的推导知,例:,如图3-18所示的平面2,R,机械手，手爪端点与外界接触，手爪作用于外界环境的力为 ，若关节无摩擦力存在，求力 的等效关节力矩 。,所以得：,图3-18 关节力和操作力关系,y,0,x,0,例：如图所示的机械手夹扳手拧螺丝，在腕部（,Os）,装有力/力矩传感器，若已测出传感器上的力和力矩 ，求这时作用在螺钉上的力和力矩 。,(),解：根据图示的相应位姿关系得,因此可得两坐标系的微分运动关系和静力传递关系为：,S,T,S,T,微分运动关系时：,静力传递关系时：,4.3.,1Lagrange,动力学,对于任何机械系统，拉格朗日函数,L,定义为系统总的动能,K,与总的势能,P,之差，即,L=K-P。,这里，,L,是拉格朗日算子；,k,是动能；,P,是势能。,或,利用,Lagrange,函数,L，,系统的动力学方程（称为第二类,Lagrange,方程）为：,表示动能，表示势能。,4.3,机器人的动力学,例：平面,RP,机械手如图所示，连杆1和连杆2的质量分别为,m,1,和,m,2,，,质心的位置由,l,1,和,d,2,所规定，惯性张量为（,z,轴垂直纸面）：,解：,连杆1，2的动能分别为：,机械手总的动能为,连杆1，2的势能分别为,机械手总的位能（势能）为,计算各偏导数,将以上结果代入,Lagrange,方程 得,附：就前面的1自由度机械手用,Lagrange,法求解如下：,总势能为,代入,Lagrange,方程 得 ，与前面的结,果一致。这里,I=I,Z,=I,C,+mL,2,C,解：,总动能（,为广义坐标）,z,mg,.,若1自由度机械手为匀质连杆，质量为,m,，长度为,L,，结果会怎样？,.,若1自由度机械手为集中质量连杆，长度为,L,，集中质量,m,在连杆末端,L,处，结果会怎样？,z,Class is over.Bye-bye!,