这一章要解决什么
上一章得到一个结论:描述三维空间里一个刚体的位置和姿态,至少需要六个数。第 3 章要给出一套系统办法——把一个参考系固定在刚体上,再用这个系相对于某个固定系的位形来描述刚体。这个位形写成一个 4×4 矩阵。
这句话把本章的两条主线一次性说清了:矩阵既能表示位形,也能当作算子去「移动」和「换系」。后面 §3.2.1.2、§3.3.1.2 的「三种用途」就是把它展开。
物理空间里有一个目标点。当人形机器人转动腰部、或你在 URDF 树里切换连杆参考系时,空间点分毫未动,但送入控制器的坐标读数却彻底重组——先在下方调用的真实在线三维仿真站里亲手试现象,再顺着四幕网格把数学本质推到底。
上一章得到一个结论:描述三维空间里一个刚体的位置和姿态,至少需要六个数。第 3 章要给出一套系统办法——把一个参考系固定在刚体上,再用这个系相对于某个固定系的位形来描述刚体。这个位形写成一个 4×4 矩阵。
这句话把本章的两条主线一次性说清了:矩阵既能表示位形,也能当作算子去「移动」和「换系」。后面 §3.2.1.2、§3.3.1.2 的「三种用途」就是把它展开。
教材的第一张图就把本节的问题摆出来了。物理空间里有一个点 p;固定参考系 {a} 后,可以把它写成 pa;换一个位置、朝向、长度尺度都不同的参考系 {b},同一个点就写成 pb。
| 参考系 | 原点 | 轴方向 | 尺度 | 坐标 |
|---|---|---|---|---|
| {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 标题「苹果没动,为什么换个参考系,坐标就变了」的教科书版本。
教材全书固定一个约定:恰好有一个静止的固定系,记作 {s}(space frame),可以钉在房间墙角;另有一个系贴在运动刚体上,记作 {b}(body frame)。
这一点很容易和动力学课里的「随体非惯性系」混淆:这里的 {b} 在每一瞬时是静止的、只是恰好与刚体上的系重合。教材还特意重复了一句 "It is worth repeating one more time: all frames are stationary."
所有参考系都是右手系:x̂、ŷ、ẑ 分别对应右手的食指、中指、拇指;绕某轴的正旋转方向,是拇指指向该轴时四指弯曲的方向。Figure 3.2, p.60
先看平面情形。固定系 {s} 的单位轴是 x̂s、ŷs,物体系 {b} 的单位轴是 x̂b、ŷb。教材没有直接写 p = (px, py),而是先把「沿轴走」写出来:
姿态也一样。既可以只用角度 θ 描述,也可以把 {b} 的两根轴在 {s} 中的方向写出来:
教材说这个写法「乍看低效」,但到了三维,一个角度 θ 就不够了;而把新系的轴写成旧系轴的系数,在三维里可以直接照搬。这正是旋转矩阵 R 的来源:R 的三列就是 {b} 的三根轴在 {s} 中的方向。
R 的九个元素里只有三个能自由选,因为三列是单位且互相正交的轴。教材把约束写成两组:
但这六个约束还分不出左右手。x̂b × ŷb = ẑb(右手)与 = −ẑb(左手)都满足 RTR = I。教材用行列式补上这一条:
特殊正交群 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 之后:
SO(n) 之所以叫「群」,是因为满足四条性质:封闭性、结合律、单位元、逆元。教材逐一给出命题。最要紧的是第一条,它直接解释本站公式里 RT 的来历:
旋转矩阵的逆等于它的转置
"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."
逆变换不用求逆矩阵,直接转置即可,数值绝对稳定。
两个旋转矩阵相乘仍是旋转矩阵,连续旋转可合并连乘。
三维 SO(3) 旋转顺序不可颠倒;平面 SO(2) 子群内可交换。
旋转不改变向量长度;换参考系时苹果到原点的距离不变。
Proposition 3.6 的证明只有一行:‖y‖² = (Rx)T(Rx) = xTRTRx = xTx = ‖x‖²。这也说明:在左边演示里切换参考系时,苹果到原点的距离不会变,变的只是分量。
滚读右侧第 08 节时,矩阵会自动升维展示包含平移向量的齐次变换矩阵 T_sb。
"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 被当作作用在向量或系上的算子。同一个矩阵,身份不同——这正是「切换参考系」和「旋转物体」最容易讲混的地方。
为了不把方向记反,教材给了一条下标消去律:两个旋转矩阵相乘时,若前一个的第二个下标等于后一个的第一个下标,这两个下标就「消掉」:
| 系 | 坐标 |
|---|---|
| pa | (1, 1, 0) |
| pb | (1, −1, 0) |
| pc | (0, −1, −1) |
教材还给出 Rde = Red−1 = RedT,并配了一张图把「同一空间、同一点、三个不同朝向的系」画了三遍(Figure 3.7)。
在 ① 里提交预测后揭晓坐标,本质就是在做 Rab pb = pa;转腰则是在改 R,而不是移动苹果。② 的 θ=90° 预设可直接复现 Figure 3.7 的 pb=(1,−1)。
把旋转 R 和平移 p 装进一个 4×4 矩阵,就得到 T = (R, p) ∈ SE(3)。教材第 3 章开篇说「位形写成 4×4 矩阵」,到这里兑现:
刚体变换保持距离与角度
对 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。
"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 的具体数值,用来目视核对这些计算。
先做教材版本的。取 Figure 3.7 的 Rb 与 pb,用 pW = R·pH + t 的形式(这里 t = 0):
再做本站演示里的三维设定:H 原点在 W 中为 (0.4, 0, 1.0),H 相对 W 绕 z 转 +90°,苹果在 H 中为 (0.1, 0.2, 0)。
② 的「本站 A01 · H 系」就是这组数的 xy 投影:t=(0.4, 0)、θ=90°,由 pb=(0.1, 0.2) 反算回 ps=(0.2, 0.1)。
把教材 §3.2.1.2 的三种用途落到上方调用的真实三维仿真站里,同样「看起来画面变了」,数学身份却截然不同。混淆「系」与「算子」,就会把「物体动了」和「读数变了」当成一回事:
MIT OpenCourseWare 的 2.12 Introduction to Robotics(Fall 2005, Asada & Leonard)采用 CC BY-NC-SA,允许原文引用与翻译。它第 4 章讲的是「坐标系一旦选定,怎样用它写出运动学方程」,正好接在本节之后。
匹配度说明:2.12 没有独立的「坐标系」章节(ch1 学科史、ch2 电机、ch3 连杆、ch4 平面运动学、ch5 微分运动与雅可比)。chapter4 是坐标系建好之后的应用,适合本节之后做练习,不是定义出处。
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。