机器人入行指南
原理层/矩阵就是旋转的记账本

原理层 T1 / 27 · 高中出发

矩阵就是旋转的记账本

你已经会 sin(a+b) 和 cos(a+b)。把它们排成一张 2×2 的表,就得到了机器人里出现一万次的东西:旋转矩阵。

你已会的:sin/cos 和差公式高中二年级已知记成矩阵:R(θ),乘法=复合本篇 T1桥三维版:SE(3) 与四种姿态表示/k/A1/ 完整版深水从和差公式到旋转矩阵只差一步「排个表」:矩阵乘法复合的四个格子,正好是和差公式的四行
约 25 分钟2 定理4 步证明3 题自测

一句话结论

旋转矩阵不是新发明,是三角和差公式的记账格式。矩阵乘法看起来新,算的其实是「先转 α 再转 β,等于一次转 α+β」。

动图版 · 拖动圆上的点,右侧旋转矩阵的四个数字实时跟着变——矩阵不是表格,是会动的账本

站里 /k/A1/ 讲姿态的四种表示,那是完整版。这一篇只做一件事:从和差公式出发,让你第一次见到矩阵时不觉得它是天书。

为什么需要它

「机械臂末端在哪儿」= 把末端坐标从关节坐标系一路换到基座坐标系。每换一次,就是一次旋转加平移。

每次旋转的坐标换算展开后,就是四个三角函数的组合。每次都展开太累,所以人们把它们打包成矩阵。

「先转 A 再转 B」用矩阵乘法记成一行;乘开一看,正好就是和差公式。

定义

绕原点的旋转

平面里点 (x, y) 绕原点逆时针转角 θ 后到 (x', y'):x' = x·cosθ − y·sinθ,y' = x·sinθ + y·cosθ。写成矩阵就是 R(θ) = [[cosθ, −sinθ], [sinθ, cosθ]] 乘列向量 (x, y)。

为什么这样定这个定义不是拍脑袋——把它写成矩阵后,「先转 α 再转 β」的复合会自动算出和差公式,见下面第一条定理。

定理与证明

定理 1(复合)

R(α)·R(β) = R(α+β)。

证

按矩阵乘法定义展开,逐格算:左上格 = cosα·cosβ − sinα·sinβ,由和差公式等于 cos(α+β);右上格 = −cosα·sinβ − sinα·cosβ = −sin(α+β);左下格 = sinα·cosβ + cosα·sinβ = sin(α+β);右下格 = −sinα·sinβ + cosα·cosβ = cos(α+β)。

四个格子和 R(α+β) 的四个格子逐格相同,故 R(α)·R(β) = R(α+β)。

注这就是「矩阵乘法 = 动作复合」的出处。机器人里一整条坐标变换链(相机→末端→基座),本质就是这条定理连着用。

定理 2(保长)

旋转不改变长度:x'² + y'² = x² + y²。

证

代入 x' = x·c − y·s,y' = x·s + y·c(c=cosθ,s=sinθ):x'² + y'² = (xc−ys)² + (xs+yc)² = x²c² − 2xycs + y²s² + x²s² + 2xycs + y²c²。

交叉项抵消,剩下 x²(c²+s²) + y²(s²+c²) = x² + y²(用 c²+s²=1)。

注所以矩阵只管转,不会把点拉长压扁。会拉长的矩阵(缩放/剪切)机器人里也有,但姿态表示永远用「不拉长」的这种。

手算一遍

点 (1, 0) 先转 90° 再转 90°,用矩阵乘法算出它最后在哪。

  1. R(90°) = [[0, −1], [1, 0]](cos90°=0,sin90°=1)。
  2. R(90°)·R(90°):左上格 = 0×0 − 1×1 = −1;右上格 = 0×(−1) − 1×0 = 0;左下格 = 1×0 + 0×1 = 0;右下格 = 1×(−1) + 0×0 = −1。乘积 = [[−1, 0], [0, −1]],正是 R(180°)。
  3. (1, 0) 乘它 = (−1, 0)。
答

(−1, 0)。转两次 90° 等于一次 180°——定理 1 的手算版。

实跑一遍

数字出处

双精度浮点实跑:随机取 1000 个点,先转 37° 再转 53°,与直接转 90° 逐点比对(生成器真算):

  • 最大坐标误差 = 4.4e-16×10^-16——双精度机器精度的量级,两种路径在数值上不可区分。
  • 结论:机器人代码里连乘几十个旋转矩阵,和「一次转到位」的差别只在 1e-15 量级——误差不来自这个记法。

映射回强化学习

这里的对象RL 里的对应物站内用法
旋转矩阵 R(θ)姿态 / 坐标变换的第一件工具用法 →
矩阵乘法复合相机→末端→基座的变换链用法 →
二维旋转三维齐次变换 SE(3)用法 →

边界:这一篇停在哪里

本篇停在二维。三维旋转的四种表示、万向锁、四元数双覆盖,都在 /k/A1/ 的完整版里。二维里先转 α 再转 β 和反过来结果一样(定理 1 两个方向都对),三维绕不同轴就不一样了——那是完整版才有的坑。

自测 3 题

全是手算和「找证明错在哪」类题目,不出背诵题。答不上来回到对应小节。

01二维里「先转 30° 再转 60°」和「先转 60° 再转 30°」结果一样吗?三维呢?

二维一样,都等于转 90°(定理 1)。三维绕不同轴的旋转不可交换——A1 里有数值反例。

02用和差公式手算 R(45°)·R(45°) 的左上格,应等于多少?

cos45°cos45° − sin45°sin45° = 1/2 − 1/2 = 0 = cos90°。左上格为 0,正对 90° 旋转。

03点 (0, 1) 转 90° 后在哪?

x' = 0×0 − 1×1 = −1,y' = 0×1 + 1×0 = 0,得 (−1, 0)。转到了 x 负半轴。

接着看

全系列 27 篇

T1矩阵就是旋转的记账本约 25 分钟T2从斜率到梯度:机器人学习算法的第一行约 25 分钟T3向量与受力:点积的物理读法约 20 分钟T4两把尺子和一把更好的尺子约 25 分钟T5电机转一圈的账:弧度、转速与功率约 20 分钟T6复数乘法就是旋转:四元数的一维版约 20 分钟T7基与坐标:为什么机器人什么都用矩阵约 45 分钟T8矩阵乘法:变换的串联,不是表格运算约 40 分钟T9雅可比:关节转一度,末端动多少约 45 分钟T10特征向量:矩阵不敢动的方向约 45 分钟T11SVD 与伪逆:没有精确解时,找最近的解约 50 分钟T12泰勒展开:用直线替曲线打工约 40 分钟T13概率空间:为什么「随机」需要公理约 50 分钟T14期望:「平均」的严格构造约 55 分钟T15条件期望:竖线的真正含义约 60 分钟T16四个不等式:「多少样本才够」的定量答案约 45 分钟T17范数与不动点:「一定收敛」的出处约 55 分钟T18马尔可夫链:时间平均何时等于集合平均约 55 分钟T19MDP 的数学构造:一条公理值多少钱约 50 分钟T20动态规划:两种迭代的账约 50 分钟T21优化:约束为什么不能只靠罚约 55 分钟T22随机逼近:学习率公式里的每一条约 55 分钟T23接触的数学:Hertz 理论约 45 分钟T24摩擦与摩擦锥:约束的几何形状约 40 分钟T25力封闭与抓取度量:ε 是一个线性规划约 50 分钟T26接触运动学:滚动为什么不是「贴着滑」约 45 分钟T27滑移检测:从「感觉到了」到「算出来了」约 50 分钟