机器人的数学基础齐次变换矩阵及其运算PPT精选文档

1、LOGO机器人学基础机器人学基础齐次变换矩阵及其运算2齐次变换矩阵及其运算齐次变换矩阵及其运算0001xxxxyyyyzzzznoapnoapFnoap由于各种原因，变换矩阵应写成方型形式，3*3或4*4均可. 为保证所表示的矩阵为方阵，如果在同一矩阵中既表示姿态又表示位置，那么可在矩阵中加入比例因子使之成为4*4矩阵。 3变换可定义为空间的一个运动。 已知一直角坐标系中的某点坐标，那么该点在另一直角坐标系中的坐标可通过齐次坐标变换来求得。变换可分为如下形式： 纯平移 纯旋转 平移与旋转的结合4v1.平移的齐次变换平移的齐次变换v空间某一点在直角坐标系中的平移空间某一点在直角坐标系中的平移,由

2、由A(x, y, z)平移至平移至A(x, y, z), 即即 zzzyyyxxx110001000100011zyxzyxzyx a=Trans(x, y, z)a 平移算子5v 算子左乘算子左乘: : 表示点的平移是相对固定坐标系进行的坐标变换。表示点的平移是相对固定坐标系进行的坐标变换。v 算子右乘算子右乘: : 表示点的平移是相对动坐标系进行的坐标变换。表示点的平移是相对动坐标系进行的坐标变换。v 该公式亦适用于坐标系的平移变换、该公式亦适用于坐标系的平移变换、 物体的平移变换物体的平移变换, , 如机如机器人手部的平移变换。器人手部的平移变换。 1000100010001),(Tra

3、nszyxzyx6v 例例 动坐标系动坐标系A相对于固定坐标系的相对于固定坐标系的X0、Y0、Z0轴作轴作v (-1,2,2)平移后到平移后到A；动坐标系；动坐标系A相对于自身坐标系相对于自身坐标系(即动系即动系)的的X、Y、Z轴分别作轴分别作(-1,2,2)平移后到平移后到A。已知。已知A,写出坐标系写出坐标系A、 A1000110010011010A1000310030010010 A1000110020011010 A7v2旋转的齐次变换旋转的齐次变换v 点在空间直角坐标系中的旋转如图所示。点在空间直角坐标系中的旋转如图所示。A(x, y, z)绕绕Z轴旋轴旋转转角后至角后至A(x, y

4、, z),则则A与与A之间的关系为之间的关系为 ：zzyxyyxxcossinsincos11000010000cossin00sincos1zyxzyx记为: a=Rot(z, )a 旋转算子81000010000cossin00sincos),(zRot同理，绕x轴、Y轴旋转算子内容为：绕Z轴旋转算子内容为：10000cossin00sincos00001),(xRot10000cos0sin00100sin0cos),(yRot9如图所示单操作手臂，并且手腕如图所示单操作手臂，并且手腕也具有一个旋转自由度。已知手也具有一个旋转自由度。已知手部的起始位姿矩阵为部的起始位姿矩阵为G1.若手臂

5、绕若手臂绕Z0轴旋转轴旋转90，则手臂，则手臂到达到达G2；若手臂不动，仅手部绕；若手臂不动，仅手部绕手腕手腕Z1轴转轴转90，则手部到达，则手部到达G3.写出手部坐标系写出手部坐标系G2、G3表达表达式。式。10113复合齐次变换复合齐次变换复合变换是由固定参考坐标系或当前运动坐标系的一系列沿轴平移和绕轴旋转变换所组成的。任何变换都可以分解为按一定顺序的一组平移和旋转变换。 相对于固定坐标系相对于动坐标系算子左乘算子右乘12v 已知坐标系中点已知坐标系中点U的位置矢量的位置矢量 ，将此点绕，将此点绕Z轴轴旋转旋转90，再绕，再绕Y轴旋转轴旋转90，如图所示，求旋转变换后，如图所示，求旋转变换

6、后所得的点所得的点W。Tu1237Rot( ,90 )Rot( ,90 )YZWU7001 001 0001 0010003 1 000001 02000100011 13v 平移变换和旋转变换可以组合在一个齐次变换中。上例平移变换和旋转变换可以组合在一个齐次变换中。上例中点中点U若还要作若还要作4i-3j+7k的平移，则只要左乘上平移变换的平移，则只要左乘上平移变换算子即可得到最后的列阵表达式。算子即可得到最后的列阵表达式。uzRotyRotTransE)90,()90,()7 , 3, 4( 1415 齐次变换矩阵齐次变换矩阵 的数学意义：的数学意义：ABT （1）同一点在不同坐标系）同一

7、点在不同坐标系B和和A中的变换；中的变换； （2）描述坐标系）描述坐标系B相对于坐标系相对于坐标系A的位置和方位；的位置和方位； （3）点的运动算子。）点的运动算子。pTpBABA1000401030011100TAB1000100010001),(Transzyxzyx1000010000cossin00sincos),(zRot164变换矩阵相乘变换矩阵相乘对于给定的坐标系A、B、C，已知B相对A的描述为 ，C相对B的描述为 ，则pTpCBCBpTTpTpCBCABBABA。从而定义复合变换 表示C相对于A的描述，是两变换矩阵的乘积。注意：变换矩阵相乘不满足“交换律”，变换矩阵的左乘和右乘

8、的运动解释不同。TTTBCABACTTTBCABACTABTBC17101000CBBCBAABBCABACpRpRTTT复合变换可解释为：TACTBCTABTBCTAC(1) 和 分别代表同一坐标系C相对于A和B的描述。则 表示坐标系C从 映射为 的变换。 (2)坐标系C相对于A的描述 是这样得到的：最初C与A重合，首先相对于A作运动 ，到达B,然后相对B作运动 ，到达最终位置C。TACTABTBC185.变换矩阵求逆变换矩阵求逆如果知道坐标系B相对于A的描述。希望得到A相对于B的描述，这是个齐次变换求逆问题。 对4*4矩阵直接求逆；利用齐次变换矩阵的特点，简化矩阵求逆运算。求逆问题可以描述

9、为：已知 ，求解 。TABTBA100BAABABpRT100ABBABApRT利用旋转矩阵正交性 TABABR1R利用复合变换公式(2.13) ,求出 在B中描述。0BAp19100BATABTABBApRRT0)(000ABBABABABppRp000BATABBABAABpRpRp20 下面我们写出变换矩阵的一般表达形式下面我们写出变换矩阵的一般表达形式 nx ox ax px ny oy ay py T = nz oz az pz 0 0 0 1 式中式中 n, o, a 是旋转变换列向量，是旋转变换列向量，p 是平移向量，其逆是是平移向量，其逆是 nx ny nz - p.n ox

10、oy oz - p.o T- -1 = ax ay az - p.a 0 0 0 1 式中的式中的 “ . ” 表示向量的点积。表示向量的点积。21 计算T矩阵的逆矩阵。0.500.86630.86605201050001T10.50.8660(3 0.52 0.8665 0)001(3 02 05 1)0.8660.50(3 0.86620.55 0)0001T 0.50.86603.2300150.8660.501.5980001-0.5226 变换方程变换方程为了描述机器人的操作，必须建立机器人本身各连杆之间，机器人与周围环境之间的运算关系。为此要规定各种坐标系来描述机器人与环境的相对位

11、姿关系。B代表基座坐标系；W代表腕部坐标系；T代表工具坐标系；S代表工作站坐标系；G代表目标坐标系；它们之间的位姿关系用相应的齐次变换来描述。TBS描述工作站坐标系相对于基座的位姿；TSG描述目标坐标系相对于S的位姿；TBW描述腕部W相对于基座B的位姿；23TGT对物体进行操作时，工具坐标系T相对于目标坐标系G的位姿 直接影响操作效果。它是机器人控制和规划的目标。实际上，它与其他变换之间的关系类似于空间尺寸链，TGT则是封闭环。如图所示，工具坐标系T相对于基座坐标系B的描述可用两种变换矩阵的乘积来表示：TTTWTBWBTTTTTGTSGBSBT令上面两式相等，则得变换方程TTTTTGTSGBS

12、WTBW24变换方程中的任一变换矩阵都可用其余的变换矩阵来表示。例如，为了对目标物进行有效操作，工具坐标系T相对于目标坐标系G的位姿 是预先规定的，需要改变 以达到这一目的，即通常规定 ，求 。TGTTBW1TTTTTWTGTSGBSBW根据变换方程，可以立即求出TGTTBW25kjikzyxkkk旋转变换通式旋转变换通式令是过原点的单位矢量，求绕k旋转角的旋转矩阵R(k,)。问题描述：令),(kRotRAB即R(k,)表示坐标系B相对于参考系A的方位。 坐标系坐标系B由坐标系由坐标系A绕绕 轴旋转轴旋转 角得到。角得到。kkA26kxAyAzAxByBzB AAyAxAz BBxByBz A

13、 B旋转变换通式旋转变换通式xxxABAByyyzzznokRRnoknok再定义两坐标系A和 B，分别与A和B固接，但要求(1)A和 B的z轴与k重合。(2)旋转之前A和 B重合， A和B也重合。27 AAAABBABBRRRRcossin0sincos0001ABR又因为又因为所以可以得到：坐标系B绕k轴相对于A旋转角相当于：坐标系B相对于A的z轴旋转角，保持其他关系不变。则TBBBBRRkxAyAzAxByBzB AAyAxAz BBxByBz A B坐标系A经过如下变换到坐标系B:281cossin0sincos0001cossin0sincos0001xxxxxxAAABBABByy

14、yyyyzzzzzzxxxxyzyyyxyzzzzxyznoknokRRRRnoknoknoknoknoknnnnokooonokkkk把上式右端三矩阵相乘，并运用旋转矩阵的正交性质：onknkkoonkkoonn01291 c1 c1 c1 c1 c1 c1 c1 c1 cxxyxzzxyABxyzyyzyxxzyyzxzzk kck kk sk kk sRk kk sk kck kk sk kk sk kk sk kc 该式为一般旋转齐次变换通式，概括了绕该式为一般旋转齐次变换通式，概括了绕X X、Y Y、Z Z轴进行旋转变换的情况。轴进行旋转变换的情况。反之，当给出某个旋转齐次变换矩阵，

15、则可求得反之，当给出某个旋转齐次变换矩阵，则可求得k k及转角及转角。 变换算子公式不仅适用于点的旋转，也适用于矢量、坐标系、物体的旋转。变换算子公式不仅适用于点的旋转，也适用于矢量、坐标系、物体的旋转。 左乘是相对固定坐标系的变换；右乘是相对动坐标系的变换。左乘是相对固定坐标系的变换；右乘是相对动坐标系的变换。 当当kx=1，ky=kz=0时时当当ky=1，kx=kz=0时时当当kz=1，kx=ky=0时时30v反之，若给出某个旋转齐次矩阵反之，若给出某个旋转齐次矩阵则可根据 求出其等效矢量k及等效转角),(Rotk31等效转轴和等效转角等效转轴和等效转角 给定旋转矩阵给定旋转矩阵 ，求对应

16、的等效旋转轴，求对应的等效旋转轴 和等效转角和等效转角ABRkxxxyyyzzznoaRnoanoa设设 ，令令 1 c1 c1 c1 c1 c1 c1 c1 c1 cxxxyyyzzzxxyxzzxyxyzyyzyxxzyyzxzznoaRnoanoak kck kk sk kk sk kk sk kck kk sk kk sk kk sk kc32得到：得到：方程两边矩阵的非对角元素成对相减，得到：方程两边矩阵的非对角元素成对相减，得到：2sin2sin2sinzyxxzyyxzoakanknok2221 cos3cosxyzxyznoakkk1cos12xyznoa两边平方后相加，所以整

17、理后得到：两边平方后相加，所以整理后得到：2221sin2zyxzyxoaanno 所以，所以，12cosxyznoa 33所以：所以：方程两边矩阵的非对角元素成对相减，整理得到：方程两边矩阵的非对角元素成对相减，整理得到：2sin2sin2sinzyxxzyyxzoakanknok222tan1zyxzyxxyzoaannonoa （1）多值性：）多值性： 和和 值并不唯一，一般选取值并不唯一，一般选取 。（2）病态情况：当）病态情况：当 很小时，转轴很小时，转轴 不能确定，需要其它方法。不能确定，需要其它方法。注意：注意：kk0,1 8 034例题：已知转动变换矩阵1000001000010100)90,()90,(zRotyRot试求：等效转轴与转角。可以证明，任何一组绕过