3. 传感器空间同步基础

时间同步解决的是“同一时刻”，空间同步解决的是“同一位置”。在 Bosch ADAS 系统中，摄像头、毫米波雷达、激光雷达各自工作在独立坐标系下，只有把它们的观测统一到同一参考系，融合模块才能判断“前方 30 m 处的目标”究竟是同一个物体。本节围绕坐标系定义、内参、外参、刚体变换、旋转表示和标定链六个概念展开，重点说明它们之间的依赖关系与工程落地方式。

一、坐标系定义：先约定，再计算

空间同步的第一步不是标定，而是明确每个坐标系的轴向、原点和单位。ADAS 中常见的坐标系包括：

• 车辆坐标系（Vehicle）：原点通常位于后轴中心地面投影点，X 轴指向车头前方，Y 轴指向车辆左侧，Z 轴垂直向上，符合右手定则，单位 m。
• 相机坐标系（Camera）：原点在光心，Z 轴沿光轴指向前方，X 轴向右，Y 轴向下，单位 m。
• 图像坐标系（Image）：原点在图像左上角，u 轴向右，v 轴向下，单位 pixel。
• 雷达坐标系（Radar）：原点在雷达天线相位中心，X 轴指向探测正前方，Y 轴指向左侧，Z 轴向上。
• 激光雷达坐标系（LiDAR）：原点在激光发射中心，轴向依安装方式而定，需在标定文件中显式声明。

需要特别强调的是：相机坐标系是右手系但 Y 轴向下，与车辆坐标系 Y 轴向左不同，因此相机到车辆的旋转矩阵中必然包含一次绕 X 轴的 180° 翻转分量。若忽略这一点，标定结果会出现目标上下颠倒或俯仰角符号错误。所有坐标系约定必须写入标定文件头部，并在整个项目周期内保持一致。

二、内参与外参：各管一段

内参描述传感器自身成像或测量的内部映射关系。以针孔相机为例，内参矩阵 K 为：

K = [ fx  0  cx ]
    [  0 fy  cy ]
    [  0  0   1 ]

fx = f / dx,  fy = f / dy

其中 f 为焦距，dx、dy 为单个像素在水平和垂直方向的物理尺寸，cx、cy 为主点像素坐标。内参由镜头和传感器决定，与安装位置无关，通常通过棋盘格标定获得。雷达的内参则包括天线阵列相位偏差、通道增益和角度查找表，激光雷达的内参包括各激光束的垂直角与水平角偏移。

外参描述传感器坐标系相对于车辆坐标系的位姿，由旋转矩阵 R 和平移向量 t 组成，即刚体变换 T = [R | t]。外参由安装位置决定，是空间同步的核心。例如某前置摄像头安装于挡风玻璃后，其外参可能为：绕 Z 轴偏航 0.5°，绕 Y 轴俯仰 -1.2°，绕 X 轴横滚 0.1°，平移 t = [1.45, 0.0, 1.25] m（示例值，实际以标定结果为准）。

三、刚体变换与旋转表示

刚体变换保证两点间距离和夹角不变，只包含旋转和平移。点 P 从传感器坐标系变换到车辆坐标系：

P_vehicle = R * P_sensor + t

旋转的表示方式有多种，工程中需根据场景选择：

欧拉角必须明确旋转顺序，Bosch 常用 Z-Y-X 顺序，即先绕 Z 轴偏航，再绕 Y 轴俯仰，最后绕 X 轴横滚。四元数 q = [qw, qx, qy, qz] 需归一化，单位四元数满足 qw² + qx² + qy² + qz² = 1。旋转矩阵与四元数之间可相互转换，标定优化通常以四元数为参数，输出时再转为欧拉角写入标定文件。

四、标定链：从内参到外参的依赖关系

标定不是单次操作，而是一条有向依赖链。下图展示了从原始传感器数据到车辆坐标系观测的完整空间同步链路，以及各环节的输入、输出与关键参数。

标定链的执行顺序为：先标内参，再标外参。内参标定通常在实验室完成，使用棋盘格或专用靶标，通过多视角图像求解 K 和畸变系数。外参标定则在车辆下线或维修后执行，常用方法包括：

1. 靶标法：在车辆前方固定位置放置已知尺寸的标定板，相机识别角点，雷达和激光雷达识别板面，通过对应点求解 T。
2. 道路特征法：利用车道线、路沿等自然特征，在车辆行驶中优化外参，适合在线标定。
3. 手眼标定法：适用于多传感器刚性连接的情况，通过运动约束求解传感器间相对位姿。

五、工程检查要点

完成标定后，需验证以下内容：外参平移量是否与安装图纸一致（误差通常要求小于 2 cm）；旋转角是否在合理范围（偏航和俯仰一般小于 3°）；将雷达目标投影到图像上，检查目标框是否与图像中的车辆对齐；将激光雷达点云投影到图像，检查点云是否落在对应物体表面。若发现系统性偏移，应优先检查坐标系轴向定义是否一致，再检查旋转顺序和符号约定。

空间同步的最终目标，是让融合模块拿到任意传感器的一个观测时，都能通过统一的变换链将其映射到车辆坐标系，从而在同一空间基准下比较、关联和融合。内参保证“测得准”，外参保证“放得对”，旋转表示保证“算得稳”，标定链保证“可复现”。四者缺一不可。