1、第第3 3章章 机器人运动学机器人运动学3.1 3.1 机器人的位姿描述机器人的位姿描述3.2 3.2 齐次变换及运算齐次变换及运算3.3 3.3 机器人运动学方程机器人运动学方程3.4 3.4 机器人微分运动机器人微分运动1ppt课件机器人的任务2ppt课件第第3 3章章 机器人运动学机器人运动学运动学研究的问题：手在空间的位姿及运动与各个关节的位姿及运动之间的关系。其中：正问题：已知关节运动，求手的运动。逆问题：已知手的运动，求关节运动。3ppt课件3.1 3.1 机器人的位姿描述机器人的位姿描述 对于机器人来说，我们最关心它的末端执行器相对于基座的位置和姿态，简称为位姿。问：我们如何用一
2、组关节参数来描述机器人的末端执行器相对于基座的位姿？4ppt课件一、机器人位姿的表示1、位置的表示 坐标系建立后，任意点p在空间的位置可以用一个31的位置矢量来描述；例如，点p在A坐标系中表示为：(,)3.1 3.1 机器人的位姿描述机器人的位姿描述xAyzpPpp A其中px，py，pz为P点的坐标分量。5ppt课件 位置矢量不同于一般矢量，它的大小与坐标原点的选择有关。6ppt课件2、姿态（或称方向）的表示我们知道：两个刚体的相对姿态可以用附着与它们上的坐标系的相对姿态来描述。3.1 机器人的位姿描述7ppt课件刚体的姿态可以用附着于刚体上的坐标系（用B表示）来表示；因此，刚体相对于坐标系
3、A的姿态等价于B相对于A的姿态。坐标系B相对于A的姿态表示可以用坐标系B的三个基矢量xB、yB和zB在A中的表示给出，即AxB AxB AxB（这里前上标A说明：B的三个基矢量在A坐标系中表示），它是一个33矩阵，它的每一列为 B的基矢量在A中的分量表示。3.1 机器人的位姿描述8ppt课件即：3.1 3.1 机器人的位姿描述机器人的位姿描述 ),cos(),cos(),cos()A,cos()A,cos(),cos()A,cos(),cos(),cos(BBBBBBBBBzzAyzAxzAzy yyxyAzxyxAxxARAB 基矢量都是单位矢量，因此，上式又可以写成：TABTABTABAB
4、ABABABABABABABABBABABAABZYXzzzyzxyzyyyxxzxyxxRzyx9ppt课件3.1 机器人的位姿描述机器人的位姿描述 称为坐标系B相对A的旋转矩阵。旋转矩阵的性质：1、列向量两两正交，行向量两两正交。2、列向量和行向量都是单位向量。3、每一列是B的基矢量在A中的分量表示，同样，每一行是A的基矢量在B中的分量表示。4、旋转矩阵是正交矩阵，其行列式等于1。5、它的逆矩阵等于它的转置矩阵，即：ABR1AATBBBARRR10ppt课件3、位姿的统一表示 定义一组四向量矩阵R P，如图。其中，表示j相对i的姿态，表示j的原点相对i的位移。我们可以将j坐标系相对i坐标系
5、描述为：Rijiiiijjjjpj iijjorgR p3.1 机器人的位姿描述jorgip3411ppt课件3.2.1、不同直角坐标系之间的关系 1、平移 设坐标系i和坐标系j具有相同的姿态，但它俩的坐标原点不重合，若用31矩阵iPjorg表示坐标系j的原点相对坐标系i的位置，则同一点P在两个坐标系中的表示的关系为：3.2 齐次变换及运算ijijorgPPPP12ppt课件2、旋转 设坐标系i和坐标系j的原点重合，但它俩的姿态不同。设有一向量P，它在j坐标系中的表示为jP，它在i中如何表示？考虑分量：即：3.2 齐次变换及运算iiiijjjjpiijjpRppzpypxpxjijzijijy
6、ijijjixippp13ppt课件3、另一种解释 对同一个数学表达式可以给出多种不同的解释，前面介绍的是同一个向量在不同的坐标系的表示之间的关系。上述数学关系也可以在同一个坐标系中解释为向量的“向前”移动或旋转，或则，坐标系“向后”的移动或旋转。3.2 齐次变换及运算14ppt课件4、常用的旋转变换、绕z轴旋转角 坐标系i和坐标系j的原点合，坐标系j的坐标轴方向相对于坐标系i绕的z轴旋转一个角。角的正负一般按右手法则确定，即由z轴的矢端看，逆时钟为正。3.2 齐次变换及运算iiiijjjj15ppt课件3.2 齐次变换及运算 jjjiiizyxzyx1000cossin0sincos 令:c
7、ossin0()sincos0001ZR16ppt课件、绕x轴旋转角的旋转变换矩阵为：3.2 3.2 齐次变换及运算齐次变换及运算iiiijjjj17ppt课件绕y轴旋转角的旋转变换矩阵为：3.2 3.2 齐次变换及运算齐次变换及运算iiiijjjj18ppt课件复合转动:3.2 3.2 齐次变换及运算齐次变换及运算19ppt课件 绕任意轴的转动 设绕k轴转动角，则旋转矩阵为：其中：3.2 齐次变换及运算齐次变换及运算20ppt课件 若给定一旋转矩阵:则可计算出：3.2 齐次变换及运算齐次变换及运算111213212223313222R()Krrrrrrrrr21ppt课件3.2 齐次变换及运
8、算5、联合（平移+旋转）设坐标系i和坐标系j坐标原点不重合并具有不同的姿态。则空间任一矢量在坐标系i和坐标系j 之间有以下关系：iiii orgijijjorgijijjorgpppR ppR pp 设I是方向与i平行的中间坐标系，则：22ppt课件 若坐标系i和坐标系j之间是先旋转变换，后平移变换，则上述关系是应如何变化？3.2 3.2 齐次变换及运算齐次变换及运算iijijjorgpRpp（）23ppt课件例：已知坐标系B沿坐标系A的x轴移动12个单位，并沿坐标系A的y轴移动6个单位，绕坐标系A的z轴旋转30，求平移变换矩阵和旋转变换矩阵。假设某点在坐标系B中的矢量为 ，求该点在坐标系A中
9、的表示。3.2 3.2 齐次变换及运算齐次变换及运算kjirB095 24ppt课件解：由题意可得平移变换矩阵和旋转变换矩阵分别为：和则：3.2 3.2 齐次变换及运算齐次变换及运算 0612ABp1000866.05.005.0866.0100030cos30sin030sin30cos)30(zRAB 0794.13830.110951000866.05.005.0866.00612BABABArRpr25ppt课件3.2 3.2 齐次变换及运算齐次变换及运算3.2.23.2.2、齐次坐标变换、齐次坐标变换 为什么学习齐次坐标表示？将坐标系的平移和旋转用一个矩阵统一表示。26ppt课件1、
10、齐次坐标的定义 空间中任一点在直角坐标系中的三个坐标分量用 表示，若有四个不同时为零的数 与三个直角坐标分量之间存在以下关系：则称 是空间该点的齐次坐标。3.2 3.2 齐次变换及运算齐次变换及运算3.2.23.2.2、齐次坐标变换、齐次坐标变换),(zyxkzzkyykxx ,),(kzyx ),(kzyx 以后用到齐次坐标时，一律默认k=1。27ppt课件3.2 齐次变换及运算齐次变换及运算iijijjorgpR pp2、齐次坐标变换 为何使用齐次坐标？在进行联合变换时，变换关系为：28ppt课件将其写成统一的矩阵形式则有：3.2 3.2 齐次变换及运算齐次变换及运算 110001000c
11、ossin0sincos1jjjzyxiiizyxpppzyx 11ijijppM式中，称为齐次坐标变换矩阵，它是一个44的矩阵。ijM29ppt课件1）、齐次坐标变换矩阵的意义 若将齐次坐标变换矩阵分块，则有：意义：左上角的33矩阵是两个坐标系之间的旋转变换矩阵，它描述了姿态关系；右上角的31矩阵是两个坐标系之间的平移变换矩阵，它描述了位置关系，所以齐次坐标变换矩阵又称为位姿矩阵。3.2 3.2 齐次变换及运算齐次变换及运算 1010001000cossin0sincos,ijzijzyxijpRpppM 30ppt课件联合变换与单步齐次变换矩阵的关系：任何一个齐次坐标变换矩阵均可分解为一个
12、平移变换矩阵与一个旋转变换矩阵的乘积，即：3.2 3.2 齐次变换及运算齐次变换及运算100000010001000100011000zzzyyyxxxzyxzzzzyyyyxxxxijaonaonaonppppaonpaonpaonM注意：1、这里的平移和旋转都是相对i坐标系的，即绝对变换。2、矩阵相乘的次序是不可交换的。),(),(trans0kRotpppzyx31ppt课件3.2 3.2 齐次变换及运算齐次变换及运算 如图所示的两坐标系的位姿可以有两种理解：1、j先相对i旋转，再相对i平移，即绝对变换。2、j先相对i 平移，再相对平移后的j旋转，即相对变换。ij 可见，同样的位姿，既可
13、以按照绝对运动来实现，也可以按相对运动来理解，但两种方法的矩阵表达式是不同的。32ppt课件3.2 3.2 齐次变换及运算齐次变换及运算 结论：左乘和右乘原则：绝对运动变换矩阵左乘，即先做的在右边，后做的在左边。相对运动变换矩阵右乘，即先做的在左边，后做的在右边。33ppt课件3.2 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)如果上述运动为
14、相对运动，则应用右乘原则。有：MAB=Rot(z,90)Rot(x,90)Trans(3,-5,9)34ppt课件2）、齐次变换的逆变换 设：，等号两边同乘得：可知：求齐次变换的逆可按一般矩阵求逆的方法进行，也可按几何意义求。3.2 3.2 齐次变换及运算齐次变换及运算1ABMPMPBABAPMPPMMPMABABBABABAAB11BAABMM135ppt课件3.2 3.2 齐次变换及运算齐次变换及运算 正、逆变换间的几何意义：顺序颠倒，符号取反，如图所示。36ppt课件齐次变换的逆变换若齐次坐标变换矩阵为：则：3.2 3.2 齐次变换及运算齐次变换及运算 101000ijijzzzzyyy
15、yxxxxijpRpaonpaonpaonM 1000101apaaaopooonpnnnpRRMMzyxzyxzyxijTijTijijji37ppt课件2）、齐次变换的逆变换 设：则：3.2 3.2 齐次变换及运算齐次变换及运算101000)(1)(0)(0100)(0)(cos)()sin(0cossin)(0)(sin)(cos0sincos1ijTijTijzyxzyxzyxjiijpRRpppppppppMM10001000cossin0sincoszyxijpppM38ppt课件3）、联合变换与单步齐次矩阵的关系 当空间有任意多个坐标系时，若已知相邻坐标系之间的齐次坐标变换矩阵，则由坐标变换原理可知：由此可知，建立机器人的坐标系，可以通过齐次坐标变换，将机器人手部在空间的位置和姿态用齐次坐标变换矩阵描述出来，从而建立机器人的运动学方程。3.2 齐次变换及运算0i-1innniinMMMMM1112010 39ppt课件3.2 齐次变换及运算40ppt课件
