辅助驾驶功能开发-功能算法篇(1)-ACC-多目标选择

1、总体架构

2、漏斗概念(Funnel)

路径漏斗是围绕着自车预测轨迹的一片区域。换言之，漏斗的中心应该根据预测的轨迹方向相应的弯曲。

2.1、普通&略宽漏斗(Normal Funnel & Wider Funnel)

普通漏斗用于选择路径中最近的目标车辆A和次近的车辆B。

更宽的漏斗用于选择路径左侧最近的目标车辆C和路径右侧最近的目标D。

2.2、内部&外部漏斗(Inner Funnel & Outer Funnel)

每个ACC漏斗应有两个envelope。其中，内部漏斗(Inner Funnel)用于目标进入；外部漏斗(Outer Funnel)用于目标离开。

Inner: left=innerLeft + InnerFunnel/2 – lanePosition
          Right=-1*( innerRight+ InnerFunnel/2 + lanePosition)
Outer: left=outerLeft + outerFunnel/2 – lanePosition
           Right=-1*(outerRight+ outerFunnel/2 + lanePosition)

2.3、影响因素