COLMAP中ENU世界坐标系到相机姿态的转换方法

概述

在三维重建和摄影测量领域，COLMAP是一个广泛使用的开源工具。本文将详细介绍如何将无人机(UAV)采集的ENU(东-北-天)坐标系下的相机位置和姿态数据转换为COLMAP所需的格式，特别是针对常见的转换错误进行分析和解决方案提供。

ENU坐标系与COLMAP坐标系

ENU坐标系是地理信息系统和导航中常用的坐标系：

• X轴指向东(East)
• Y轴指向北(North)
• Z轴指向天(Up)

COLMAP使用右手坐标系系统，其相机坐标系定义如下：

• X轴指向图像右侧
• Y轴指向图像下方
• Z轴指向相机前方

转换流程

1. 欧拉角到旋转矩阵的转换

首先需要将无人机提供的欧拉角(roll, pitch, yaw)转换为旋转矩阵。这一步骤需要注意旋转顺序，通常无人机使用Z-Y-X顺序(偏航-俯仰-横滚)。

def euler_to_rotation_matrix(euler_angles):
    """将欧拉角转换为旋转矩阵"""
    roll, pitch, yaw = euler_angles
    # 实现具体的旋转矩阵计算
    # ...
    return R

2. 坐标系转换

ENU到COLMAP的坐标系转换需要特别注意：

1. 坐标轴方向的调整
2. 旋转矩阵的转置(因为COLMAP使用相机到世界的变换)

正确的转换公式应为：

R_colmap = R_enu.T  # 旋转矩阵转置
t_colmap = -R_enu.T @ t_enu  # 平移向量转换

3. 旋转矩阵到四元数的转换

COLMAP使用四元数表示相机方向，需要将旋转矩阵转换为四元数：

def rotation_matrix_to_quaternion(R):
    """将旋转矩阵转换为四元数"""
    # 实现四元数转换逻辑
    # ...
    return qw, qx, qy, qz

常见错误分析

1. 忽略旋转矩阵转置：这是最常见的错误，导致相机朝向完全错误。
2. 坐标系轴定义混淆：没有正确处理ENU和COLMAP坐标系的轴向差异。
3. 欧拉角顺序错误：不同的系统可能使用不同的旋转顺序(Z-Y-X vs X-Y-Z等)。

验证方法

1. 可视化检查：使用COLMAP自带的可视化工具检查相机位置和朝向。
2. 相对位置验证：检查相邻相机的相对位置关系是否符合实际飞行路径。
3. 投影验证：将已知3D点投影到图像上，检查投影位置是否正确。

实际应用建议

1. 对于无人机数据，建议先在小规模数据集上测试转换结果。
2. 记录转换过程中使用的所有参数和假设，便于后续调试。
3. 考虑使用中间验证步骤，如保存转换前后的相机位置进行对比。

总结

正确实现ENU坐标系到COLMAP格式的转换需要注意多个技术细节，特别是坐标系定义差异和矩阵运算的顺序。通过理解底层数学原理和系统性的验证方法，可以确保转换结果的准确性，为后续的三维重建工作奠定良好基础。