如何旋转雷达点云使OBB与AABB重合及区域边平行于坐标轴

需求说明 #

我有一系列雷达点云，已通过Shapefile分割出若干区域，从Z轴视角观察这些区域均为矩形。需要找到旋转方法，让区域的某条边平行于X轴或Y轴。计划通过创建OBB（有向包围盒）与AABB（轴对齐包围盒），对比二者来实现点云的旋转对齐。

现有代码片段 #

aabb = cloud.get_axis_aligned_bounding_box()
aabb.color = (1, 0, 0)

obb = cloud.get_oriented_bounding_box()
obb.color = (0, 1, 0)

实现方案 #

核心逻辑 #

OBB的方向对应点云区域的自然矩形朝向，AABB是强制贴合XY轴的包围盒。通过计算OBB与XY轴的夹角，即可得到点云需要旋转的角度，旋转后区域的边会自动对齐到X/Y轴。

步骤拆解 #

• 提取OBB的旋转参数，计算其与X轴（或Y轴）的夹角θ
• 对目标点云区域应用反向旋转（旋转-θ角度），使OBB的边对齐到XY轴
• 验证旋转后的点云AABB与OBB是否近似重合，确认对齐效果

补充代码示例 #

# 获取OBB绕Z轴的旋转角度（弧度）
obb_rot_angle = obb.Rotation().GetAngleAxis()[0]

# 构造绕Z轴的逆旋转矩阵
import numpy as np
rotation_matrix = np.array([
    [np.cos(-obb_rot_angle), -np.sin(-obb_rot_angle), 0],
    [np.sin(-obb_rot_angle), np.cos(-obb_rot_angle), 0],
    [0, 0, 1]
])

# 对原始点云应用旋转
import open3d as o3d
rotated_points = np.dot(np.asarray(cloud.points), rotation_matrix.T)
rotated_cloud = o3d.geometry.PointCloud()
rotated_cloud.points = o3d.utility.Vector3dVector(rotated_points)

# 验证对齐效果
new_aabb = rotated_cloud.get_axis_aligned_bounding_box()
new_obb = rotated_cloud.get_oriented_bounding_box()

内容的提问来源于stack exchange，提问作者pepe