📚 课程目录第2章传感器标定基础

2. 传感器标定基础

在 Bosch ADAS 传感器标定体系中，标定工作被划分为两个层次：内参标定与外参标定。理解这两者的定义、数学表达以及它们对感知性能的影响，是后续所有标定实操与整车验证工作的基础。

一、内参标定与外参标定的定义

内参标定（Intrinsic Calibration）解决的是“传感器自身如何成像或测距”的问题。对于摄像头，内参描述的是三维空间点投影到二维像素平面的映射关系，核心参数包括焦距 fx, fy、主点 cx, cy、以及畸变系数 k1, k2, p1, p2, k3。对于毫米波雷达，内参则涉及天线阵列的相位响应、通道间幅相一致性等。内参由传感器制造工艺决定，一旦出厂通常相对稳定，但在温度漂移、机械冲击或镜头更换后需要重新标定。

外参标定（Extrinsic Calibration）解决的是“传感器在车辆坐标系中的位姿”问题。它描述传感器坐标系相对于车辆坐标系（通常以车辆后轴中心地面投影为原点，X 轴指向车头，Y 轴指向左侧，Z 轴指向上方）的旋转与平移关系。外参由安装位置和安装角度决定，是传感器融合、目标定位、测距测速精度的直接决定因素。

在 Bosch 工程实践中，内参标定通常在产线或售后使用标定板完成，外参标定则分为产线静态标定与售后动态标定两种模式。整车验证阶段重点关注外参的稳定性与一致性。

二、坐标系转换与旋转矩阵、平移向量

传感器坐标系到车辆坐标系的转换是一个刚体变换，数学上表示为：

P_vehicle = R * P_sensor + T

其中：
  P_sensor  : 传感器坐标系下的三维点 (x_s, y_s, z_s)
  P_vehicle : 车辆坐标系下的三维点 (x_v, y_v, z_v)
  R         : 3x3 旋转矩阵，描述传感器坐标系相对车辆坐标系的姿态
  T         : 3x1 平移向量 [tx, ty, tz]^T，描述传感器原点在车辆坐标系中的位置

旋转矩阵 R 是一个正交矩阵，满足 R^T * R = I 且 det(R) = 1。它可以用三个欧拉角表示：绕 Z 轴的偏航角（Yaw，θz）、绕 Y 轴的俯仰角（Pitch，θy）、绕 X 轴的横滚角（Roll，θx）。Bosch 常用 Z-Y-X 旋转顺序，即先绕 Z 轴旋转 Yaw，再绕 Y 轴旋转 Pitch，最后绕 X 轴旋转 Roll，对应的旋转矩阵为：

R = Rz(θz) * Ry(θy) * Rx(θx)

Rz(θz) = [ cosθz  -sinθz  0 ]
         [ sinθz   cosθz  0 ]
         [   0       0     1 ]

Ry(θy) = [  cosθy  0  sinθy ]
         [    0    1    0   ]
         [ -sinθy  0  cosθy ]

Rx(θx) = [ 1    0       0    ]
         [ 0  cosθx  -sinθx ]
         [ 0  sinθx   cosθx ]

平移向量 T 的物理含义是传感器安装点相对于车辆坐标系原点的偏移。例如，前视摄像头安装在内后视镜后方，其平移向量典型值约为 [1.8, 0.0, 1.4] 米（X 向前、Y 向左、Z 向上），表示摄像头位于车辆后轴中心前方 1.8 米、高度 1.4 米处。这些数值属于教学示例，实际值需以具体车型的 CAD 数据或实测为准。

需要特别强调的是，旋转方向的正负号约定必须在整个项目中保持一致。Bosch 通常采用右手坐标系，逆时针旋转为正。若在标定工具链中切换了旋转顺序或正负号定义，必须重新验证所有外参矩阵，否则会导致融合结果出现系统性偏差。

三、标定参数对感知性能的影响

标定参数的微小误差会在远距离目标上被显著放大。以 100 米处的前视摄像头为例，若 Yaw 角存在 0.1° 的偏差，横向定位误差约为 100 × tan(0.1°) ≈ 0.175 米；若 Yaw 偏差达到 0.5°，横向误差将接近 0.87 米，足以导致车道保持功能误判。Pitch 角偏差则直接影响测距精度，0.1° 的 Pitch 误差在 100 米处引入约 0.17 米的纵向距离误差。

内参误差的影响同样不可忽视。焦距 fx 的标定误差会导致目标像素坐标到角度映射的缩放错误，进而影响目标横向距离估计；主点 cx, cy 的偏移则会造成整个图像平面的系统性平移，使所有目标的方位角出现固定偏差。畸变系数标定不准确时，图像边缘区域的目标会出现非线性位置误差，在广角摄像头中尤为明显。

参数类型	典型误差量	100m 处影响（示例估算）	主要受影响功能
Yaw 角	0.1°	横向 ≈ 0.17 m	车道保持、目标横向定位
Pitch 角	0.1°	纵向 ≈ 0.17 m	自适应巡航、前车距离
Roll 角	0.2°	高度 ≈ 0.35 m	目标高度分类、地面估计
焦距 fx	1%	角度 ≈ 0.01 rad	目标方位角、横向距离
主点 cx	5 px	角度 ≈ 0.005 rad	全画面方位角一致性

上表中的影响量为基于小角度近似的教学示例估算，实际误差传播需结合具体传感器安装高度、视场角及目标距离进行完整建模。工程中应以标定后的残差分析和实车验证结果为准。

四、工程实践中的关键控制点

在 Bosch 标定流程中，内参与外参的标定顺序通常是先内参后外参。内参标定使用标准标定板（如棋盘格或圆点阵列），在多个不同位姿下采集图像，通过最小化重投影误差求解内参和畸变系数。外参标定则使用已知尺寸的标定靶标或自然特征，在车辆坐标系中建立对应关系后求解旋转矩阵和平移向量。

标定完成后，必须通过重投影误差和融合一致性检查来验证参数质量。重投影误差反映的是标定模型对观测数据的拟合程度，通常要求摄像头内参重投影误差小于 0.3 像素；融合一致性检查则通过对比不同传感器对同一目标的定位结果，判断外参是否存在系统性偏差。若发现某传感器外参异常，应优先排查安装支架是否变形、传感器是否松动，而非直接修改标定参数。

此外，温度变化会引起传感器安装结构的微小形变，进而导致外参漂移。Bosch 在部分量产项目中引入了在线外参监测机制，通过持续观测稳定目标（如道路边缘、远处标志物）的定位偏差，判断外参是否需要重新标定。这一机制的有效性，同样依赖于内参的长期稳定性。