第2章 工业机器人运动学-old

工业机器人基础讲义 第2章 工业机器人运动学

注：1）2008年春季讲课用；2）带下划线的黑体字为板书内容；3）公式及带波浪线的部分为必讲内容

第2章 工业机器人运动学

2.1 引言

通过上一章的学习我们知道，从机构学的角度看，工业机器人可以认为是用一系列关节连接起来的连杆所组成的开链机构。工业机器人运动学研究的是各连杆之间的位移关系、速度关系和加速度关系。本章仅研究位移关系，重点是研究手部相对于机座的位姿与各连杆之间的相互关系。“位姿”是“位置和姿态”的简称。

工业机器人手部相对于机座的位姿与工业机器人各连杆之间的相互关系直接相关。为了便于数学上的分析，一般选定一个与机座固联的坐标系，称为固定坐标系，并为每一个连杆（包括手部）选定一个与之固联的坐标系，称为连杆坐标系。一般把机座也视为一个连杆，即零号连杆。这样，连杆之间的相互关系可以用连杆坐标系之间的相互关系来描述。工业机器人手部相对机座的位姿就是固联在手部的坐标系相对固定坐标系的位姿。

工业机器人运动学主要包括正向运动学和反向运动学两类问题。正向运动学是在已知各个关节变量的前提下，解决如何建立工业机器人运动学方程，以及如何求解手部相对固定坐标系位姿的问题。反向运动学则是在已知手部要到达目标位姿的前提下，解决如何求出关节变量的问题。反向运动学也称为求运动学逆解。

在工业机器人控制中，先根据工作任务的要求确定手部要到达的目标位姿，然后根据反向运动学求出关节变量，控制器以求出的关节变量为目标值，对各关节的驱动元件发出控制命令，驱动关节运动，使手部到达并呈现目标位姿。可见，工业机器人反向运动学是工业机器人控制的基础。在后面的介绍中我们会发现，正向运动学又是反向运动学的基础。 工业机器人相邻连杆之间的相对运动不是旋转运动，就是平移运动，这种运动体现在连接两个连杆的关节上。物理上的旋转运动或平移运动在数学上可以用矩阵代数来表达，这种表达称之为坐标变换。与旋转运动对应的是旋转变换，与平移运动对应的是平移变换。坐标系之间的运动关系可以用矩阵之间的乘法运算来表达。用坐标变换来描述坐标系（刚体）之间的运动关系是工业机器人运动学分析的基础。

在工业机器人运动学分析中要注意下面四个问题：

1）工业机器人操作臂可以看成是一个开式运动链，它是由一系列连杆通过转动或移动关节串联起来的。开链的一端固定在机座上，另一端是自由的。自由端安装着手爪（或工具，统称手部或末端执行器），用以操作物体，完成各种作业。关节变量的改变导致连杆的运动，从而导致手爪位姿的变化。

2）在开链机构简图中，关节符号只表示了运动关系。在实际结构中，关节由驱动器驱动，驱动器一般要通过减速装置（如用电机或马达驱动）或机构（如用油缸驱动）来驱动操作臂运动，实现要求的关节变量。

3）为了研究操作臂各连杆之间的位移关系，可在每个连杆上固联一个坐标系，然后描述这些坐标系之间的关系。Denavit和Hartenberg提出一种通用的方法，用一个4×4的齐次变换矩阵描述相邻两连杆的空间关系，从而推导出“手部坐标系”相对于“固定坐标系”的齐次变换矩阵，建立操作臂的运动方程。

4）在轨迹规划时，人们最感兴趣的是手部相对于固定坐标系的位姿。

黄海东 第 1 页 共 31 页

工业机器人基础讲义 第2章 工业机器人运动学

2.2 齐次坐标及对象物的描述

齐次变换具有较直观的几何意义，非常适合描述坐标系之间的变换关系。另外，齐次变换可以将旋转变换与平移变换用一个矩阵来表达，关系明确，表达简洁。所以常用于解决工业机器人运动学问题。下面我们先介绍有关齐次坐标和齐次变换的内容。 2.2.1 点的位置描述 如图2-1所示，在选定的三维空间直角坐标系{A}中，空间任一点P的坐标可以用一个(3×1)列阵（或称三维列向量）Ap表示，即：

?x?Z ? Ap??y (2-1) ????z??式中：X，y，z是点P在坐标系{A}中的三个坐标分量；

Ap的左上标A代表选定的参考坐标系。 2.2.2 齐次坐标

{A} P(x，y，z) O Y 如果用四个数组成的(4×1)列阵（或称四维列向量）表示三维空间直角坐标系{A}中的点P，即：

X 图2-1 点的位置描述 x???y? (2-2) p???

?z????1?则定义列阵[x y z 1]T为三维空间点P的齐次坐标。 必须注意，齐次坐标的表示不是唯一的。如果将列阵p中的元素同乘一非零系数w后，仍然代表同一点P，即：

?x??a??y??b? (2-3) p??????

?z??c??????1??w?式中：x＝a/w，y＝b/w，z＝c/w。 2.2.3 坐标轴的描述 如图2-2所示，i、j、k分别是直角坐标系中X、Y、Z坐标轴的单位矢量，若用齐次坐标来描述X、Y、Z轴，则定义下面三个(4×1)列阵分别为单Z

v 位矢量i、j、k（即X、Y、Z坐标轴）的方向列阵。

k i＝[1 0 0 0]T h ? T

j＝[0 1 0 0]

? k＝[0 0 1 0]T

O 图2-2中所示矢量v的单位矢量h的方向列阵为：

Y j ? h＝[a b c 0]T＝[cos? cos? cos? 0]T (2-4) i

式中，?、?、?分别是矢量v与坐标轴X、Y、Z的夹角，0????180?，

X

0??? ?180?，0??? ?180?。cos?、cos?、cos?称为矢量v的方向图2-2 坐标轴及矢量的描述

黄海东

第 2 页 共 31 页

工业机器人基础讲义 第2章 工业机器人运动学

余弦，且满足cos2?+cos2?+cos2?＝1。 综上所述，可得下面两点结论：

1）(4×1)列阵[a b c w]T中第四个元素不为零，则表示空间某点的位置；

2）(4×1)列阵[a b c 0]T中第四个元素为零，且a2+b2+c2＝1，则表示某个坐标轴(或某个矢量)的方向，[a b c 0]T称为该矢量的方向列阵。

表示坐标原点的(4×1)列阵定义为：o＝[0 0 0 ?]T ?≠0

[例2-l] 用齐次坐标分别写出图2-3中矢量u、v、w的方向列阵。 Z Z Z u

v w ? ? ?

?

? ?

O O O ? ? Y Y Y ?

?＝90? ?＝45? ?＝60?

?＝45? ?＝90? ?＝60?

X X X ?＝45? ?＝45? ?＝45?

解：矢量u：u＝[cos? cos? cos? 0]＝[0.0 0.7071 0.7071 0]T 矢量v：v＝[cos? cos? cos? 0]T＝[0.7071 0.0 0.7071 0]T 矢量w：w＝[cos? cos? cos? 0]T＝[0.5 0.5 0.7071 0]T 2.2.4 动坐标系位姿的描述 对动坐标系位姿的描述就是相对固定坐标系对动坐标系原点位置的描述以及对动坐标系三个坐标轴方向的描述，现以两个实例说明。 1）刚体位姿的描述

组成工业机器人的每一个连杆都可以看作是一个刚体。若给定了刚体上某一点的位置和该刚体在空间的姿态，则这个刚体在空间上是完全确定的。

设有一刚体Q，如图2-4所示，在刚体上选任一点O?，建立与刚体固连的坐标系O?X?Y?Z?，称为动坐标系。O?点在固定坐标系OXYZ中Z? Z Q 的位置可用齐次坐标形式的(4×1)列阵表示为：

a ?x0?o Y? ?y?0O?(x0，y0，z0) (2-5) p??? p ?z0?n ???1?X? O 刚体姿态可用动坐标系三个坐标轴的方向来表示。令

Y n、o、a分别为X?、Y?、Z?坐标轴的单位方向矢量，每个

X 单位方向矢量在固定坐标系上的分量为动坐标系该坐标

图2-4 刚体的位置和姿态

轴的方向余弦，用齐次坐标列阵分别表示为：

n＝[ix iy iz 0]T＝[cos?X? cos?X? cos?X? 0]T o＝[ox oy oz 0]T＝[cos?Y? cos?Y? cos?Y? 0]T (2-6)

TT

a＝[ax ay az 0]＝[cos?Z? cos?Z? cos?Z? 0]

式中：?X?、?Y?、?Z?分别为X?、Y?、Z?坐标轴与X坐标轴的夹角； ?X?、?Y?、?Z?分别为X?、Y?、Z?坐标轴与Y坐标轴的夹角；

黄海东

第 3 页 共 31 页

图2-3 用不同方向角描述的方向矢量u

T

工业机器人基础讲义 第2章 工业机器人运动学

?X?、?Y?、?Z?分别为X?、Y?、Z?坐标轴与Z坐标轴的夹角。 因此，图2-4中刚体的位姿可用下面的(4×4)矩阵来描述：

?nxoxaxx0??noa?yyy0? (2-7) T?[noap]??y?nzozazz0???0001?? 很明显，对刚体Q位姿的描述就是对固连于刚体Q的坐标系O?X?Y?Z?位姿的描述。 [例2-2] 图2-5表示固连于刚体的坐标系{B}位于OB点，xb＝10，yb＝6，zb＝0。ZB轴和ZA轴与纸面垂直，坐标系{B}相对固定坐标系{A}有一个30?的偏转，试写出表示刚体位姿的坐标系{B}的(4×4)矩阵表达式。

解：XB的方向列阵：n＝[cos30? cos60? cos90? 0]T＝[0.866 0.5 0.0 0]T YB的方向列阵：o＝[cos120? cos30? cos90? 0]T＝[-0.5 0.866 0.0 0]T ZB的方向列阵：a＝[cos90? cos90? cos0? 0]T＝[0.0 0.0 1.0 0]T 坐标系{B}的位置列阵：p＝[10.0 6.0 0.0 1]T 所以，坐标系{B}的(4×4)矩阵表达式为： YB {B} ?0.866?0.5000.00010.0?XB OB(xB，yB，zB) ?0.5000.8660.0006.0?30? ?? T??0.0000.0001.0000.0?YA {A} ??001??0OA 2）手部位姿的表示 XA 图2-5 动坐标系{B}的描述 工业机器人手部的位姿也可以用固连于手部的坐标

系{B}的位姿来表示，如图2-6所示。坐标系{B}

可以这样来确定：取手部的中心点OB为原点；Z 关节轴为ZB轴，ZB轴的单位方向矢量a称为接近矢量，指向朝外；两个手指的连线为YB轴，OB 指向可任意选定，YB轴的单位方向矢量o称为姿p n XB O 态矢量；XB轴与YB轴及ZB轴垂直，XB轴的单a o Y 位方向矢量n称为法向矢量，且n＝o×a，指向{B} YB X ZB 符合右手法则。

手部的位置矢量为固定坐标系原点指向手图2-6 手部位置及姿态的描述 部坐标系{B}原点的矢量p，手部的方向矢量为

n、o、a。于是，手部的位姿可用(4×4)矩阵表示为：

?nxoxaxpx??noa?pyyyy? (2-8) T?[noap]???nzozazpz???0001?? [例2-3] 图2-7表示手部抓握物体Q，物体为边长2个单位的正立方体，写出表达该手部位姿的矩阵式。 解：因为物体Q的形心与手部坐标系O?X?Y?Z?的坐标原点O?重合，固定坐标系原点O为正立方体的后下方左侧顶点，所以手部位置的(4×1)列阵为：

黄海东 第 4 页 共 31 页

工业机器人基础讲义 第2章 工业机器人运动学

p＝[1 1 1 1]T

设n、o、a为手部坐标系三个坐标轴的单位方向矢量，由图2-7可知： 矢量n的方向角为：?X?＝90? ?X?＝180? ?X?＝90? 矢量o的方向角为：?Y?＝180? ?Y?＝90? ?Y?＝90?

Z 矢量a的方向角为：?Z?＝90? ?Z?＝90? ?Z?＝180? 于是有：

n＝[cos?X? cos?X? cos?X? 0]T＝[0 -1 0 0]T

o o＝[cos?Y? cos?Y? cos?Y? 0]T＝[-1 0 0 0]T (Y?) Y a＝[cos?Z? cos?Z? cos?Z? 0]T＝[0 0 -1 0]T n O? Q (X?) 根据式(2-8)可知，表达该手部位姿的矩阵式为： a (Z?) ?0?101???1001?X ? T?[noap]???00?11?图2-7 握住物体Q的手部 ??0001??2.2.5 目标物的齐次矩阵表示 设有一楔块Q如图2-8所示，坐标系OXYZ为固定坐标系，坐标系O?X?Y?Z?为与楔块

Q固连的动坐标系。在图(a)情况下，动坐标系O?X?Y?Z?与固定坐标系OXYZ重合。楔块Q的位置和姿态可用6个点的齐次坐标来描述，在图(a)情况下，其矩阵表达式为：

?ABCDEF??1?1?111?1???Q??000044?

??002200???1111??11?

Z Z(Z?) F(4, -1, 4) E(4, 1, 4) C(-1, 0, 2) B(-1, 0, 0) O (1, 0, 2) Y? D Y Q F(-1, 4, 0) Q A(4, 1, 0) O? B(4, -1, 0) O(O?) Y(Y?) X? Z? A(1, 0, 0) E(1, 4, 0) C(6, -1, 0) D(6, 1, 0) X(X?) (a) (b) X 图2-8 物体的齐次矩表示

若让楔块Q先绕Z轴旋转90?，再绕Y轴旋转90?，最后沿X轴方向平移4，则楔块成为图(b)之情况。此时楔块用新的6个点的齐次坐标来描述它的位置和姿态，其矩阵表达式为：

黄海东 第 5 页 共 31 页

本文来源：https://www.bwwdw.com/article/puat.html