根据 roll, pitch, yaw计算R
```cpp
Eigen::Matrix4f eulerAnglesToTransformationMatrix(float roll, float pitch, float yaw) {
Eigen::Matrix3f Rx;
Rx = Eigen::AngleAxisf(roll, Eigen::Vector3f::UnitX());
Eigen::Matrix3f Ry;
Ry = Eigen::AngleAxisf(pitch, Eigen::Vector3f::UnitY());
Eigen::Matrix3f Rz;
Rz = Eigen::AngleAxisf(yaw, Eigen::Vector3f::UnitZ());
Eigen::Matrix3f R = Rz * Ry * Rx;
Eigen::Matrix4f transformation = Eigen::Matrix4f::Identity();
transformation.block<3, 3>(0, 0) = R;
return transformation;
}