在組合導航、無人機控制、機器人運動學等領域，旋轉矩陣是連接參考座標系與載體座標系的核心工具，而歐拉角旋轉順序則決定了姿態描述的邏輯與精度。本文將聚焦最常用的三種旋轉順序，從基礎原理、旋轉矩陣推導到實際應用場景，為新手梳理清晰的知識體系，助力快速上手姿態解算與座標系轉換。
在組合導航、無人機控制、機器人運動學等領域，旋轉矩陣是連接參考座標系與載體座標系的核心工具，而歐拉角旋轉順序則決定了姿態描述的邏輯與精度。本文將聚焦最常用的三種旋轉順序，從基礎原理、旋轉矩陣推導到實際應用場景，為新手梳理清晰的知識體系，助力快速上手姿態解算與座標系轉換。
一、核心基礎：先搞懂旋轉矩陣的"底層邏輯"
在深入旋轉順序前，必須先掌握兩個核心概念，這是理解所有旋轉邏輯的前提：
1. 兩個關鍵座標系
- 導航座標系（n 系）：固定不動的參考系（常用"東北天"座標系），用於描述載體的絕對位置、速度和姿態，是所有物理量的"統一參考標準"。
- 機體座標系（b 系）：固定在載體上的座標系（如無人機、機器人機身），IMU（慣性測量單元）測量的比力（加速度相關）、角速度均在該座標系下輸出，需通過旋轉矩陣轉換到 n 系才能進行後續計算。
2. 旋轉矩陣的核心性質
旋轉矩陣是 3×3 的正交矩陣，核心性質為：自身轉置 = 自身逆矩陣（\(C_{nb}^T = C_{nb}^{-1}\)）。
通俗理解：轉置就是將矩陣的行與列互換，逆矩陣則是實現"反向座標系轉換"的工具。正交性讓我們無需複雜的求逆運算，只需轉置就能得到反向轉換矩陣（如 \(C_{bn} = C_{nb}^T\)，\(C_{bn}\)
物理意義：旋轉矩陣僅改變物理量的方向，不改變其大小，確保座標系轉換過程中數據的一致性。
3. 歐拉角旋轉的本質
歐拉角通過"繞三個正交軸的依次旋轉"描述載體姿態，旋轉順序直接決定旋轉矩陣的形式。本文討論的均為"內在旋轉"（繞載體自身座標系的軸旋轉，旋轉後軸的方向會隨之前的旋轉改變），這是工程領域的通用標準。
二、三種常用旋轉順序：原理、矩陣與特點
（一）Z-Y-X 旋轉順序：航空航天與導航首選
1. 旋轉邏輯與姿態角定義
- 旋轉軸順序：先繞 Z 軸→再繞 Y 軸→最後繞 X 軸（不可顛倒）。
- 對應姿態角（最貼合人類感知）：
- Z 軸旋轉：航向角 \(\psi\)（Yaw）——載體繞垂直地面軸的旋轉（左右轉彎）；
- Y 軸旋轉：俯仰角 \(\theta\)（Pitch）——載體繞左右方向軸的旋轉（上下俯仰）；
- X 軸旋轉：橫滾角 \(\phi\)（Roll）——載體繞前後方向軸的旋轉（左右傾斜）。
2. 旋轉矩陣推導
旋轉矩陣遵循"後旋轉的矩陣在前"的乘法規則，Z-Y-X 順序的組合旋轉矩陣 \(C_{nb}\)（b 系→n 系轉換）為：
\[C_{nb} = R_z(\psi) \times R_y(\theta) \times R_x(\phi) \]
其中三個單軸旋轉矩陣（角度需用弧度制）為：
- Z 軸旋轉矩陣 \(R_z(\psi)\)：
\[R_z(\psi) = \begin{bmatrix} \cos\psi & -\sin\psi & 0 \\ \sin\psi & \cos\psi & 0 \\ 0 & 0 & 1 \end{bmatrix} \]
- Y 軸旋轉矩陣 \(R_y(\theta)\)：
\[R_y(\theta) = \begin{bmatrix} \cos\theta & 0 & \sin\theta \\ 0 & 1 & 0 \\ -\sin\theta & 0 & \cos\theta \end{bmatrix} \]
- X 軸旋轉矩陣 \(R_x(\phi)\)：
\[R_x(\phi) = \begin{bmatrix} 1 & 0 & 0 \\ 0 & \cos\phi & -\sin\phi \\ 0 & \sin\phi & \cos\phi \end{bmatrix} \]
將單軸矩陣相乘，最終得到 Z-Y-X 順序的組合旋轉矩陣：
\[C_{nb} = \begin{bmatrix} \cos\theta\cos\psi & -\sin\psi\cos\phi + \sin\theta\cos\psi\sin\phi & \sin\psi\sin\phi + \sin\theta\cos\psi\cos\phi \\ \cos\theta\sin\psi & \cos\psi\cos\phi + \sin\theta\sin\psi\sin\phi & -\cos\psi\sin\phi + \sin\theta\sin\psi\cos\phi \\ -\sin\theta & \cos\theta\sin\phi & \cos\theta\cos\phi \end{bmatrix} \]
3. 核心優勢與應用場景
- 優勢 1：姿態角定義直觀，完全匹配人類對"方向-姿態"的感知邏輯（轉彎→俯仰→傾斜）；
- 優勢 2：與 IMU 數據轉換、ESKF（誤差狀態卡爾曼濾波）姿態解算兼容性最佳，是組合導航的標準選擇；
- 優勢 3：行業工具包（ROS、MATLAB 導航工具箱、PX4 飛控）默認支持，資料豐富，開發成本低。
- 典型應用：無人機、地面機器人、常規飛行器、組合導航系統、自動駕駛車輛。
（二）X-Y-Z 旋轉順序：基礎教學與簡單載體首選
1. 旋轉邏輯與姿態角定義
- 旋轉軸順序：先繞 X 軸→再繞 Y 軸→最後繞 Z 軸。
- 對應姿態角：
- X 軸旋轉：橫滾角 \(\phi\)（Roll）——載體繞前後軸旋轉；
- Y 軸旋轉：俯仰角 \(\theta\)（Pitch）——載體繞左右軸旋轉；
- Z 軸旋轉：航向角 \(\psi\)（Yaw）——載體繞垂直軸旋轉。
2. 旋轉矩陣推導
組合旋轉矩陣 \(C_{nb} = R_x(\phi) \times R_y(\theta) \times R_z(\psi)\)，單軸矩陣與 Z-Y-X 順序一致，最終組合矩陣為：
\[C_{nb} = \begin{bmatrix} \cos\theta\cos\psi & -\cos\theta\sin\psi & -\sin\theta \\ \sin\psi\cos\phi - \cos\psi\sin\theta\sin\phi & \cos\psi\cos\phi + \sin\psi\sin\theta\sin\phi & \cos\theta\sin\phi \\ \sin\psi\sin\phi + \cos\psi\sin\theta\cos\phi & -\cos\psi\sin\phi + \sin\psi\sin\theta\cos\phi & \cos\theta\cos\phi \end{bmatrix} \]
3. 核心優勢與應用場景
- 優勢 1：旋轉矩陣形式相對簡潔，步驟清晰，適合入門教學，容易理解"從參考系到載體系的逐步旋轉"邏輯；
- 優勢 2：載體運動範圍小時（無大幅航向或俯仰運動），不易觸發"萬向鎖"（歐拉角的固有缺陷，兩軸旋轉角度為 90° 時丟失自由度）；
- 優勢 3：計算量小，適配資源有限的簡單載體。
- 典型應用：入門教學、小型輪式機器人（如巡線小車）、固定翼模型、早期慣性導航系統、低精度姿態解算場景。
（三）Z-X-Y 旋轉順序：特殊飛行器與水下機器人首選
1. 旋轉邏輯與姿態角定義
- 旋轉軸順序：先繞 Z 軸→再繞 X 軸→最後繞 Y 軸。
- 對應姿態角：
- Z 軸旋轉：航向角 \(\psi\)（Yaw）——優先固定載體水平方向；
- X 軸旋轉：橫滾角 \(\phi\)（Roll）——調整載體左右傾斜；
- Y 軸旋轉：俯仰角 \(\theta\)（Pitch）——最後調整上下俯仰。
2. 旋轉矩陣推導
組合旋轉矩陣 \(C_{nb} = R_z(\psi) \times R_x(\phi) \times R_y(\theta)\)，最終組合矩陣為：
\[C_{nb} = \begin{bmatrix} \cos\theta\cos\psi & -\cos\phi\sin\psi + \sin\phi\sin\theta\cos\psi & \sin\phi\sin\psi + \cos\phi\sin\theta\cos\psi \\ \sin\psi & \cos\phi\cos\psi + \sin\phi\sin\theta\sin\psi & -\sin\phi\cos\psi + \cos\phi\sin\theta\sin\psi \\ -\cos\psi\sin\theta & \sin\phi\cos\theta & \cos\phi\cos\theta \end{bmatrix} \]
3. 核心優勢與應用場景
- 優勢 1：適配載體"先定航向→再調橫滾→最後修俯仰"的運動邏輯，符合部分載體的實際控制流程；
- 優勢 2：水下機器人、某些固定翼飛機的航向運動優先，橫滾調整比俯仰更頻繁，該順序更貼合實際需求；
- 優勢 3：在水平面上的姿態解算精度穩定，適合多在平面運動、少量俯仰的載體。
- 典型應用：水下機器人（ROV/AUV）、部分固定翼飛機、多旋翼飛行器的特殊控制算法、需要優先固定航向的場景。
三、三種旋轉順序核心差異對比表
|
對比維度
|
Z-Y-X 順序
|
X-Y-Z 順序
|
Z-X-Y 順序
|
|
旋轉軸順序
|
Z→Y→X
|
X→Y→Z
|
Z→X→Y
|
|
核心優勢
|
直觀、兼容 ESKF、行業標準
|
簡潔、易教學、低計算量
|
適配特定運動邏輯、航向優先
|
|
適配載體特性
|
全場景運動、高精度需求
|
簡單運動、低精度需求
|
航向優先、橫滾頻繁調整
|
|
萬向鎖風險
|
中等（俯仰角接近 90° 觸發）
|
低（運動範圍小時）
|
中等（俯仰角接近 90° 觸發）
|
|
工具包支持度
|
高（ROS/MATLAB 默認）
|
中（需手動設置）
|
中（特殊場景支持）
|
|
典型應用
|
無人機、組合導航、自動駕駛
|
教學、小型輪式機器人
|
水下機器人、特殊固定翼飛機
|
四、新手避坑：旋轉矩陣使用關鍵技巧
- 旋轉順序與矩陣乘法順序強綁定：比如選擇 Z-Y-X 順序，就必須嚴格按照 \(R_z \times R_y \times R_x\)
- 角度單位統一：所有三角函數均需用弧度制，新手容易混用角度/弧度，計算前務必通過"角度 \(\times \pi/180\)"換算；
- 正交性驗證：計算完旋轉矩陣後，可通過 \(C_{nb} \times C_{nb}^T\)
- 萬向鎖規避：若載體需做大角度俯仰運動（如直升機），建議優先選擇 Z-Y-X 順序，或改用四元數描述姿態（無萬向鎖缺陷）；
- 反向轉換用轉置：無論哪種順序，n 繫到 b 系的轉換矩陣 \(C_{bn}\) 均為 \(C_{nb}\)
總結
旋轉矩陣是姿態解算的基礎，而旋轉順序的選擇直接決定了工程實現的效率與精度。
