第二章 仿人机器人原理与设计-运动学与动力学分析

The Army Armored Force Academy of PLA
2.3 Homogeneous Transformation of the Coordinate Frames 齐次坐标变换
A A B p B R p ApBo
Homogeneous Transformation
A A p B R | A pBo B p 0 0 0 | 1 1 1
zA {A} xB
A
zB {B}
oB p yB
A B
R R ;
A B T
1
A B
R 1
xA
oA
yA
The Army Armored Force Academy of PLA
2.1 Representation of Position and Attitude
• Description of Frames
1.仿人机器人的结构
The Army Armored Force Academy of PLA
1.1 人体结构分析（以下肢为例）
髋关节类似球副
The Army Armored Force Academy of PLA
1.1 人体结构分析
膝关节受力是体重的1.5~8倍
The Army Armored Force Academy of PLA

x y ( , )
齐次坐标提供了用矩阵运算把二维、三维甚至高维空间中的 一个点集从一个坐标系变换到另一个坐标系的有效方法。

x p y z
x wx y wy p z wz 1 w
2.2 Coordinate Transformation 坐标变换 • 平移坐标变换 (Translation Transform)
A
p p pBo
B A
zB {A}
A
{B}
zA
p oB
B
p yB
A
pBo xB
oA
yA
xA
The Army Armored Force Academy of PLA
The Army Armored Force Academy of PLA
第二章主要内容：
1 仿人机器人的结构 2 仿人机器人的运动学分析 2.1 位置和姿势的表示 2.2 坐标的变换 2.3 齐次坐标变换 2.4 正运动学分析
2.3 逆运动学分析
3 仿人机器人的动力学分析
The Army Armored Force Academy of PLA
The Army Armored Force Academy of PLA
2.1 Representation of Position and Attitude 位置和姿态的表示 • Description of Position
px A p p y pz
xA zA {A} p
2.3 Homogeneous Transformation of the Coordinate Frames 齐次坐标变换
齐次坐标就是将一个原本是 n 维的向量用一个 n+1 维向量来 表示。一个向量的齐次表示是不唯一的，比如齐次坐标[8,4,2]、 [4,2,1]表示的都是二维点[2,1]。
( x,y, ω)
仿人机器人的连杆模型二维视图
2.仿人机器人的运动学分析(Kinematics)
运动学模型是指仿人机器人的各关节角 度和连杆位姿之间的关系，它是仿人机器人 步态规划和运动控制的基础。
正运动学是指根据仿人机器人的各关节角度求 各连杆的位姿，常用方法D-H方法。
逆运动学是指根据各连杆的位姿求解各连杆关 节的角度，即根据髋关节、膝关节和踝关节的位姿， 通过连杆间的几何位置等关系求解各关节的角度。
第三章 仿人机器人的常用传感器 第四章 仿人机器人的执行器 第五章 仿人机器人的控制与轨迹规划 第六章 简单仿人机器人制作
The Army Armored Force Academy of PLA
《Principle and Design of Humanoid Robot》
第二章
仿人机器人的运动学与 动力学分析
c s s c Rot( z, ) 0 0 0 0 0 0 1 0
0 0 0 1
0 0 0 1
c 0 Rot( y, ) s 0
0 s 0 1 0 0 0 c 0 0 0 1
绕轴轴不变， 自轴取余弦； 余轴用sin( ) 符号看象限。
1.1 人体结构分析
1）踝关节关节窝结构灵活 性好适应不同路面。
2）踝关节侧翻角度不大， 保证稳定性。
The Army Armored Force Academy of PLA
1.1 人体结构分析
关节名称 运动名称 旋转（内旋/外旋） 髋关节 前后伸/屈 运动范围 / ⁰ 外45 内45 前120 后15
A
p
oA
yA
The Army Armored Force Academy of PLA
2.1 Representation of Position and Attitude
• Description of Orientation
A B
R

A
xB
A
yB
A
zB

r11 r12 r13 r r r 21 22 23 r31 r32 r33
The Army Armored Force Academy of PLA
2.3 Homogeneous Transformation of the Coordinate Frames 齐次坐标变换
Homogeneous Transformation of Rotation
0 1 0 0 c s Rot( x, ) 0 s c 0 0 0
内收/外展 膝关节
踝关节 （简化为2自由度）
内45 外45 前90 后0
左45 右45 前50 后50
伸/屈
内收/外展 屈/ 伸
关节名称
髋关节 膝关节 踝关节
人体的关节形式
球形关节 两方向转动关节 球形关节
替代方式
分解为三个十字交叉的转动关节 用一个转动副代替 分解为三个十字交叉的转动关节
The Army Armored Force Academy of PLA
2.2 Coordinate Transformation 坐标变换
• 复合变换 (Composite Transform)
A
p R p pBo
A B B A
zC zB {B} zA
A B
p oB
p
yB
yC
{A} oA yA
A
pBo xC xB
xA
The Army Armored Force Academy of PLA
肩
俯仰 滚动 俯仰 滚动
髋 膝
偏摆
俯仰 俯仰 滚动
-45 ~ 45
0 ~ 130 -75 ~ 45 -45 ~ 45
踝
The Army Armored Force Academy of PLA
1.2 仿人机器人结构
（忽略径向平面和侧向平面的耦合作用，分别研究）
The Army Armored Force Academy of PLA
cosθ
xA
绕z轴旋转θ
The Army Armored Force Academy of PLA
2.2 Coordinate Transformation 坐标变换
• Rotation about an axis
1 0 R ( x, ) 0 c 0 s 0 s c
The Army Armored Force Academy of PLA
The Army Armored Force Academy of PLA
[例]已知点 u=7i+3j+2k，将 u绕 z 轴旋转90°得到点 v，再 将点 v 绕 y轴旋转90°得到点w，求点v、w的坐标。 解：
c90 s 90 0 0 7 3 s 90 c90 0 0 3 7 v Rot z,90 u 0 0 1 0 2 2 0 0 0 1 1 1
• Rotation about an axis
A A A
xp xp cos
B
yB {B}
yA
{A} xB
y p B xp sin z p B xp 0 0
s c 0 0 0 1
sinθ oA θ
p
c R( z , ) s 0
1.2 仿人机器人结构
自由度 DOF（Degrees of Freedom）
Number of independent motions that are allowed to the body.
刚体的6个自由度
The Army Armored Force Academy of PLA
1.2 仿人机器人结构
The Army Armored Force Academy of PLA
仿人机器人原理与设计
Principle and Design of Humanoid Robot
主讲：张小明
《Principle and Design of Humanoid Robot》
课时安排：
第一章 仿人机器人概述
第二章 仿人机器人的运动学与动力学分析
（各部分简化为质量均匀、现状规则的刚性连杆，关节间无摩擦）
The Army Armored Force Academy of PLA
仿人机器人简化的连杆模型、自由度和坐标系
1.2 仿人机器人结构
部位名称 关节自由度 角度范围 / ⁰
-120 ~ 120 0 ~ 95 -100 ~ 45 -25 ~ 45
2.2 Coordinate Transformation 坐标变换
• 旋转坐标变换 (Rotation Transform)
zA zB
B
p
A
yB yA
pபைடு நூலகம்R p
A B B
o
xA
xB
The Army Armored Force Academy of PLA
2.2 Coordinate Transformation 坐标变换
Matrix Form：
A B p A T p B
The Army Armored Force Academy of PLA
2.3 Homogeneous Transformation of the Coordinate Frames 齐次坐标变换
Homogeneous Transformation of Translation 空间中的某点用矢量ai+bj+ck描述，该点也可表示为：
1 0 Trans(a, b, c) 0 0 0 0 a 1 0 b 0 1 c 0 0 1
对已知矢量 u=[x,y,z,w]T 进行平移变换所得的矢量 v 为：
1 0 v Trans(a, b, c) u 0 0 0 1 0 0 0 0 1 0 a x x aw x / w a y y bw y / w b b c z z cw z / w c 1 w w 1
相对参考系{A}，坐标系{B}的原点位置和坐标轴 A 的方位，分别由位置矢量(Position Vector) pBo 和旋转 A 矩阵(Rotation Matrix) B R 描述。这样，刚体的位姿 （位置和姿态）可由坐标系{B}来描述，即
A {B} B R A
pBo
The Army Armored Force Academy of PLA
yB {B}
yA
{A} xB
c 0 s R ( y , ) 0 1 0 s 0 c c s 0 R( z , ) s c 0 0 1 0
sinθ oA θ
p
cosθ
xA
绕z轴旋转θ
The Army Armored Force Academy of PLA