第二章 机器人运动学
机器人，尤其是其中最为常用的关节型机器人，由若干个关节所联系起来的一种开链，其一端固结在机座上，另一端安装有末端执行器。已知所有关节变量确定机器人末端执行器的位姿或者由末端手的位姿计算出每一个关节变量值是机器人运动学研究的主要内容。
本章主要介绍机器人运动学，首先介绍了 1.1齐次坐标与齐次变换
在描述刚体（如零件、工具或机械手）间关系时，要用到点、向量、坐标系、平移、旋转以及变换等概念，这些概念可用齐次矩阵来表示。
1.1.1空间点的表示
在指定的直角坐标系{}A 中，空间任一点P （图2-1）的位置可用13?的列矢量P A
表
示：
[
]
z y
x
A
p p p P = （2.1）
其中x p ，y p ，z p 为点P 的三个坐标分量，P A
的上标A 代表参考坐标系{}A ，称P A
为位置矢量。
图2-1位置表示
1.1.2空间向量的表示
将一个n 维空间的点用1+n 维坐标表示，则该1+n 维坐标即为n 维坐标的齐次坐标，即：
[
]
T
z y
x
A
p p p P 1= （2.2）
在上式中加入一个比例因子w ，点P 表示为：
[
]
T
z
y x
A
w c b a P = （2.3）
其中，w p a x x =，w p b y y =，w p c z z =。式2.2和2.3表示同一个点P 。 起始于原点，终止于P 点的空间向量也可以采用齐次矩阵形式表示：
[
]
T
z
y
x w c b a P = （2.4）
若比例因子w 变化，向量的大小也会发生变化，w 大于1，向量所有的分量都变大，如果w 小于1，向量所有的分量都变小，w 等于1，各分量的大小保持不变。w 等于0表示该向量的方向，称为方向向量。如图2-2中，i 、j 、k 分别表示直角坐标系中X 、Y 、Z 坐标轴的单位矢量，用齐次坐标表示为：
[]T X 0001= []T Y 0010=[]T
Z 0100= （2.5）
图2-2中所示的矢量u 的方向表示为：
[]T
u 0cos cos cos γ
β
α= （2.6）
其中α、β、γ分别为矢量u 与坐标轴的夹角。 1.1.3刚体位姿的表示
为了研究机器人的运动，往往不仅要表示空间某个点的位置，而且需要表示刚体的姿态。指定一个坐标系与此刚体固接，再将此坐标系在空间表示出来，该坐标系称为动坐标系。如
图2-3所示，O '为刚体上任一点，Z Y X O '''
'为固接在刚体上的一个动坐标系，动坐标系的原点与固定坐标系原点之间做一个向量P 来表示动坐标系的位置，即为式2.2。动坐标系的姿态可由其坐标轴方向来表示，令n 、o 、a 分别为X '、Y '、Z '坐标轴的单位向量，每个向量都由其所在固定坐标系中的三个分量表示：
[]
[][
]
??
?
??===T
z
y
x T z y x T z y x
a a a
a o o o o n n n n 000
（2.7） 动坐标系的位姿可以由三个表示方向的单位向量以及第四个位置向量来表示，式中前三个向量是0=w 的方向向量，表示该坐标系的三个单位向量n 、o 和a 的方向，而第四个
1=w 的向量表示动坐标系的原点相对于固定坐标系的位置。与单位向量不同，向量P 的长
度十分重要，因而比例因子为1。
[]?????
???????==10
00
z z z z y y y y
x x x x
p a o n p a o n p a o n p a
o n F （2.8） 由于动坐标系一直固接在该刚体上，只要动坐标系在空间表示出来，刚体相对于固定坐
标系的位姿也可以采用式2-8进行描述。空间中的刚体具有沿着X 、Y 和Z 三轴的移动和绕三轴的旋转，因此需要6条独立的信息描述刚体的位姿。而式2-8中给出了12条信息，其中9条为姿态信息，3条为位置信息。三个单位向量n 、o 和a 两两正交，因而它的9个元素满足6个约束条件：
0=?=?=?o a a n o n （2.9）
1===a o n （2.10）
1.2齐次变换
变换为空间的一个运动，由旋转和平移组成。当空间的一个坐标系相对于固定的参考坐
标系运动时，这一运动可以用类似于表示坐标系的方式来表示。变换本身就是坐标系位姿的变换，分为以下几种形式：
1.2.1平移的齐次变换
一个坐标系（或刚体）在空间中以不变的姿态运动，该变换为平移变换。坐标系的单位向量保持同一方向不变，所有改变只是坐标系原点相对于参考坐标系的变化，如图2-2所示。相对于固定参考系的新的坐标系的位置可以用原来坐标系的原点位置向量加上表示位移的向量求得。变换矩阵为：
??
???
????
???=100
100010001
z y x d d d T （2.9） 其中x d ，y d 和z d 是纯平移向量d 相对于参考坐标系x ，y 和z 轴的三个向量，矩阵T 的前三列等同于单位矩阵，表示没有旋转运动，最后一列表示平移运动。若坐标系平移前的位姿矩阵为：
????
?
?
???
???=1000z y x old
P az oz nz P ay oy ny P ax ox nx F （2.9） 则，坐标系平移后的位姿矩阵为：
?????
?
??????+++=???
??????????=1000100
100010001z z y y x x old z y x new
d P az oz nz d P ay oy ny d P ax ox nx F d d d F （2.9） 也可表示为：
old z y x new F d d d Trans F ?=),,( （2.9）
对比式子2.9和2.9，坐标系平移变换前后的位姿矩阵维数相同，方向向量保持不变，
仅是位置向量发生变换，即为d 和P 相加的结果。
1.2.2旋转的齐次变换
空间某点P ，坐标为),,(z y x P P P ，当它绕x 轴旋转角后至P '点，坐标为),,(z y x P P P '''，
P 点和P '点的坐标关系为：
???
??+=-=='θ
θθθcos sin sin cos z y z
z y y x
x P P P P P P P P （2.9） 写成矩阵形式为：
????
?
???????????????-=??????????'''z y x z y x P P P P P P θθ
θθc o s s i n 0
s i n c o s
01
（2.9）
也可表示为：
P x Rot P ?='),(θ （2.9）
),(θx Rot 表示齐次坐标变换时绕x 轴的旋转变换矩阵，第一列表示相对于x 轴的位置，
其值为1，0，0，它表示沿着x 轴的坐标没有改变。习惯上采用符号θC 表示θcos ，θS 表示θsin ，因此旋转矩阵表示为：
????
?
?????-=θθ
θθ
θC S S C x Rot 0000
1),( （2.9） 将上式矩阵写成44?的齐次变换矩阵为：
?????
??
??
???-=10
000000001),(θθθθ
θC S S C x Rot （2.9） 同理，绕y 轴和z 轴的旋转矩阵分别为：
??
???????
???-=10
00
000010
00),(θθθθθC S S C y Rot ?????
???????-=10
00
01000000),(θθθ
θ
θC S S C z Rot （2.9） 1.2.3复合变换
复合变换是由固定参考坐标系或当前运动坐标系的一系列沿轴平移和绕轴旋转变换所
组成的。任何变换都可以分解为按一定顺序的一组平移和旋转变换，将两种变换组合在一个齐次变换中，称为复合变换。在计算变换矩阵时，要考虑算子左、右乘规则：如果相对于固定坐标系进行变换，则算子左乘；如果相对于动坐标系进行变换，则算子右乘。
动坐标系()a o n ,,相对于参考坐标系()z y x ,,依次进行下面三种变换：（1）绕x 轴旋转α
度；（2）接着沿x 轴平移1l ，沿z 轴平移3l ；（3）最后，绕y 轴旋转β度。
点P 固连在动坐标系上，动坐标系与固定坐标系重合，随着动坐标系()a o n ,,相对于固
定坐标系旋转或平移时，坐标系中的P 点相对于固定坐标系也跟着改变，第一步变换后，P 点相对于固定坐标系的坐标为：
P x Rot P xyz ?=),(,1α； （2.9）
第二步变换后，P 点相对于固定坐标系的坐标为：
P x Rot l l Trans
P l l Trans P xyz xyz ??=?=),(),0,(),0,(31,131,2α； （2.9） 第三步变换后，P 点相对于固定坐标系的坐标为：
P x Rot l l Trans
y Rot P y Rot P xyz xyz ???=?=),(),0,(),(),(31,2,3αββ； （2.9）
每一步变换都是用变换矩阵左乘P 点的坐标得到该点相对于固定坐标系的坐标，矩阵
的书写顺序和进行变换的顺序正好相反，变换的顺序很重要，如果颠倒了变换的顺序，结果将完全不同。
1.2.4相对于动坐标系的变换
上述介绍的变换是相对于固定坐标系进行的，所有的平移距离和旋转角度都是相对于参
考坐标系轴来测量的。在实际应用中，也有可能相对于动坐标系或当前坐标系的轴变换。点
P 固连在动坐标系()a o n ,,上，依次进行下面三种变换：（1）绕a 轴旋转α度；（2）接着
沿n 轴平移1l ，沿a 轴平移3l ；（3）最后，绕o 轴旋转β度。
为了计算当前坐标系中点的坐标相对于参考坐标系的变化，这时需要右乘变换矩阵而不
是左乘。第一步变换后，P 点相对于固定坐标系的坐标为：
P a Rot P xyz ?=),(,1α； （2.9）
第二步变换后，P 点相对于固定坐标系的坐标为：
P l l Trans a Rot P xyz ??=),0,(),(31,2α； （2.9）
第三步变换后，P 点相对于固定坐标系的坐标为：
P Rot l l Trans a Rot P xyz ???=),(),0,(),(31,3βοα； （2.9）
1.3机器人位姿分析 1.3.1杆件坐标系的建立
第二章 机器人运动学 机器人，尤其是其中最为常用的关节型机器人，由若干个关节所联系起来的一种开链，其一端固结在机座上，另一端安装有末端执行器。已知所有关节变量确定机器人末端执行器的位姿或者由末端手的位姿计算出每一个关节变量值是机器人运动学研究的主要内容。 本章主要介绍机器人运动学，首先介绍了 1.1齐次坐标与齐次变换 在描述刚体（如零件、工具或机械手）间关系时，要用到点、向量、坐标系、平移、旋转以及变换等概念，这些概念可用齐次矩阵来表示。 1.1.1空间点的表示 在指定的直角坐标系{}A 中，空间任一点P （图2-1）的位置可用13?的列矢量P A 表 示： [ ] z y x A p p p P = （2.1） 其中x p ，y p ，z p 为点P 的三个坐标分量，P A 的上标A 代表参考坐标系{}A ，称P A 为位置矢量。 图2-1位置表示 1.1.2空间向量的表示 将一个n 维空间的点用1+n 维坐标表示，则该1+n 维坐标即为n 维坐标的齐次坐标，即： [ ] T z y x A p p p P 1= （2.2） 在上式中加入一个比例因子w ，点P 表示为： [ ] T z y x A w c b a P = （2.3） 其中，w p a x x =，w p b y y =，w p c z z =。式2.2和2.3表示同一个点P 。 起始于原点，终止于P 点的空间向量也可以采用齐次矩阵形式表示：
[ ] T z y x w c b a P = （2.4） 若比例因子w 变化，向量的大小也会发生变化，w 大于1，向量所有的分量都变大，如果w 小于1，向量所有的分量都变小，w 等于1，各分量的大小保持不变。w 等于0表示该向量的方向，称为方向向量。如图2-2中，i 、j 、k 分别表示直角坐标系中X 、Y 、Z 坐标轴的单位矢量，用齐次坐标表示为： []T X 0001= []T Y 0010=[]T Z 0100= （2.5） 图2-2中所示的矢量u 的方向表示为： []T u 0cos cos cos γ β α= （2.6） 其中α、β、γ分别为矢量u 与坐标轴的夹角。 1.1.3刚体位姿的表示 为了研究机器人的运动，往往不仅要表示空间某个点的位置，而且需要表示刚体的姿态。指定一个坐标系与此刚体固接，再将此坐标系在空间表示出来，该坐标系称为动坐标系。如 图2-3所示，O '为刚体上任一点，Z Y X O ''' '为固接在刚体上的一个动坐标系，动坐标系的原点与固定坐标系原点之间做一个向量P 来表示动坐标系的位置，即为式2.2。动坐标系的姿态可由其坐标轴方向来表示，令n 、o 、a 分别为X '、Y '、Z '坐标轴的单位向量，每个向量都由其所在固定坐标系中的三个分量表示： [] [][ ] ?? ? ??===T z y x T z y x T z y x a a a a o o o o n n n n 000 （2.7） 动坐标系的位姿可以由三个表示方向的单位向量以及第四个位置向量来表示，式中前三个向量是0=w 的方向向量，表示该坐标系的三个单位向量n 、o 和a 的方向，而第四个 1=w 的向量表示动坐标系的原点相对于固定坐标系的位置。与单位向量不同，向量P 的长 度十分重要，因而比例因子为1。 []????? ???????==10 00 z z z z y y y y x x x x p a o n p a o n p a o n p a o n F （2.8） 由于动坐标系一直固接在该刚体上，只要动坐标系在空间表示出来，刚体相对于固定坐
第二章机器人基础知识 2.3工业机器人运动学(二) 【内容提要】 本课主要学习工业机器人技术的运动学基础知识，涉及连杆参数及连杆坐标系的建立、连杆坐标系之间的变换矩阵、机器人运动学一般方程，并介绍了正逆向运动学以及实例。 知识要点： ?连杆坐标系 ?连杆坐标系之间的变换矩阵 ?机器人运动学一般方程 重点： ?掌握连杆坐标系之间的变换矩阵 ?掌握机器人运动学一般方程的建立 ?掌握机器人正逆向运动学的实例 难点： ?机器人运动学一般方程的建立 关键字： ?连杆参数、变换矩阵、运动学一般方程、
【本课内容相关资料】 2.3.4 工业机器人的连杆参数和齐次变换矩阵 1. 连杆参数及连杆坐标系的建立 工业机器人相邻连杆之间的关系，与连杆自身的特征和连杆之间的连接方式有关。因此，我们首先应该清楚如何对连杆的特征和连接方式进行描述。 1）连杆特征的描述 如图2.35所示，连杆i 两端有关节i 和i +1。该连杆的特征可以用两个参数来描述：一个是两个关节轴线沿公垂线的距离l i ，称为连杆长度；另一个是在垂直于公垂线的平面内两个轴线的夹角αi ，称为连杆扭角。这两个参数为表述连杆特征的尺寸参数。连杆长度l i 恒为非负数，但连杆扭角αi 可正、可负。αi 的正负是这样规定的：公垂线的正向规定为从 关节i 指向关节i +1，按右手法则从轴线i 绕公垂线转至轴线i +1，逆时针为正，瞬时针为负。两轴线平行时，αi ＝0；两轴线相交时，l i ＝0，此时扭角αi 为两轴线的夹角，正负与X i 轴选向有关。 2）连杆连接方式的描述 如图2.36所示，连杆i 与连杆i -1通过关节i 相连，因此，关节i 的轴线有两条公垂线与它垂直。两条公垂线的相对位置可用两个参数d i 和θi 来确定，其中d i 是沿关节i 轴线测量的两个公垂线与i 轴线交点的距离，当关节轴线相交时，d i 为i 轴线上两交点的距离；θi 是在关节i 轴线的垂直平面内两个公垂线的夹角，当公垂线不存在时，对旋转关节θi 仍然存在。d i 和θi 是表达相邻连杆连接关系的参数。d i 和θi 都可正、可负(详见表2.8)。 这样，相邻两个连杆之间的关系可以由四个参数所描述：其中两个参数（l i 和αi ）描述连杆i 的尺寸；另外两个参数（d i 和θi ）描述连杆i 和连杆i -1之间的连接关系。对于旋转关节，θi 是关节变量，其它三个参数固定不变；对于移动关节，d i 是关节变量，其它三个参数固定不变。(对照图2.36解释，一个关节即为一个自由度) 3）连杆坐标系的建立 D-H 法要求按下面规则建立连杆i 的坐标系{i }（简称i 系）： 1）坐标系{i }与连杆i 固连。Z i 轴与关节i +1的轴线重合，指向任意； 2） X i 轴与连杆i 的两个关节轴线的公垂线重合，方向从关节i 指向关节i +1。当l i 连杆i 关节+1 αi l i 图2.35 连杆尺寸参数l i 及αi