《机器人原理与应用》

第四章位置运动学东北大学人工智能与机器人研究所2016.9整理课件几个基本概念运动学：处理运动的几何学以及与时间有关的量，而不考虑引起运动的力。位置运动学：只处理运动的几何学，而不考虑运动的时间。机器人的位置运动学存在有两类问题：

1、根据关节变量求手部位姿是位置运动学正问题；

2、根据手部位姿求关节变量是位置运动学逆问题，又称为手臂解。整理课件关节空间笛卡儿空间正向变换逆向变换笛卡尔空间又常称之为任务空间整理课件本章的主要内容4.1D-H参数的确定4.2从关节变量到手部位姿——运动学正问题4.3从手部位姿到关节变量——运动学逆问题习题整理课件4.1D-H参数的确定具有n个关节自由度的机器人系统，其齐次矩阵可表示为

为建立运动学方程，要讨论相邻连杆运动关系，为此引入机器人学中的重要参数—Denavit-Hartenberg参数，简称为D-H参数。整理课件4.1.1以回转副连接的两杆件的D-H参数的确定定义：在杆件i-1前端的坐标系视为基础坐标系B，在杆件i

前端的坐标系视为运动坐标系H。整理课件i-1和i关节各坐标轴的定义整理课件整理课件C）手爪坐标系

z轴设在手指接近物体的方向，称为接近矢量；y轴设在两手指的连线方向，称为方位矢量；x轴由右手系确定，即，称为法向矢量。a(z)o(y)n(x)B）基座坐标系和n坐标系的确定

从基座到末端执行器，给各关节依次标号：1，2，、、、，n；在基座上设置右手直角坐标系ΣO0，使Z0沿着关节1的轴线，X0或Y0可以任选。最后一个坐标系ΣOn与末端执行器（手爪）的坐标系重合。整理课件4.1.2变换矩阵的确立若已知四个参数、、及就完全确定了连杆i-1和连杆i之间的相对关系。对此，我们建立i-1和i坐标系之间的变换关系。对于旋转关节可以确定以下的齐次矩阵：整理课件对于旋转关节：（1）绕Zi-1轴旋转θi角，使Xi-1轴与Xi轴和Zi-1轴在同一平面上；（2）沿Zi-1轴平移一距离di，使Xi-1轴与Xi轴重合；（3）沿Xi轴平移一距离ai，使连杆i-1的坐标系原点与连杆i的坐标系原点重合；（4）绕Xi轴旋转αi角，使Zi-1轴与Zi轴重合。整理课件将上式展开整理课件4.1.3以移动副连接的两杆件的

D-H参数的确定若杆件以移动副相连接时，则连杆的坐标系的建立与参数的规定同回转副连接的杆件的规定相类似，但是连杆的长度已经没有意义，故可以令其为零。可得齐次矩阵为整理课件4.2从关节变量到手部位姿

——运动学正问题4.2.1三种简化情况的齐次变换矩阵

a、关节变量是伸缩臂的长度d整理课件b、θ-r操作机（平行轴情况）整理课件简化转动关节

条件：杆件均为直杆，即为公共法线，与x轴重合。故d=0.整理课件4.2.2运动学方程求解实例6关节机器人手爪坐标系整理课件机器人的最后一个构件（手部）由三个自由度来确定位置，三个自由度确定其方向；我们将描述其位置和方向的坐标系原点定在两个手指的中间，用一个向量P描述这个原点；三个向量，和描述机器人的姿态；当手部处于初始位置和姿态时，向量指向手接近物体的方向，其单位向量称为接近向量；向量的单位向量称为方向向量；向量的单位向量称为法线向量。整理课件6关节机械手的端部对基座的关系可用下列矩阵表示：

变换Z－－机械手与参考坐标系的相对关系，变换E－－机械手与其端部工具的关系，变换X－－此工具端部对参考坐标系的位置和方向整理课件从图中可求得：整理课件具有6个简化转动关节的操作机6个简化转动关节的操作机由转动坐标臂和手腕组成，如图所示：整理课件6关节操作机齐次矩阵中的D-H参数对于简化转动关节。整理课件由上述条件可得：整理课件则：其中：整理课件PUMA560运动学方程θ1θ2θ3θ4θ5θ6关节变量都是θ整理课件（１）θi是从Xi-1到Xi绕Zi-1旋转的角度；（２）di是从Xi-1到Xi沿Zi-1测量的距离；（３）ai是从Zi-1到Zi沿Xi测量的距离；（４）αi是从Zi-1到Zi绕Xi旋转的角度。整理课件（1）连杆参数（2）A矩阵整理课件零位校验：零位校验：零位校验：整理课件零位校验：零位校验：零位校验：整理课件=整理课件零位校验：

令得整理课件Stanford机器人运动学（１）θi是从Xi-1到Xi绕Zi-1旋转的角度；（２）di是从Xi-1到Xi沿Zi-1测量的距离；（３）ai是从Zi-1到Zi沿Xi测量的距离；（４）αi是从Zi-1到Zi绕Xi旋转的角度。整理课件（1）连杆参数（2）A矩阵整理课件这里略去了零位校验整理课件本文讲述的方法书上讲述的方法3.1.3.3

另一种连杆坐标系的建立

整理课件结论：3.选择不同的连杆坐标系，相应的连杆参数将会发生变化。

１.一般来说，机器人的坐标系可以任意建立；

２.如果不是按照D-H方法建立连杆坐标系，则不能按照A矩阵表达式来求解相邻连杆坐标系之间的变换；整理课件4.3从手部位姿到关节变量

—运动学逆问题4.3.1θ-r操作机的手臂解

对于θ-r操作机，其逆变换就是由表示手部位姿的齐次矩阵求操作机的两个关节变量。由手坐标系到基座坐标系的齐次矩阵可以表示为：即：整理课件其中：令上面矩阵的对应元素分别相等，则：从而推出：整理课件而：令其中的对应元素分别相等，则可以得到：整理课件正解：其实问题很简单逆解：整理课件4.3.2手部姿态角的确定手部的姿态可以用绕x，y，z轴依次转动侧摆，俯仰和横滚获得：

等式左式与右式对应元素相等，最终可得：整理课件4.3.36关节操作机的手臂解

6关节操作机位置运动学逆问题就是由描述手部位姿的齐次矩阵

求解构成手臂的六个关节角

、

、

、

、

、

，这一逆问题又称为手臂解。操作机手部位姿的齐次矩阵为：将上式等式两边左乘以矩阵则可以得到：令左式与右式的矩阵元素（3，4）相等可得：于是得到：整理课件由于无法找到新的关节角的解，于是继续左乘得到：从以上方程无法找到有用的信息，这是因为这两个关节互相平行，事实上直到达到非平行关节时才能找到有用的方程，即：进而可以写成：整理课件令上式等式的对应元素分别相等，则从（3,3）可以得到：进而：为了简化计算，规定：整理课件所以：整理课件最后为了获得的信息，将最后的矩阵等式左乘以可得到：由上式可解出：整理课件4.3.4在求手臂解时出现的两个问题

奇异问题：当进行逆变换的计算时要做除法，而当分母趋于零时便会出现奇异现象。如在θ−r

操作机中r=0。

退化问题：在求逆问题时可能出现多解现象，即同一操作机位姿对应于多于一组的关节变量的解存在，则手臂处于退化状态。显然这种不确定性的问题很容易解决。整理课件奇异问题：

边界奇异形位：PUMA560的θ3在-90º附近，手臂伸直，处于边界奇异状态；内部奇异形位：由两个关节轴线或多个关节轴线重合造成的。操作臂各关节运动相抵消，不产生操作运动。PUMA560θ5=0º时，关节4和6轴线重合，丧失了一个自由度，处于内部奇异状态。整理课件机器人奇异情况分析整理课件退化问题在操作机的设计中，为了达到回避障碍等目的，常常需要使操作机具有多于6个的自由度。这时同一手臂的位姿有无穷多个关节变量相对应，称为无穷退化手臂。人的手臂就具有这种特点。整理课件PUMA机器人的四种运动学逆解整理课件手腕翻转的两种逆解整理课件习题转动－平动三关节手臂习题解垂直三关节手臂习题解整理课件3.1.3.5

关节空间和操作空间

机械手的末端位姿由n个关节变量所决定，这n个关节变量统称为n维关节矢量，所有关节矢量构成的空间称为关节空间。

末端手爪的位姿是在直角坐标空间中描述的，即用操作空间或作业定向空间来表示。

各驱动器的位置统称为驱动矢量。所有驱动矢量构成的空间称为驱动空间。整理课件3.2

移动机器人运动学

以两轮差速驱动方式的移动机器人为例，建立其运动学方程。所做的基本假设如下：(1)车体所在路面为光滑平面；(2)车轮在运动过程中，在纵向作纯滚动，没有侧向滑移；(3)车体有关参数，如左右轮直径和左右轮间距在车