4. 功能融合基础

在ADAS与自动驾驶域控制器中,单一传感器无法同时满足全天候、全场景、高冗余的感知需求。摄像头擅长纹理与语义识别,毫米波雷达擅长测距测速且不受光照影响,激光雷达提供高精度三维几何,超声波覆盖近距盲区,IMU与轮速计提供自车运动信息。多传感器数据融合的本质,是把这些异构、异步、不同置信度的观测,在时空对齐后组合成比任一单源更完整、更一致的环境描述,为后续规划控制提供稳定输入。

一、为什么必须融合:意义与工程价值

融合带来的收益可以归纳为四个维度。第一是冗余与安全:当摄像头逆光失效时,雷达仍能提供目标距离与速度,系统可降级运行而非直接退出。第二是互补与完整:雷达给出精确距离但角度分辨率低,摄像头给出类别与横向位置但深度弱,二者融合后目标的位置与属性同时可信。第三是置信度提升:多源独立观测同一目标,可显著降低虚警与漏检,融合后的存在概率高于任一单源。第四是时空覆盖扩展:不同传感器视场角、探测距离、更新率不同,融合后形成更连续、更宽域的感知覆盖。

融合不是简单“取平均”。若两个传感器对同一目标给出矛盾结果,融合模块必须依据标定质量、历史一致性、场景先验进行加权或仲裁,否则会把正确观测“平均”成错误结果。

二、融合层级:数据级、特征级、决策级

按信息抽象程度,融合通常分为三个层级,层级越低信息保留越完整,但对时空对齐与算力要求越高。

  • 数据级融合(前融合):在原始测量或点云层面直接合并。例如将激光雷达点云与摄像头像素做外参投影,生成带颜色的点云,再统一做检测。优点是信息损失最小,理论上限最高;缺点是对时间同步、外参标定、数据关联极其敏感,算力开销大。
  • 特征级融合(中融合):各传感器先提取特征(如BEV特征图、目标框、雷达点迹),再在特征空间拼接或注意力交互。这是当前域控制器主流方案,兼顾精度与工程可行性,典型如BEV+Transformer将多相机与雷达特征在统一鸟瞰空间融合。
  • 决策级融合(后融合):各传感器独立完成检测并输出目标列表,融合层只做关联、滤波与仲裁。优点是模块解耦、易调试、对时间同步要求低;缺点是各源已丢失原始信息,融合上限受限,且关联错误会直接导致目标分裂或合并。

三层并非互斥,实际系统常采用混合架构:近距用数据级保证精度,中距用特征级保证鲁棒,远距用决策级保证解耦与可解释性。

多传感器融合:层级递进与算法分类 传感器输入 摄像头 毫米波雷达 激光雷达 超声波 IMU/轮速 时间同步 + 空间标定 数据级融合(前融合) 原始点云/像素级合并 信息损失最小 · 对齐要求最高 特征级融合(中融合) BEV特征拼接/注意力交互 精度与工程性平衡 · 主流方案 决策级融合(后融合) 目标列表关联与仲裁 模块解耦 · 信息上限受限 融合算法分类 滤波类 卡尔曼 / 扩展KF / UKF 适合目标跟踪与状态估计 概率类 贝叶斯 / D-S证据理论 适合不确定性推理与仲裁 深度学习类 BEV+Transformer / 多模态 适合特征级端到端融合 优化/关联类 匈牙利匹配 / 图优化 适合数据关联与位姿求解 统一环境模型:目标列表 + 占据栅格 + 自车位姿 输出至预测、规划与控制模块

三、融合算法分类与选型逻辑

融合算法可按数学工具分为四类,选型取决于融合层级、目标类型与算力预算。

算法类别代表方法适用层级优势局限
滤波类卡尔曼、EKF、UKF、IMM决策级/跟踪实时性好,状态估计成熟依赖线性高斯假设,难处理类别语义
概率类贝叶斯推理、D-S证据理论决策级/仲裁显式表达不确定性与冲突证据组合计算量随源数增长
深度学习类BEV+Transformer、多模态注意力特征级/数据级端到端学习,精度高需大量标注,可解释性弱
优化与关联类匈牙利匹配、图优化、ICP数据级/决策级解决对应关系与位姿求解易受初值与异常值影响

四、典型场景:AEB中的融合链路

以自动紧急制动(AEB)为例,融合链路如下:毫米波雷达输出目标距离与相对速度,摄像头输出目标类别与横向位置,激光雷达输出精确轮廓。决策级融合先做时空对齐,再用匈牙利算法关联同一目标,随后用卡尔曼滤波估计目标运动状态,最后依据TTC(碰撞时间)阈值判断是否触发制动。若摄像头因逆光丢失目标,雷达仍可维持跟踪,系统降级为雷达单源模式并限制最高车速,保证安全冗余。

融合伪代码(决策级):
for each radar_target in radar_list:
    matched = hungarian_match(radar_target, camera_list, lidar_list)
    if matched:
        fused = kalman_update(radar_target, matched.camera, matched.lidar)
        fused.confidence = weighted_sum(radar_q, camera_q, lidar_q)
    else:
        fused = radar_target  # 单源降级
    if fused.ttc < TTC_BRAKE_THRESHOLD:
        trigger_aeb(fused)

五、常见误区与复盘要点

误区一:认为融合层级越高越好。数据级融合虽理论上限高,但若外参标定漂移1°,远距目标投影误差可达米级,反而引入错误关联。误区二:忽视时间同步。雷达与摄像头帧率不同,若不做时间戳对齐,高速场景下目标位置偏差可达数十厘米。误区三:只做加权平均不做冲突仲裁。当两源对同一目标给出相反速度时,平均会得到既不正确也不安全的结果。
复盘建议:在融合模块中保留每个目标的“来源标签”与“置信度贡献”,便于回放时定位是关联错误、标定错误还是单源失效。同时建立降级策略矩阵,明确各传感器失效时的功能边界与车速限制。

综上,多传感器融合的意义在于用异构互补换取安全冗余与感知完整;融合层级决定信息保留程度与工程复杂度;算法分类决定选型边界。工程实践中,应优先保证时空对齐与关联正确,再追求融合精度,最后通过降级策略守住安全底线。