机器人运动学.PPT
合集下载
机器人运动学课件
轨迹规划实现
坐标系选择
在进行轨迹规划时，需要选择合适的坐标系，如笛卡尔坐 标系和关节坐标系等，以便于描述机器人的运动轨迹和关 节角度。
插值函数选择
选择合适的插值函数能够保证机器人的运动轨迹的光滑性 和连续性，需要根据实际需求和约束条件来确定插值函数 的形式和参数。
插值点选择
选择合适的插值点是实现精确轨迹的关键，需要根据实际 需求和约束条件来确定插值点的数量和位置。
根据不同的分类标准，轨迹规划可以分为多种类型，如基于时间的轨迹 规划、基于空间的轨迹规划、笛卡尔空间的轨迹规划和关节空间的轨迹 规划等。
轨迹规划方法
基于多项式的轨迹规划方法
基于样条曲线的轨迹规划方法
该方法通过使用多项式函数来描述机器人 的运动轨迹，具有简单、易实现的特点， 但可能会产生较大的轨迹误差。
描述机器人末端执行器的 方向变化。
齐次变换矩阵
用于描述平移和旋转的复 合变换，包括旋转和平移 矩阵的组合。
03
机器人运动学方程
齐次变换
齐次变换定义
齐次变换描述了刚体在空间中的位置和姿态，由平移和旋转组成 。
齐次变换矩阵
齐次变换可以用一个4x4的矩阵来表示，该矩阵包含了刚体的位置 信息和姿态信息。
绝对位置
相对于参考坐标系的机器 人位置。
相对位置
相对于机器人上某固定参 考点的位置。
姿态描述
方向描述
描述机器人的朝向，通常使用欧拉角 （俯仰角、偏航角、滚动角）或四元 数表示。
姿态矩阵
通过旋转和平移矩阵描述机器人末端 执行器的姿态。
坐标系转换
平移变换
描述机器人末端执行器在 空间中的位置变化。
旋转变换
根据机器人的关节类型和连接方式， 通过几何关系和运动约束建立机器人 末端执行器的位置和姿态的运动学方 程。
第二章 机器人运动学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机器人正逆运动学
迭代法
通过不断迭代和优化关节角度，逐渐 逼近满足末端执行器位置和姿态要求 的解。这种方法适用于复杂机器人结 构和动态环境下的逆运动学求解。
逆运动学应用实例
工业机器人
在工业自动化领域，逆运动学被广泛应用于机器人轨迹规划和精确控制。通过逆运动学算法，可以快速求解机器 人的关节角度，实现精确的定位和姿态控制。
技术发展趋势
深度学习
01
利用深度学习技术，使机器人能够更好地理解和识别环境，提
高自主导航和避障能力。
强化学习
02
通过强化学习算法，使机器人能够在实践中不断学习和优化，
提高任务执行效率。
模块化设计
03
采用模块化设计理念，使机器人能够根据不同任务需求进行快
速重构和升级。
未来挑ቤተ መጻሕፍቲ ባይዱ与机遇
安全问题
随着机器人应用场景的扩 大，如何保证机器人的安 全性和可靠性成为亟待解 决的问题。
控制硬件实现
传感器选择
根据机器人运动需求，选择合适的传感器， 如编码器、陀螺仪、加速度计等。
硬件平台搭建
根据控制需求，搭建合适的硬件平台，如采 用微控制器、DSP、FPGA等。
控制软件实现
要点一
软件架构设计
设计合理的软件架构，包括主程序、中断服务程序、任务 调度程序等。
要点二
算法实现
根据优化后的算法，在软件中实现相应的控制逻辑，并进 行调试和测试。
约束条件
机器人关节角度限制、工作空间限制、动力学限制等。
常用优化算法
梯度下降法
通过迭代计算，逐步逼近最优解。
遗传算法
模拟生物进化过程，通过基因突变和自然选择寻找最优解。
粒子群优化算法
模拟鸟群、鱼群等生物群体的行为，通过个体间的相互协作寻找 最优解。
通过不断迭代和优化关节角度，逐渐 逼近满足末端执行器位置和姿态要求 的解。这种方法适用于复杂机器人结 构和动态环境下的逆运动学求解。
逆运动学应用实例
工业机器人
在工业自动化领域，逆运动学被广泛应用于机器人轨迹规划和精确控制。通过逆运动学算法，可以快速求解机器 人的关节角度，实现精确的定位和姿态控制。
技术发展趋势
深度学习
01
利用深度学习技术，使机器人能够更好地理解和识别环境，提
高自主导航和避障能力。
强化学习
02
通过强化学习算法，使机器人能够在实践中不断学习和优化，
提高任务执行效率。
模块化设计
03
采用模块化设计理念，使机器人能够根据不同任务需求进行快
速重构和升级。
未来挑ቤተ መጻሕፍቲ ባይዱ与机遇
安全问题
随着机器人应用场景的扩 大，如何保证机器人的安 全性和可靠性成为亟待解 决的问题。
控制硬件实现
传感器选择
根据机器人运动需求，选择合适的传感器， 如编码器、陀螺仪、加速度计等。
硬件平台搭建
根据控制需求，搭建合适的硬件平台，如采 用微控制器、DSP、FPGA等。
控制软件实现
要点一
软件架构设计
设计合理的软件架构，包括主程序、中断服务程序、任务 调度程序等。
要点二
算法实现
根据优化后的算法，在软件中实现相应的控制逻辑，并进 行调试和测试。
约束条件
机器人关节角度限制、工作空间限制、动力学限制等。
常用优化算法
梯度下降法
通过迭代计算，逐步逼近最优解。
遗传算法
模拟生物进化过程，通过基因突变和自然选择寻找最优解。
粒子群优化算法
模拟鸟群、鱼群等生物群体的行为，通过个体间的相互协作寻找 最优解。
第七章 机器人运动学ppt课件
Ai Ai-1
编辑版pppt
8
➢ 杆件参数的定义—— 、li 、 i 和di i
由运动学的观点来看，杆件保持其两端关节间的形态
不变，这种形态由两个参数决定：杆件长度 li 和杆件扭
转角 i 。杆件的相对位置关系，由另外两个参数决定：
杆件的距离 di 和杆件的回转角 i 。
li — 关节 Ai 轴和 Ai+1 轴线公法线的长度。
li
i zi
yi
xi oi
绕 xi 轴转 i 角度，两
坐标系完全重合．
li 1
di
zi1 oi1
yi1
i
xi1
i 1 A i R ( z i 1 ,i ) T r a n s ( z i 1 , d 编i ) 辑T 版pr ppa t n s ( x i , l i ) R ( x i ,i )
机器人技术及空间应用
第七章 机器人运动学
机器人运动学主要是把机器人相对于固定参考 系的运动作为时间的函数进行分析研究，而不 考虑引起这些运动的力和力矩 将机器人的空间位移解析地表示为时间的函数， 特别是研究机器人关节变量空间和机器人末端 执行器位置和姿态之间的关系 本章将讨论机器人运动学几个具有实际意义的 基本问题。
• 并联机器人：刚性好，负载大，误差不积累，工作空间 小，姿态范围不大。
• 本章讲解以串联机器人为主。
编辑版pppt
3
§7.1.2 运动学研究的问题
Where is my hand?
Direct Kinematics HERE!
运动学正问题
运动学逆问题
How do I put my hand here?
ny
z
n0x
编辑版pppt
8
➢ 杆件参数的定义—— 、li 、 i 和di i
由运动学的观点来看，杆件保持其两端关节间的形态
不变，这种形态由两个参数决定：杆件长度 li 和杆件扭
转角 i 。杆件的相对位置关系，由另外两个参数决定：
杆件的距离 di 和杆件的回转角 i 。
li — 关节 Ai 轴和 Ai+1 轴线公法线的长度。
li
i zi
yi
xi oi
绕 xi 轴转 i 角度，两
坐标系完全重合．
li 1
di
zi1 oi1
yi1
i
xi1
i 1 A i R ( z i 1 ,i ) T r a n s ( z i 1 , d 编i ) 辑T 版pr ppa t n s ( x i , l i ) R ( x i ,i )
机器人技术及空间应用
第七章 机器人运动学
机器人运动学主要是把机器人相对于固定参考 系的运动作为时间的函数进行分析研究，而不 考虑引起这些运动的力和力矩 将机器人的空间位移解析地表示为时间的函数， 特别是研究机器人关节变量空间和机器人末端 执行器位置和姿态之间的关系 本章将讨论机器人运动学几个具有实际意义的 基本问题。
• 并联机器人：刚性好，负载大，误差不积累，工作空间 小，姿态范围不大。
• 本章讲解以串联机器人为主。
编辑版pppt
3
§7.1.2 运动学研究的问题
Where is my hand?
Direct Kinematics HERE!
运动学正问题
运动学逆问题
How do I put my hand here?
ny
z
n0x
1(第二章机器人运动学)PPT课件
第二章 机器人运动学
(Robot Kinematics) (Manipulator Kinematics)
刘志远、刘海峰
30.10.2020
1
Degree of Freedom (DOF)
30.10.2020
end-effector
2
机器人各连杆视作刚体
g2 (t) Joint angle Link g1(t)
U
system (OXYZ)
x
– Rotated coordinate system (OUVW)
U
A point P in the space can be represented by its coordinates
x
with respect to both coordinate systems.
正交变换
30.10.2020
11
Remark: geometric interpretation of rotation matrices.
Z W
p pu pv pw T
Z W
T
pw pv
p pu
O
U X
Y
V
O
X
U
V Y
px pu
pu
py
R
pv
r1
r2
r3
pv
p 30.10.2020
Actuator
End-effector
关g (节t) 角[g 1 g((tt))g [g 2( 1t() t) g g n 2 (t(t))T T ] ]。若为n自由度的机械手则
30.10.2020
3
2.1 引言(Introduction)
(Robot Kinematics) (Manipulator Kinematics)
刘志远、刘海峰
30.10.2020
1
Degree of Freedom (DOF)
30.10.2020
end-effector
2
机器人各连杆视作刚体
g2 (t) Joint angle Link g1(t)
U
system (OXYZ)
x
– Rotated coordinate system (OUVW)
U
A point P in the space can be represented by its coordinates
x
with respect to both coordinate systems.
正交变换
30.10.2020
11
Remark: geometric interpretation of rotation matrices.
Z W
p pu pv pw T
Z W
T
pw pv
p pu
O
U X
Y
V
O
X
U
V Y
px pu
pu
py
R
pv
r1
r2
r3
pv
p 30.10.2020
Actuator
End-effector
关g (节t) 角[g 1 g((tt))g [g 2( 1t() t) g g n 2 (t(t))T T ] ]。若为n自由度的机械手则
30.10.2020
3
2.1 引言(Introduction)
机器人运动学正解逆解-精PPT课件
A3
ai—沿 xi 轴， zi-1 轴与 xi 轴交点到Oi 的距离
αi — 绕 xi 轴，由 zi-1 转向zi
di — 沿 zi-1 轴，zi-1 轴和 xi 交点至Oi –1 坐标
系原点的距离
θi — 绕 zi-1 轴，由 xi-1转向 xi
A5
A4 A6
.
16
连杆 n θn
dn
anαn1 θ1 源自900) 0S5S6 0C234S5 S234S5
C5 0
C234a4 C23a3 C2a2
S234a4
S23a3
S2a2
0
1
根据第3行第4列元素对应相等可得到
1a rc tp paxy)n和 (111 8 0
.
29
根据1，4元素和2，4元素，可得到：
pxC 1pyS1C23 a4 4C2a 33C2a2 pzS23 a4 4S2a 33S2a2
C234a4 ) S234a4 )
进而可得：
4 234 2 3
再 根 据 对 应 项 元 素 相 ， 等 可 以 得 到
S5 C23（4 C1ax S1ay ) S234az
C5 C1ay S1ax
5
arctanC234(C1ax S1ax
S1ay ) C1ay
S234az
.
32
§1.4 机器人正向运动学
工业机器人的正向运动学是指已知各关节的类型、相邻 关节之间的尺寸和相邻关节相对运动量的大小时，如何确 定工业机器人末端操作器在固定坐标系中的位姿。
主要包括以下内容： 1) 相对杆件的坐标系的确定； 2) 建立各连杆的模型矩阵A； 3) 正运动学算法；
.
1
《机器人运动学》课件
机器人正向运动学建模
正向运动学
根据机器人关节参数，计算机器人末端执行器在笛卡尔坐标 系中的位置和姿态的过程。
正向运动学模型
描述机器人末端执行器位置和姿态与关节参数之间关系的数 学模型。
机器人逆向运动学建模
逆向运动学
已知机器人末端执行器在笛卡尔坐标系中的位置和姿态，求解机器人关节参数 的过程。
逆向运动学模型
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
从而定义复合变换
。
同理得出：
- 1、下载文档前请自行甄别文档内容的完整性，平台不提供额外的编辑、内容补充、找答案等附加服务。
- 2、"仅部分预览"的文档,不可在线预览部分如存在完整性等问题,可反馈申请退款(可完整预览的文档不适用该条件!)。
- 3、如文档侵犯您的权益，请联系客服反馈,我们会尽快为您处理(人工客服工作时间：9:00-18:30)。
（3）沿Xi轴移动ai ；Trans(Xi,ai)
（4）绕Xi轴转αi ；Rot(Xi,αi)
• 由于以上变换都是相对于动坐标系的，根据“由左向右”的原则可求
出变换矩阵：Ai Ro(tz,i)Tran(0s,0,di)Tran(asi,0,0)Ro(tx,i)
ci sici sisi aici
si
cici
轴的交点；
14
移动连杆坐标系的建立
• 首连杆0：基座坐标系{0}是固定不动的；Z0 轴取关节1的轴线，O0的设置任意，通常与 O1重合；
• 末连杆n：工具坐标系{n}固定在机器人的 终端，由于连杆n的终端不再有关节，约定 坐标系{n}与{n-1}平行；
15
再看移动连杆参数的含义
• 由于移动连杆的OiZi轴线平行于移动关节轴 线移动， OiZi在空间的位置是变化的，因而 ai参数无意义。连杆i的长度在坐标系{i-1} 中考虑， 故参数ai=0 。原点Oi的零位与Oi-1 重合，此时移动连杆的变量di=0 。
10
转动连杆坐标系的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)
6
（二）转动连杆坐标系及连杆的D-H坐标变换
7
转动连杆坐标系的建立
• 坐标轴Zi：与i+1关节的轴线重合； • 坐标轴Xi：沿连杆i两关节轴线的公垂线,指向i+1关节； • 坐标轴Yi：按右手直角坐标系法则确定； • 坐标原点Oi： （1）当关节i轴线和关节i+1轴线相交时，取交点； （2）当关节i轴线和关节i+1轴线异面时，取两轴线的公垂
线与关节i+1轴线的交点； （3）当关节i轴线和关节i+1轴线平行时，取关节i+1轴线与
关节i+2轴线的公垂线与关节i+1轴线的交点；
8Hale Waihona Puke 转动连杆坐标系的建立• 首连杆0：基座坐标系{0}是固定不动的；Z0 轴取关节1的轴线，O0的设置任意，通常与 O1重合；
• 末连杆n：工具坐标系{n}固定在机器人的 终端，由于连杆n的终端不再有关节，约定 坐标系{n}与{n-1}平行；
• 相邻连杆的关系参数
连杆偏置di ：沿关节i轴线方向，两个共垂线之间的距离； 关节转角θi ：垂直于关节轴线的平面内，两个共垂线之 间的夹角；
5
关节变量
• 旋转关节：
关节转角θi是关节变量，连杆长度ai、连杆 扭角αi 、连杆偏置di 是固定不变的；
• 移动关节：
连杆偏置di是关节变量，连杆长度ai 、连杆 扭角αi 、关节转角 θi是固定不变的；
第6、7讲 机器人位置运动学
Kinematics of Robotics
机器人正向运动学（运动学正解）
已知所有连杆长度和关节角度，计算机器人手的位姿
机器人逆向运动学（运动学逆解）
已知机器人手的位姿，计算所有连杆长度和关节角度
1
机器人运动学分析步骤和内容
一、机器人连杆参数及其D-H坐标变换
(连杆参数/连杆坐标系及D-H连杆变换)
• 则第二连杆对基坐标的位姿为 T2 A1A2 • 手爪相对于基座的位姿
T6A 1A 2A 3A 4A 5A 6
注意前后 顺序
二、机器人运动学方程
(运动学方程/典型机器人运动学方程)
三、机器人逆运动学
(机器人运动学逆解有关问题/典型臂运动学逆解)
2
一、机器人连杆参数及其D-H坐标变换
在驱动装置带动下，连杆将绕或沿关节轴线， 相对于前一临近连杆转动或移动。
3
（一）连杆参数
4
（一）连杆参数
• 连杆的尺寸参数
连杆长度ai：两个关节轴线i和i+1 沿共垂线的距离； 连杆扭角αi ：两个关节轴线i和i+1的夹角；
线的交点； （3）当关节i轴线和关节i+1轴线平行时，取关节i+1轴线与关节i+2轴线
的公垂线与关节i+1轴线的交点；
13
移动连杆坐标系的建立
移动连杆前的相邻连杆坐标系的规定：
• 坐标轴Zi-1：过原点Oi且平行于移动关节i的轴线； • 坐标轴Xi-1：沿移动关节i-1轴线与Zi-1轴线的公垂
线,指向Zi-1轴线； • 坐标轴Yi-1：按右手直角坐标系法则确定； • 坐标原点Oi-1：关节轴线i-1和Zi-1轴的公垂线与Zi-1
9
再看转动连杆参数的含义
• 连杆的尺寸参数
连杆长度ai：Zi和Zi-1沿Xi的距离，总为正；； 连杆扭角αi ：Zi-1绕Xi转至Zi的转角，符号根据右手定则确 定；
• 相邻连杆的关系参数
连杆偏置di ： Xi-1沿Zi-1至Xi的距离，沿Zi-1正向时为正； 关节转角θi ：Xi-1绕Zi-1转至Xi的转角，符号根据右手定则 确定；
0
0
si
0
ci
0
d1i
17
二、机器人运动学方程
（一）运动学方程
• 机械手可以看成由一系列关节连接起来的连杆组构成。
• 给每一个连杆在关节处设置一个连杆坐标系，该连杆坐标系 随关节运动而运动。
18
二、 机器人运动学方程
1、A矩阵和T矩阵
• 用A矩阵描述连杆坐标系间相对平移和旋转 的齐次变换。
• A1表示第一连杆对基坐标的位姿， A2表示 第二连杆对第一连杆位姿……
16
移动连杆坐标系的D-H变换
• 移动连杆的D-H参数为θi、ai、αi 、di，其中关 节变量是di 。用与求转动连杆坐标系相同的方法 可求出移动连杆的D-H变换矩阵：
Ai Ro(tz,i)Tran(0s,0,di)Tran(asi,0,0)Ro(tx,i)
ci sici sisi 0
si cici cisi 0
cisi
aisi
0
0
si
0
ci
0
di 1
11
（三）移动连杆坐标系及连杆的D-H坐标变换
12
移动连杆坐标系的建立
移动连杆坐标系的规定：
• 坐标轴Zi：与i+1关节的轴线重合； • 坐标轴Xi：沿移动关节i轴线与关节i+1轴线的公垂线,指向i+1关节； • 坐标轴Yi：按右手直角坐标系法则确定； • 坐标原点Oi： （1）当关节i轴线和关节i+1轴线相交时，取交点； （2）当关节i轴线和关节i+1轴线异面时，取两轴线的公垂线与关节i轴