第三章机器人运动学
合集下载
第三章机器人运动学
第三章机器人运动学机器人运动学是研究机器人如何在二维或三维空间中进行运动的学科。
它涉及到机器人的轨迹规划、运动控制和路径规划等重要内容。
本章将介绍机器人运动学的基本概念和常用模型，帮助读者全面了解机器人的运动规律和控制原理。
1. 机器人运动学的基本概念机器人运动学是研究机器人位置和姿态变化的学科，包括正运动学和逆运动学两个方面。
正运动学研究机器人的末端执行器的位置和姿态如何由关节变量确定；逆运动学则研究机器人如何通过末端执行器的位置和姿态来确定关节变量的值。
机器人的运动学建模一般采用DH（Denavit-Hartenberg）参数表示方法。
DH 参数是由Denavit和Hartenberg提出的一种机器人坐标系的选择和旋转轴的确定方法。
通过定义一系列关节坐标系，建立起机器人的坐标系链，并确定各个关节的旋转轴和约定的方向，可以方便地描述机器人的运动学特性。
2. 机器人正运动学机器人正运动学是研究机器人末端执行器位置和姿态如何由关节变量确定的问题。
在机器人的正运动学中，常用的方法有几何法和代数法。
2.1 几何法几何法是一种较为直观的方法，通过对机器人各个关节坐标系的位置和旋转进行推导，得到机器人末端执行器的位置和姿态。
几何法适用于无约束和无外力干扰的情况，可以简单快速地推导出机器人的正运动学方程。
2.2 代数法代数法是一种基于运动学链的代数运算的方法，通过DH参数建立起机器人的坐标系链，并通过矩阵运算推导出机器人的正运动学方程。
代数法在机器人正运动学的推导和计算过程中更具有普适性和灵活性。
3. 机器人逆运动学机器人逆运动学是研究机器人如何通过末端执行器的位置和姿态来确定关节变量的值的问题。
机器人逆运动学在机器人运动规划和路径控制中起到重要的作用。
机器人逆运动学的求解一般采用迭代方法，通过迭代计算来逼近解析解，实现对机器人关节变量的求解。
逆运动学的求解过程中可能会出现奇异点和多解的情况，需要通过约束条件和优化方法来处理。
第3章 机器人运动
3 齐次坐标变换 3.1齐次坐标变换 3.1齐次坐标变换 假设机器人手部拿一个钻头在 工件上实施钻孔作业，已知钻 头中心P点相对于手腕中心的 位置，求P点相对于基座的位 置。
x i o
zb kb yb jb o, ib xb P
z
k
j
y
分别在基座和手部设置为固定坐标系和动坐标系， 如图所示。
P点 相对于固定坐标系
1 4 0 −3 0 7 0 1
T中第一列的三个元素（0，1，0）T表示活动坐标系的u轴与 固定坐标系三个坐标轴之间的投影，故u轴平行于y轴；T中第 二列的三个元素（0，0，1）T表示活动坐标系的v轴与固定坐 标系三个坐标轴之间的投影，故v轴平行于z轴；T中第三列的 三个元素（1，0，0）T表示活动坐标系的w轴与固定坐标系三 个坐标轴之间的投影，故轴w平行于x轴；T中第四列的三个元 素（4，-3，7）T表示活动坐标系的原点与固定坐标系原点之 间的距离。
b
3.3.2 举例 ⋅ i i
z kb k o, xb i o xi y j y j
1 0 0 R = 0 1 0 0 0 1
所以
x0 X 0 = y0 z0
0 0 1 0 0 1 0 0
1 0 A = Trans( x0 , y0 , z0 ) = 0 0
上面所述的坐标变换每步都是相对于固定坐标系进行的，也可以 相对于动坐标系进行变换： 坐标系 {o , : u , v, w} 初始与固定坐标系 {o:x, y, z} 相重合，首先相对于固定坐标系平移
4i − 3 j + 7 k ；然后绕活动系的v轴旋转900；最后绕w轴旋转900。
变换的几何表示如图所示。这是合成变换矩阵为
机器人学第3章 机器人运动学
(3.46)
如果已知一个表示任意旋转的齐次变换，那么就能够 确定其等价欧拉角。
3.2 机械手运动方程的求解
21
3.2.2 滚、仰、偏变换解
直接从显式方程来求解用滚动、俯仰和偏转表示的变 换方程。 RPY变换各角如下：
atan2(n y , n x ) 180 atan2(n z , cn x sn y ) atan2( sa x ca y , so x co y )
0
T6 0T1 (1 )1T2 (2 )2T3 (3 )3T4 (4 )4T5 (5 )5T6 (6 )
3.1 机器人运动方向的表示
5
3.1.1 运动姿态和方向角
用横滚、俯仰和偏转角表示运动姿态 另一种常用的旋转集合是横滚（roll）、俯仰（pitch） 和偏转（yaw）。
图3.3 用横滚、俯仰和偏转表示机械手运动姿态
3.1 机器人运动方向的表示 6
3.1.1 运动姿态和方向角
对于旋转次序，规定：
1
(3.16)
3.1 机器人运动方向的表示
15
3.1.3 连杆变换矩阵及其乘积
如果机械手与参考坐标系的相对关系是由变换 Z 来 表示的，而且机械手与其端部工具的关系由变换 E 表示，那么此工具端部对参考坐标系的位置和方向 可由变换 X 表示如下：
可求得：
X ZT6 E
T6 Z 1 XE 1
(3.52)
3.2 机械手运动方程的求解
22
3.2.3 球面变换解
把求解滚、仰和偏变换方程的技术用于球面坐标表示 的运动方程。 球面变换的解为：
atan2( p y , p x ), 180 atan2(cp x sp y , p z )
第三章_机器人运动学
举例（example）
• 一个差动驱动机器人（针对图3.3所示机器人） 将滚动约束和滑动约束方程联合起来可得到式：
J1 ( s ) J C ( ) R( ) I 2 1 s 0
由于小脚轮无动力，并可在任何方向自由运动，因此可忽略第三个接触点。 其余两个轮不可操纵，因此 J1 ( s ) 和 C1 ( s ) 分别简化为
• 瞬时转动中心 ICR （instantaneous center of rotation） 在任何给定时刻，轮子必定沿着半径为 R的某个圆瞬时的运动，使得那个圆的中心 处在零运动直线上，该中心称为瞬时转动 中心。它可以位于沿零运动直线的任何地 方。
•
要使机器人运动存在一个单独的解，必须有 一个单独的ICR，即所有的零运动直线在一个单 独点相交。 • ICR的几何特性显示了机器人的活动性是机 器人运动上的独立约束数目的函数而不是轮子数 目的函数。 • 独立的滑动约束的数目可用 C1 (s ) 的秩来描述
.
.
.
.
（1）
• 其次，计算在YR 方向的贡献
由于没有一个轮子可以提供侧向运动， 所以沿YR 方向的速度总是零。 • 最后，计算旋转角速度分量。可独立的计 算各轮的贡献，且只要简单相加即可。 . .
r 1 r 2 1 2 2l 2l
（2）
ห้องสมุดไป่ตู้
• 联合式（1）和式（2）得到差动驱动机器人的 运动学模型如式（3）所示：
x I y
• 为了根据分量的移动描述机器人的移动， 需要将全局参考架下的移动映射到局部参 考框架下的运动。该运动可由正交旋转矩 阵来完成：
举例（example）
机器人学基础_第3章_机器人运动学
机械手的运动姿态往往由 一个绕轴x ，y 和 z 的旋转 序列来规定。这种转角的 序列，称为欧拉（Euler） 角。 欧拉角: 用一个绕 z 轴 旋转ф角，再绕新的 y 轴 y’旋转θ角，最后绕新的 z 轴z’’旋转ψ角来描述任 图3.2 欧拉角的定义 何可能的姿态。 欧拉变换Euler可由连乘三个旋转矩阵来求得，即 Euler (φ ,θ ,ψ ) = Rot ( z , φ ) Rot ( y,θ ) Rot ( z ,ψ ) （3.3）
Kinematics treats motion without regard to the forces that cause it. Within the science of kinematics one studies the position, velocity, acceleration, and all higher order derivatives of the position variables (with respect to time or any other variable). 从几何学 几何学的观点来处 几何学 理手指位置 手指位置P与关节变量 关节变量 手指位置 L1, L2, θ1 和 θ 2的关系称为 运动学(Kinematics)。 运动学
(3.9)
3.1 Representation of Kinematics Equation of Manipulator
17
3.1 Representation of Kinetic Equation of Robot Manipulator
3.1 Representation of Kinematics Equation of Manipulator
12
3.1.1 Kinetic Pose and Oriented Angle Roll, Pitch, Yaw to represent motion pose
Kinematics treats motion without regard to the forces that cause it. Within the science of kinematics one studies the position, velocity, acceleration, and all higher order derivatives of the position variables (with respect to time or any other variable). 从几何学 几何学的观点来处 几何学 理手指位置 手指位置P与关节变量 关节变量 手指位置 L1, L2, θ1 和 θ 2的关系称为 运动学(Kinematics)。 运动学
(3.9)
3.1 Representation of Kinematics Equation of Manipulator
17
3.1 Representation of Kinetic Equation of Robot Manipulator
3.1 Representation of Kinematics Equation of Manipulator
12
3.1.1 Kinetic Pose and Oriented Angle Roll, Pitch, Yaw to represent motion pose
机器人技术基础课件第三章-机器人运动学精选全文完整版
03T 01T12T 23T
如此类推，对于六连杆机器人，有下列矩阵：
06T 01T 12T 23T 34T 45T 56T
3.2 3.2 机械手运动学方程
26
0 6
T
3.1.4 连杆变换矩阵及其乘积
06T 01T12T 23T 34T 45T 56T
机器人运动学方程
此式右边表示了从固定参考系到手部坐标系的各连杆
一个六连杆机械手可具有六个自由度，每个连杆含 有一个自由度，并能在其运动范围内任意定位与定向。 其中三个自由度用于规定位置，而另外三个自由度用 来规定姿态。
8
3.1.1 连杆坐标系
机械手的运动方向
机器人手部的位置和姿态也可以
用固连于手部的坐标系{B}的位姿
来表示
关节轴为ZB， ZB轴的单位方向 矢量α称为接近矢量，指向朝外。
(1) 坐标系｛i-1｝绕xi-1轴转角αi-1，使Zi－1与Zi平行，算子为Rot(x, αi-1) ； (2) 沿Xi-1轴平移ai-1，使Zi－1和Zi共线， 算子为Trans(ai-1,0,0)； (3)绕Zi轴转角θi; 使得使Xi－1与Xi平行, 算子为Rot(z,θi)；
(4) 沿Zi轴平移di。使得i-1系和i系重合, 算子为Trans(0,0,di)。
3.2.1 机器人正运动学方程
连杆 i 1
2
3
连杆长 度ai-1
0
a0
a1
连杆偏距 di 0
0
d2
连杆扭角 αi-1 00
00
-900
关节角 θi
θ1(00) θ2(00) θ3(00)
3.2.1 机器人正运动学方程
该3自由度机器人的运动学方程为：
如此类推，对于六连杆机器人，有下列矩阵：
06T 01T 12T 23T 34T 45T 56T
3.2 3.2 机械手运动学方程
26
0 6
T
3.1.4 连杆变换矩阵及其乘积
06T 01T12T 23T 34T 45T 56T
机器人运动学方程
此式右边表示了从固定参考系到手部坐标系的各连杆
一个六连杆机械手可具有六个自由度，每个连杆含 有一个自由度，并能在其运动范围内任意定位与定向。 其中三个自由度用于规定位置，而另外三个自由度用 来规定姿态。
8
3.1.1 连杆坐标系
机械手的运动方向
机器人手部的位置和姿态也可以
用固连于手部的坐标系{B}的位姿
来表示
关节轴为ZB， ZB轴的单位方向 矢量α称为接近矢量，指向朝外。
(1) 坐标系｛i-1｝绕xi-1轴转角αi-1，使Zi－1与Zi平行，算子为Rot(x, αi-1) ； (2) 沿Xi-1轴平移ai-1，使Zi－1和Zi共线， 算子为Trans(ai-1,0,0)； (3)绕Zi轴转角θi; 使得使Xi－1与Xi平行, 算子为Rot(z,θi)；
(4) 沿Zi轴平移di。使得i-1系和i系重合, 算子为Trans(0,0,di)。
3.2.1 机器人正运动学方程
连杆 i 1
2
3
连杆长 度ai-1
0
a0
a1
连杆偏距 di 0
0
d2
连杆扭角 αi-1 00
00
-900
关节角 θi
θ1(00) θ2(00) θ3(00)
3.2.1 机器人正运动学方程
该3自由度机器人的运动学方程为：
机器人运动学
R3
Z
三个平移自由度 T1, T2, T3
三个旋转自由度 R1, R2, R3
T3
T1
T2
Y R2
X
2019/3/31
R1
2.2 刚体位姿描述
方位描述
第三章
机器人运动学
利用固定于物体的坐标系描述方位 (orientation)。方位又称为姿 态 (pose)。
在刚体 B上设置直角坐标系 {B} ，利用与 {B} 的坐标轴平行 的三个单位矢量表示B的姿态。
A
p R ( x , ) p
B
zB
zA
Bp
P
yB
{A}
1 0 R ( x , ) 0 c 0 s
c R ( y , ) 0 s 0 s 1 0 , 0 c
0 s c
s c 0 0 0 1
2019/3/31
i A iB A jB r11 r12
第三章
机器人运动学
2.2 刚体位姿描述
位置与姿态的表示 相对于参考坐标系{A}，坐标系{B}的原点位置和坐标轴的 方位可以由位置矢量和旋转矩阵描述。刚体B在参考坐标 系{A}中的位姿利用坐标系{B}描述。
{ B}
当表示位置时 当表示方位时
zA
iB
jB
A
kA 坐标系{B}的三个单位主矢量在坐标系{A}中的描述：
pBo
kB
yA
{ A iB , A jB , A k B }
坐标系{B}相对于坐标系{A}的姿态描述：
A B
O
R { iB , jB , k B }
A A A
第三章机器人运动学
Axis i+1
αi
3.2.3连杆附加坐标系的规定
（4）建立连杆坐标系的步骤
确定关节轴，并画出轴的延长线。 找出关节轴i和i+1的公垂线或交点，作为坐标系i的原点。 规定Zi的指向是沿着第i个关节轴。 规定Xi轴得指向是沿着轴i和i+1的公垂线的方向，如果关节轴 i和i+1相交，则Xi轴垂直于关节轴i和i+1所在的平面。 Yi 轴的方向由右手定则确定。 当第一个关节变量为0时，规定坐标系{0}和{1} 重合，对于坐 标系{N}，尽量选择坐标系使得连杆参数为0.
3.2.3连杆附加坐标系的规定
为了描述每个连杆和相邻连杆之间的相对位置关系,需要在每个连杆 上定义一个固连坐标系. （1）连杆中的中间连杆 规定: 坐标系{i}的Z轴称为Zi,与 关节轴i重合; 坐标系{i}的原点位于公垂 线ai与关节轴i的交点处. Xi轴沿ai方向由关节i指向 关节i+1 (若: ai =0,则Xi垂直于Zi和Zi+1所 在的平面;按照右手定则绕Xi轴的 转角定义为αi ,由于Xi轴的符号 有两种,则转角的符号也有两种.) Yi轴由右手定则确定
3.2.5 PUMA560运动学方程
（2）连续连杆变换 定义了连杆坐标系和相应得连杆参数，就能建立运动学 方程，坐标系{N}相对于坐标系{0}的变换矩阵为：
0 N
0
T T T T
0 1 1 2 2 3
N 1 N
T
变换矩阵 NT 是关于n个关节变量的函数，这些变量可以通 过放置在关节上的传感器测得，则机器人末端连杆再基坐标系 （笛卡尔坐标系）中的位置和姿态就能描述出来。
2) joint angle 关节角 描述两个相邻连杆绕公共轴线旋 转的夹角θi. 当i为转动关节时,关节角为一变量.
αi
3.2.3连杆附加坐标系的规定
（4）建立连杆坐标系的步骤
确定关节轴，并画出轴的延长线。 找出关节轴i和i+1的公垂线或交点，作为坐标系i的原点。 规定Zi的指向是沿着第i个关节轴。 规定Xi轴得指向是沿着轴i和i+1的公垂线的方向，如果关节轴 i和i+1相交，则Xi轴垂直于关节轴i和i+1所在的平面。 Yi 轴的方向由右手定则确定。 当第一个关节变量为0时，规定坐标系{0}和{1} 重合，对于坐 标系{N}，尽量选择坐标系使得连杆参数为0.
3.2.3连杆附加坐标系的规定
为了描述每个连杆和相邻连杆之间的相对位置关系,需要在每个连杆 上定义一个固连坐标系. （1）连杆中的中间连杆 规定: 坐标系{i}的Z轴称为Zi,与 关节轴i重合; 坐标系{i}的原点位于公垂 线ai与关节轴i的交点处. Xi轴沿ai方向由关节i指向 关节i+1 (若: ai =0,则Xi垂直于Zi和Zi+1所 在的平面;按照右手定则绕Xi轴的 转角定义为αi ,由于Xi轴的符号 有两种,则转角的符号也有两种.) Yi轴由右手定则确定
3.2.5 PUMA560运动学方程
（2）连续连杆变换 定义了连杆坐标系和相应得连杆参数，就能建立运动学 方程，坐标系{N}相对于坐标系{0}的变换矩阵为：
0 N
0
T T T T
0 1 1 2 2 3
N 1 N
T
变换矩阵 NT 是关于n个关节变量的函数，这些变量可以通 过放置在关节上的传感器测得，则机器人末端连杆再基坐标系 （笛卡尔坐标系）中的位置和姿态就能描述出来。
2) joint angle 关节角 描述两个相邻连杆绕公共轴线旋 转的夹角θi. 当i为转动关节时,关节角为一变量.
电机拖动技术基础第三章机器人的运动学PPT课件
第三章 机器人的运动学
►3.1 刚体的位姿描述 ►3.2 坐标变换 ►3.3 齐次坐标和齐次变换 ►3.4 变换方程和欧拉角 ►3.5 机器人运动学的正问题和逆问题
3.1 刚体的位姿描述
一、位姿的定义
刚体参考点的位置（坐标系的位置）和刚体的姿态统称为刚体的位姿。
(为描述机器人本身的各个连杆之间.机器人和环境之间的运动关系,将
n
n o a
手爪的方位由旋转矩阵R规定。
R n
o
a
手爪的位置由位置矢量 p
规定。
代表手p 爪坐标系的原点。
则手爪的位姿可由四个矢量
来 来描述。
noa p
记为:
T n o a p
3.2 坐标变换
定义：由于空间中任意点P在不同坐标系中的描述不同，所以需要 研究从一个坐标系的描述到另一个坐标系的描述之间的变换关，通 常称为坐标变换。
{S}代表工作站(操作台)坐标系(工作站框)
{G}代表目标坐标系(目标框) 它们之间的位姿关系用相应的齐次变换来描述。图3-6 机器人与环境坐标系
B S
T描述工作站框{S}相对于基座{B}的位姿，
S G
T描述目标框{G}相对于工作站{S}的位姿。
对物体进行操作时(搬运或装配机器人)，工具框{T}相对目标框{G} 的位姿 直接GT T 影响操作效果。 是机GT T器人控制和轨迹规划的对象。
=
相对于固定坐标系运动 相对于活动坐标系运动
2.变换过程的可逆性
齐次坐标变换过程是可逆的. 若有 ，则逆变换
。
所以有 I44BATABT A B0R BP 1AO BA0R AP 1BO
A BR0BAR
A BRAPB1OBPAO
►3.1 刚体的位姿描述 ►3.2 坐标变换 ►3.3 齐次坐标和齐次变换 ►3.4 变换方程和欧拉角 ►3.5 机器人运动学的正问题和逆问题
3.1 刚体的位姿描述
一、位姿的定义
刚体参考点的位置（坐标系的位置）和刚体的姿态统称为刚体的位姿。
(为描述机器人本身的各个连杆之间.机器人和环境之间的运动关系,将
n
n o a
手爪的方位由旋转矩阵R规定。
R n
o
a
手爪的位置由位置矢量 p
规定。
代表手p 爪坐标系的原点。
则手爪的位姿可由四个矢量
来 来描述。
noa p
记为:
T n o a p
3.2 坐标变换
定义：由于空间中任意点P在不同坐标系中的描述不同，所以需要 研究从一个坐标系的描述到另一个坐标系的描述之间的变换关，通 常称为坐标变换。
{S}代表工作站(操作台)坐标系(工作站框)
{G}代表目标坐标系(目标框) 它们之间的位姿关系用相应的齐次变换来描述。图3-6 机器人与环境坐标系
B S
T描述工作站框{S}相对于基座{B}的位姿，
S G
T描述目标框{G}相对于工作站{S}的位姿。
对物体进行操作时(搬运或装配机器人)，工具框{T}相对目标框{G} 的位姿 直接GT T 影响操作效果。 是机GT T器人控制和轨迹规划的对象。
=
相对于固定坐标系运动 相对于活动坐标系运动
2.变换过程的可逆性
齐次坐标变换过程是可逆的. 若有 ，则逆变换
。
所以有 I44BATABT A B0R BP 1AO BA0R AP 1BO
A BR0BAR
A BRAPB1OBPAO
第三章机器人运动学
机器人运动学
XX,a click to unlimited possibilities
汇报人：XX
目录
01 机 器 人 运 动 学 基 础 03 机 器 人 运 动 学 求 解
方法
05 机 器 人 运 动 学 的 发
展趋势和挑战
02 机 器 人 关 节 类 型 和 运动学模型
04 机 器 人 运 动 学 在 实 践中的应用
迭代求解算法
迭代求解算法的基本思想是通过不断迭代逼近解的过程 常见的迭代求解算法包括雅可比迭代法、高斯-赛德尔迭代法等 迭代求解算法的收敛性和收敛速度是评价算法优劣的重要指标 迭代求解算法在机器人运动学中具有广泛的应用，可以提高机器人的运动精度和稳定性
Part Four
机器人运动学在实 践中的应用
添加标题
添加标题
添加标题
添加标题
变换矩阵：描述机器人末端执行器 相对于参考坐标系的位姿变化，由 平移和旋转矩阵组合而成。
齐次坐标和变换矩阵的应用场景： 机器人轨迹规划、姿态控制、碰撞 检测等。
运动学方程
定义：描述机器 人关节运动的数 学模型
建立方法：根据 机器人结构和运 动需求进行建模
求解过程：通过 数值计算得到机 器人末端执行器 的位置和姿态
添加标题
添加标题
添加标题
添加标题
变换矩阵：描述机器人末端执行器 在各个坐标系之间位置和姿态关系 的数学工具
逆运动学：已知目标位置和姿态， 求解机器人关节角度的过程
齐次坐标和变换矩阵
齐次坐标：描述机器人末端执行器 的位置和姿态，通过将实际坐标系 与参考坐标系进行转换得到。
齐次坐标和变换矩阵在机器人运动 学中的重要性：实现机器人末端执 行器的精确控制和定位。
XX,a click to unlimited possibilities
汇报人：XX
目录
01 机 器 人 运 动 学 基 础 03 机 器 人 运 动 学 求 解
方法
05 机 器 人 运 动 学 的 发
展趋势和挑战
02 机 器 人 关 节 类 型 和 运动学模型
04 机 器 人 运 动 学 在 实 践中的应用
迭代求解算法
迭代求解算法的基本思想是通过不断迭代逼近解的过程 常见的迭代求解算法包括雅可比迭代法、高斯-赛德尔迭代法等 迭代求解算法的收敛性和收敛速度是评价算法优劣的重要指标 迭代求解算法在机器人运动学中具有广泛的应用，可以提高机器人的运动精度和稳定性
Part Four
机器人运动学在实 践中的应用
添加标题
添加标题
添加标题
添加标题
变换矩阵：描述机器人末端执行器 相对于参考坐标系的位姿变化，由 平移和旋转矩阵组合而成。
齐次坐标和变换矩阵的应用场景： 机器人轨迹规划、姿态控制、碰撞 检测等。
运动学方程
定义：描述机器 人关节运动的数 学模型
建立方法：根据 机器人结构和运 动需求进行建模
求解过程：通过 数值计算得到机 器人末端执行器 的位置和姿态
添加标题
添加标题
添加标题
添加标题
变换矩阵：描述机器人末端执行器 在各个坐标系之间位置和姿态关系 的数学工具
逆运动学：已知目标位置和姿态， 求解机器人关节角度的过程
齐次坐标和变换矩阵
齐次坐标：描述机器人末端执行器 的位置和姿态，通过将实际坐标系 与参考坐标系进行转换得到。
齐次坐标和变换矩阵在机器人运动 学中的重要性：实现机器人末端执 行器的精确控制和定位。
机器人学基础_第3章机器人运动学
移动连杆坐标系的建立
移动连杆坐标系的规定：
• 坐标轴Zi：与i+1关节的轴线重合； • 坐标轴Xi：沿移动关节i轴线与关节i+1轴线的公垂线,指向i+1关节； • 坐标轴Yi：按右手直角坐标系法则确定； • 坐标原点Oi： （1）当关节i轴线和关节i+1轴线相交时，取交点； （2）当关节i轴线和关节i+1轴线异面时，取两轴线的公垂线与关节i轴
动到使其原点与连杆i坐标系原点重合的地方。 • (4) 绕Xi旋转αi角，使Zi–1转到与Zi同一直线上。 • 连杆i–1的坐标系经过上述变换与连杆i的坐标系
重合。如果把表示相邻连杆相对空间关系的矩阵 称为A矩阵，那么根据上述变换步骤，从连杆i到 连杆i–1的坐标变换矩阵Ai为
•
(3.13)
• 同理，对联轴器的齐次坐标变换矩阵有 •
• 手部的位置矢量为固定参考系原点指向手 部坐标系{B}原点的矢量P，手部的方向矢 量为n、o、a。于是手部的位姿可用4 4 矩阵表示为
•
•
nX oX a X PX
T
nY
oY
aY
PY
nZ 0
oz 0
aZ 0
PZ 1
• 思考：
• ①说明位姿矩阵的左上角3×3矩阵的几何 意义。
• ②分别说明n, o, a, P的几何意义。
a1 = l 1 =100
a2 = l 2 =100
旧课复习与总结
转动连杆坐标系的建立
• 坐标轴Zi：与i+1关节的轴线重合； • 坐标轴Xi：沿连杆i两关节轴线的公垂线,指向i+1关节； • 坐标轴Yi：按右手直角坐标系法则确定； • 坐标原点Oi： （1）当关节i轴线和关节i+1轴线相交时，取交点； （2）当关节i轴线和关节i+1轴线异面时，取两轴线的公垂
机器人学-第3章_机器人运动学
构参数。如果机器人6个关节均为转动关节，18个固定参数可以用6组（ai-1, i-
1, di）表示。
空间机械臂坐标系选择
为了获得机械臂末端执行器在3维空间的位置和姿态，需要在每个连杆上 定义与连杆固连的坐标系来描述相邻连杆之间的位置关系。
根据固连坐标系所在连杆的编号对固连坐标系命名，如在固连在连杆i上 的固连坐标系称为坐标系{i}。
若ai =0，两Z轴相交，则选Xi垂于Zi和Zi+1 ，坐标系{i}的选择不是唯一的。
9
轴i θi
轴 i-1
连杆坐标系中连杆参数确定
θi-1
连杆 i-1
DH参数按以下方法确定：
Zi
ai =沿Xi轴，从Zi移动到Zi+1的距离；
Yi
i =绕Xi轴，从Zi旋转到Zi+1的角度；
di =沿Zi轴，从Xi-1移动到Xi的距离；
系{1}与坐标系{0}重合。
对于坐标系{n}，原点位置可以在关节轴
上任意选取， Xn的方向也是任意的。但在选 择时应尽量使更多的连杆参数为1=0 1=-90o d1=0
Y2
a2=L2 2=0 q2=-90o d2=L1
(b)
Z1
X2
Y2
Y1
X1
a1=0 1=90o d1=0
相邻连杆间坐标变换公式
建立 {P}、{Q}和{R}3个中间坐标系， 其中{i}和{i-1}是固定在连杆 i 和 i-1 上的固 连坐标系，如图3-13所示。
连杆 i-1 Zi
ZP
Xi ai
di ZQ XQ
ZR
qi
Zi-1
Xi-1XR ai-1
XP
i-1
1. 绕 Xi-1 轴旋转 i-1角
1, di）表示。
空间机械臂坐标系选择
为了获得机械臂末端执行器在3维空间的位置和姿态，需要在每个连杆上 定义与连杆固连的坐标系来描述相邻连杆之间的位置关系。
根据固连坐标系所在连杆的编号对固连坐标系命名，如在固连在连杆i上 的固连坐标系称为坐标系{i}。
若ai =0，两Z轴相交，则选Xi垂于Zi和Zi+1 ，坐标系{i}的选择不是唯一的。
9
轴i θi
轴 i-1
连杆坐标系中连杆参数确定
θi-1
连杆 i-1
DH参数按以下方法确定：
Zi
ai =沿Xi轴，从Zi移动到Zi+1的距离；
Yi
i =绕Xi轴，从Zi旋转到Zi+1的角度；
di =沿Zi轴，从Xi-1移动到Xi的距离；
系{1}与坐标系{0}重合。
对于坐标系{n}，原点位置可以在关节轴
上任意选取， Xn的方向也是任意的。但在选 择时应尽量使更多的连杆参数为1=0 1=-90o d1=0
Y2
a2=L2 2=0 q2=-90o d2=L1
(b)
Z1
X2
Y2
Y1
X1
a1=0 1=90o d1=0
相邻连杆间坐标变换公式
建立 {P}、{Q}和{R}3个中间坐标系， 其中{i}和{i-1}是固定在连杆 i 和 i-1 上的固 连坐标系，如图3-13所示。
连杆 i-1 Zi
ZP
Xi ai
di ZQ XQ
ZR
qi
Zi-1
Xi-1XR ai-1
XP
i-1
1. 绕 Xi-1 轴旋转 i-1角
机器人技术及其应用第3章 机器人运动学
图3-2 二自由度机械手的逆运动学
机器人运动学的基本问题
上述的正运动学、 逆运动学统称为运动学。 将式 （３⁃３） 的两边微分即可 得到机器人手爪速度和关节速度的关系， 再进一步进行微分将得到加速度之间的 关系， 处理这些关系也是机器人的运动学问题。
机器人运动学的基本问题
3.2.2 机器人位姿与关节变量的关系
下面计算从１ｐ 向２ｐ 的变换， 假设已知在坐标系∑１ 中描述的坐标系∑２ 的 坐标 ｘ 轴和ｙ 轴方向的单位矢量为１ｅｘ 和１ｅｙ， 则通过矢量的运算分析， 可 得到如下关系式
式中的右上标 Ｔ 表示转置， 将上述两式合并为下式
机器人运动学的基本问题
式中
２Ｒ１是从∑１ 坐标系向∑２ 坐标系进行位置矢量姿态变换的矩阵， 称为姿态变 换矩阵 （或旋转变换矩阵）。
机器人运动学的基本问题
２.姿态的变换矩阵 如图 ３⁃４ 所示， 给出原点重合的两坐标系∑
１ （Ｏ１ －ｘ１ｙ１） 和∑２ （Ｏ２ －ｘ２ｙ２）， 以及点Ｐ 的位置矢量 ｐ。 假设点 Ｐ 的位置矢量 ｐ 的分量在两坐标系中分别表示为
图3-4 点 Ｐ 在两个坐标系中 的位置矢量分量
机器人运动学的基本问题
机器人的运动学可用一个开环关节链来建模， 此链由数个刚体 （杆件） 用转 动或移动关节串联而成。 开环关节链的一端固定在基座上， 另一端是自由的， 安 装着工具， 用以操作物体或完成装配作业。 关节的相对运动促使杆件运动， 使手 到达所需的位置和姿态。 在很多机器人应用问题中， 人们感兴趣的是操作机末端 执行器相对于固定参考坐标系的空间描述。
如图 ３⁃ ２ 所示， 根据图中描述的几何 学关系， 可得
二自由度机械手的逆运动学
机器人运动学的基本问题
机器人运动学的基本问题
上述的正运动学、 逆运动学统称为运动学。 将式 （３⁃３） 的两边微分即可 得到机器人手爪速度和关节速度的关系， 再进一步进行微分将得到加速度之间的 关系， 处理这些关系也是机器人的运动学问题。
机器人运动学的基本问题
3.2.2 机器人位姿与关节变量的关系
下面计算从１ｐ 向２ｐ 的变换， 假设已知在坐标系∑１ 中描述的坐标系∑２ 的 坐标 ｘ 轴和ｙ 轴方向的单位矢量为１ｅｘ 和１ｅｙ， 则通过矢量的运算分析， 可 得到如下关系式
式中的右上标 Ｔ 表示转置， 将上述两式合并为下式
机器人运动学的基本问题
式中
２Ｒ１是从∑１ 坐标系向∑２ 坐标系进行位置矢量姿态变换的矩阵， 称为姿态变 换矩阵 （或旋转变换矩阵）。
机器人运动学的基本问题
２.姿态的变换矩阵 如图 ３⁃４ 所示， 给出原点重合的两坐标系∑
１ （Ｏ１ －ｘ１ｙ１） 和∑２ （Ｏ２ －ｘ２ｙ２）， 以及点Ｐ 的位置矢量 ｐ。 假设点 Ｐ 的位置矢量 ｐ 的分量在两坐标系中分别表示为
图3-4 点 Ｐ 在两个坐标系中 的位置矢量分量
机器人运动学的基本问题
机器人的运动学可用一个开环关节链来建模， 此链由数个刚体 （杆件） 用转 动或移动关节串联而成。 开环关节链的一端固定在基座上， 另一端是自由的， 安 装着工具， 用以操作物体或完成装配作业。 关节的相对运动促使杆件运动， 使手 到达所需的位置和姿态。 在很多机器人应用问题中， 人们感兴趣的是操作机末端 执行器相对于固定参考坐标系的空间描述。
如图 ３⁃ ２ 所示， 根据图中描述的几何 学关系， 可得
二自由度机械手的逆运动学
机器人运动学的基本问题
课件：第三章机器人运动学
• 3.1 机器人运动方程的表示
• 3.1.2 运动位置和坐标
• 一旦机械手的运动姿态由某个姿态变换规定之后，它在基坐标系中的 位置就能够由左乘一个对应于矢量p的平移变换来确定。
1 0 0 px
T6
0 0
1 0
0 1
p
y
某姿态变换
pz
0 0
0
1
Robotics运动学
3.1 机器人运动方程的表示
3.1.3 连杆变换矩阵 1.广义连杆(D-H坐标)
所有关节全为转动关节时: Zi坐标轴; Xi坐标轴; Yi坐标轴;
连杆长度ai;连杆两端关节公共法线距离 连杆扭角αi;垂直于ai所在平面内两轴的夹角 两连杆距离di;两连杆的相对位置di 两杆夹角θ 两连杆法线的夹角
Robotics运动学
3.1 机器人运动方程的表示
s c 0 0ny
oy
ay
p
y
s
c
0 0
0
0
0 0
1 0
0 1
nz 1
oz 1
az 1
pz 1
sc
0
ss
0
c 0
0 1
(3-39)
Robotics运动学
3.2 机械手运动方程的求解
3.2.1欧拉变换解
重写为
f11(n) f11(o) f11(a) f11( p) cc cs s 0
保持姿态,执行器要绕其自身Y和Z轴反向旋转.
Sph( , , r) Rot(z, )Rot( y, )Trans(0,0, r)Rot( yA, )Rot(zA, )
1 0 0 rcs
0
1
0
rss
第三章 机器人运动学
cos 3 sin 3 A3 0 0
sin 3 0 0 cos 3 0 0 0 1 0 0 0 1
0 l2 cos 2 0 l2 sin 2 1 0 0 1
SCARA机器人
（ Selective Compliance Assembly Robot Arm ）
第3 章 机器人运动学
3.1
3
概述
将关节坐标固连于机器人的每 一个连杆上。
6
2 4 5 1 以齐次坐标变换来描述坐标间的 相对位置和方向。 ——等同于描述了连杆间的位姿关 系！
3 6 2 4 5 1
齐次变换矩阵 A1 描述第1连杆 相对于参考坐标系{O}的位姿
0
p A1 1 p
A
0 1
0 l2 cos 2 0 l2 sin 2 1 0 0 1
1 0 A3 0 0
0 1 0 0
0 0 0 0 1 d3 0 1
cos 4 sin 4 A4 0 0
sin 4 cos 4 0 0
坐标系{i}固连于连杆i 坐标系{i}固连于关节i+1 z 轴与关节轴重合，方向 自由确定。
x 轴是连杆长度的延长线，
方向由关节i指向关节i+1。
坐标系{i}由坐标系{i-1}通过4次齐次变换而得到的。
4次齐次变换都 是相对于当前 坐标系进行的！
Ai1 Rot zi 1,i Ai3 Trans ai ,0,0
齐次变换矩阵 A2 描述第1连杆 相对于第2连杆的位姿
1
p A2 2 p
0
p A1 A2 2 p
T2 A1 A2
第三章机器人运动学PPT课件
用一组关节变量(di或i)来描述。这组变量通常称为关节矢量或关节坐标，
由这些矢量描述的空间称为关节空间。
• 正向运动学：关节空间末端笛卡儿空间，单射 • 逆向运动学：末端笛卡儿空间关节空间，复射
不同的关节空间，相同的 末端笛卡儿空间
关节空间与末端笛卡儿空 间映射关系
第三章 机器人的运动学
3.1 工业机器人运动学
，它的齐
次坐标就是
，即满足Px=ωPx/ω，Py=ωPy/ω，
Pz=ωPz/ω（ω是非零整数）。可以看出，在三维直角坐标系中，
由于ω取值的不同，一个点的齐次坐标的表达不唯一。
齐次坐标不仅可以规定点的位置（ω为非零整数），还可以
用来规定矢量的方向（第四个元素为零时）。列向量
(
）表示空间的无穷远点，a，b和c称为它的方向
单位主矢量相对于坐标系{A}的方向余弦组成：
xB
yB
zB
xA
yA
zA
其中：co scoxB s ,xA ()
既表示了刚体F在{A}系中的方位，也描述了{B}系在{A}系中的 姿态。
3.1.2.2 坐标变换
一、坐标平移
如图3-5，坐标系{B}与{A} 方向相同，但原点不重合。
图3-5 坐标平移
此式称为平移方程。其中 是B系中的原点在A系中的表示。
0
0
0
1
1
1
给定坐标系{A}，{B}和{C}，已知{B}相对{A}的描述为 ，
{C}相对{B}的描述为
AP A BTBP BPC BTCP APC ATCP
，则有
APA BTC BTCP
CATABTCBT
从而定义复合变换
。
同理得出：
由这些矢量描述的空间称为关节空间。
• 正向运动学：关节空间末端笛卡儿空间，单射 • 逆向运动学：末端笛卡儿空间关节空间，复射
不同的关节空间，相同的 末端笛卡儿空间
关节空间与末端笛卡儿空 间映射关系
第三章 机器人的运动学
3.1 工业机器人运动学
，它的齐
次坐标就是
，即满足Px=ωPx/ω，Py=ωPy/ω，
Pz=ωPz/ω（ω是非零整数）。可以看出，在三维直角坐标系中，
由于ω取值的不同，一个点的齐次坐标的表达不唯一。
齐次坐标不仅可以规定点的位置（ω为非零整数），还可以
用来规定矢量的方向（第四个元素为零时）。列向量
(
）表示空间的无穷远点，a，b和c称为它的方向
单位主矢量相对于坐标系{A}的方向余弦组成：
xB
yB
zB
xA
yA
zA
其中：co scoxB s ,xA ()
既表示了刚体F在{A}系中的方位，也描述了{B}系在{A}系中的 姿态。
3.1.2.2 坐标变换
一、坐标平移
如图3-5，坐标系{B}与{A} 方向相同，但原点不重合。
图3-5 坐标平移
此式称为平移方程。其中 是B系中的原点在A系中的表示。
0
0
0
1
1
1
给定坐标系{A}，{B}和{C}，已知{B}相对{A}的描述为 ，
{C}相对{B}的描述为
AP A BTBP BPC BTCP APC ATCP
，则有
APA BTC BTCP
CATABTCBT
从而定义复合变换
。
同理得出：
第三章-机器人运动学
在 量B。坐标系中的矢量rB
5i
9
j
0k
，求该点在A坐标系中的矢
解：由题意可得平移变换矩阵和旋转变换矩阵分别为：
轴移动6个单位，再绕z轴旋转30°，
求平移变换矩阵和旋转变换矩阵。
假设某点在B坐标系中的矢量rB
5i
9
j
0k
求该点在A坐标系中的矢量。
例：已知B坐标系的初始位置与A坐标系重合，首先把B坐标
系沿A坐标系的x轴移动12个单位，并沿y轴移动6个单位，再
绕z轴旋转30°，求平移变换矩阵和旋转变换矩阵。假设某点
机器人的位姿
机器人位姿的表示 位置可以用一个3×1的位置矩阵来描述。
p
px py
x
y
pz z
ｚ
ｐ(ｘ,ｙ,ｚ)
ｏ ｙ
ｘ
机器人的位姿
姿态可以用坐标系三个 坐标轴两两夹角的余弦值（ 三个h坐标轴的单位矢量）组 成3×3的姿态矩阵来描述。
ｚ
ｚh
ｘh ｏh ｐ(ｘ,ｙ,ｚ)
ｏ
ｙh
ｙ
ｘ
cos(x, xh ) R cos(y, xh )
ｚi ｚj
ｏi
ｘi
ｏj
ｘj
ｙj ｙi
直角坐标变换
齐次变换及运算
旋转变换
——旋转变换矩阵，是一个3×3的矩阵，其中的每个元素 就是i坐标系和j坐标系相应坐标轴夹角θ的余弦值，它表明了 姿态（方向）。θ角的正负按右手法则确定，即由轴的矢端 看，逆时钟为正。
直角坐标变换
齐次变换及运算
联合变换
设i坐标系j和坐标系之间存在先平移变换，后
cos(z, xh )
cos(x, yh ) cos(y, yh ) cos(z, yh )
- 1、下载文档前请自行甄别文档内容的完整性，平台不提供额外的编辑、内容补充、找答案等附加服务。
- 2、"仅部分预览"的文档,不可在线预览部分如存在完整性等问题,可反馈申请退款(可完整预览的文档不适用该条件!)。
- 3、如文档侵犯您的权益，请联系客服反馈,我们会尽快为您处理(人工客服工作时间：9:00-18:30)。
坐标系原点沿x i轴的偏移距离(是z i-1轴和zi两轴间的最小距离） i ：绕x i轴（右手规则）由z i-1轴转向zi轴的偏角。 对于转动关节，di、ai、αi是关节参数，θi是关节变量。 移动关节的关节参数是θi、 ai、αi， di是关节变量。
3.1.3 建立i坐标系和i-1 坐标系的齐次变换矩阵
连杆i 1 2 3 4 5 6
θi
θ1(90°) θ2(0°)
θ3(-90°) θ4(0°)
θ5(0°) θ6(0°)
αi-1
ai-1
di
0°
0
0
-90°
0
d2
0°
a2
0
-90°
a3
d4
90°
0
0
-90°
0
0
c1 s1 0 0
A1
s1 0
c1 0
0 0 1 0
0
0
0 1
(3)将坐标系Oi-1xi-1yi-1zi-1沿xi轴平移 距离ai ，使两坐标系的原点重合； (4)将坐标系Oi-1xi-1yi-1zi-1绕xi轴转αi 角，使两坐标系完全重合。
i坐标系和i—l坐标系的 齐次变换矩阵i-1Ai可以根据矩 阵的合成规则得到，i-1Ai称为 相邻坐标系i和i—1的D-H变换 矩阵。即
zi-1与zi的公垂线为xi-1, zi与zi+1的公垂线为xi轴,
αi-1:为zi-1与zi的交错角；
αi:绕x i轴（右手规则）由z i轴转向zi+1轴的偏角；
ai-1：从第i-1坐标系原点到x i-1轴和z i的交点沿x i-1 轴的偏移距离
ai：从第i坐标系原点到x i轴和z i+1的交点沿x i轴的 偏移距离
[例]确定下图所示机器人的位置和姿态 解：用D—H法建立坐标系转换矩阵，首先 列出各连轩及关节参数，如下表所示。
斯坦福机器人的连杆及关节参数表
斯坦福机器人及其坐标系图
将表中的参数分别代入i坐标系和i—l坐标系的齐次变换矩阵i-1Ai
c osi
i1 Ai
s
in
i
0
0
cosi sin i cosi cosi
确定和建立每个坐标系应根据 下面3条规则:
转动关节连杆四参数示意图
①z i-1轴沿着第i关节的运动轴； ②x i轴垂直于z i-1轴和z i轴并指向 离开z i-1轴的方向 ③y i轴按右手坐标系的要求建立。
按照这些规则，第0号坐标系在机座上的位置和方向可任选，只要z0轴沿 着第i关节运动轴。第n坐标系可放在手的任何部位、只要xn轴与zn-1轴垂直。
sin i 0
sin i sin i sin i cosi
cosi 0
ai cosi
ai
sin
i
di 1
可得如下变换矩阵：
c1 0 s1 0
A1
s1 0
0 1
c1 0
0 0
0
0
0 1
c2 0 s2 0
A2
s2 0
c5 s5 0 0
A5
0
s5 0
0 c5 0
1 0 0 0 0 1
式中 ：ci=cosi si=sini
c6 s6 0 0
A6
0
0s6
0 c6
0
1
0
0 0
0 1
§ 3.2 机器人运动学正问题 机器人运动学正问题是已知机器人各关节、各连杆 参数及各关节变量，求机器人手端坐标在基础坐标中的 位置和姿态。
cos i
sin i cos i1
si
n
i
si 0
n
i 1
sin i
cos i cos i1 cos i sin i1
0
0
sin i1 cos i1
0
a i 1
d
i
si
n
i
1
di cos i1
1
例 建立右图所示机器人相邻坐标 系间的转换矩阵
s1c2 c1s2
s1s2 c1c2
l2
(s1c2
c1s2
)
l1s1
s12
c12
l2 s12
l1s1
0
0
1
0 0
1
式中，c12=cos(1+ 2)， s12=sin(1+ 2)
容易验证上式的正确性，即：末端位置为[ 姿态为1+ 2 ；
T2= A1 A2
同理，若A3表示第三个连杆相对于第二个连杆的位置和姿态，则有
T3= A1 A2 A3
称这些A矩阵的乘积为T矩阵，其前置上标若为0，则可省略。对于六 连杆机械手，有下列T矩阵
T6= A1 A2 A3 A4 A5 A6
手爪坐标系
机械手的运动方向
原点由矢量p表示。
图3.1 矢量n,o,a和p
c2 s2 l2c2
A2
s2
c2
l2
s2
0 0 1
c1 s1 l1c1c2 s2 l2c2
T A1A2 s1
c1
l1s1
s2
c2
l2
s2
0 0 1 0 0 1
c1c2 s1s2 c1s2 s1c2 l2 (c1c2 s1s2 ) l1c1 c12 s12 l2c12 l1c1
c2 s2 0 0
A2
0
0s2
0 c2
0
1 0 0
d
2
0
1
c3 s3 0 a2
A3
s3
0
c3 0
0
0
1 0
0
0
0
1
c4 s4 0 a3
A4
0
0s4
0 c4
0
1 0 0
d
4
0
1
解：建立的坐标系如右图，这是二维坐 标系(在三维空间中，各坐标系的z轴垂 直于纸面)，其相邻坐标系的变换矩阵 为
c1 s1 01 0 l1 c1 s1 l1c1
A1 R T z, x,l1 s1
c1
00 1 0 s1
c1
l1s1
0 0 10 0 1 0 0 1
0
0
0
1
六连杆机械手的T矩阵（ T6 ）可由指定其16个元素的 数值来决定。在这16个元素中，只有12个元素具有实际 含义。
3.1.1 Denavt-Hartenberg(D-H)表示法
机械手由一串用转动或平移关节连
接的刚体(杆件)组成。每一对关节–杆件
构成一个自由度。杆件的编号由手臂的 固定基座开始，固定基座可看成杆件0， Ai
两杆间的距离di：关节轴上两个法线的距离
夹角θi：关节轴上两个法线的夹角
Ai-1
Ai
ai
ai1
di
i
ai
i
3.1.1 Denavt-Hartenberg(D-H)表示法
为 描 述 相 邻 杆 件 间 平 移 和 转 动 的 关 系 。 Denavt 和 Hartenberg (1955)提出了一种为关节链中的每一杆件建立 附体坐标系的矩阵方法。D-H方法是为每个关节处的杆件坐 标系建立4 4齐次变换矩阵，表示它与前一杆件坐标系的关 系。这样逐次变换，用“手部坐标”表示的末端执行器可被 变换并用机座坐标表示。
固联坐标系后置（zi位于 i+1关节轴上），变换公式
i1Ai Rot(zi1,i )Trans(0,0, di )Trans(ai ,0,0)Rot(xi ,i )
cosi sini 0 01 0 0 0 1 0 0 ai 1 0
0 0
A i1 i
sin
机器人机械手上坐标系的配置取决于机械手连杆连接的类型。有两种连接—— 转动关节和棱柱联轴节。现在来考虑棱柱联轴节（平动关节）的情况。下图示
出其特征参数 , d和 。
棱柱关节连杆四参数示意图 9
3.1.2 几何参数定义
3.1.2 几何参数定义
根据上述对杆件参数及坐标 系的定义，描述串联机器人相邻 坐标系之间的关节关系可归结如 下4个参数： θi：绕z i-1轴（右手规则）由x i-1轴向x i轴的关节角； di：从第i—1坐标系的原点到z i-1轴和x i轴的交点沿z i-1轴的距离； ai：从z i-1和x i轴的交点到第i
i
0
0
c os i 0 0
0
00
1
0
0 0
100 Nhomakorabea0
c os i
sin i
0
1 0
00 10
0 0
1 0
di 1
0 0
0 0
1 0
0 0
1
0
sin i 0
c os i 0
0 1
cosi
s
in
θi :绕z i轴由x i-1轴向x i轴的关节角；
di：从x i-1 轴和z i轴的交点到第i坐标系的原点沿z i 轴的距离
固联坐标系前置（zi位于i关节轴上），变换公式
3.1.3 建立i坐标系和i-1 坐标系的齐次变换矩阵
连杆i 1 2 3 4 5 6
θi
θ1(90°) θ2(0°)
θ3(-90°) θ4(0°)
θ5(0°) θ6(0°)
αi-1
ai-1
di
0°
0
0
-90°
0
d2
0°
a2
0
-90°
a3
d4
90°
0
0
-90°
0
0
c1 s1 0 0
A1
s1 0
c1 0
0 0 1 0
0
0
0 1
(3)将坐标系Oi-1xi-1yi-1zi-1沿xi轴平移 距离ai ，使两坐标系的原点重合； (4)将坐标系Oi-1xi-1yi-1zi-1绕xi轴转αi 角，使两坐标系完全重合。
i坐标系和i—l坐标系的 齐次变换矩阵i-1Ai可以根据矩 阵的合成规则得到，i-1Ai称为 相邻坐标系i和i—1的D-H变换 矩阵。即
zi-1与zi的公垂线为xi-1, zi与zi+1的公垂线为xi轴,
αi-1:为zi-1与zi的交错角；
αi:绕x i轴（右手规则）由z i轴转向zi+1轴的偏角；
ai-1：从第i-1坐标系原点到x i-1轴和z i的交点沿x i-1 轴的偏移距离
ai：从第i坐标系原点到x i轴和z i+1的交点沿x i轴的 偏移距离
[例]确定下图所示机器人的位置和姿态 解：用D—H法建立坐标系转换矩阵，首先 列出各连轩及关节参数，如下表所示。
斯坦福机器人的连杆及关节参数表
斯坦福机器人及其坐标系图
将表中的参数分别代入i坐标系和i—l坐标系的齐次变换矩阵i-1Ai
c osi
i1 Ai
s
in
i
0
0
cosi sin i cosi cosi
确定和建立每个坐标系应根据 下面3条规则:
转动关节连杆四参数示意图
①z i-1轴沿着第i关节的运动轴； ②x i轴垂直于z i-1轴和z i轴并指向 离开z i-1轴的方向 ③y i轴按右手坐标系的要求建立。
按照这些规则，第0号坐标系在机座上的位置和方向可任选，只要z0轴沿 着第i关节运动轴。第n坐标系可放在手的任何部位、只要xn轴与zn-1轴垂直。
sin i 0
sin i sin i sin i cosi
cosi 0
ai cosi
ai
sin
i
di 1
可得如下变换矩阵：
c1 0 s1 0
A1
s1 0
0 1
c1 0
0 0
0
0
0 1
c2 0 s2 0
A2
s2 0
c5 s5 0 0
A5
0
s5 0
0 c5 0
1 0 0 0 0 1
式中 ：ci=cosi si=sini
c6 s6 0 0
A6
0
0s6
0 c6
0
1
0
0 0
0 1
§ 3.2 机器人运动学正问题 机器人运动学正问题是已知机器人各关节、各连杆 参数及各关节变量，求机器人手端坐标在基础坐标中的 位置和姿态。
cos i
sin i cos i1
si
n
i
si 0
n
i 1
sin i
cos i cos i1 cos i sin i1
0
0
sin i1 cos i1
0
a i 1
d
i
si
n
i
1
di cos i1
1
例 建立右图所示机器人相邻坐标 系间的转换矩阵
s1c2 c1s2
s1s2 c1c2
l2
(s1c2
c1s2
)
l1s1
s12
c12
l2 s12
l1s1
0
0
1
0 0
1
式中，c12=cos(1+ 2)， s12=sin(1+ 2)
容易验证上式的正确性，即：末端位置为[ 姿态为1+ 2 ；
T2= A1 A2
同理，若A3表示第三个连杆相对于第二个连杆的位置和姿态，则有
T3= A1 A2 A3
称这些A矩阵的乘积为T矩阵，其前置上标若为0，则可省略。对于六 连杆机械手，有下列T矩阵
T6= A1 A2 A3 A4 A5 A6
手爪坐标系
机械手的运动方向
原点由矢量p表示。
图3.1 矢量n,o,a和p
c2 s2 l2c2
A2
s2
c2
l2
s2
0 0 1
c1 s1 l1c1c2 s2 l2c2
T A1A2 s1
c1
l1s1
s2
c2
l2
s2
0 0 1 0 0 1
c1c2 s1s2 c1s2 s1c2 l2 (c1c2 s1s2 ) l1c1 c12 s12 l2c12 l1c1
c2 s2 0 0
A2
0
0s2
0 c2
0
1 0 0
d
2
0
1
c3 s3 0 a2
A3
s3
0
c3 0
0
0
1 0
0
0
0
1
c4 s4 0 a3
A4
0
0s4
0 c4
0
1 0 0
d
4
0
1
解：建立的坐标系如右图，这是二维坐 标系(在三维空间中，各坐标系的z轴垂 直于纸面)，其相邻坐标系的变换矩阵 为
c1 s1 01 0 l1 c1 s1 l1c1
A1 R T z, x,l1 s1
c1
00 1 0 s1
c1
l1s1
0 0 10 0 1 0 0 1
0
0
0
1
六连杆机械手的T矩阵（ T6 ）可由指定其16个元素的 数值来决定。在这16个元素中，只有12个元素具有实际 含义。
3.1.1 Denavt-Hartenberg(D-H)表示法
机械手由一串用转动或平移关节连
接的刚体(杆件)组成。每一对关节–杆件
构成一个自由度。杆件的编号由手臂的 固定基座开始，固定基座可看成杆件0， Ai
两杆间的距离di：关节轴上两个法线的距离
夹角θi：关节轴上两个法线的夹角
Ai-1
Ai
ai
ai1
di
i
ai
i
3.1.1 Denavt-Hartenberg(D-H)表示法
为 描 述 相 邻 杆 件 间 平 移 和 转 动 的 关 系 。 Denavt 和 Hartenberg (1955)提出了一种为关节链中的每一杆件建立 附体坐标系的矩阵方法。D-H方法是为每个关节处的杆件坐 标系建立4 4齐次变换矩阵，表示它与前一杆件坐标系的关 系。这样逐次变换，用“手部坐标”表示的末端执行器可被 变换并用机座坐标表示。
固联坐标系后置（zi位于 i+1关节轴上），变换公式
i1Ai Rot(zi1,i )Trans(0,0, di )Trans(ai ,0,0)Rot(xi ,i )
cosi sini 0 01 0 0 0 1 0 0 ai 1 0
0 0
A i1 i
sin
机器人机械手上坐标系的配置取决于机械手连杆连接的类型。有两种连接—— 转动关节和棱柱联轴节。现在来考虑棱柱联轴节（平动关节）的情况。下图示
出其特征参数 , d和 。
棱柱关节连杆四参数示意图 9
3.1.2 几何参数定义
3.1.2 几何参数定义
根据上述对杆件参数及坐标 系的定义，描述串联机器人相邻 坐标系之间的关节关系可归结如 下4个参数： θi：绕z i-1轴（右手规则）由x i-1轴向x i轴的关节角； di：从第i—1坐标系的原点到z i-1轴和x i轴的交点沿z i-1轴的距离； ai：从z i-1和x i轴的交点到第i
i
0
0
c os i 0 0
0
00
1
0
0 0
100 Nhomakorabea0
c os i
sin i
0
1 0
00 10
0 0
1 0
di 1
0 0
0 0
1 0
0 0
1
0
sin i 0
c os i 0
0 1
cosi
s
in
θi :绕z i轴由x i-1轴向x i轴的关节角；
di：从x i-1 轴和z i轴的交点到第i坐标系的原点沿z i 轴的距离
固联坐标系前置（zi位于i关节轴上），变换公式