《机器人的位姿描述》PPT课件.ppt

山东大学机械工程学院机电工程研究所2010/09/02,第3章 机器人运动学,3.1 机器人的位姿描述 3.2 齐次变换及运算 3.3 机器人运动学方程 3.4 机器人微分运动,山东大学机械工程学院机电工程研究所2010/09/02,机器人的任务,山东大学机械工程学院机电工程研究所2010/09/02,第3章 机器人运动学,运动学研究的问题： 手在空间的位姿及运动与各个关节的位姿及运动之间的关系。 其中： 正问题：已知关节运动，求手的运动。 逆问题：已知手的运动，求关节运动。,山东大学机械工程学院机电工程研究所2010/09/02,3.1 机器人的位姿描述,对于机器人来说，我们最关心它的末端执行器相对于基座的位置和姿态，简称为位姿。 问：我们如何用一组关节参数来描述机器人的末端执行器相对于基座的位姿？,山东大学机械工程学院机电工程研究所2010/09/02,一、机器人位姿的表示 1、位置的表示 坐标系建立后，任意点p在空间的位置可以用一个31的位置矢量来描述；例如，点p在A坐标系中表示为：,3.1 机器人的位姿描述,A,其中px，py，pz为P点的 坐标分量。,山东大学机械工程学院机电工程研究所2010/09/02,位置矢量不同于一般矢量，它的大小与坐标原点的选择有关。,山东大学机械工程学院机电工程研究所2010/09/02,2、姿态（或称方向）的表示 我们知道：两个刚体的相对姿态可以用附着与它们上的坐标系的相对姿态来描述。,3.1 机器人的位姿描述,山东大学机械工程学院机电工程研究所2010/09/02,刚体的姿态可以用附着于刚体上的坐标系（用B表示）来表示；因此，刚体相对于坐标系A的姿态等价于B相对于A的姿态。 坐标系B相对于A的姿态表示可以用坐标系B的三个基矢量xB、yB和zB在A中的表示给出， 即AxB AxB AxB （这里前上标A说明：B的三个基矢量在A坐标系中表示），它是一个33矩阵，它的每一列为 B的基矢量在A中的分量表示。,3.1 机器人的位姿描述,山东大学机械工程学院机电工程研究所2010/09/02,即：,3.1 机器人的位姿描述,基矢量都是单位矢量，因此，上式又可以写成：,山东大学机械工程学院机电工程研究所2010/09/02,3.1 机器人的位姿描述,称为坐标系B相对A的旋转矩阵。 旋转矩阵的性质： 1、列向量两两正交，行向量两两正交。 2、列向量和行向量都是单位向量。 3、每一列是B的基矢量在A中的分量表示，同样，每一行是A的基矢量在B中的分量表示。 4、旋转矩阵是正交矩阵，其行列式等于1。 5、它的逆矩阵等于它的转置矩阵，即：,山东大学机械工程学院机电工程研究所2010/09/02,3、位姿的统一表示 定义一组四向量矩阵R P，如图。其中， 表示j相对i的姿态， 表示j的原点相对i的位移。 我们可以将j坐标 系相对i坐标系描述为：,p,3.1 机器人的位姿描述,34,山东大学机械工程学院机电工程研究所2010/09/02,3.2.1、不同直角坐标系之间的关系 1、平移 设坐标系i和坐标系j具有相同的姿态，但它俩的坐标原点不重合，若用31矩阵iPjorg表示坐标系j的原点相对坐标系i的位置，则同一点P 在两个坐标系中的表 示的关系为：,3.2 齐次变换及运算,P,山东大学机械工程学院机电工程研究所2010/09/02,2、旋转 设坐标系i和坐标系j的原点重合，但它俩的姿态不同。设有一向量P，它在j坐标系中的表示为jP，它在i中如何表示？ 考虑分量： 即：,3.2 齐次变换及运算,i,i,i,i,j,j,j,j,p,山东大学机械工程学院机电工程研究所2010/09/02,3、另一种解释 对同一个数学表达式可以给出多种不同的解释，前面介绍的是同一个向量在不同的坐标系的表示之间的关系。 上述数学关系也可以在同一个坐标系中解释为向量的“向前”移动或旋转，或则，坐标系“向后”的移动或旋转。,3.2 齐次变换及运算,山东大学机械工程学院机电工程研究所2010/09/02,4、常用的旋转变换 、绕z轴旋转角 坐标系i和坐标系j的原点合，坐标系j的坐标轴方向相对于坐标系i绕的z轴旋转一个角。角的正负一般按右手法则确定，即由z轴的矢端看，逆 时钟为正。,3.2 齐次变换及运算,山东大学机械工程学院机电工程研究所2010/09/02,3.2 齐次变换及运算,2019年6月11日星期二,令:,山东大学机械工程学院机电工程研究所2010/09/02,、绕x轴旋转角的旋转变换矩阵为：,3.2 齐次变换及运算,山东大学机械工程学院机电工程研究所2010/09/02,绕y轴旋转角的旋转变换矩阵为：,3.2 齐次变换及运算,山东大学机械工程学院机电工程研究所2010/09/02,复合转动:,3.2 齐次变换及运算,山东大学机械工程学院机电工程研究所2010/09/02,绕任意轴的转动 设绕k轴转动角，则旋转矩阵为： 其中：,3.2 齐次变换及运算,山东大学机械工程学院机电工程研究所2010/09/02,若给定一旋转矩阵: 则可计算出：,3.2 齐次变换及运算,山东大学机械工程学院机电工程研究所2010/09/02,3.2 齐次变换及运算,5、联合（平移+旋转） 设坐标系i和坐标系j坐标原点不重合并具有不同的姿态。则空间任一矢量在坐标系i和坐标系j 之间有以下关系：,设I是方向与i平行 的中间坐标系，则：,山东大学机械工程学院机电工程研究所2010/09/02,若坐标系i和坐标系j之间是先旋转变换，后平移变换，则上述关系是应如何变化？,3.2 齐次变换及运算,山东大学机械工程学院机电工程研究所2010/09/02,例：已知坐标系B沿坐标系A的x轴移动12个单位，并沿坐标系A的y轴移动6个单位，绕坐标系A的z轴旋转30，求平移变换矩阵和旋转变换矩阵。 假设某点在坐标系B中的矢量为 ，求该点在坐标系A中的表示。,3.2 齐次变换及运算,山东大学机械工程学院机电工程研究所2010/09/02,解：由题意可得平移变换矩阵和旋转变换矩阵分别为： 和 则：,3.2 齐次变换及运算,2019年6月11日星期二,山东大学机械工程学院机电工程研究所2010/09/02,3.2 齐次变换及运算,3.2.2、齐次坐标变换 为什么学习齐次坐标表示？ 将坐标系的平移和旋转用一个矩阵统一表示。,山东大学机械工程学院机电工程研究所2010/09/02,1、齐次坐标的定义 空间中任一点在直角坐标系中的三个坐标分量用 表示，若有四个不同时为零的数 与三个直角坐标分量之间存在以下关系： 则称 是空间该点的齐次坐标。,3.2 齐次变换及运算,3.2.2、齐次坐标变换,以后用到齐次坐标时，一律默认k=1 。,山东大学机械工程学院机电工程研究所2010/09/02,3.2 齐次变换及运算,2、齐次坐标变换 为何使用齐次坐标？ 在进行联合变换时，变换关系为：,山东大学机械工程学院机电工程研究所2010/09/02,将其写成统一的矩阵形式则有：,3.2 齐次变换及运算,式中， 称为齐次坐标变换矩阵，它是一个44的矩阵。,山东大学机械工程学院机电工程研究所2010/09/02,1）、齐次坐标变换矩阵的意义 若将齐次坐标变换矩阵分块，则有： 意义：左上角的33矩阵是两个坐标系之间的旋转变换矩阵，它描述了姿态关系；右上角的31矩阵是两个坐标系之间的平移变换矩阵，它描述了位置关系，所以齐次坐标变换矩阵又称为位姿矩阵。,3.2 齐次变换及运算,山东大学机械工程学院机电工程研究所2010/09/02,联合变换与单步齐次变换矩阵的关系： 任何一个齐次坐标变换矩阵均可分解为一个平移变换矩阵与一个旋转变换矩阵的乘积，即：,3.2 齐次变换及运算,注意：1、这里的平移和旋转都是相对i坐标系的，即绝对变换。 2、矩阵相乘的次序是不可交换的。,山东大学机械工程学院机电工程研究所2010/09/02,3.2 齐次变换及运算,如图所示的两坐标系的位姿可以有两种理解： 1、 j先相对i旋转，再相对i平移，即绝对变换。 2、 j先相对i 平移，再相对平移后的j旋转，即相对变换。,可见，同样的位姿，既可以按照绝对运动来实现，也可以按相对运动来理解，但两种方法的矩阵表达式是不同的。,山东大学机械工程学院机电工程研究所2010/09/02,3.2 齐次变换及运算,结论：左乘和右乘原则： 绝对运动变换矩阵左乘，即先做的在右边，后做的在左边。 相对运动变换矩阵右乘，即先做的在左边，后做的在右边。,山东大学机械工程学院机电工程研究所2010/09/02,3.2 齐次变换及运算,例3（3-2）：已知坐标系B先绕坐标系A的z轴旋转90，再绕坐标系A的x轴旋转90，最后沿矢量P=3i-5j+9k平移得到，求：坐标系A与B之间的齐次坐标变换矩阵MAB。 解：绝对运动，左乘原则。 MAB=Trans(3,-5,9)Rot(x,90)Rot(z,90) 如果上述运动为相对运动，则应用右乘原则。有 ： MAB=Rot(z,90)Rot(x,90)Trans(3,-5,9),山东大学机械工程学院机电工程研究所2010/09/02,2）、齐次变换的逆变换 设： ，等号两边同乘 得： 可知： 求齐次变换的逆可按一般矩阵求逆的方法进行，也可按几 何意义求。,3.2 齐次变换及运算,山东大学机械工程学院机电工程研究所2010/09/02,3.2 齐次变换及运算,正、逆变换间的几何意义：顺序颠倒，符号取反，如图所示。,山东大学机械工程学院机电工程研究所2010/09/02,齐次变换的逆变换 若齐次坐标变换矩阵为： 则：,3.2 齐次变换及运算,山东大学机械工程学院机电工程研究所2010/09/02,2）、齐次变换的逆变换 设： 则：,3.2 齐次变换及运算,山