齐次变换矩阵及其运算课件

上海电机学院 机械学院,*,单击此处编辑母版标题样式,单击此处编辑母版文本样式,第二级,第三级,第四级,第五级,机器人学基础,齐次变换矩阵及其运算,齐次变换矩阵及其运算,由于各种原因，变换矩阵应写成方型形式，,3*3,或,4*4,均可,.,为保证所表示的矩阵为方阵，如果在同一矩阵中既表示姿态又表示位置，那么可在矩阵中加入比例因子使之成为,4*4,矩阵。,上海电机学院 机械学院,变换可定义为空间的一个运动。,已知一直角坐标系中的某点坐标，那么该点在另一直角坐标系中的,坐标可通过齐次坐标变换来求得。,变换可分为如下形式：,纯平移,纯旋转,平移与旋转的结合,上海电机学院 机械学院,1.,平移的齐次变换,空间某一点在直角坐标系中的平移,由,A,(,x,y,z,),平移至,A,(,x,y,z,),即,a,=Trans(,x,y,z,),a,平移算子,上海电机学院 机械学院,算子左乘,:,表示点的平移是相对固定坐标系进行的坐标变换。,算子右乘,:,表示点的平移是相对动坐标系进行的坐标变换。,该公式亦适用于坐标系的平移变换、物体的平移变换,如机器人手部的平移变换。,上海电机学院 机械学院,例 动坐标系,A,相对于固定坐标系的,X0,、,Y0,、,Z0,轴作,(-1,2,2),平移后到,A,；动坐标系,A,相对于自身坐标系,(,即动系,),的,X,、,Y,、,Z,轴分别作,(-1,2,2),平移后到,A,。已知,A,写出坐标系,A,、,A,上海电机学院 机械学院,2,旋转的齐次变换,点在空间直角坐标系中的旋转如图所示。,A,(,x,y,z,),绕,Z,轴旋转,角后至,A,(,x,y,z,),则,A,与,A,之间的关系为：,记为,:,a,=Rot(,z,),a,旋转算子,上海电机学院 机械学院,同理，绕,x,轴、,Y,轴旋转算子内容为：,绕,Z,轴旋转算子内容为：,上海电机学院 机械学院,如图所示单操作手臂，并且手腕也具有一个旋转自由度。已知手部的起始位姿矩阵为,G1.,若手臂绕,Z0,轴旋转,90,，则手臂到达,G2,；若手臂不动，仅手部绕手腕,Z1,轴转,90,，则手部到达,G3.,写出手部坐标系,G2,、,G3,表达式。,上海电机学院 机械学院,上海电机学院 机械学院,3,复合齐次变换,复合变换是由固定参考坐标系或当前运动坐标系的一系列沿轴平移和绕轴旋转变换所组成的。任何变换都可以分解为按一定顺序的一组平移和旋转变换。,相对于固定坐标系,相对于动坐标系,算子左乘,算子右乘,上海电机学院 机械学院,已知坐标系中点,U,的位置矢量 ，将此点绕,Z,轴旋转,90,，再绕,Y,轴旋转,90,，如图所示，求旋转变换后所得的点,W,。,上海电机学院 机械学院,平移变换和旋转变换可以组合在一个齐次变换中。上例中点,U,若还要作,4i-3j+7k,的平移，则只要左乘上平移变换算子即可得到最后的列阵表达式。,上海电机学院 机械学院,上海电机学院 机械学院,齐次变换矩阵 的数学意义：,（,1,）同一点在不同坐标系,B,和,A,中的变换；,（,2,）描述坐标系,B,相对于坐标系,A,的位置和方位；,（,3,）点的运动算子。,上海电机学院 机械学院,4,变换矩阵相乘,对于给定的坐标系,A,、,B,、,C,，已知,B,相对,A,的描述为 ，,C,相对,B,的描述为 ，则,。,从而定义复合变换,表示,C,相对于,A,的描述，是两变换矩阵的乘积。,注意：变换矩阵相乘不满足“交换律”，变换矩阵的左乘和右乘的运动解释不同。,上海电机学院 机械学院,复合变换可解释为：,(1),和 分别代表同一坐标系,C,相对于,A,和,B,的描述。则,表示坐标系,C,从 映射为 的变换。,(2),坐标系,C,相对于,A,的描述 是这样得到的：最初,C,与,A,重合，首先相对于,A,作运动 ，到达,B,然后相对,B,作运动 ，到达最终位置,C,。,上海电机学院 机械学院,5.,变换矩阵求逆,如果知道坐标系,B,相对于,A,的描述。希望得到,A,相对于,B,的描述，这是个齐次变换求逆问题。,对,4*4,矩阵直接求逆；,利用齐次变换矩阵的特点，简化矩阵求逆运算。,求逆问题可以描述为：已知 ，求解 。,利用旋转矩阵正交性,利用复合变换公式,(2.13),求出 在,B,中描述。,上海电机学院 机械学院,上海电机学院 机械学院,下面我们写出变换矩阵的一般表达形式,n,x,o,x,a,x,p,x,n,y,o,y,a,y,p,y,T=n,z,o,z,a,z,p,z,0 0 0 1,式中,n,o,a,是旋转变换列向量，,p,是平移向量，其逆是,n,x,n,y,n,z,-,p,.,n,o,x,o,y,o,z,-,p,.,o,T,-,1,=a,x,a,y,a,z,-,p,.,a,0 0 0 1,式中的“.”表示向量的点积。,上海电机学院 机械学院,计算,T,矩阵的逆矩阵。,-0.5,上海电机学院 机械学院,6,变换方程,为了描述机器人的操作，必须建立机器人本身各连杆之间，机器人与周围环境之间的运算关系。为此要规定各种坐标系来描述机器人与环境的相对位姿关系。,B,代表基座坐标系；,W,代表腕部坐标系；,T,代表工具坐标系；,S,代表工作站坐标系；,G,代表目标坐标系；,它们之间的位姿关系用相应,的齐次变换来描述。,描述工作站坐标系相对于基座的位姿；,描述目标坐标系相对于,S,的位姿；,描述腕部,W,相对于基座,B,的位姿；,上海电机学院 机械学院,对物体进行操作时，工具坐标系,T,相对于目标坐标系,G,的位姿 直接影响操作效果。它是机器人控制和规划的目标。,实际上，它与其他变换之间的关系类似于空间尺寸链，,则是封闭环。如图所示，工具坐标系,T,相对于基座坐标系,B,的描述可用两种变换矩阵的乘积来表示：,令上面两式相等，则得变换方程,上海电机学院 机械学院,变换方程中的任一变换矩阵都可用其余的变换矩阵来表示。例如，为了对目标物进行有效操作，工具坐标系,T,相对于目标坐标系,G,的位姿 是预先规定的，需要改变 以达到这一目的，即通常规定 ，求 。,根据变换方程，可以立即求出,上海电机学院 机械学院,旋转变换通式,令,是过原点的单位矢量，求绕,k,旋转,角的旋转矩阵,R(,k,),。,问题描述：,令,即,R(,k,),表示坐标系,B,相对于参考系,A,的方位。,坐标系,B,由坐标系,A,绕 轴旋转 角得到。,k,A,上海电机学院 机械学院,x,A,y,A,z,A,x,B,y,B,z,B,旋转变换通式,再定义两坐标系,A,和,B,，分别与,A,和,B,固接，但要求,(1),A,和,B,的,z,轴与,k,重合,。,(2),旋转之前,A,和,B,重合，,A,和,B,也重合。,上海电机学院 机械学院,又因为,所以可以得到：,坐标系,B,绕,k,轴相对于,A,旋转,角相当于：坐标系,B,相对于,A,的,z,轴旋转,角，保持其他关系不变。则,x,A,y,A,z,A,x,B,y,B,z,B,坐标系,A,经过如下变换到坐标系,B:,上海电机学院 机械学院,把上式右端三矩阵相乘，并运用旋转矩阵的正交性质：,上海电机学院 机械学院,该式为一般旋转齐次变换通式，概括了绕,X,、,Y,、,Z,轴进行旋转变换的情况。反之，当给出某个旋转齐次变换矩阵，则可求得,k,及转角,。,变换算子公式不仅适用于点的旋转，也适用于矢量、坐标系、物体的旋转。,左乘是相对固定坐标系的变换；右乘是相对动坐标系的变换。,当,kx=1,，,ky=kz=0,时,当,ky=1,，,kx=kz=0,时,当,kz=1,，,kx=ky=0,时,上海电机学院 机械学院,反之，若给出某个旋转齐次矩阵,则可根据 求出其等效矢量,k,及等效转角,上海电机学院 机械学院,等效转轴和等效转角,给定旋转矩阵 ，求对应的等效旋转轴 和等效转角,设 ，,令,上海电机学院 机械学院,得到：,方程两边矩阵的非对角元素成对相减，得到：,两边平方后相加，所以整理后得到：,所以，,上海电机学院 机械学院,所以：,方程两边矩阵的非对角元素成对相减，整理得到：,（,1,）多值性：和 值并不唯一，一般选取 。,（,2,）病态情况：当 很小时，转轴 不能确定，需要其它方法。,注意：,上海电机学院 机械学院,例题：已知转动变换矩阵,试求：等效转轴与转角。,可以证明，任何一组绕过原点的轴线的复合转动总是等效于绕某一过原点的轴线的转动,R(k,).,上海电机学院 机械学院,为什么说任一,4*4,阶的齐次坐标变换矩阵,T,可以是一个变换，也可以表示一个坐标系？,T,为变换时，其中什么子矩阵表示旋转变换？什么子矩阵表示平移变换？,T,为坐标系时，其原点、坐标轴用什么表示？试用矩阵,加以说明，并绘图。,上海电机学院 机械学院,