第5章机器人控制技术微分变换14993

单击此处编辑母版标题样式,单击此处编辑母版文本样式,第二级,第三级,第四级,第五级,*,*,第五章 微分变换,Chapter Differential Relationships,5.1 引言,5.2,微分矩阵,5.3,微分平移和旋转变换,5.4,微分旋转,5.5,坐标系之间的微分变换,5.6,机械手的微分变换方程 雅可比方程,5.7,雅可比逆矩阵,5.8,本章小结,10/1/2024,1,5.1 引言,（Introduction）,微分变换在机器人视觉、动力学和机器人控制（如力控、刚度控制、阻抗控制、顺应控制等）中十分重要。例如当摄像机或其它传感装置检测到机器人末端执行器的位置和方向的微小变化时，需要将该微小变化从摄像机或其它传感装置坐标转换到基坐标或参考坐标系。在机器人刚度控制中，需要获得在控制坐标系中力与位置的微分变换。又如将直角坐标的微分变换转化为关节坐标的微分变换，还有在下一章介绍的机器人动力学问题时，也会用到微分变换。本章将介绍微分变换的基本原理和方法，包括微分平移、微分旋转、坐标系之间的微分变换、雅可比矩阵和逆雅可比矩阵及其应用。,10/1/2024,2,5.2 微分矩阵,（Derivative Matrixes）,给出一个44的矩阵A,（5.1）,矩阵A的微分就是对矩阵A中的每一个元素对自变量x的微分，结果如下,（5.2）,10/1/2024,3,5.3 微分平移和旋转变换,(Differential Translation and Rotation),微分平移和旋转变换可以是针对基坐标或参考坐标系，也可以是针对某个指定的坐标系进行。例如对于一个变换矩阵,T,，它对基坐标的微分变换可表示为,（5.3）,式中是在基坐标的,x,，,y,，,z,轴向上分别平移,dx,，,dy,，,dz,；和绕基坐标的向量,k,旋转,d,角。由此可得到,（5.4）,如果上述微分变换不是针对基坐标而是针对坐标系,T,，那么微分变换的结果可表示为,（5.5）,此时，式中 是在,T,坐标的,x,，,y,，,z,轴向上分别平移,dx,，,dy,，,dz,；是绕,T,坐标的向量,k,旋转,d,角。由此可得到,（5.6）,10/1/2024,4,我们用符号 来表示式（5.4）和式（5.6）中的 并将它称为微分变换算子,（5.6）,这样式（5.4）和式（5.6）就可写成如下形式,（5.7）,和 （5.8）,式（5.7）中的微分变换算子 是针对基坐标的，而式（5.8）中的微分变换算子 则是针对,T,坐标的。,在第二章我们给出了平移和一般性旋转变换的齐次变换矩阵表达式，平移变换矩阵是,1 0 0,a,0 1 0,b,Trans(,a,b,c,)=0 0 1,c,（5.9）,0 0 0 1,10/1/2024,5,当平移向量是微分向量d,dxi+dyj+dzk,时，微分平移矩阵为,1 0 0,dx,0 1 0,dy,Trans(,d,)=0 0 1,dz,（5.10）,0 0 0 1,一般性旋转变换的变换矩阵是,kxkxvers+cos kykxvers-kzsin kzkxvers+kysin,0,kxkyvers+kzsin kykyvers+cos kzkyvers-kxsin,0,Rot(,k,)=,kxkzvers-kysin kykzvers+kxsin kzkzvers+cos,0 (5.11),0 0 0 1,当进行微分旋转变换时，旋转角,d,极小，此时有如下关系,10/1/2024,6,将上述关系代入式（5.11）可得,1,-kzd kyd,0,kzd,1,-kxd,0,Rot(,k,d,)=,-kyd kxd,1 0 (5.12),0 0 0 1,由式（5.6）可得,(5.13),10/1/2024,7,5.4 微分旋转,(Differential Rotations),式（5.13）给出的微分变换算子 是基于微分旋转角,d,的微分平移和旋转变换表达式，下面讨论绕坐标轴x、y、z旋转,x,、,y,、,z,的微分变换。,第二章给出的绕坐标轴x、y、z旋转的变换矩阵分别为,（5.14）,（5.15）,（5.16）,10/1/2024,8,在微分变换的情况下，,sin,d,，con,1，,上面三个式子变为,（5.17）,（5.18）,（5.19）,由此可得到,（5.20）,10/1/2024,9,比较式（5.12）和式（5.20）可知，绕任意向量,k,旋转,d,的微分旋转与绕x、y、z轴分别旋转 的结果相同，即,（5.21）,由此可得到绕坐标轴x、y、z旋转,x,、,y,、,z,的微分变换算子为,（5.22）,微分变换算子中的元素由微分平移向量,d,和微分旋转向量,的各个分量组成，即,（5.23）,（5.24）,将上述二个向量组合构成一个微分运动矢量D,（5.25）,这样，我们就可根据式（5.25）给出的微分运动矢量D直接得到微分变换算子 ，或基于,T,坐标的微分运动矢量 的微分变换算子 。,10/1/2024,10,【例5.1】已知坐标A的变换矩阵为,当用微分平移矢量,d,=1,i,+0,j,+0.5,k,和微分旋转矢量,0,i,+0.1,j,+0,k,对坐标A 进行变换时，求出微分变换的结果,dA,。,解：首先，由式（5.22）求出微分变换算子,由式（5.7）可得,即,微分变换结果如图5.1所示。,x,y,z,z,A,y,A+dA,x,图5.1 坐标A的微分变换,10/1/2024,11,5.5 坐标系之间的微分变换,(Transforming Differential Changes between Coordinate Frames),上节讨论了基于基坐标或某个指定坐标的微分变换，本节继续讨论坐标系之间的微分变换，也就是已知微分变换算子 ，如何求出T坐标的微分变换算子 。由式（5.7）和（5.8）可知,（5.26）,则为 （5.27）,上式是一个重要的表达式，它描述了坐标系之间的微分变换关系。下面我们用微分平移矢量,d,和微分旋转矢量 来推导 的表达式。,已知变换矩阵T为,10/1/2024,12,我们用矢量的叉乘来得到式（5.27）等号右边二项的乘积,（5.29）,式中,d,和 分别是微分平移和微分旋转矢量。用 左乘式（5.29）可得,（5.30）,上式矩阵元素都具有如下矢量三重积形式,根据矢量三重积的性质有,（5.31）,10/1/2024,13,同时，三重积中只要有二个矢量是相同的，其结果为零。如,（5.32）,根据上述性质，式（5.30）可写成,（5.33）,对于正交矢量有,（5.34）,这样，式（5.33）可重写成,（5.35）,10/1/2024,14,上式可进一步简化为,（5.36）,比较式（5.35）和式（5.36）的矩阵元素可得,（5.37）,（5.38）,在式（5.37）和式（5.38）中，,n,、,o,、,a,和,p,是微分坐标变换矩阵T的旋转和平移矢量，和 是对应坐标T的微分平移和旋转矢量。,10/1/2024,15,式（5.37）和式（5.38）也可用66的矩阵形式表示如下,（5.39）,将上式写成式（5.36）和式（5.37）的形式如下,（5.40）,（5.41）,式（5.40）和式（5.41）是后续内容中要经常用到的重要结果。,10/1/2024,16,【例5.2】给出与例5.1相同的坐标的变换矩阵、微分平移矢量和微分旋转矢量如下：,d,=1,i,+0,j,+0.5,k,0,i,+0.1,j,+0,k,试求出坐标,A,上的等效微分变换,dA,。,解：由坐标变换矩阵,A,可得到相应的旋转与平移矢量,由此可求出,根据式（5.40）和式（5.41）得到,10/1/2024,17,用上述结果来验证坐标,A,上的等效微分变换,dA,，由式（5.8）有,由已求出的 、和式（5.36）可得到,则,上述结果与例5.1相同。,10/1/2024,18,5.6 机械手的微分变换方程雅可比方程,（The Manipulator Jacobian）,在第三章我们介绍过，机械手的运动学方程由它的末端相对于基坐标的齐次变换矩阵T,6,表示，即,T,6,=A,1,A,2,A,3,A,4,A,5,A,6,（5.42）,其中每一个关节变换矩阵A,i,描述了该关节坐标相对于前一个关节坐标的变换关系，关节变量用,q,i,表示，如果是旋转关节，关节变量是,i,，它是绕前一个关节坐标z轴的旋转角度；如果是滑动关节，关节变量是,d,i,，它是沿前一个关节坐标z轴滑动的距离。同样，当我们讨论机械手的微分变换方程时，首先定义微分关节变量为,dq,i,，如果是旋转关节，则为,d,i,，如果是滑动关节，则为,dd,i,。,10/1/2024,19,机械手第,i,个关节的微分变换引起第6个连杆末端（即机械手末端）的微分变换,dT,6,可由下式表示：,（5.43）,则,（5.44）,由式（5.27）可得到机械手末端的微分变换算子,（5.45）,其中,（5.46）,如果关节,i,是旋转关节，则,d,i,=0，式（5.40）和式（5.41）变为,（5.47）,（5.48）,10/1/2024,20,当 ，为单位微分旋转矢量时，式（5.47）和（5.48）可进一步简化为,（5.49）,（5.50）,如果关节,i,是棱形滑动关节，则,i,0，,d,i,=,0,i,+0,j,+1,k,，式（5.40）和式（5.41）变为,（5.51）,（5.52）,机械手末端坐标,T,6,的微分变换是所有6个关节微分变量的函数，可用66的矩阵表示，矩阵元素由6个关节的微分平移和微分旋转矢量构成，该矩阵称为雅可比矩阵。它的每一列元素为对应关节的微分平移和微分旋转矢量。应用雅可比矩阵的机械手微分变换方程雅可比方程如下：,（5.53）,10/1/2024,21,5.7 雅可比逆矩阵,（The Inverse Jacobian）,当微分变换是由直角坐标空间向关节坐标空间进行时，由式（5.53）可得到,（5.72）,上式等号右边矩阵是雅可比逆矩阵。显然，用符号运算来得到雅可比逆阵是很困难的，因为微分变换要进行大量算术运算，同时当机械手出现退化时，其结果会出错。,为此，我们采用第四章介绍的根据,T,6,的值计算关节坐标值的方法和步骤来计算微分关节坐标值。将关节坐标的微分变换表示为,dT,6,中各元素的函数，然后求出各关节的微分变换值。该方法相对比较简单，而且在机械手出现退化时，将相应关节的微分变换值设置为零，这就不会影响后续关节的计算结果。在后面的讨论中，我们假设机械手的符号解存在，而且关节变量的正弦和余弦值已知。,10/1/2024,22,为了计算,dT,6,我们首先根据式（5.37）和式（5.38）对,T,6,进行微分变换得到微分平移矢量 和微分旋转矢量 ，然后根据式（5.22）求出 ，最后根据式（5.8）得到,dT,6,。,下面通过对第四章介绍的斯坦福机械手逆运动学解的微分变换来说明上述方法的具体步骤。,由第四章式（4.15）有,S,1,p,x,C,1,p,y,=d,2,（5.73）,对式（5.73）求导可直接得到第一个关节变量,1,的微分,（5.74）,对于正切函数,（5.75）,其微分公式为,（5.76）,10/1/2024,23,由第四章式（4.24）和式（4.25）有,（5.77）,（5.78）,对式（5.77）和式（5.78）求微分得到,（5.79）,（5.80）,由公式（5.76）可得到第二个关节变量,2,的微分,（5.81）,将式（5.77）代入第四章的式（4.31）有,（5.82）,对式（5.82）进行微分可直接得到第三个滑动关节变量,d,3,的微分,（5.83）,10/1/2024,24,由第四章式（4.38）和式（4.39）有,NS,4,=,S,1,a,x,C,1,a,y,（5.84）,NC,4,=,C,2,D,41,S,2,a,z,（5.85）,其中,D,41,=,C,1,a,x,S,1,a,y,（5.86）,对式（5.84）式（5.86）进行微分得