第四讲-机器人的位姿描述课件.ppt

《第四讲-机器人的位姿描述课件.ppt》由会员分享，可在线阅读，更多相关《第四讲-机器人的位姿描述课件.ppt（40页珍藏版）》请在淘文阁 - 分享文档赚钱的网站上搜索。

1、第第3 3章章 机器人运动学机器人运动学3.1 3.1 机器人的位姿描述机器人的位姿描述3.2 3.2 齐次变换及运算齐次变换及运算3.3 3.3 机器人运动学方程机器人运动学方程3.4 3.4 机器人微分运动机器人微分运动1机器人的任务2第第3 3章章 机器人运动学机器人运动学运动学研究的问题：手在空间的位姿及运动与各个关节的位姿及运动之间的关系。其中：正问题：已知关节运动，求手的运动。逆问题：已知手的运动，求关节运动。33.1 3.1 机器人的位姿描述机器人的位姿描述 对于机器人来说，我们最关心它的末端执行器相对于基座的位置和姿态，简称为位姿。问：我们如何用一组关节参数来描述机器人的末端执

2、行器相对于基座的位姿？4一、机器人位姿的表示1、位置的表示 坐标系建立后，任意点p在空间的位置可以用一个31的位置矢量来描述；例如，点p在A坐标系中表示为：(,)3.1 3.1 机器人的位姿描述机器人的位姿描述A其中px，py，pz为P点的坐标分量。5位置矢量不同于一般矢量，它的大小与坐标原点的选择有关。62、姿态（或称方向）的表示我们知道：两个刚体的相对姿态可以用附着与它们上的坐标系的相对姿态来描述。3.1 机器人的位姿描述7刚体的姿态可以用附着于刚体上的坐标系（用B表示）来表示；因此，刚体相对于坐标系A的姿态等价于B相对于A的姿态。坐标系B相对于A的姿态表示可以用坐标系B的三个基矢量xB、

3、yB和zB在A中的表示给出，即AxB AxB AxB（这里前上标A说明：B的三个基矢量在A坐标系中表示），它是一个33矩阵，它的每一列为 B的基矢量在A中的分量表示。3.1 机器人的位姿描述8即：3.1 3.1 机器人的位姿描述机器人的位姿描述 =),cos(),cos(),cos()A,cos()A,cos(),cos()A,cos(),cos(),cos(BBBBBBBBBzzAyzAxzAzy yyxyAzxyxAxxARAB 基矢量都是单位矢量，因此，上式又可以写成：93.1 机器人的位姿描述机器人的位姿描述 称为坐标系B相对A的旋转矩阵。旋转矩阵的性质：1、列向量两两正交，行向量两两

4、正交。2、列向量和行向量都是单位向量。3、每一列是B的基矢量在A中的分量表示，同样，每一行是A的基矢量在B中的分量表示。4、旋转矩阵是正交矩阵，其行列式等于1。5、它的逆矩阵等于它的转置矩阵，即：103、位姿的统一表示 定义一组四向量矩阵R P，如图。其中，表示j相对i的姿态，表示j的原点相对i的位移。我们可以将j坐标系相对i坐标系描述为：iiiijjjjp3.1 机器人的位姿描述34113.2.1、不同直角坐标系之间的关系 1、平移 设坐标系i和坐标系j具有相同的姿态，但它俩的坐标原点不重合，若用31矩阵iPjorg表示坐标系j的原点相对坐标系i的位置，则同一点P在两个坐标系中的表示的关系为

5、：3.2 齐次变换及运算P122、旋转 设坐标系i和坐标系j的原点重合，但它俩的姿态不同。设有一向量P，它在j坐标系中的表示为jP，它在i中如何表示？考虑分量：即：3.2 齐次变换及运算iiiijjjjp133、另一种解释 对同一个数学表达式可以给出多种不同的解释，前面介绍的是同一个向量在不同的坐标系的表示之间的关系。上述数学关系也可以在同一个坐标系中解释为向量的“向前”移动或旋转，或则，坐标系“向后”的移动或旋转。3.2 齐次变换及运算144、常用的旋转变换、绕z轴旋转角 坐标系i和坐标系j的原点合，坐标系j的坐标轴方向相对于坐标系i绕的z轴旋转一个角。角的正负一般按右手法则确定，即由z轴的

6、矢端看，逆时钟为正。3.2 齐次变换及运算iiiijjjj153.2 齐次变换及运算03 03 一月一月 2023 2023令:16、绕x轴旋转角的旋转变换矩阵为：3.2 3.2 齐次变换及运算齐次变换及运算iiiijjjj17绕y轴旋转角的旋转变换矩阵为：3.2 3.2 齐次变换及运算齐次变换及运算iiiijjjj18复合转动:3.2 3.2 齐次变换及运算齐次变换及运算19绕任意轴的转动 设绕k轴转动角，则旋转矩阵为：其中：3.2 齐次变换及运算齐次变换及运算20若给定一旋转矩阵:则可计算出：3.2 齐次变换及运算齐次变换及运算213.2 齐次变换及运算5、联合（平移+旋转）设坐标系i和坐

7、标系j坐标原点不重合并具有不同的姿态。则空间任一矢量在坐标系i和坐标系j 之间有以下关系：设I是方向与i平行的中间坐标系，则：22 若坐标系i和坐标系j之间是先旋转变换，后平移变换，则上述关系是应如何变化？3.2 3.2 齐次变换及运算齐次变换及运算23例：已知坐标系B沿坐标系A的x轴移动12个单位，并沿坐标系A的y轴移动6个单位，绕坐标系A的z轴旋转30，求平移变换矩阵和旋转变换矩阵。假设某点在坐标系B中的矢量为 ，求该点在坐标系A中的表示。3.2 3.2 齐次变换及运算齐次变换及运算24解：由题意可得平移变换矩阵和旋转变换矩阵分别为：和则：3.2 3.2 齐次变换及运算齐次变换及运算03

8、03 一月一月 2023 2023253.2 3.2 齐次变换及运算齐次变换及运算3.2.23.2.2、齐次坐标变换、齐次坐标变换 为什么学习齐次坐标表示？将坐标系的平移和旋转用一个矩阵统一表示。261、齐次坐标的定义 空间中任一点在直角坐标系中的三个坐标分量用 表示，若有四个不同时为零的数 与三个直角坐标分量之间存在以下关系：则称 是空间该点的齐次坐标。3.2 3.2 齐次变换及运算齐次变换及运算3.2.23.2.2、齐次坐标变换、齐次坐标变换以后用到齐次坐标时，一律默认k=1。273.2 齐次变换及运算齐次变换及运算2、齐次坐标变换 为何使用齐次坐标？在进行联合变换时，变换关系为：28将其

9、写成统一的矩阵形式则有：3.2 3.2 齐次变换及运算齐次变换及运算式中，称为齐次坐标变换矩阵，它是一个44的矩阵。291）、齐次坐标变换矩阵的意义 若将齐次坐标变换矩阵分块，则有：意义：左上角的33矩阵是两个坐标系之间的旋转变换矩阵，它描述了姿态关系；右上角的31矩阵是两个坐标系之间的平移变换矩阵，它描述了位置关系，所以齐次坐标变换矩阵又称为位姿矩阵。3.2 3.2 齐次变换及运算齐次变换及运算30联合变换与单步齐次变换矩阵的关系：任何一个齐次坐标变换矩阵均可分解为一个平移变换矩阵与一个旋转变换矩阵的乘积，即：3.2 3.2 齐次变换及运算齐次变换及运算注意：1、这里的平移和旋转都是相对i坐

10、标系的，即绝对变换。2、矩阵相乘的次序是不可交换的。313.2 3.2 齐次变换及运算齐次变换及运算 如图所示的两坐标系的位姿可以有两种理解：1、j先相对i旋转，再相对i平移，即绝对变换。2、j先相对i 平移，再相对平移后的j旋转，即相对变换。ij 可见，同样的位姿，既可以按照绝对运动来实现，也可以按相对运动来理解，但两种方法的矩阵表达式是不同的。323.2 3.2 齐次变换及运算齐次变换及运算 结论：左乘和右乘原则：绝对运动变换矩阵左乘，即先做的在右边，后做的在左边。相对运动变换矩阵右乘，即先做的在左边，后做的在右边。333.2 3.2 齐次变换及运算齐次变换及运算例3（3-2）：已知坐标系

11、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)342）、齐次变换的逆变换 设：，等号两边同乘得：可知：求齐次变换的逆可按一般矩阵求逆的方法进行，也可按几何意义求。3.2 3.2 齐次变换及运算齐次变换及运算353.2 3.2 齐次变换及运算齐次变换及运算 正、逆变换间的几何意义：顺序颠倒，符号取反，如图所示。36齐次变换的逆变换若齐次坐标变换矩阵为：则：3.2 3.2 齐次变换及运算齐次变换及运算372）、齐次变换的逆变换 设：则：3.2 3.2 齐次变换及运算齐次变换及运算383）、联合变换与单步齐次矩阵的关系 当空间有任意多个坐标系时，若已知相邻坐标系之间的齐次坐标变换矩阵，则由坐标变换原理可知：由此可知，建立机器人的坐标系，可以通过齐次坐标变换，将机器人手部在空间的位置和姿态用齐次坐标变换矩阵描述出来，从而建立机器人的运动学方程。3.2 齐次变换及运算0i-1in393.2 齐次变换及运算40