RTAB-Map相机标定矩阵格式问题解析与坐标约定说明

问题背景

在使用RTAB-Map进行RGB-D数据集采集时，用户发现导出的相机标定文件存在异常。具体表现为相机内参矩阵格式不正确，其中部分元素被错误地置零。这个问题实际上是一个存在多年的软件缺陷，直到最近才被发现并修复。

技术分析

相机标定矩阵格式问题

在原始问题中，相机内参矩阵(camera_matrix)的格式存在明显错误。标准的3×3相机内参矩阵应包含以下元素：

• fx和fy：x和y方向的焦距（像素单位）
• cx和cy：主点坐标（像素单位）
• 其他位置应为0

然而在问题示例中，矩阵被错误地表示为：

[ 6.0879376220703125e+02, 0., 3.1840899658203125e+02, 
  0., 0., 6.0877636718750000e+02, 
  2.4450122070312500e+02, 0., 0. ]

这显然不符合3×3矩阵的排列方式，其中包含了过多的元素（9个而非9个）且位置错误。

临时解决方案

在修复前，用户可以通过以下方式恢复正确的相机内参矩阵：

1. 从投影矩阵(projection_matrix)中提取左侧3×3部分
2. 这部分矩阵即为正确的相机内参矩阵

坐标系统约定

RTAB-Map遵循ROS的标准坐标约定：

1. 基础坐标系(base_link)：

   • X轴：向前
   • Y轴：向左
   • Z轴：向上

2. 相机光学坐标系(camera_optical_frame)：

   • X轴：向右
   • Y轴：向下
   • Z轴：向前

局部变换(local_transform)含义

local_transform表示机器人基础坐标系(base_link)与相机光学坐标系之间的变换关系，包含：

• 3×3旋转矩阵
• 3×1平移向量 这个变换包含了从机器人基础坐标系到相机光学坐标系的所有空间关系转换。

问题修复

该问题已在最新提交中修复。修复后，相机标定文件将正确输出3×3的相机内参矩阵，格式符合计算机视觉领域的标准规范。

总结

本文分析了RTAB-Map中相机标定矩阵的格式问题及其解决方案，同时详细解释了软件中使用的坐标系统约定。对于使用RTAB-Map进行三维重建或SLAM的研究人员和开发者，理解这些技术细节对于正确解析和使用采集的数据至关重要。