01
LAYER 01 · SPATIAL DESCRIPTIONS & FRAMES LYNCH & PARK · MODERN ROBOTICS CH.3 (PP. 57–90)
CRAIG 4/E · CHAPTER 2 CORE SPINE

点不在乎你怎么表示它。

物理空间里有一个目标点。当人形机器人转动腰部、或你在 URDF 树里切换连杆参考系时,空间点分毫未动,但送入控制器的坐标读数却彻底重组——先在下方调用的真实在线三维仿真站里亲手试现象,再顺着四幕网格把数学本质推到底。

LIVE 3D SIMULATIONS 直连 5 座现成 WebGL / MuJoCo 站点 URDF 连杆系 · HTD 躯干命令 · Metatron IK · mjswan
LIE GROUPS & IDENTITIES SO(3) 旋转正交群与 SE(3) 齐次矩阵 RᵀR = I · 逆等于转置 R⁻¹ = Rᵀ · 下标消去律
LIVE WEBGL STAGE · EXTERNAL SIMULATION EMBEDS 第一站:在真实在线三维机器人网站里观察「参考系、位姿与空间目标点」 点击标签直接切换现成在线实验站 · 右侧同步给出本章观察点
https://imchong.github.io/Robot_Description_Gallery_Online/
新窗口全屏打开 ↗
正在连接在线三维仿真环境(首次加载 WebAssembly / 3D 模型约需数秒)…
ACT I · TUFTE MONOGRAPH GRID 刚体位形、静止参考系约定与方向余弦导出 2 : 7 : 3 非对称网格 · 右轨原典英文旁注
01 Ch.3 开篇 · p.57

这一章要解决什么

上一章得到一个结论:描述三维空间里一个刚体的位置和姿态,至少需要六个数。第 3 章要给出一套系统办法——把一个参考系固定在刚体上,再用这个系相对于某个固定系的位形来描述刚体。这个位形写成一个 4×4 矩阵。

这句话把本章的两条主线一次性说清了:矩阵既能表示位形,也能当作算子去「移动」和「换系」。后面 §3.2.1.2、§3.3.1.2 的「三种用途」就是把它展开。

02 Figure 3.1 · p.59

点与它的坐标,不是一回事

教材的第一张图就把本节的问题摆出来了。物理空间里有一个点 p;固定参考系 {a} 后,可以把它写成 pa;换一个位置、朝向、长度尺度都不同的参考系 {b},同一个点就写成 pb。

Figure 3.1 的数值 教材原图数据,用文字还原
同一个物理点 p,两种表达:
参考系原点轴方向尺度坐标
{a}固定x̂a, ŷa基准pa = (1, 2)
{b}不同不同不同pb = (4, −2)

教材紧接着强调:「A reference frame can be placed anywhere in space, and any reference frame leads to an equally valid representation of the underlying space and the objects in it.」 没有哪个系更"对",只是度量尺换了。这就是本站 A01 标题「苹果没动,为什么换个参考系,坐标就变了」的教科书版本。

03 pp.59–60 · Figure 3.2

空间系、物体系与右手定则

教材全书固定一个约定:恰好有一个静止的固定系,记作 {s}(space frame),可以钉在房间墙角;另有一个系贴在运动刚体上,记作 {b}(body frame)。

这一点很容易和动力学课里的「随体非惯性系」混淆:这里的 {b} 在每一瞬时是静止的、只是恰好与刚体上的系重合。教材还特意重复了一句 "It is worth repeating one more time: all frames are stationary."

所有参考系都是右手系:x̂、ŷ、ẑ 分别对应右手的食指、中指、拇指;绕某轴的正旋转方向,是拇指指向该轴时四指弯曲的方向。Figure 3.2, p.60

04 pp.60–61 · Eq (3.1)–(3.3)

§3.1 从坐标轴写出位置与姿态

先看平面情形。固定系 {s} 的单位轴是 x̂s、ŷs,物体系 {b} 的单位轴是 x̂b、ŷb。教材没有直接写 p = (px, py),而是先把「沿轴走」写出来:

教材 Eq (3.1) · p.61p=pxx^s+pyy^s

姿态也一样。既可以只用角度 θ 描述,也可以把 {b} 的两根轴在 {s} 中的方向写出来:

教材 Eq (3.2)–(3.3) · p.61x^b=cos⁡θ·x^s+sin⁡θ·y^sy^b=−sin⁡θ·x^s+cos⁡θ·y^s

教材说这个写法「乍看低效」,但到了三维,一个角度 θ 就不够了;而把新系的轴写成旧系轴的系数,在三维里可以直接照搬。这正是旋转矩阵 R 的来源:R 的三列就是 {b} 的三根轴在 {s} 中的方向。

Figure 3.3 的数值 教材例题,θ = 60°
p = (2, 1) θ = 60°
x̂b = (cos θ, sin θ) = (1/2, √3/2)
ŷb = (−sin θ, cos θ) = (−√3/2, 1/2)
把两列并起来就是 Rsb = [ (1/2, √3/2)T , (−√3/2, 1/2)T ],即绕 z 转 60° 的旋转矩阵。
ACT II · CORE GROUP AXIOMS · LIE GROUP SO(3)

旋转矩阵的六个正交约束与「逆即转置」

Rᵀ R = I  ⟺  R⁻¹ = Rᵀ,   det R = +1 DEFINITION 3.1 & PROPOSITIONS 3.3–3.6 · MODERN ROBOTICS PP. 66–69
05 pp.66–68 · Eq (3.17)–(3.21)

§3.2.1 旋转矩阵的六个约束

R 的九个元素里只有三个能自由选,因为三列是单位且互相正交的轴。教材把约束写成两组:

  • (a) 单位长度条件 Eq (3.17):每一列的平方和为 1,共 3 个约束。
  • (b) 正交条件 Eq (3.18):x̂b·ŷb = x̂b·ẑb = ŷb·ẑb = 0,共 3 个约束。
教材 Eq (3.19) · p.67RTR=I

但这六个约束还分不出左右手。x̂b × ŷb = ẑb(右手)与 = −ẑb(左手)都满足 RTR = I。教材用行列式补上这一条:

教材 Eq (3.21) · p.67det⁡R=1(若为左手系则 det R = −1)
Definition 3.1 · 教材 p.68

特殊正交群 SO(3)

"The special orthogonal group SO(3), also known as the group of rotation matrices, is the set of all 3×3 real matrices R that satisfy (i) RTR = I and (ii) det R = 1." 二维的子群记作 SO(2)(Definition 3.2)。

由定义可直接写出平面旋转矩阵,教材把它放在 Definition 3.2 之后:

教材 p.68 · SO(2) 的一般形式R=[cos⁡θ−sin⁡θsin⁡θcos⁡θ]θ∈[0,2π)
06 pp.68–69 · Proposition 3.3–3.6

§3.2.1.1 命题:为什么逆就是转置

SO(n) 之所以叫「群」,是因为满足四条性质:封闭性、结合律、单位元、逆元。教材逐一给出命题。最要紧的是第一条,它直接解释本站公式里 RT 的来历:

Proposition 3.3 · 教材 p.68

旋转矩阵的逆等于它的转置

"The inverse of a rotation matrix R ∈ SO(3) is also a rotation matrix, and it is equal to the transpose of R, i.e., R−1 = RT."
教材原证明:"The condition RTR = I implies that R−1 = RT and RRT = I. Since det RT = det R = 1, RT is also a rotation matrix."

PROPOSITION 3.3 R⁻¹ = Rᵀ

逆变换不用求逆矩阵,直接转置即可,数值绝对稳定。

PROPOSITION 3.4 群乘法封闭

两个旋转矩阵相乘仍是旋转矩阵,连续旋转可合并连乘。

PROPOSITION 3.5 结合但不交换

三维 SO(3) 旋转顺序不可颠倒;平面 SO(2) 子群内可交换。

PROPOSITION 3.6 保长 ‖Rx‖ = ‖x‖

旋转不改变向量长度;换参考系时苹果到原点的距离不变。

Proposition 3.6 的证明只有一行:‖y‖² = (Rx)T(Rx) = xTRTRx = xTx = ‖x‖²。这也说明:在左边演示里切换参考系时,苹果到原点的距离不会变,变的只是分量。

本站 A01 的两条基本式 · 由上述命题而来pW=RWH·pH+tWHpH=RWHT·(pW−tWH)
ACT III · STICKY SCROLLYTELLING WORKBENCH 下标消去律、4×4 齐次变换矩阵 SE(3) 与正反向口算验算 滚动右侧段落自动平滑切换构型与矩阵阶数 · 点击或拖拽画布任意位置实时交互
FIG 02 · 平面双参考系与列着色矩阵(可直接点击画布移动 p)
x̂_s ŷ_s x̂_b ŷ_b O_s O_b p
p_s ( 1.000, 1.000) 固定系不变量
p_b ( 1.000, −1.000) t=(0.0,0.0) · θ=90°
R_sb =
0.000−1.000 1.0000.000
延伸:MIT 2.165 轨迹实验 ↗

滚读右侧第 08 节时,矩阵会自动升维展示包含平移向量的齐次变换矩阵 T_sb。

07

§3.2.1.2 R 的三种用途与下标消去律 pp.69–71 · Eq (3.22)

教材原文 · §3.2.1.2, p.69

"there are three major uses for a rotation matrix R: (a) to represent an orientation; (b) to change the reference frame in which a vector or a frame is represented; (c) to rotate a vector or a frame."

Lynch & Park (2017), p.69

教材进一步点破:前一种用法里 R 被当作一个坐标系;后两种里 R 被当作作用在向量或系上的算子。同一个矩阵,身份不同——这正是「切换参考系」和「旋转物体」最容易讲混的地方。

为了不把方向记反,教材给了一条下标消去律:两个旋转矩阵相乘时,若前一个的第二个下标等于后一个的第一个下标,这两个下标就「消掉」:

教材 Eq (3.22) · p.71RabRbc=RacRabpb=pa
Figure 3.7 的数值 教材 p.70,三系共原点,验证消去律
{b} 由 {a} 绕 ẑa 转 90° 得到,故
Rb = [ 0 −1 0 ; 1 0 0 ; 0 0 1 ]
同一个点 p 在三个系中的坐标:
系坐标
pa(1, 1, 0)
pb(1, −1, 0)
pc(0, −1, −1)
验算:Rb · pb = (0·1 + (−1)·(−1), 1·1 + 0·(−1), 0) = (1, 1, 0) = pa ✓ ——点没动,读数从 pb 变回 pa。

教材还给出 Rde = Red−1 = RedT,并配了一张图把「同一空间、同一点、三个不同朝向的系」画了三遍(Figure 3.7)。

↔ 几何台联动

在 ① 里提交预测后揭晓坐标,本质就是在做 Rab pb = pa;转腰则是在改 R,而不是移动苹果。② 的 θ=90° 预设可直接复现 Figure 3.7 的 pb=(1,−1)。

08

§3.3.1 齐次变换矩阵 T pp.89–90 · §3.3.1.2

把旋转 R 和平移 p 装进一个 4×4 矩阵,就得到 T = (R, p) ∈ SE(3)。教材第 3 章开篇说「位形写成 4×4 矩阵」,到这里兑现:

T 的结构T=[Rp01]R∈SO(3),p∈ℝ3
Proposition 3.18 · 教材 p.89

刚体变换保持距离与角度

对 x, y, z ∈ ℝ³:‖Tx − Ty‖ = ‖x − y‖;⟨Tx − Tz, Ty − Tz⟩ = ⟨x − z, y − z⟩。教材解释:若三点取在刚体上,变换后的三角形与原三角形等距(isometric),"It is in this sense that SE(3) can be identified with rigid-body motions." 并有 Tde = Ted−1。

教材原文 · §3.3.1.2, p.89

"there are three major uses for a transformation matrix T: (a) to represent the configuration (position and orientation) of a rigid body; (b) to change the reference frame in which a vector or frame is represented; (c) to displace a vector or frame."

Lynch & Park (2017), p.89

和 R 的三种用途一一对应,只是把「旋转」升级为「位移(displace)」。§3.3.1 的 Figure 3.14 给了 Tsa、Tsb、Tsc 与 Tbc 的具体数值,用来目视核对这些计算。

09

把数值代进去:一道可口算的例题

先做教材版本的。取 Figure 3.7 的 Rb 与 pb,用 pW = R·pH + t 的形式(这里 t = 0):

教材 Figure 3.7 · 正向Rbpb=(0·1+(−1)(−1),1·1+0·(−1),0)=(1,1,0)=pa
用 Proposition 3.3 反向验算RbTpa=(1,−1,0)=pb✓(逆 = 转置,不必求逆矩阵)

再做本站演示里的三维设定:H 原点在 W 中为 (0.4, 0, 1.0),H 相对 W 绕 z 转 +90°,苹果在 H 中为 (0.1, 0.2, 0)。

先旋转,再平移R·pH=(−0.2,0.1,0)pW=(0.4−0.2,0+0.1,1.0)=(0.2,0.1,1.0)m
逆变换检验RT(pW−t)=(0.1,0.2,0)✓回到 pH
检查顺序(本站 A01):先查参考系,再查正负号,最后才调小数。能复述「苹果没动,但手坐标变了」的原因,比把误差调到零更重要。
↔ 几何台联动

② 的「本站 A01 · H 系」就是这组数的 xy 投影:t=(0.4, 0)、θ=90°,由 pb=(0.1, 0.2) 反算回 ps=(0.2, 0.1)。

ACT IV · PARALLEL SPREADS & COLOPHON 三种易混操作并置对比、MIT OCW 原典双语对开与学术出处 三联对照联动在线仿真 · 左右双语平行对开
10

三个容易混淆的操作

把教材 §3.2.1.2 的三种用途落到上方调用的真实三维仿真站里,同样「看起来画面变了」,数学身份却截然不同。混淆「系」与「算子」,就会把「物体动了」和「读数变了」当成一回事:

I · PROJECTION

拖动相机视角

教材里的身份
纯观察投影(不属于刚体变换)
改变了什么
屏幕二维成像的相机方位角
什么绝不会变
W / B / H 与目标点的三维坐标全部不变
II · PASSIVE MAP

切换参考系

教材里的身份
(b) 改变向量所在参考系的表达
改变了什么
同一物理点在不同连杆系下的坐标分量
什么绝不会变
物体在物理世界里的真实空间位置
III · ACTIVE MOTION

转动机器人躯干/腰部

教材里的身份
(a) 表示新位形 / (c) 刚体旋转算子
改变了什么
末端系 H 相对世界系 W 的位姿矩阵 T_WH
什么绝不会变
外部静止目标点的世界坐标 p_W
11

原典选读:MIT OCW 2.12 讲义双语对开 CC BY-NC-SA

MIT OpenCourseWare 的 2.12 Introduction to Robotics(Fall 2005, Asada & Leonard)采用 CC BY-NC-SA,允许原文引用与翻译。它第 4 章讲的是「坐标系一旦选定,怎样用它写出运动学方程」,正好接在本节之后。

Chapter 4 · Planar Kinematics · p.1(英文原文)
"Kinematics is Geometry of Motion. It is one of the most fundamental disciplines in robotics, providing tools for describing the structure and behavior of robot mechanisms. In this chapter, we will discuss how the motion of a robot mechanism is described, how it responds to actuator movements, and how the individual actuators should be coordinated to obtain desired motion at the robot end-effecter."
中译:运动学是「运动的几何学」,是机器人学最基础的学科之一,为描述机构的结构与行为提供工具。本章讨论机构的运动如何被描述、它如何响应驱动器的运动,以及各驱动器应如何协调,才能在末端得到期望的运动。
Chapter 4 · §4.1 · p.2(英文原文)
"To describe its location, we use a coordinate system, O-xy, fixed to the base link with the origin at the first joint, and describe the end-effecter position with coordinates ex and ey. We can relate the end-effecter coordinates to the joint angles determined by the three actuators by using the link lengths and joint angles defined above."
中译:为描述末端位置,我们把坐标系 O-xy 固定在基座连杆上、原点取在第一个关节,用 ex、ey 表示末端位置;再用杆长与关节角,把末端坐标与三个驱动器的关节角联系起来——这就是式 (4.1.1)–(4.1.3) 的正运动学方程。

匹配度说明:2.12 没有独立的「坐标系」章节(ch1 学科史、ch2 电机、ch3 连杆、ch4 平面运动学、ch5 微分运动与雅可比)。chapter4 是坐标系建好之后的应用,适合本节之后做练习,不是定义出处。

Harry Asada and John Leonard. 2.12 Introduction to Robotics. Fall 2005. Massachusetts Institute of Technology: MIT OpenCourseWare, https://ocw.mit.edu/. License: Creative Commons BY-NC-SA.
12

另一套经典表述:QUT Robot Academy

Peter Corke(QUT)在《Summary of 2D geometry and pose》里,用一句很有名的话替本节收尾:

同一节课还把本节用到的事实压成一段:坐标系遵循右手约定;两系之间的相对旋转用角度定义,逆时针为正;点用相对于某系的向量表示;2×2 旋转矩阵是正交阵,其逆等于转置,行列式恒为 +1;3×3 齐次变换矩阵同时包含旋转矩阵与平移向量。这些与 Modern Robotics §3.2.1、§3.3.1 完全一致。

该站鼓励教育机构以 viewing lists(链接清单)用于课堂与翻转学习;改写、剪辑等定制需向 QUT 申请许可,故这里只引用短段落并标注出处,不搬全文 transcript。