光学坐标系与ROS坐标系转换原理及实践

1. 光学坐标系与ROS坐标系的核心差异

在机器人视觉定位项目中，坐标系定义差异是最容易被忽视却又最关键的基础问题。很多开发者第一次接触ArUco码定位时都会困惑：为什么明明摄像头正对着标记，获取的姿态数据中yaw角却显示-90度？这个看似诡异的现象，根源在于光学坐标系与ROS坐标系采用了完全不同的轴向定义标准。

光学坐标系（camera_optical_frame）遵循的是计算机视觉领域的传统习惯。想象你手持一台相机，镜头朝前拍摄时：

• Z轴正向沿着镜头光轴方向指向被拍摄物体
• X轴正向指向图像平面的右侧（对应图像像素的列坐标增加方向）
• Y轴正向指向图像平面的下方（对应图像像素的行坐标增加方向）

这种定义方式与OpenCV的solvePnP、estimatePoseSingleMarkers等函数输出完全一致。而ROS采用的REP-103标准则继承了航空航天领域的坐标系传统：

• X轴正向指向机器人前进方向
• Y轴正向指向机器人左侧
• Z轴正向垂直向上

这两种坐标系的核心差异可以用一个简单实验验证：当摄像头正对ArUco码时，在光学坐标系下检测到的yaw角确实是0°，但经过坐标转换到ROS标准坐标系后，就会自动产生-90°的偏移量。这不是算法错误，而是两种标准对"前方"的定义不同导致的——光学系用Z轴表示前方，而ROS用X轴表示前方。

2. 坐标系转换的数学本质

从camera_optical_frame到base_link的转换需要经过两次基本旋转操作，这可以通过旋转矩阵或四元数精确描述。理解这个转换过程对正确解析姿态数据至关重要。

第一次旋转是绕X轴旋转-90度：

• 旋转前：Z朝前，X朝右，Y朝下
• 旋转后：Z朝下，X朝右，Y朝前
  这个操作将原本朝下的Y轴转到了前方位置，而原本朝前的Z轴则转向下方。用旋转矩阵表示就是：

code复制Rx(-90°) = [1  0   0
            0  0   1
            0 -1   0]

第二次旋转是绕新的Z轴（现在指向下方）再旋转-90度：

• 旋转前：Z朝下，X朝右，Y朝前
• 旋转后：Z朝上，X朝前，Y朝左
  这个操作完成了到ROS标准坐标系的最终转换，其旋转矩阵为：

code复制Rz(-90°) = [ 0  1  0