旋转矩阵：二维与三维旋转矩阵的推导与几何意义

旋转矩阵这东西，说白了就是描述一个物体怎么转的数学工具。我刚开始做控制算法那会儿，总觉得它就是个公式，背下来就行了。直到有一次做机械臂的轨迹规划，发现末端执行器怎么都对不准目标点……查了半天，原来是旋转矩阵的顺序搞反了。从那以后，我对旋转矩阵的理解就再也不敢停留在表面了。

今天咱们就把二维和三维的旋转矩阵彻底捋一遍。我会从几何直觉出发，再落到数学推导上，最后聊聊我在实际项目中踩过的坑。

先看最简单的二维情况。你想想看，一个点P在平面上绕原点转个角度θ，它的新坐标怎么算？

假设P的原始坐标为(x, y)，用极坐标表示就是：

x = r·cos(α)
y = r·sin(α)

其中r是到原点的距离，α是初始角度。旋转θ角后，新坐标变成：

x' = r·cos(α + θ) = r·(cosα·cosθ - sinα·sinθ) = x·cosθ - y·sinθ
y' = r·sin(α + θ) = r·(sinα·cosθ + cosα·sinθ) = x·sinθ + y·cosθ

写成矩阵形式就是：

[x']   [cosθ  -sinθ] [x]
[y'] = [sinθ   cosθ] [y]

嗯，这就是二维旋转矩阵R(θ)。它的几何意义很直观：每一列其实都是旋转后的基向量。第一列[cosθ, sinθ]ᵀ是x轴单位向量旋转后的位置，第二列[-sinθ, cosθ]ᵀ是y轴单位向量旋转后的位置。

关键性质：二维旋转矩阵是正交矩阵，满足RᵀR = I，且行列式为+1。这意味着旋转不改变向量的长度，也不改变坐标系的手性。

三维情况稍微复杂一点，但思路是一样的。我们分别看绕三个坐标轴的旋转。

绕Z轴旋转θ角：

这个最简单，因为z坐标不变，x和y的变换和二维完全一样：

Rz(θ) = [cosθ  -sinθ   0]
        [sinθ   cosθ   0]
        [0      0      1]

绕X轴旋转θ角：

这时候x坐标不变，y和z发生旋转。我习惯用右手定则来记：大拇指指向旋转轴正方向，四指弯曲的方向就是正角度方向。

Rx(θ) = [1    0       0   ]
        [0    cosθ   -sinθ]
        [0    sinθ    cosθ]

绕Y轴旋转θ角：

这个最容易搞混。注意y坐标不变，但x和z的变换符号和绕X轴不一样。为什么？因为y轴的方向和x、z轴构成右手系，旋转方向的定义导致符号差异。

Ry(θ) = [cosθ   0    sinθ]
        [0      1    0   ]
        [-sinθ  0    cosθ]

我曾经踩过的坑：绕Y轴的旋转矩阵，右上角是+sinθ，左下角是-sinθ，和绕X轴正好相反。我第一次手写代码时没注意，结果机械臂转出来的姿态完全不对，调试了整整一个下午才发现这个符号问题。

旋转矩阵不仅仅是一个数学工具，它背后有深刻的几何含义。我个人习惯从三个层面去理解：

这里我画了一张图，帮你把二维和三维旋转的核心逻辑串起来：

实际应用中，我们很少只做一次旋转。比如一个飞行器，先绕Z轴转个航向角，再绕Y轴转个俯仰角，最后绕X轴转个滚转角。这就涉及到旋转矩阵的复合。

复合旋转的矩阵是各个旋转矩阵的乘积。但注意：矩阵乘法不满足交换律。也就是说，先转A再转B，和先转B再转A，结果完全不同。

我举个例子你就明白了：

// 先绕X转90°，再绕Y转90°
R_total = Ry(90°) · Rx(90°)

// 先绕Y转90°，再绕X转90°
R_total' = Rx(90°) · Ry(90°)

// 这两个结果不一样！

我的经验：在写代码时，我习惯把旋转顺序写在注释里，比如"ZYX顺序"或"XYZ顺序"。这样过了一个月回头看代码，还能记得当初的设计意图。另外，建议用四元数做插值，避免万向锁问题——这个后面章节会细讲。

旋转矩阵在控制接入场景中太常见了。我简单列几个典型应用：

我曾经踩过的坑：在做惯性导航的姿态解算时，旋转矩阵经过多次迭代更新后，由于浮点误差累积，矩阵逐渐偏离正交性。结果就是姿态越算越偏，最后完全发散。解决方案是每隔一段时间对旋转矩阵做一次施密特正交化，或者直接用四元数替代。

旋转矩阵是坐标变换的基石。二维情况简单直观，三维情况需要多花点心思记住每个轴的符号。我个人觉得，理解旋转矩阵的关键不在于背公式，而在于理解它的几何意义——每一列就是旋转后的基向量，这个视角能帮你解决大部分问题。

最后送你一句话：旋转矩阵的复合顺序决定了最终姿态，写代码时一定要把顺序写清楚。别像我当年那样，因为一个符号问题浪费一个下午。

核心要点回顾：