原理层 T1 / 27 · 高中出发
矩阵就是旋转的记账本
你已经会 sin(a+b) 和 cos(a+b)。把它们排成一张 2×2 的表,就得到了机器人里出现一万次的东西:旋转矩阵。
一句话结论
旋转矩阵不是新发明,是三角和差公式的记账格式。矩阵乘法看起来新,算的其实是「先转 α 再转 β,等于一次转 α+β」。
动图版 · 拖动圆上的点,右侧旋转矩阵的四个数字实时跟着变——矩阵不是表格,是会动的账本
站里 /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°,用矩阵乘法算出它最后在哪。
- R(90°) = [[0, −1], [1, 0]](cos90°=0,sin90°=1)。
- 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°)。
- (1, 0) 乘它 = (−1, 0)。
(−1, 0)。转两次 90° 等于一次 180°——定理 1 的手算版。
实跑一遍
数字出处
双精度浮点实跑:随机取 1000 个点,先转 37° 再转 53°,与直接转 90° 逐点比对(生成器真算):
- 最大坐标误差 = 4.4e-16×10^-16——双精度机器精度的量级,两种路径在数值上不可区分。
- 结论:机器人代码里连乘几十个旋转矩阵,和「一次转到位」的差别只在 1e-15 量级——误差不来自这个记法。
映射回强化学习
边界:这一篇停在哪里
本篇停在二维。三维旋转的四种表示、万向锁、四元数双覆盖,都在 /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 负半轴。