| 旋转轴 | 旋转矩阵 |
| 绕Z轴(ψ) | $$ \begin{bmatrix} \cos\psi & -\sin\psi & 0 \\ \sin\psi & \cos\psi & 0 \\ 0 & 0 & 1 \end{bmatrix} $$ |
| 绕Y轴(θ) | $$ \begin{bmatrix} \cos\theta & 0 & \sin\theta \\ 0 & 1 & 0 \\ -\sin\theta & 0 & \cos\theta \end{bmatrix} $$ |
| 绕X轴(φ) | $$ \begin{bmatrix} 1 & 0 & 0 \\ 0 & \cos\phi & -\sin\phi \\ 0 & \sin\phi & \cos\phi \end{bmatrix} $$ |
2. 从旋转矩阵中提取欧拉角
若已知旋转矩阵 R,则可以通过以下公式反推出欧拉角(以 ZYX 顺序为例):
- ψ(偏航角):
$$
\psi = \arctan2(R_{21}, R_{11})
$$
- θ(俯仰角):
$$
\theta = \arcsin(-R_{31})
$$
- φ(滚转角):
$$
\phi = \arctan2(R_{32}, R_{33})
$$
三、示例计算
假设旋转矩阵 R 为:
$$
R =
\begin{bmatrix}
0.5 & -0.5 & 0.7071 \\
0.5 & 0.5 & 0.7071 \\
-0.7071 & 0.7071 & 0
\end{bmatrix}
$$
根据上述公式,可得:
- $\psi = \arctan2(0.5, 0.5) = 45^\circ$
- $\theta = \arcsin(0.7071) = 45^\circ$
- $\phi = \arctan2(0.7071, 0) = 90^\circ$
因此,对应的欧拉角为 (90°, 45°, 45°)
四、注意事项
- 欧拉角存在“万向锁”(Gimbal Lock)问题,当俯仰角为 ±90° 时,两个旋转轴会重合,导致信息丢失。
- 不同的应用可能采用不同的旋转顺序,需根据具体需求选择合适的顺序。
- 实际应用中,常使用四元数(Quaternions)代替欧拉角以避免万向锁问题。
五、总结表格
| 项目 | 内容 |
| 定义 | 欧拉角是用三个角度描述三维空间中物体旋转的方式 |
| 常见顺序 | ZYX、XYZ、ZYZ 等 |
| 三角度 | φ(Roll)、θ(Pitch)、ψ(Yaw) |
| 计算方式 | 通过旋转矩阵相乘得到总旋转矩阵,再提取角度 |
| 公式 | $\psi = \arctan2(R_{21}, R_{11})$;$\theta = \arcsin(-R_{31})$;$\phi = \arctan2(R_{32}, R_{33})$ |
| 注意事项 | 存在万向锁问题,建议结合四元数使用 |
如需更详细的数学推导或代码实现,可进一步探讨。