演示文稿机器人技术二齐次坐标变换

（优选）机器人技术二齐次坐标变换ppt讲解当前1页，总共38页。主要内容引言点的向量表示单位向量点和向量的齐次表示坐标系的位姿刚体的位姿平移变换旋转变换一般变换相对参考坐标系的变换相对自身坐标系的变换当前2页，总共38页。引言(Introduction)

机器人运动学解决的基本问题：正向运动学逆向运动学当前3页，总共38页。机器人机构一个自由度情况多个自由度情况误差的反馈当前4页，总共38页。点、向量和坐标系的传统表示坐标轴的定义或或非方阵相乘结果的维数发生变化当前5页，总共38页。点、向量和坐标系的齐次表示在三维向量中加入一比例因子w；其物理意义是，随着W的改变，向量的大小会发生变化，而方向不变；W大于1，向量的分量变大；W小于1，向量的分量变小；若W＝1，各分量大小不变；若W＝0，则表示一个无穷小的向量，其方向不变。第二章机器人运动学其中齐次坐标与传统坐标的关系当前6页，总共38页。点、向量和坐标系的齐次表示第二章机器人运动学

因此，习惯上用W＝1表示向量的长度，用W＝0表示向量的方向，而且方向向量一般表示成单位向量的形式。形式如下：例：有一向量P（3，5，2），请按如下要求表示成矩阵形式：1、比例因子为2；2、表示为方向的单位向量。当前7页，总共38页。点、向量和坐标系的齐次表示原点重合情况坐标系的齐次表示是由坐标系的三个方向向量和原点位置齐次坐标组成：例：如图所示为F坐标系位于参考坐标系中（3，5，7）的位置，它的n轴与x轴平行，o轴相对于y轴的角度为45度，a轴相对于z的角度为45度。请写出该坐标的齐次表达形式。当前8页，总共38页。点、向量和坐标系的齐次表示第二章机器人运动学刚体的表示

一个刚体在空间的表示可以这样实现：通过在它上面固连一个坐标系，再将该固连的坐标系在空间表示出来。由于这个坐标系一直固连在该刚体上，所以该刚体相对于坐标系的位姿是已知的。因此，只要这个坐标系可以在空间表示出来，那么这个刚体相对于固定坐标系的位姿也就已知了。由此可知，刚体在参考坐标系的表示与坐标系是完全一样的。图当前9页，总共38页。约束变量点、向量和坐标系的齐次表示第二章机器人运动学由刚体（坐标系）在参考坐标系的齐次矩阵表达可知，该矩阵有12个变量，但描述刚体位姿只需要6个变量（自由度）就足够了，因此，齐次矩阵中12个变量之间并不是相互独立的，而是有约束的，约束条件为：1、三个方向向量相互垂直；2、每个单位向量的长度均为1。即：当前10页，总共38页。

已知两个向量

a=axi+ayj+azkb=bxi+byj+bzk

向量的点积是标量。用“·”来定义向量点积，即

a·b=axbx+ayby+azbz

向量的叉积是一个垂直于由叉积的两个向量构成的平面的向量。用“×”表示叉积，即

a×b=(aybz¯azby)i+(azbx¯axbz)j+(axby¯aybx)k

可用行列式表示为ijk

a×b=axayaz

bxbybz当前11页，总共38页。例题点、向量和坐标系的齐次表示第二章机器人运动学对于下列坐标系，求解所缺元素的值，并用矩阵来表示这个坐标系。注：三个点积约束条件可以用叉积代替，即：进一步有当前12页，总共38页。齐次变换矩阵变换定义为空间的一个运动；当空间的一个坐标系（向量、刚体、运动坐标系）相对于固定的参考坐标系运动时，这一运动可以用类似于表示坐标系的方式来表示；变换有如下几种形式：

纯平移，纯旋转，平移和旋转的结合。第二章机器人运动学当前13页，总共38页。纯平移齐次变换矩阵第二章机器人运动学特点：运动过程中姿态不变，坐标方向单位向量保持同一方向不变。变换矩阵可表示为变换过程为：注：相对固定坐标系的平移，变换矩阵左乘，公式为例当前14页，总共38页。纯旋转(相对坐标绕参考坐标X轴）齐次变换矩阵第二章机器人运动学例必须从原点开始变换！当前15页，总共38页。纯旋转齐次变换矩阵第二章机器人运动学也就相当于旋转变换前在固定参考坐标系的初始位置。式中图、例注：相对固定坐标系的旋转，变换矩阵左乘，公式为绕x轴旋转可简写成其中同理当前16页，总共38页。纯旋转－例题齐次变换矩阵第二章机器人运动学旋转坐标系中有一点P（2，3，4），此坐标系绕参考坐标系x轴旋转90度。求旋转后该点相对于参考坐标系的坐标。当前17页，总共38页。复合变换齐次变换矩阵第二章机器人运动学特点：既有平移，又有旋转，而且可以多次。假设坐标系（n，o，a）相对于参考坐标系（x，y，z）依次进行如下变换：1、绕x轴旋转角；2、平移；3、再绕y轴旋转角。注：矩阵的顺序不能变；相对固定坐标系的平移和旋转，变换矩阵左乘。例当前18页，总共38页。复合变换例题齐次变换矩阵相对坐标系的齐次矩阵固连在坐标系（n，o，a）上的点P（7，3，2）经历如下变换，求出变换后该点相对于参考坐标系的坐标。1、绕z轴旋转90度；2、接着绕y轴旋转90度；3、接着再平移（4，-3，7）。当前19页，总共38页。复合变换例题齐次变换矩阵第二章机器人运动学假设（n，o，a）坐标系上的点P（7，3，2）也经历相同变换，但变换顺序按如下进行，求出变换后该点相对于参考坐标系的坐标。1、绕z轴旋转90度；2、接着平移（4，-3，7）；3、接着再绕y轴旋转90度。当前20页，总共38页。相对动坐标系的变换齐次变换矩阵第二章机器人运动学相对运动坐标系的变换与相对固定参考坐标系不同，这时需要右乘变换矩阵而不是左乘。相对自身的运动即是相对动坐标。相对动坐标是指动坐标系本身相对自身的运动，而不是动坐标系中的点相对动坐标系的运动。如果在一个变换过程中，既有相对固定坐标系的变换，也有相对于动坐标系的变换，则应先写出第一个变换因子，在根据变换的具体过程，依次左乘或右乘变换因子，最后乘以被变换的对象（点或坐标）。当前21页，总共38页。相对动坐标系的变换－例题齐次变换矩阵第二章机器人运动学假设与上例相同的点现在进行相同的变换，但所有变换都是相对当前运动坐标系的，具体变换如下，求变换完成后该点相对于参考坐标系的坐标。1、绕a轴旋转90度；2、然后沿n、o、a轴平移（4，-3，7）；3、接着绕o轴旋转90度。当前22页，总共38页。相对动坐标系的变换－例题齐次变换矩阵第二章机器人运动学坐标系B绕x轴旋转90度，然后沿当前坐标系a轴做了3英寸的平移，然后再绕z轴旋转90度，最后沿当前坐标系o轴做5英寸的平移。1、写出描述该运动的方程；2、求坐标系中的点P（1，5，4）相对于参考坐标系的最终位置。提示：先求，再求当前23页，总共38页。变换矩阵的逆第二章机器人运动学钻孔点位置的描述：式中：只有是未知的，其它都可以通过传感器获得，或本身就是已知的。因此，通过求逆阵就可以求得。当前24页，总共38页。求矩阵逆－例题变换矩阵的逆第二章机器人运动学在一个具有六自由度的机器人的第五个连杆上装有照相机，照相机观察物体并测定它相对于照相机坐标系的位置，然后根据以下数据来确定末端执行器要到达物体所必须完成的运动。提示：根据求，这可以用于测距当前25页，总共38页。变换矩阵的逆求逆阵的步骤：第二章机器人运动学1、计算矩阵的行列式；2、将矩阵转置；3、将转置矩阵的每个元素用它的子行列式（伴随矩阵）代替；4、用转换后的矩阵除以行列式即例：求的逆阵。满足的矩阵称为酉矩阵。当前26页，总共38页。齐次矩阵的逆变换矩阵的逆第二章机器人运动学

对于4X4齐次变换矩阵，可以将矩阵分成两部分求逆。其旋转部分仍是酉矩阵，只需要简单的转置；矩阵的位置部分是向量P分别与n、o、a向量点积的取反。即的逆阵为例：求的逆阵。当前27页，总共38页。图2.12所示为点A绕任意过原点的单位矢量此旋转θ角的情况。kx，ky，kz分别为此矢量在固定参考系坐标轴X、Y、Z上的三个分量，可以证得，绕任意过原点的单位矢量k转θ角的旋转齐次变换公式为当前28页，总共38页。当前29页，总共38页。式(2-18)称为一般旋转齐次变换通式，它概括了绕X轴、Y轴、Z轴进行旋转齐次变换的各种特殊情况，例如：当kx=1，即ky=kz=0时，则由式(2-18)可得到式(2-16)；当ky=1，即kx=kz=0时，则由式(2-18)可得到式(2-17)；当kz=1，即kx=ky=0时，则由式(2-18)可得到式(2-15)。当前30页，总共38页。反之，若给出某个旋转齐次矩阵则可根据式(2-18)求出其等效矢量k及等效转角θ当前31页，总共38页。式中：当θ取0到180。之间的值时，式中的符号取+号；当转角时很小时，公式很难确定转轴；当θ接近0。或180。时，转轴完全不确定。当前32页，总共38页。

与平移变换一样，旋转变换算子公式(2-15)、(2-16)、(2-17)以及一般旋转变换算子公式(2-18)，不仅仅适用于点的旋转变换,而且也适用于矢量、坐标系、物体等旋转变换计算。若相对固定坐标系进行变换,则算子左乘；若相对动坐标系进行变换，则算子右乘。例2-5已知坐标系中点U的位置矢量u=[7321]T