一种自动驾驶汽车集成式决控的静态路径优选方法及装置制造方法及图纸

本申请涉及一种自动驾驶汽车集成式决控的静态路径优选方法及装置，其中，方法包括：基于静态路径集合，分别计算每条静态路径的安全性指标、合规性指标、通畅性指标、经济性指标和舒适性指标；根据每条静态路径的安全性指标、合规性指标、通畅性指标、经济性指标和舒适性指标及对应的优先度和权重，计算每条静态路径的综合评价指标；根据每条静态路径的综合评价指标的大小和变化信息从基于静态路径集合中选取满足预设条件的最优静态路径。由此，解决了相关技术中，由于集成式决控动态跟踪控制将决策，规划和控制融合为一体，使得存在功能集成度高、算法设计复杂、计算规模大和实时性差的问题。的问题。的问题。

【技术实现步骤摘要】
一种自动驾驶汽车集成式决控的静态路径优选方法及装置


[0001]本申请涉及汽车智能驾驶
，特别涉及一种自动驾驶汽车集成式决控的静态路径优选方法及装置。

技术介绍

[0002]以自动驾驶为代表的智能汽车技术是新一轮科技革命的核心组成，正成为世界各工业强国的战略竞争高地。面向高级别自动驾驶的集成式决控将自动驾驶决控任务整合为一个约束型最优控制问题，可提升自动驾驶汽车整体智能性，适应性和安全性。
[0003]相关技术中，主要包括静态路径规划和动态跟踪控制两个模块，其中静态路径规划模块是根据静态道路环境信息生成可跟踪的备选路径集合，动态跟踪控制将路径跟踪问题构造成一个约束型最优控制问题，实现参考路径优选和车辆跟踪避障。
[0004]然而，相关技术中，由于集成式决控动态跟踪控制将决策，规划和控制融合为一体，使得存在功能集成度高、算法设计复杂、计算规模大和实时性差的问题，亟待解决。

技术实现思路

[0005]本申请提供一种自动驾驶汽车集成式决控的静态路径优选方法及装置，以解决相关技术中，由于集成式决控动态跟踪控制将决策，规划和控制融合为一体，使得存在功能集成度高、算法设计复杂、计算规模大和实时性差的问题。
[0006]本申请第一方面实施例提供一种自动驾驶汽车集成式决控的静态路径优选方法，包括以下步骤：基于静态路径集合，分别计算每条静态路径的安全性指标、合规性指标、通畅性指标、经济性指标和舒适性指标；根据所述每条静态路径的安全性指标、合规性指标、通畅性指标、经济性指标和舒适性指标及对应的优先度和权重，计算所述每条静态路径的综合评价指标；以及根据所述每条静态路径的综合评价指标的大小和变化信息从所述基于静态路径集合中选取满足预设条件的最优静态路径。
[0007]可选地，在本申请的一个实施例中，其中，
[0008]所述安全性指标的计算公式为：
[0009][0010]其中，表示当前时刻t静态路径τ的安全性指标，∏为静态路径的集合，t∈[t,t+Δt]表示以当前时刻t为起始的预测时域，Δt表示预测时长，j∈{1,2,
…
,J}表示t时刻交通参与者编号，其总数量为J；表示预测时域内在t时刻车辆沿着在静态路径τ行驶时，交通参与者i与自车发生假设性碰撞导致的碰撞双方总体损伤；ω
D
表示距离衰减系数，ω
t
表示时间衰减系数；
[0011]所述合规性指标的计算公式为：
[0012][0013]其中，为当前时刻t备选静态路径τ的合规性指标，为车辆换道到(或者继续行驶在)静态路径τ所在车道时违反不按指定车道行驶规定的代价；
[0014]所述通畅性指标的计算公式为：
[0015][0016]其中，表示当前时刻t静态路径τ所在车道的通畅性，和分别表示当前时刻t静态路径τ所在车道内最近前车与自车的距离和速度，ω
d
和ω
v
分别为和的权重，可根据通行效率对前车距离和速度的需求设定，且有ω
d
+ω
v
＝1；
[0017]所述经济性指标的计算公式为：
[0018][0019]其中，表示当前时刻t静态路径τ的经济性指标，f(
·
)表示自车的百公里油耗模型，表示当前时刻t静态路径τ所在车道内所有车辆的平均速度；
[0020]所述舒适性指标的计算公式为：
[0021][0022]其中，表示当前时刻t静态路径τ舒适性指标，表示当前时刻t第i∈{1,2,
…
,N}车辆的纵向加速度，N表示静态路径τ所在车道内所有周车的数量。
[0023]可选地，在本申请的一个实施例中，所述综合评价指标的计算公式为：
[0024][0025]其中，表示当前时刻t静态路径τ的综合评价指标，ω1，ω2，ω3，ω4，ω5分别为安全性、合规性、通畅性、经济性、舒适性权重系数，表示归一化后的当前时刻t静态路径τ的*指标。
[0026]可选地，在本申请的一个实施例中，所述根据所述每条静态路径的综合评价指标的大小和变化信息从所述基于静态路径集合中选取满足预设条件的最优静态路径，包括：以最大化综合评价指标的方式选取所述最优静态路径；根据所述综合评价指标的变化信息设定所述最优静态路径的更新频率。
[0027]可选地，在本申请的一个实施例中，所述更新频率为：
[0028][0029]其中，表示时刻的最优静态路径，表示时刻最优静态路径的综合评价指标，ΔJ表示静态路径更新所允许的综合评价指标变化阈值。
[0030]本申请第二方面实施例提供一种自动驾驶汽车集成式决控的静态路径优选装置，包括：第一计算模块，用于基于静态路径集合，分别计算每条静态路径的安全性指标、合规性指标、通畅性指标、经济性指标和舒适性指标；第二计算模块，用于根据所述每条静态路
径的安全性指标、合规性指标、通畅性指标、经济性指标和舒适性指标及对应的优先度和权重，计算所述每条静态路径的综合评价指标；以及选取模块，用于根据所述每条静态路径的综合评价指标的大小和变化信息从所述基于静态路径集合中选取满足预设条件的最优静态路径。
[0031]可选地，在本申请的一个实施例中，其中，
[0032]所述安全性指标的计算公式为：
[0033][0034]其中，表示当前时刻t静态路径τ的安全性指标，∏为静态路径的集合，t∈[t,t+Δt]表示以当前时刻t为起始的预测时域，Δt表示预测时长，j∈{1,2,
…
,}表示t时刻交通参与者编号，其总数量为J；表示预测时域内在t时刻车辆沿着在静态路径τ行驶时，交通参与者i与自车发生假设性碰撞导致的碰撞双方总体损伤；ω
D
表示距离衰减系数，ω
t
表示时间衰减系数；
[0035]所述合规性指标的计算公式为：
[0036][0037]其中，为当前时刻t备选静态路径τ的合规性指标，为车辆换道到(或者继续行驶在)静态路径τ所在车道时违反不按指定车道行驶规定的代价；
[0038]所述通畅性指标的计算公式为：
[0039][0040]其中，表示当前时刻t静态路径τ所在车道的通畅性，和分别表示当前时刻t静态路径τ所在车道内最近前车与自车的距离和速度，ω
d
和ω
v
分别为和的权重，可根据通行效率对前车距离和速度的需求设定，且有ω
d
+
v
＝1；
[0041]所述经济性指标的计算公式为：
[0042][0043]其中，表示当前时刻t静态路径τ的经济性指标，f(
·
)表示自车的百公里油耗模型，表示当前时刻t静态路径τ所在车道内所有车辆的平均速度；
[0044]所述舒适性指标的计算公式为：
[0045][0046]其中，表示当前时刻t静态路径τ舒适性指标，表示当前时刻t第i∈{1,2,
…
,}车辆的本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种自动驾驶汽车集成式决控的静态路径优选方法，其特征在于，包括以下步骤：基于静态路径集合，分别计算每条静态路径的安全性指标、合规性指标、通畅性指标、经济性指标和舒适性指标；根据所述每条静态路径的安全性指标、合规性指标、通畅性指标、经济性指标和舒适性指标及对应的优先度和权重，计算所述每条静态路径的综合评价指标；以及根据所述每条静态路径的综合评价指标的大小和变化信息从所述基于静态路径集合中选取满足预设条件的最优静态路径。2.根据权利要求1所述的方法，其特征在于，其中，所述安全性指标的计算公式为：其中，表示当前时刻t静态路径τ的安全性指标，∏为静态路径的集合，t∈[t,t+Δt]表示以当前时刻t为起始的预测时域，Δt表示预测时长，j∈{1,2,
…
,}表示t时刻交通参与者编号，其总数量为J；表示预测时域内在t时刻车辆沿着在静态路径τ行驶时，交通参与者i与自车发生假设性碰撞导致的碰撞双方总体损伤；ω
D
表示距离衰减系数，ω
t
表示时间衰减系数；所述合规性指标的计算公式为：其中，为当前时刻t备选静态路径τ的合规性指标，为车辆换道到(或者继续行驶在)静态路径τ所在车道时违反不按指定车道行驶规定的代价；所述通畅性指标的计算公式为：其中，表示当前时刻t静态路径τ所在车道的通畅性，和分别表示当前时刻t静态路径τ所在车道内最近前车与自车的距离和速度，ω
d
和ω
v
分别为和的权重，可根据通行效率对前车距离和速度的需求设定，且有ω
d
+
v
＝1；所述经济性指标的计算公式为：其中，表示当前时刻t静态路径τ的经济性指标，f(
·
)表示自车的百公里油耗模型，表示当前时刻t静态路径τ所在车道内所有车辆的平均速度；所述舒适性指标的计算公式为：其中，表示当前时刻t静态路径τ舒适性指标，表示当前时刻t第i∈{1,2,
…
,}车辆的纵向加速度，N表示静态路径τ所在车道内所有周车的数量。3.根据权利要求2所述的方法，其特征在于，所述综合评价指标的计算公式为：
其中，表示当前时刻t静态路径τ的综合评价指标，ω1，ω2，ω3，ω4，ω5分别为安全性、合规性、通畅性、经济性、舒适性权重系数，表示归一化后的当前时刻t静态路径τ的*指标。4.根据权利要求1所述的方法，其特征在于，所述根据所述每条静态路径的综合评价指标的大小和变化信息从所述基于静态路径集合中选取满足预设条件的最优静态路径，包括：以最大化综合评价指标的方式选取所述最优静态路径；根据所述综合评价指标的变化信息设定所述最优静态路径的更新频率。5.根据权利要求4所述的方法，其特征在于，所述更新频率为：其中，表示时刻的最优静态路径，表示时刻最优静态路径的综合评价指标，ΔJ表示静态路径更新所允许的综合评价指标变化阈值。6.一种自动驾驶汽车集成式决控的静态路径优选装置，其特征在于，包括：第一计算模块，用于基于静态路径集合，分别计算每条静态路径的安全性指标、合规性指标、通畅性指标、经济性指标和舒适性指标；第二计算模块，用于根据所述每条静...

【专利技术属性】
技术研发人员：李升波，杨森，金东润，成波，邹文俊，张宇航，徐少兵，王建强，许庆，
申请(专利权)人：清华大学，
类型：发明
国别省市：