基于Open3D计算有向包围盒绕各轴的旋转角度

核心思路 #

无需使用ICP这类复杂的对齐算法，直接从Open3D OBB的旋转矩阵中提取欧拉角即可，这是最简洁稳定的方案。Open3D的OrientedBoundingBox对象自带R属性，是一个3×3的正交旋转矩阵，其列向量对应OBB的三个局部坐标轴方向，通过标准的矩阵转欧拉角计算就能得到绕各轴的旋转角度。

具体实现步骤 #

1. 获取OBB旋转矩阵：从目标OBB对象中提取旋转矩阵obb.R，转换为numpy数组便于计算。
2. 固定旋转顺序：欧拉角的结果依赖于旋转顺序（如XYZ、ZYX等），必须固定顺序（这是避免你觉得“变换矩阵结果不一致”的核心前提）。
3. 矩阵转欧拉角：利用科学计算库的旋转转换工具，直接将正交矩阵转换为指定顺序的欧拉角。

代码示例 #

import numpy as np
from scipy.spatial.transform import Rotation
import open3d as o3d

# 示例：生成带旋转的点云并计算OBB
pcd = o3d.geometry.PointCloud()
pcd.points = o3d.utility.Vector3dVector(np.random.rand(1000, 3))
# 给点云施加已知旋转（用于验证）
rot = Rotation.from_euler('xyz', [30, 45, 60], degrees=True)
pcd.rotate(rot.as_matrix())
# 计算OBB
obb = pcd.get_oriented_bounding_box()

# 从OBB旋转矩阵提取欧拉角
rot_matrix = np.asarray(obb.R)
r = Rotation.from_matrix(rot_matrix)
# 选择XYZ旋转顺序，输出角度（单位：度）
euler_angles = r.as_euler('xyz', degrees=True)
print(f"绕X轴旋转角度：{euler_angles[0]:.2f}°")
print(f"绕Y轴旋转角度：{euler_angles[1]:.2f}°")
print(f"绕Z轴旋转角度：{euler_angles[2]:.2f}°")

关键注意事项 #

• 旋转顺序一致性：必须全程固定同一旋转顺序（如始终使用XYZ），否则同一旋转矩阵会得到不同的欧拉角结果，这是导致你感知“结果不一致”的常见原因。
• 万向锁问题：欧拉角存在万向锁（当绕Y轴旋转90°或-90°时，X和Z轴旋转会耦合），如果需要无歧义的旋转表示，建议使用四元数（r.as_quat()）替代欧拉角。
• 旋转矩阵的方向：Open3D的obb.R是将OBB局部坐标系转换到世界坐标系的旋转矩阵，若需要世界到局部的旋转，取其转置即可（正交矩阵的转置等于逆矩阵）。

验证方案 #

你已编写的pytest用例可按以下逻辑验证：

1. 生成已知旋转角度的点云/网格。
2. 计算其OBB并提取欧拉角。
3. 对比提取的角度与输入的旋转角度（允许微小浮点误差），验证方法正确性。

内容的提问来源于stack exchange，提问作者Simon De Gheselle