（各部分简化为质量均匀、现状规则的刚性连杆，关节间无摩擦）
The Army Armored Force Academy of PLA
仿人机器人简化的连杆模型、自由度和坐标系
1.2 仿人机器人结构
部位名称 关节自由度 角度范围 / ⁰
-120 ~ 120 0 ~ 95 -100 ~ 45 -25 ~ 45

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

x p y z
x wx y wy p z wz 1 w
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 仿人机器人结构
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( ) 符号看象限。
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.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
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描述，该点也可表示为：
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
肩
俯仰 滚动 俯仰 滚动
髋 膝
偏摆
俯仰 俯仰 滚动
-45 ~ 45
0 ~ 130 -75 ~ 45 -45 ~ 45
踝
The Army Armored Force Academy of PLA
1.2 仿人机器人结构
（忽略径向平面和侧向平面的耦合作用，分别研究）
The Army Armored Force Academy of PLA
2.3 Homogeneous Transformation of the Coordinate Frames 齐次坐标变换
齐次坐标就是将一个原本是 n 维的向量用一个 n+1 维向量来 表示。一个向量的齐次表示是不唯一的，比如齐次坐标[8,4,2]、 [4,2,1]表示的都是二维点[2,1]。
( x,y, ω)
相对参考系{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
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
1.1 人体结构分析
1）踝关节关节窝结构灵活 性好适应不同路面。
2）踝关节侧翻角度不大， 保证稳定性。
The Army Armored Force Academy of PLA
1.1 人体结构分析
关节名称 运动名称 旋转（内旋/外旋） 髋关节 前后伸/屈 运动范围 / ⁰ 外45 内45 前120 后15
第三章 仿人机器人的常用传感器 第四章 仿人机器人的执行器 第五章 仿人机器人的控制与轨迹规划 第六章 简单仿人机器人制作
The Army Armored Force Academy of PLA
《Principle and Design of Humanoid Robot》
第二章
仿人机器人的运动学与 动力学分析
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
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 Acቤተ መጻሕፍቲ ባይዱdemy 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
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 坐标变换
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
仿人机器人原理与设计
Principle and Design of Humanoid Robot
主讲：张小明
《Principle and Design of Humanoid Robot》
课时安排：
第一章 仿人机器人概述
第二章 仿人机器人的运动学与动力学分析