3. 机器人坐标系与传感器安装标定

在移动机器人定位与安全协同感知系统中，所有测量结果最终都要落到一个统一的坐标参照下，才能被比较、融合和用于决策。机器人本体坐标系、传感器坐标系与世界坐标系构成了这套参照体系的三个基本层次。理解它们的定义、相互转换关系，以及外参标定如何确定这些转换，是后续定位精度与安全区域判断能否成立的前提。

三个坐标系的定义与角色

机器人本体坐标系（base_link）固定在机器人车体上，通常以车体几何中心或后轴中心为原点，x 轴指向机器人前进方向，y 轴指向左侧，z 轴向上，符合右手定则。它是机器人自身运动状态的表达基准：里程计输出的位姿、速度指令、底盘运动模型都相对该坐标系描述。无论机器人走到哪里，本体坐标系都随车体一起运动。

传感器坐标系固定在各传感器自身安装位置。例如激光雷达坐标系原点在雷达光学中心，x 轴指向其零度扫描方向；相机坐标系原点在光心，z 轴沿光轴向前，x 轴向右，y 轴向下。不同传感器的轴向约定可能不同，这是标定中必须显式处理的问题。

世界坐标系（map 或 world）是全局静止参照，原点通常选在场地某个固定标志点，例如充电桩中心或地图原点。机器人定位的本质，就是估计本体坐标系相对世界坐标系的位姿，即 map→base_link 的变换。

三者关系可以概括为：传感器测量值先经外参变换到本体坐标系，再经定位结果变换到世界坐标系，最终用于地图匹配、障碍物投影和安全区域判断。

外参标定的实际流程

外参标定的目标是求出传感器坐标系到本体坐标系的刚体变换，包含三个平移量 (x, y, z) 和三个旋转量 (roll, pitch, yaw)。以一台前向安装的 2D 激光雷达为例，标定可按以下过程展开。

首先进行安装测量。用卷尺或图纸测量雷达光心相对车体中心的前向偏移、横向偏移和高度，得到平移量的初值。例如测得雷达位于车体中心前方 0.35 m、左偏 0.02 m、离地 0.28 m，则平移初值为 (0.35, 0.02, 0.28)。旋转初值通常按设计安装角给出，若雷达水平正装，roll、pitch 初值取 0，yaw 初值取 0。

然后进行数据采集与求解。在场地中放置已知几何特征的标定物，例如直角墙角或标定板，控制机器人以不同位置和朝向多次观测同一特征。对激光雷达，可提取墙角两条直线的交点作为特征点；对相机，可提取标定板角点。设第 i 次观测中，特征点在本体坐标系下的理论位置为 p_base,i，在传感器坐标系下的测量位置为 p_sensor,i，则满足：

p_base,i = R(yaw, pitch, roll) · p_sensor,i + t(x, y, z)

将多组观测代入，构建关于 R 和 t 的优化问题，最小化所有特征点的配准残差平方和。工程上常用非线性最小二乘求解，初值取安装测量值，迭代收敛后得到外参。若残差均方根明显偏大，例如超过 0.03 m，说明安装测量初值偏差过大或存在观测异常，需要检查标定物提取是否正确。

最后进行验证。将标定得到的外参写回系统，重新采集一组未参与标定的观测，把传感器点云经外参投影到本体坐标系，再叠加到车体轮廓上。若雷达扫描到的墙面在投影后与地图中墙面重合，且不同距离下偏差一致，说明外参可信。若近处重合、远处发散，通常是 yaw 角仍有偏差；若整体平移一个固定量，则是平移量需要微调。

安装位置对定位与安全感知的影响

安装位置首先影响定位精度。激光雷达若安装过高，扫描到的地面点减少，可用于匹配的环境特征变少；安装过低则容易被地面杂物遮挡。前向雷达若偏离车体中心线，机器人旋转时雷达轨迹是一个偏心圆，若外参未正确标定，扫描匹配会把偏心误判为平移，导致位姿估计出现周期性误差。相机安装俯仰角过大时，远处特征被压缩，视觉里程计的尺度估计会变差。

安装位置对安全感知的影响更直接。安全激光雷达需要覆盖机器人前方的制动距离区域。若雷达安装高度为 0.28 m，而障碍物是一个高 0.15 m 的低矮台阶，雷达扫描平面可能从台阶上方掠过而漏检。此时需要评估扫描平面高度与最小可检测障碍物高度的关系，必要时增加下俯角或改用多线雷达。同样，若雷达被安装在车体边缘内侧，车体自身结构会形成扫描盲区，盲区内的障碍物无法被感知，安全区域必须扣除这部分。

外参误差还会放大到安全区域判断上。假设 yaw 标定偏差为 2°，在 5 m 距离处产生的横向位置误差约为 5 × tan(2°) ≈ 0.17 m。如果安全停车距离按 0.3 m 设定，这 0.17 m 的误差已经占去一半以上余量，可能导致该停不停或误停。因此，安全相关传感器的外参标定精度要求通常高于普通定位传感器，yaw 误差宜控制在 0.5° 以内，平移误差宜控制在 0.01 m 以内。

综合来看，坐标系定义解决“在哪里表达”的问题，外参标定解决“如何转换”的问题，而安装位置与标定精度共同决定“转换得准不准”。三者环环相扣：定义不清会导致转换方向混乱，标定不准会让定位与安全判断同时失准，安装位置不合理则可能让再高的标定精度也无法弥补感知盲区。实际工程中，应先在图纸阶段确定各坐标系原点和轴向约定，再在装配后完成外参标定与验证，最后把外参作为配置项纳入版本管理，确保定位与安全模块使用同一套参数。