Reality Capture相机姿态导入Open3D时方向异常问题求助

核心问题分析 #

你遇到的偏差本质是坐标系定义差异和旋转矩阵的轴对应/顺序适配问题：

• Reality Capture（RC）的相机坐标系：x北、y东、z向下；旋转顺序为绕z轴(heading) → y轴(pitch) → x轴(roll)
• Open3D（O3D）的世界坐标系：y向上；默认相机朝向为**-z方向**（看向屏幕内），旋转矩阵遵循右手坐标系，以逆时针为正方向

你已对网格执行绕x轴-90度旋转（实现RC z-up到O3D y-up的转换），因此相机姿态需要同步完成坐标系转换，并适配O3D的旋转逻辑。

解决步骤与代码实现 #

1. 角度转弧度与旋转方向修正 #

若RC的旋转角度以顺时针为正（多数摄影测量软件默认规则），需转换为O3D的右手坐标系规则（逆时针为正），因此要对角度取负；同时需将角度转为弧度。

2. 构建适配O3D的旋转矩阵 #

先将RC的旋转转换到O3D坐标系，再调整旋转顺序：

• 应用与网格一致的坐标系转换矩阵
• 按照O3D的旋转逻辑重新计算旋转矩阵

3. 可视化相机姿态（箭头+坐标系轴） #

替换原球体，用箭头显示相机朝向，用坐标系轴展示完整姿态，便于直观验证。

完整代码如下：

import open3d as o3d
import numpy as np
import math

def read_csv(path) -> list:
    # 根据你的CSV格式调整，示例实现
    import csv
    csv_list = []
    with open(path, 'r') as f:
        reader = csv.reader(f)
        next(reader)  # 跳过表头
        for row in reader:
            x = float(row[0])
            y = float(row[1])
            alt = float(row[2])
            heading = float(row[3])
            pitch = float(row[4])
            roll = float(row[5])
            csv_list.append((x,y,alt,heading,pitch,roll))
    return csv_list

# 读取网格与相机数据
mesh = o3d.io.read_triangle_mesh("test.obj")
csv_list = read_csv("test.csv")

# 坐标系转换矩阵：RC z-up → O3D y-up（绕x轴转-90度）
coord_transform = o3d.geometry.get_rotation_matrix_from_xyz((-math.pi/2, 0, 0))

geometries = [mesh]

for camera in csv_list:
    x,y,alt,heading,pitch,roll = camera
    
    # 1. 角度转弧度，修正旋转方向（RC顺时针正→O3D逆时针正）
    heading_rad = -math.radians(heading)
    pitch_rad = -math.radians(pitch)
    roll_rad = -math.radians(roll)
    
    # 2. 构建RC原始旋转矩阵：Rz(heading) * Ry(pitch) * Rx(roll)
    # O3D的get_rotation_matrix_from_xyz顺序为Rx*Ry*Rz，需对应roll/pitch/heading
    R_rc = o3d.geometry.get_rotation_matrix_from_xyz((roll_rad, pitch_rad, heading_rad))
    
    # 3. 应用坐标系转换，得到O3D中的旋转矩阵
    R_o3d = coord_transform @ R_rc
    
    # 4. 转换相机朝向：RC默认z向下 → O3D坐标系下的最终朝向
    rc_cam_dir = np.array([0, 0, -1])
    o3d_cam_dir = coord_transform @ rc_cam_dir
    final_dir = R_o3d @ o3d_cam_dir
    
    # 5. 创建箭头可视化朝向
    arrow = o3d.geometry.TriangleMesh.create_arrow(
        cylinder_radius=0.1, cone_radius=0.2, cylinder_height=4, cone_height=1
    )
    # 计算箭头旋转：从默认z轴转到final_dir
    arrow_rot = o3d.geometry.get_rotation_matrix_from_axis_angle(
        np.cross([0,0,1], final_dir) * math.asin(np.linalg.norm(np.cross([0,0,1], final_dir)))
    )
    arrow.rotate(arrow_rot, center=(0,0,0))
    arrow.translate([x,y,alt])
    
    # 可选：创建相机坐标系轴（大小2）
    cam_frame = o3d.geometry.TriangleMesh.create_coordinate_frame(size=2, origin=[0,0,0])
    cam_frame.rotate(R_o3d, center=(0,0,0))
    cam_frame.translate([x,y,alt])
    
    geometries.append(arrow)
    geometries.append(cam_frame)

# 启动可视化
o3d.visualization.draw_geometries(geometries)

关键验证点 #

如果仍存在偏差，可检查以下内容：

• CSV中的角度是否为顺时针为正：若RC旋转以逆时针为正，需去掉角度的负号
• 网格的旋转是否与代码中的coord_transform完全一致：确认是否为绕x轴转-90度而非90度

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