机器人运动学(PPT38页)
合集下载
机器人运动学正解逆解 ppt课件
C1(C23a44
S1S5C6
S1S5S6
S1C5
C2a33C2a2)
S1C (C 1S253SC465C6S23S46)
S2 3C45C6
S1(C23C45C6S23C46)
C1S5S6 S23C45C6C23C46
S1(C23S45)
C1C5 S2 3S45
S1(C23a44 S23C a442a33S2C a332a2S )2a2
S2
0
C2 0
0
S2a2
1 0
0
0
0
1
C3 S3 0 C3a3
A3
S3
0
C3 0
0
S3a3
1 0
0 0 0 1
C4 0 S4 C4a4
A4
S4
0
0 1
C4 0
S4a4
0
0 0 0 1
C5 0 S5 0
A5
S
5
0
0 1
C5 0
0
0
0
0
0
1
C6 S6 0 0
A6
S
2
arctan(C3a3 (C3a3
a2 )( pz S234a4 ) S3a3( pxC1 py S1 a2 )( pxC1 py S1 C234a4 ) S3a3( pz
C234a4 ) S234a4 )
进而可得：
4 234 2 3
再 根 据 对 应 项 元 素 相 ， 等 可 以 得 到
学习重点：1. 给关节指定参考坐标系 2. 制定D-H参数表 3. 利用参数表计算转移矩阵
2
精品资料
• 你怎么称呼老师？ • 如果老师最后没有总结一节课的重点的难点，你
第二章 机器人运动学PPT课件
系的位置矢量 AP、BP具有如下变换关系
APB ARBPAPBO
（2-1-12）
15
ZA {A}
OA XA
ZB
ZC {C}
{B}
AP
BP YB
OB(OC)
YC
P A
BO XC YA
XB
图2.1.4 平移加旋转变换 注：坐标系{C}为过渡坐标系
16
2.齐次变换
一般情况下，刚体的运动是转动和平移的复合运 动，为了用同一矩阵既表示转动又表示平移，因此引 入齐次坐标变换矩阵。
28
X
偏转
Z
横滚
O船
Y
俯仰
偏转
X
Z
横滚
O
夹手
Y
俯仰
（a）
(b)
图2.1.11 RPY角的定义
29
§2.2 操作臂运动学
一、机械手位置和姿态的表示
图2.2.1所示为机器人的一个机械手。 描述机械手方位的坐标系置于手指尖的 中 位心置，可其以用原矢点量由矢p在量固p表定示坐。标机系械的手坐的标 表示为
H
0
1
0
b
称为平移的齐次变换矩阵，又可表示为
0 0 1 c
0
0
0
1
HTraa,b n,c)s。(矩阵中的第四列为平移参考矢量的齐次坐标。
19
Z
V
U
P
O
Y
X 图2.1.5 平移的齐次变换
20
例平2移.1，求向平量移U 后i得3到j的5k向沿量向V量 。P 3i7jk
解：
1 0 0 3 1 4
系，首先需要用两个参数对每个连杆进行描述。 如图2.2.2所示，对于任意一个两端带有关节i和
第七章 机器人运动学 ppt课件
杆件参数
关节角
运动学正问题 杆件参数
末端执行器
关节角
运动学正问题
2020/10/28
6
§7.2 机器人杆件，关节和它们的参数
§7.2.1 杆件与关节
操作机由一串用转动或平移（棱柱 形）关节连接的刚体（杆件）组成
每一对关节杆件构成一个自由度， 因此N个自由度的操作机就有N对关 节—杆件。
0号杆件（一般不把它当作机器人的 关 一部分）固联在机座上，通常在这 节 里建立一个固定参考坐标系，最后 一个杆件与工具相连
对位置关系。在转动关节中，li, αi, di是固定值，θi是变量。
在移动关节中，li, αi , θi是固定值， d i 是变量。
2020/10/28
11
§7.3 机器人关节坐标系的建立
对于每个杆件都可以在关节轴处建立一个正规的笛卡 儿坐标系（xi, yi, zi），（i=1, 2, …, n），n是自由度 数，再加上基座坐标系，一共有（n+1）个坐标系。
基座坐标系 ∑O0定义为0号坐标系（x0, y0, z0）,它也是 机器人的惯性坐标系，0号坐标系在基座上的位置和 方向可任选，但z0轴线必须与关节1的轴线重合，位 置和方向可任选；
最后一个坐标系（n关节），可以设在手的任意部位， 但必须保证 zn与zn-1 垂直。
2020/10/28
12
§7.3.1 D-H关节坐标系建立原则
机器人技术及空间应用
第七章 机器人运动学
机器人运动学主要是把机器人相对于固定参考 系的运动作为时间的函数进行分析研究，而不 考虑引起这些运动的力和力矩 将机器人的解析地表示为时间的函数，特别是 研究机器人关节变量空间和机器人末端执行器 位置和姿态之间的关系 本章将讨论机器人运动学几个具有实际意义的 基本问题。
关节角
运动学正问题 杆件参数
末端执行器
关节角
运动学正问题
2020/10/28
6
§7.2 机器人杆件，关节和它们的参数
§7.2.1 杆件与关节
操作机由一串用转动或平移（棱柱 形）关节连接的刚体（杆件）组成
每一对关节杆件构成一个自由度， 因此N个自由度的操作机就有N对关 节—杆件。
0号杆件（一般不把它当作机器人的 关 一部分）固联在机座上，通常在这 节 里建立一个固定参考坐标系，最后 一个杆件与工具相连
对位置关系。在转动关节中，li, αi, di是固定值，θi是变量。
在移动关节中，li, αi , θi是固定值， d i 是变量。
2020/10/28
11
§7.3 机器人关节坐标系的建立
对于每个杆件都可以在关节轴处建立一个正规的笛卡 儿坐标系（xi, yi, zi），（i=1, 2, …, n），n是自由度 数，再加上基座坐标系，一共有（n+1）个坐标系。
基座坐标系 ∑O0定义为0号坐标系（x0, y0, z0）,它也是 机器人的惯性坐标系，0号坐标系在基座上的位置和 方向可任选，但z0轴线必须与关节1的轴线重合，位 置和方向可任选；
最后一个坐标系（n关节），可以设在手的任意部位， 但必须保证 zn与zn-1 垂直。
2020/10/28
12
§7.3.1 D-H关节坐标系建立原则
机器人技术及空间应用
第七章 机器人运动学
机器人运动学主要是把机器人相对于固定参考 系的运动作为时间的函数进行分析研究，而不 考虑引起这些运动的力和力矩 将机器人的解析地表示为时间的函数，特别是 研究机器人关节变量空间和机器人末端执行器 位置和姿态之间的关系 本章将讨论机器人运动学几个具有实际意义的 基本问题。
第4讲机器人微分运动学PPT课件
0
d
0
dd
i
1
0
0
0
利用微分变换式同样有：
d
d
T x
T y
n z
t
z
d
T z
T x
bz 0
dd
i
T y
T z
0 0
即得到关节i对 末端抓手运动 的贡献。
作业2－2：设机器人的关节1轴线垂直于地面，关节2和 关节3的轴线平行，并与关节1的轴线相垂直。关节1与关 节2的轴线正交，连杆1与连杆2之间无偏距。 求该操作臂末端的位置雅可比矩阵。
斜对称矩阵(Skew Symmetric Matrix)
定义： nxn矩阵S被称为斜对称矩阵，当且仅当(iff)满足
STS0 sij sji 0, i, j1,2,3 sii 0
注：一般地，把所有3x3的斜对称矩阵表示为:so(3)
SSM的性质： S(k1a+k2b)=k1S(a)+k2S(b) S(a)p=a x p
RS(a)RT=S(Ra) R,Sso(3) XTSX=0 XRn
微分运动的坐标变换
定义六维列矢量 ：
D v xv y v z x
y
T z
称为刚体的广义速度矢量，它能完整地刻画任意刚体 在三维空间中的运动。若用差分代替微分，则上式可写为
D d xd yd z x
y
T z
称为微分运动矢量。
作业2-2图
Differential Kinematics (2)
本讲重要概念： 雅克比矩阵(Jacobian Matrix) (5S) 运动学奇异(Singularity)(5S) 冗余度(Redundancy) (4S) 零空间(Null Space) (4S) 自运动(Self-motion) (4S) 可操作性(Manipulability)(5S)
机器人学导论--ppt课件可编辑全文
关节变量
ppt课件
2
1.2 描述：位置、姿态和坐标系
位置描述
一旦建立坐标系，就能用一
个3*1的位置矢量对世界坐标 系中的任何点进行定位。因 为在世界坐标系中经常还要 定义许多坐标系，因此在位 置矢量上附加一信息，标明 是在哪一坐标系中被定义的。
例如：AP表示矢量P在A坐标系中的表示。
BP 表示矢量P在B坐标系中的表示。
c os90
c os120 c os30 c os90
XB XA
X
B
YA
X B Z A
c os90 c os90 cos0
]
YB X A YB YA YB Z A
ZB XA
ZB
YA
ZB Z A
ppt课件
5
坐标系的变换
完整描述上图中操作手位姿所需的信息为位置和姿态。机器人学中
在从多重解中选择解时，应根据具体情况，在避免碰撞的前 提下通常按“最短行程”准则来选择。同时还应当兼顾“多 移动小关节，少移动大关节”的原则。
ppt课件
23
4 PUMA560机器人运动学反解-反变换法
❖ 由于z4 , z5, z6 交于一点W,点W在基础坐标系中的位置仅与 1,2,3
有关。据此，可先解出 1,2,3 ，再分离出 4 ,5,6 ，并逐
PUMA560变换矩阵
ppt课件
21
将各个连杆变换矩阵相乘便得到PUMA560手臂变换矩阵
06T 01T (1)21T (2 )23T (3 )34T (4 )45T (5 )56T (6 )
什么是机器人运动学正解？ 什么是机器人运动学反解？
ppt课件
22
操作臂运动学反解的方法可以分为两类：封闭解和数值解、 在进行反解时总是力求得到封闭解。因为封闭解的计算速度 快，效率高，便于实时控制。而数值法不具有些特点为。 操作臂的运动学反解封闭解可通过两种途径得到：代数解和 几何解。 一般而言，非零连杆参数越多，到达某一目标的方式也越多， 即运动学反解的数目也越多。
机器人技术基础课件第三章 机器人运动学
T = f(qi) 其中，T为机器人末端执行器的位姿，qi为机器人各个关 节变量。若给定qi，要求确定相应的T，称为正运动学问题 。
30
3.2.1 机器人正运动学方程
如图所示是个三自由度的机器人， 三个关节皆为旋 转关节，第3关节轴线垂直于1、2关节轴线所在的平 面，各个关节的旋转方向如图所示，用D-H方法建立 各连杆坐标系，求出该机器人的运动学方程。
刚体的姿态可由动坐标系的坐
标的轴刚 位方置体向可Q在来用固表齐定示次坐。坐标令标系n形、O式oX、的YZa一中分
别为X′、y ′、z ′坐标轴的 个(4×1)列阵表示为： 单位方向矢量，每个单位方向 矢量在固定坐标系上的分量为 动坐标系各坐标轴的方向余弦， 用齐次坐标形式的(4×1)列阵 分别表示为：
y L1 sin1 L2 sin(1 2 )
通常的矢量形式：
r f ( )
29
3.2.1 机器人正运动学方程
机器人正运动学将关节变量作为自变量，研究机器人末 端执行器位姿与基座之间的函数关系。总体思想是：
（1）给每个连杆指定坐标系； （2）确定从一个连杆到下一连杆变换（即相邻参考系 之间的变化）； （3）结合所有变换，确定末端连杆与基座间的总变换 ； （4）建立运动学方程求解。 机器人运动学的一般模型为：
03T 01T12T 23T
如此类推，对于六连杆机器人，有下列矩阵：
06T 01T12T 23T 34T 45T 56T
3.2 3.2 机械手运动学方程
26
0 6
T
3.1.4 连杆变换矩阵及其乘积
06T 01T12T23T34T 45T56T
机器人运动学方程
此式右边表示了从固定参考系到手部坐标系的各连杆
30
3.2.1 机器人正运动学方程
如图所示是个三自由度的机器人， 三个关节皆为旋 转关节，第3关节轴线垂直于1、2关节轴线所在的平 面，各个关节的旋转方向如图所示，用D-H方法建立 各连杆坐标系，求出该机器人的运动学方程。
刚体的姿态可由动坐标系的坐
标的轴刚 位方置体向可Q在来用固表齐定示次坐。坐标令标系n形、O式oX、的YZa一中分
别为X′、y ′、z ′坐标轴的 个(4×1)列阵表示为： 单位方向矢量，每个单位方向 矢量在固定坐标系上的分量为 动坐标系各坐标轴的方向余弦， 用齐次坐标形式的(4×1)列阵 分别表示为：
y L1 sin1 L2 sin(1 2 )
通常的矢量形式：
r f ( )
29
3.2.1 机器人正运动学方程
机器人正运动学将关节变量作为自变量，研究机器人末 端执行器位姿与基座之间的函数关系。总体思想是：
（1）给每个连杆指定坐标系； （2）确定从一个连杆到下一连杆变换（即相邻参考系 之间的变化）； （3）结合所有变换，确定末端连杆与基座间的总变换 ； （4）建立运动学方程求解。 机器人运动学的一般模型为：
03T 01T12T 23T
如此类推，对于六连杆机器人，有下列矩阵：
06T 01T12T 23T 34T 45T 56T
3.2 3.2 机械手运动学方程
26
0 6
T
3.1.4 连杆变换矩阵及其乘积
06T 01T12T23T34T 45T56T
机器人运动学方程
此式右边表示了从固定参考系到手部坐标系的各连杆
课件：第三章机器人运动学
• 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
《机器人运动学》课件
机器人正向运动学建模
正向运动学
根据机器人关节参数，计算机器人末端执行器在笛卡尔坐标 系中的位置和姿态的过程。
正向运动学模型
描述机器人末端执行器位置和姿态与关节参数之间关系的数 学模型。
机器人逆向运动学建模
逆向运动学
已知机器人末端执行器在笛卡尔坐标系中的位置和姿态，求解机器人关节参数 的过程。
逆向运动学模型
02
它主要关注机器人在三维空间中 的位置和姿态，以及如何通过关 节运动来实现这些位置和姿态的 变化。
机器人运动学的研究内容
机器人位姿表示
研究如何用数学表达式表示机 器人在三维空间中的位置和姿
态。
运动学方程
建立机器人末端执行器位姿与 关节状态之间的数学关系，即 运动学方程。
运动学逆解与正解
研究如何通过给定的位姿求解 关节状态（逆解），以及如何 通过给定的关节状态求解位姿 （正解）。
关节坐标系
基于机器人关节建立的坐标系，常用于描述机器 人的关节运动状态。
工作坐标系
基于机器人工作需求建立的坐标系，常用于描述 机器人末端执行器的位置和姿态。
CHAPTER 03
机器人运动学建模
齐次变换与坐标变换
齐次变换
描述空间中物体位置和方向变化的数 学工具，包括平移和旋转。
坐标变换
将一个坐标系中的位置和方向信息转 换到另一个坐标系中的过程，涉及到 齐次变换的应用。
关节空间的轨迹规划
定义
关节空间是指机器人的各个关节角度 构成的坐标系，关节空间的轨迹规划 是指通过控制机器人的关节角度来实 现机器人的运动。
方法
常用的方法包括多项式插值、样条曲 线插值等，通过设定起始和目标位置 的关节角度，计算出一条平滑的关节 角度路径。
第三章机器人运动学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)。
移动连杆坐标系的建立
移动连杆坐标系的规定：
• 坐标轴Zi：与i+1关节的轴线重合； • 坐标轴Xi：沿移动关节i轴线与关节i+1轴线的公垂线,指向i+1关节； • 坐标轴Yi：按右手直角坐标系法则确定； • 坐标原点Oi： （1）当关节i轴线和关节i+1轴线相交时，取交点； （2）当关节i轴线和关节i+1轴线异面时，取两轴线的公垂线与关节i轴
• 相邻连杆的关系参数
连杆偏置di ：沿关节i轴线方向，两个共垂线之间的距离； 关节转角θi ：垂直于关节轴线的平面内，两个共垂线之 间的夹角；
关节变量
• 旋转关节：
关节转角θi是关节变量，连杆长度ai、连杆 扭角αi 、连杆偏置di 是固定不变的；
• 移动关节：
连杆偏置di是关节变量，连杆长度ai 、连杆 扭角αi 、关节转角 θi是固定不变的；
移动连杆坐标系的D-H变换
• 移动连杆的D-H参数为θi、ai、αi 、di，其中关 节变量是di 。用与求转动连杆坐标系相同的方法 可求出移动连杆的D-H变换矩阵：
Ai Rot(z,i )Trans(0,0, di )Trans(ai ,0,0)Rot(x,i )
ci sici sisi 0
线与关节i+1轴线的交点； （3）当关节i轴线和关节i+1轴线平行时，取关节i+1轴线与
关节i+2轴线的公垂线与关节i+1轴线的交点；
转动连杆坐标系的建立
• 首连杆0：基座坐标系{0}是固定不动的；Z0 轴取关节1的轴线，O0的设置任意，通常与 O1重合；
• 末连杆n：工具坐标系{n}固定在机器人的 终端，由于连杆n的终端不再有关节，约定 坐标系{n}与{n-1}平行；
• 由于以上变换都是相对于动坐标系的，根据“由左向右”的原则可求
出变换矩阵：Ai Rot(z,i )Trans(0,0, di )Trans(ai ,0,0)Rot(x,i )
ci
si
0
0
sici cici
si
0
si s i cisi
ci
0
aici
ai
si
di 1
（三）移动连杆坐标系及连杆的D-H坐标变换
• A1表示第一连杆对基坐标的位姿， A2表示 第二连杆对第一连杆位姿……
• 则第二连杆对基坐标的位姿为 T2 A1A2 • 手爪相对于基座的位姿
T6 A1 A2 A3 A4 A5 A6
注意前后 顺序
si
cici
cisi
0
0
0
si
0
ci
0
di 1
二、机器人运动学方程
（一）运动学方程
• 机械手可以看成由一系列关节连接起来的连杆组构成。
• 给每一个连杆在关节处设置一个连杆坐标系，该连杆坐标系 随关节运动而运动。
二、 机器人运动学方程
1、A矩阵和T矩阵
• 用A矩阵描述连杆坐标系间相对平移和旋转 的齐次变换。
（二）转动连杆坐标系及连杆的D-H坐标变换
转动连杆坐标系的建立
• 坐标轴Zi：与i+1关节的轴线重合； • 坐标轴Xi：沿连杆i两关节轴线的公垂线,指向i+1关节； • 坐标轴Yi：按右手直角坐标系法则确定； • 坐标原点Oi： （1）当关节i轴线和关节i+1轴线相交时，取交点； （2）当关节i轴线和关节i+1轴线异面时，取两轴线的公垂
转动连杆坐标系的D-H变换
• 转动连杆的D-H参数为θi、ai、αi 、di，其中关节变量是θi 。这四 个参数确定了连杆i相对于连杆i-1的位姿，即D-H坐标变换矩阵Ai。
• 坐标系{i-1}经过下面四次有序的相对变换可得到坐标系{i}：
（1）绕Zi-1轴转θi ；Rot(Zi-1,θi) （2）沿Zi-1轴移动di ；Trans(Zi-1,di) （3）沿Xi轴移动ai ；Trans(Xi,ai) （4）绕Xi轴转αi ；Rot(Xi,αi)
轴的交点；
移动连杆坐标系的建立
• 首连杆0：基座坐标系{0}是固定不动的；Z0 轴取关节1的轴线，O0的设置任意，通常与 O1重合；
• 末连杆n：工具坐标系{n}固定在机器人的 终端，由于连杆n的终端不再有关节，约定 坐标系{n}与{n-1}平行；
再看移动连杆参数的含义
• 由于移动连杆的OiZi轴线平行于移动关节轴 线移动， OiZi在空间的位置是变化的，因而 ai参数无意义。连杆i的长度在坐标系{i-1} 中考虑， 故参数ai=0 。原点Oi的零位与Oi-1 重合，此时移动连杆的变量di=0 。
二、机器人运动学方程
(运动学方程/典型机器人运动学方程)
三、机器人逆运动学
(机器人运动学逆解有关问题/典型臂运动学逆解)
一、机器人连杆参数及其D-H坐标变换
在驱动装置带动下，连杆将绕或沿关节轴线， 相对于前一临近连杆转动或移动。
ቤተ መጻሕፍቲ ባይዱ （一）连杆参数
（一）连杆参数
• 连杆的尺寸参数
连杆长度ai：两个关节轴线i和i+1 沿共垂线的距离； 连杆扭角αi ：两个关节轴线i和i+1的夹角；
第6、7讲 机器人位置运动学
Kinematics of Robotics
机器人正向运动学（运动学正解）
已知所有连杆长度和关节角度，计算机器人手的位姿
机器人逆向运动学（运动学逆解）
已知机器人手的位姿，计算所有连杆长度和关节角度
机器人运动学分析步骤和内容
一、机器人连杆参数及其D-H坐标变换
(连杆参数/连杆坐标系及D-H连杆变换)
再看转动连杆参数的含义
• 连杆的尺寸参数
连杆长度ai：Zi和Zi-1沿Xi的距离，总为正；； 连杆扭角αi ：Zi-1绕Xi转至Zi的转角，符号根据右手定则确 定；
• 相邻连杆的关系参数
连杆偏置di ： Xi-1沿Zi-1至Xi的距离，沿Zi-1正向时为正； 关节转角θi ：Xi-1绕Zi-1转至Xi的转角，符号根据右手定则 确定；
线的交点； （3）当关节i轴线和关节i+1轴线平行时，取关节i+1轴线与关节i+2轴线
的公垂线与关节i+1轴线的交点；
移动连杆坐标系的建立
移动连杆前的相邻连杆坐标系的规定：
• 坐标轴Zi-1：过原点Oi且平行于移动关节i的轴线； • 坐标轴Xi-1：沿移动关节i-1轴线与Zi-1轴线的公垂
线,指向Zi-1轴线； • 坐标轴Yi-1：按右手直角坐标系法则确定； • 坐标原点Oi-1：关节轴线i-1和Zi-1轴的公垂线与Zi-1