欧拉角与旋转矩阵转换原理及PCL实现

1. 欧拉角与旋转矩阵的基础概念解析

在三维空间刚体运动描述中，欧拉角和旋转矩阵是两种最常用的姿态表示方法。作为PCL（Point Cloud Library）点云处理中的核心数学工具，理解它们的相互转换原理对三维重建、机器人导航等领域至关重要。

欧拉角采用三个绕坐标轴连续旋转的角度（通常记为roll、pitch、yaw）来描述姿态，其优势在于直观易理解。例如无人机控制中，飞行员直接通过俯仰角(pitch)、横滚角(roll)和偏航角(yaw)来操控飞行姿态。但欧拉角存在万向节死锁问题，当pitch为±90°时会出现自由度丢失。

旋转矩阵则是3×3的正交矩阵，通过基向量变换描述姿态变化。其数学性质完备，不会出现奇异点，适合连续运算。在PCL中，旋转矩阵常用于点云配准（如ICP算法）时的坐标变换。一个典型的旋转矩阵如下：

code复制| r11 r12 r13 |
| r21 r22 r23 |
| r31 r32 r33 |

2. 欧拉角到旋转矩阵的转换实现

2.1 基本转换原理

欧拉角转换为旋转矩阵需要考虑旋转顺序的约定。工业领域常用ZYX顺序（即先绕Z轴转yaw，再Y轴pitch，最后X轴roll）。其数学本质是三个基本旋转矩阵的链式乘法：

cpp复制R = Rz(yaw) * Ry(pitch) * Rx(roll)

每个基本旋转矩阵形式如下（以Z轴为例）：

cpp复制| cosθ  -sinθ  0 |
| sinθ   cosθ  0 |
| 0      0     1 |

2.2 PCL中的代码实现

在PCL中，我们可以使用Eigen库的几何模块来完成这一转换：

cpp复制#include <pcl/common/transforms.h>
#include <Eigen/Geometry>

Eigen::Matrix3f eulerToMatrix(float roll, float pitch, float yaw) {
    Eigen::AngleAxisf rollAngle(roll, Eigen::Vector3f::UnitX());
    Eigen::AngleAxisf pitchAngle(pitch, Eigen::Vector3f::U