3. 多传感标定与时空同步

多传感环境感知系统的精度上限,往往不由单个传感器的性能决定,而由它们之间"是否对齐"决定。相机给出像素坐标,激光雷达给出三维点坐标,IMU给出角速度与加速度,GNSS/RTK给出全局位置——这些数据只有在统一的空间基准和统一的时间基准下,才能被融合成同一个物理世界的描述。标定与时空同步,就是建立这两套基准的过程。

内参与外参:两类不同性质的标定

内参描述传感器自身的成像或测量模型,与它在车体上的安装位置无关。以针孔相机为例,内参矩阵包含焦距 $f_x, f_y$ 与主点 $c_x, c_y$,以及径向畸变系数 $k_1, k_2, k_3$ 和切向畸变系数 $p_1, p_2$。内参标定通常使用棋盘格或圆点靶标,采集15~30张不同姿态的图像,通过角点检测与最小化重投影误差求解。判断内参是否可信,主要看平均重投影误差:一般要求控制在0.3像素以内,超过0.5像素说明图像质量、靶标平整度或姿态覆盖存在问题。激光雷达的内参则包括各激光束的垂直角、水平角偏移、测距偏差与回波强度修正,通常由厂商提供,必要时通过已知距离的平面靶板做距离校核。

外参描述传感器之间的相对位姿,即旋转矩阵 $R$ 与平移向量 $t$,把点从一个传感器坐标系变换到另一个坐标系。外参是融合感知中最敏感的参数:相机与激光雷达之间哪怕0.5°的旋转误差,在30 m处就会造成约0.26 m的横向偏移,足以让投影到图像上的点云落到错误的车道或障碍物边缘之外。外参标定分为离线标定与在线标定:离线标定在标定间或开阔场地用共同可见的靶标完成;在线标定则利用道路标线、杆状物、自然特征等,在运行中持续估计并修正外参漂移。

时间戳对齐与硬件触发

空间对齐解决"在哪里",时间对齐解决"在什么时候"。不同传感器的采样机制差异很大:相机按曝光周期输出帧,激光雷达按旋转扫描逐点输出,IMU以固定频率(如200 Hz)输出,GNSS按秒脉冲输出。若各传感器各自使用本地时钟打时间戳,时钟漂移会带来毫秒级甚至更大的偏差。以30 km/h行驶为例,10 ms的时间偏差对应约8.3 cm的位置误差;在高速场景下,这一误差会迅速放大。

时间对齐有两条技术路线。软同步依赖各传感器时间戳,通过插值或最近邻匹配把数据归算到同一时刻,实现简单,但精度受时钟同步质量限制。硬同步则由统一的触发源产生同步信号:常见做法是用GNSS的PPS(秒脉冲)作为基准,配合PTP(IEEE 1588)或gPTP协议把各传感器时钟同步到主时钟,再由触发控制器向相机发出曝光触发、向激光雷达发出扫描起始触发。硬同步能把时间偏差压到微秒级,是自动驾驶与高精度建图场景的常规选择。

多传感标定与时空同步链路 GNSS / PPS 主时钟 秒脉冲 + PTP/gPTP 硬件触发控制器 曝光 / 扫描起始脉冲 传感器同步采集 相机 激光雷达 IMU 时间轴对齐(同一时刻 t₀) t₀-20ms t₀ t₀+20ms 相机帧 k 相机帧 k+1 激光雷达扫描周期(逐点时间戳) IMU 200 Hz 连续采样(用于运动补偿与插值) 对齐时刻 空间变换链(外参) 相机坐标系 C 激光雷达坐标系 L IMU / 车体坐标系 B 世界坐标系 W T_CL T_LB T_BW

联合标定流程

实际工程中,内参、外参与时间同步通常按"先内后外、先时间后空间、先离线后在线"的顺序组织。一个可复现的联合标定流程如下:

  1. 准备与检查:确认各传感器固件版本、时间同步状态、镜头清洁度;记录安装初值(可用卷尺与角度尺粗测),作为优化初值。
  2. 内参标定:相机采集棋盘格图像,激光雷达对已知距离平面做距离校核,IMU做静态零偏与温度漂移记录。
  3. 时间同步验证:用LED闪烁或脉冲信号同时触发相机与激光雷达,检查两者时间戳差是否稳定在阈值内(如±1 ms)。
  4. 外参初值估计:用共同靶标(如带反光标记的标定板)同时被相机与激光雷达观测,求解 $T_{CL}$ 初值。
  5. 联合优化:以点云在图像上的投影误差、平面拟合残差、重投影误差为代价函数,用非线性最小二乘(如Ceres、g2o)同时优化内参与外参。
  6. 验证与固化:用未参与标定的数据做交叉验证,检查投影一致性;将结果写入配置文件并记录标定日期、温度、车辆状态。

标定误差对感知的影响

标定误差不会以"标定误差"的形式直接出现,而是以感知结果异常的形式暴露。常见表现有三类:

  • 空间错位:点云投影到图像后,障碍物边缘出现"重影"或偏移,导致基于图像的检测框与点云聚类不匹配,融合后目标位置抖动。
  • 时间错位:运动物体在融合结果中出现拖尾或位置滞后,尤其在快速转弯或加减速时明显;静态场景下不易发现,动态场景下误差被放大。
  • 尺度与畸变残留:内参误差导致距离估计偏差,近处目标测距偏大或偏小,影响避障安全距离判断。
判断标定是否合格的实用方法:在开阔场地放置已知尺寸的标定板或车辆,检查点云投影到图像后是否与目标边缘重合;让车辆以稳定速度直线行驶,观察融合目标位置是否平滑;用同一段数据分别用标定前后参数处理,对比目标位置方差。若投影偏差超过目标尺寸的5%,或时间偏差导致的位置误差超过10 cm,应重新标定。
外参不是一次标定就永久有效的参数。车辆载荷变化、悬架形变、碰撞、温度变化都会引起外参漂移。建议在每次长时间任务前做一次快速在线校验,并在感知模块中保留外参在线估计与告警机制。

总结来看,内参决定"看得准不准",外参决定"对得齐不齐",时间同步决定"合得上合不上"。三者共同构成多传感融合的基准。标定工作的价值不在于一次把参数调到最优,而在于建立可复现、可验证、可维护的基准链路,使感知系统在长期运行中保持稳定可靠。