自动驾驶汽车合规性安全决策规划系统和方法技术方案

本发明专利技术公开了一种自动驾驶汽车合规性安全决策规划系统和方法，包括感知模块、导航模块、合规性安全决策规划模块和控制模块。合规性安全决策规划模块包括决策层和规划层。决策层基于感知模块和自车状态信息进行高层次的规划，选择合适的行驶策略以满足交通规则和安全性要求。规划层根据决策层生成的行驶策略和导航模块提供的全局参考路径，进行路径规划和轨迹生成。感知模块用于获取周围环境中的车辆信息和交通标志标线信息，导航模块提供全局参考路径，控制模块用于跟踪控制生成的参考轨迹。本发明专利技术的优点是：能够确保自动驾驶汽车在复杂的交通场景中满足合规性和安全性要求。能够有效的处理不同类型的法规并进行拓展，计算效率高，实时性强。实时性强。实时性强。

【技术实现步骤摘要】
自动驾驶汽车合规性安全决策规划系统和方法


[0001]本专利技术涉及自动驾驶
，特别涉及一种应用于自动驾驶车辆高速公路场景下的合规性安全决策规划系统和方法。

技术介绍

[0002]遵守交通法规是道路上人类驾驶员上路行驶的基本要求，随着近年来自动驾驶技术的发展，在可预见的将来人类驾驶车辆与自动驾驶车辆共存的混合交通流将会成为常态，但目前的自动驾驶车辆主要仅把安全和避撞作为决策规划的条件，这会导致人类驾驶员的误解和不信任，甚至引发事故，因此，确保自动驾驶决策规划系统的合规性是有必要的。同时，高速公路由于其路况相对简单，预计会成为自动驾驶最早应用的场景之一，但近年来有关自动驾驶高速公路的事故频发，由于高速公路车速普遍较快，一旦发生事故将会直接造成乘客的生命财产的损失，因此确保高速公路场景下自动驾驶汽车决策规划系统的合规性对于保证自动驾驶的安全性并推广自动驾驶技术的广泛应用至关重要。
[0003]目前的自动驾驶车辆对于道路法规合规性的研究较少，对于合规性的研究大都仅仅停留在监测领域。如2022年中国科学院软件研究所在专利号为CN115662118A的中国专利技术专利中公开了一种面向自动驾驶测试的交规合规性自动化判定方法及装置。它由地图获取模块、自动驾驶测试模块、目标交通元素检测模块、是否违规判断模块与合规性评估模块。该专利技术基于场景信息绘制语义地图，判断车辆在语义地图中投影的合规情况，按照测试对象在自动驾驶测试过程中遵守交通规则的情况统计，旨在于评估测试对象的交规合规性。提升交规合规性判定效率以及判定结果的准确性和可靠性。
[0004]但是上述现有技术存在以下缺陷：
[0005]1.适用于容易获取场景信息的仿真测试及离线监测，但很难实现自动驾驶汽车的车端实时应用。
[0006]2.只是作为违规行为发生后的监测模块，无法参与到自动驾驶决策中约束车辆行为，避免车辆产生违规行为。

技术实现思路

[0007]本专利技术针对现有技术的缺陷，提供了一种自动驾驶汽车合规性安全决策规划系统和方法。以高速公路为设计运行域，在决策层基于候选行为集方法，结合提出的双层准入方法对安全性和静态法规的合规性进行处理，在规划层基于人工势场方法对动态法规的合规性进行处理。通过分层解耦处理，该方法能够有效的处理不同类型的法规并进行拓展，基于候选行为集的决策方法相比于当前主流的基于状态机的决策方法更加简单，且能应对的场景更多，计算效率相对较高，基于人工势场的规划方法相比传统二次规划方法算法的结构简单，实时性较强，因此本系统具有可靠性高、拓展性强、计算效率高、实时性强等优点。
[0008]为了实现以上专利技术目的，本专利技术采取的技术方案如下：
[0009]一种自动驾驶汽车合规性安全决策规划系统，包括：感知模块、导航模块、合规性
安全决策规划模块和控制模块，
[0010]合规性安全决策规划模块包括：决策层和规划层；
[0011]决策层的作用是基于感知模块获取到的周围环境信息和自车状态信息，对驾驶决策进行高层次的规划。判断并选择合适的行驶策略，以确保车辆在驾驶过程中能够满足交通规则、法律要求和安全性要求。决策层根据当前交通情况、道路条件以及自车状态因素，制定合适的行为规则，如加速、减速、变道、超车等。
[0012]规划层的作用是根据决策层生成的高层次行驶策略，结合导航模块提供的全局参考路径，进行路径规划和轨迹生成。规划层会考虑多个因素，如车辆动力学特性、周围环境的变化、交通流量等，以生成车辆经过的具体轨迹。规划层还需要考虑合规性和安全性，确保生成的轨迹能够安全地导航汽车通过各种复杂的交通场景。
[0013]感知模块包括：雷达、摄像头和其他车载传感器，用于获取周围环境中的他车信息、交通标志标线信息以及自车状态信息。
[0014]所述他车信息包括：他车在全局坐标系中的位置、他车的外形几何，他车类型以及他车的速度和航向角信息；
[0015]交通标志标线信息包括：交通标志标线的类型、交通标线的坐标和曲率信息等；
[0016]自车状态信息包括：自车在全局坐标系中的位置、自车的外形几何以及他车的速度、航向角信息。
[0017]导航模块用于提供全局参考路径；
[0018]控制模块用于跟踪控制由合规性安全决策规划模块生成的参考轨迹。
[0019]进一步地，所述决策层包括：候选行为集生成模块、安全评估模块、静态法规评估模块、评价指标模块和最优决策生成模块；
[0020]候选行为集生成模块根据感知模块发送的信息生成当前可供选择的候选行为。
[0021]安全评估模块负责评估候选行为集中每个行为对应的安全性，基于评估的风险和安全阈值将不安全的行为过滤掉，生成安全行为集；
[0022]静态法规评估模块根据当前场景中道路标线和标志，将违反静态法规的行为滤除，生成初步的通过行为集。
[0023]评价指标模块基于设计的评价指标，对通过行为集中的动作进行评估，为每一个动作赋一个评价值；
[0024]最优决策生成模块根据每个动作的评价值选出价值最高的动作，作为决策层输出的决策行为信息。
[0025]进一步地，所述规划层包括：安全势场构建模块、合规势场构建模块、势场整合模块，规划凸空间生成模块、参考轨迹生成模块和参考轨迹优化模块。
[0026]规划层中，势场构建模块负责将环境建模为势场，其根据感知模块发送的环境信息，对道路和周围车辆进行势场的构建，包括法规势场的构建和安全势场的构建，之后势场整合模块将法规势场和安全势场整合为最终的环境势场。
[0027]规划凸空间生成模块根据决策层生成的决策动作在环境势场中开辟出规划凸空间；
[0028]参考轨迹生成模块在规划凸空间对应的环境势场中寻找势场值最低的一条线作为参考轨迹；
[0029]参考轨迹优化模块将生成的参考轨迹进行平滑并输出给控制模块进行跟踪控制。
[0030]本专利技术还公开了一种自动驾驶汽车合规性安全决策规划方法，该方法是基于上述自动驾驶汽车合规性安全决策规划系统实现的，包括以下步骤：
[0031]步骤一：通过感知系统获取环境信息。环境信息包括车道信息：车道线坐标x
line
，y
line
、车道线类型T
line
、车道id与车道宽度W
L
；周围车辆信息：车辆坐标X
Tgt
，Y
Tgt
、车速V
Tgt
、航向角长度L
Tgt
和宽度W
Tgt
以及车辆的预测轨迹信息Traj
pre
＝(X
pre
，Y
pre
，V
pre
，t)，t≤N
p
，其中N
p
为自车的规划时域；还有自车状态信息其中e
y
为车辆与参考轨迹的横向偏差，为车辆与参考轨迹的航向角偏差。
[0032]步骤二：候本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种自动驾驶汽车合规性安全决策规划系统，其特征在于，包括：感知模块、导航模块、合规性安全决策规划模块和控制模块，合规性安全决策规划模块包括：决策层和规划层；决策层的作用是基于感知模块获取到的周围环境信息和自车状态信息，对驾驶决策进行高层次的规划；规划层的作用是根据决策层生成的高层次行驶策略，结合导航模块提供的全局参考路径，进行路径规划和轨迹生成；感知模块包括：雷达、摄像头和其他车载传感器，用于获取周围环境中的他车信息、交通标志标线信息以及自车状态信息；所述他车信息包括：他车在全局坐标系中的位置、他车的外形几何，他车类型以及他车的速度和航向角信息；交通标志标线信息包括：交通标志标线的类型、交通标线的坐标和曲率信息等；自车状态信息包括：自车在全局坐标系中的位置、自车的外形几何以及他车的速度、航向角信息；导航模块用于提供全局参考路径；控制模块用于跟踪控制由合规性安全决策规划模块生成的参考轨迹。2.根据权利要求1所述的一种自动驾驶汽车合规性安全决策规划系统，其特征在于：所述决策层包括：候选行为集生成模块、安全评估模块、静态法规评估模块、评价指标模块和最优决策生成模块；候选行为集生成模块根据感知模块发送的信息生成当前可供选择的候选行为；安全评估模块负责评估候选行为集中每个行为对应的安全性，基于评估的风险和安全阈值将不安全的行为过滤掉，生成安全行为集；静态法规评估模块根据当前场景中道路标线和标志，将违反静态法规的行为滤除，生成初步的通过行为集；评价指标模块基于设计的评价指标，对通过行为集中的动作进行评估，为每一个动作赋一个评价值；最优决策生成模块根据每个动作的评价值选出价值最高的动作，作为决策层输出的决策行为信息。3.根据权利要求2所述的一种自动驾驶汽车合规性安全决策规划系统，其特征在于：所述规划层包括：安全势场构建模块、合规势场构建模块、势场整合模块，规划凸空间生成模块、参考轨迹生成模块和参考轨迹优化模块；规划层中，势场构建模块负责将环境建模为势场，其根据感知模块发送的环境信息，对道路和周围车辆进行势场的构建，包括法规势场的构建和安全势场的构建，之后势场整合模块将法规势场和安全势场整合为最终的环境势场；规划凸空间生成模块根据决策层生成的决策动作在环境势场中开辟出规划凸空间；参考轨迹生成模块在规划凸空间对应的环境势场中寻找势场值最低的一条线作为参考轨迹；参考轨迹优化模块将生成的参考轨迹进行平滑并输出给控制模块进行跟踪控制。4.一种自动驾驶汽车合规性安全决策规划方法，其特征在于：该方法是基于权利要求3
所述的自动驾驶汽车合规性安全决策规划系统实现的，包括以下步骤：步骤一：通过感知系统获取环境信息；环境信息包括车道信息：车道线坐标x
line
，y
line
、车道线类型T
line
、车道id与车道宽度W
L
；周围车辆信息：车辆坐标X
Tgt
，Y
Tgt
、车速V
Tgt
、航向角长度L
Tgt
和宽度W
Tgt
以及车辆的预测轨迹信息Traj
pre
＝(X
pre
，Y
pre
，V
pre
，t)，t≤N
p
，其中N
p
为自车的规划时域；还有自车状态信息其中e
y
为车辆与参考轨迹的横向偏差，为车辆与参考轨迹的航向角偏差；步骤二：候选行为集构建模块基于环境信息列举出所有的候选行为动作；候选行为集的表示如下：Actionset＝[action1；action2；
…
；action
i
；
…
；action
N
]其中N为当前场景下候选行为的候选行为个数，每个可选驾驶动作包含三部分：action
i
＝[a
i
，lane
cur，i
，lane
des，i
，light
i
]其中a
i
代表可选的动作，由于本发明的设计运行域为高速公路，因此可选动作主要有a
i
∈{LK，R_CL，E_CL，R_CR，E_CR}，其中LK表示保持当前车道行驶，R_CL表示准备向左换道，E_CL表示执行向左换道，R_CR表示准备向右换道，E_CR表示执行向右换道；lane
cur，i
表示当前行驶的车道id，lane
des，i
表示目标车道id，light
i
表示与动作a
i
匹配的车辆转向灯的状态，light
i
∈{ON_L，OFF，ON_R}，这三种状态量的值是逻辑值，ON_L为真时代表左转向灯亮起，OFF为真代表转向灯关闭，ON_R为真代表右转向灯亮起；步骤三：双层准入条件判断；对候选行为集中的动作进行筛选，将不安全的和违反静态法规的动作去除，只保留安全且符合静态法规的动作；首先要进行的是安全评估，安全评估的评估对象是车辆每个动作对应的规划范围内的风险，每一个动作对应一条车道的选择，基于自动驾驶车辆周围车辆的预测轨迹结合自车的规划时域对每条车道的风险进行评估；步骤四：评价指标模块基于评价指标为所有动作赋值；评价指标包括：速度指标F
v
，空间指标F
s
和前车车型指标F
t
；步骤五：最优决策生成模块基于每个行为的评价值选出最优决策动作；基于步骤四的评价指标，每个候选动作都有了一个评价值，基于评价值选出最优的动作作为决策层的决策动作；步骤六：势场构建模块基于环境信息构建法规势场和安全势场；基于感知模块的环境信息，进行环境势场的构建，包括安全势场的构建和法规势场的构建；安全势场是保证车辆行驶中不发生碰撞的底线，自车不应该进入周围车辆的安全势场范围，安全势场通过使用自车相对于障碍物车辆距离的双曲函数进行构建；法规势场在高速公路场景下考虑的有车道线法规势场和周围车辆法规场，对于车道线法规势场，当自车在道路上行驶时，除非需要变道，否则车辆应该沿道路中心线行驶且最好不要骑压车道线，并且禁止撞击道路隔离带或越过车道实线，否则会造成危险甚至导致事故；法规势场的车道线通过二次函数定义对于周围车辆的法规势场，规定当车辆在道路上行驶时应当与周围车辆保持必要的安全距离；周围车辆合规势场通过指数函数的形势构建为可跨越势场，车辆的合规势场构建包括两种情况，一是自车与同车道前车的跟车限距的法规，二是换道超车时与邻侧车道车辆保持合适距离的法规；步骤七：势场整合模块将法规势场与安全势场整合为环境势场；
步骤八：规划凸空间生成模块基于最优动作将环境势场分割；基于步骤五中的最优决策动作对应的车道，对当前环境势场中以车道为单位的空间进行分割，将最优决策动作对应车道和当前车道的空间作为后续的规划凸空间PF
planning
PE
planning
＝PF
lane_cur
+PF
lane__actionbest
其中PF
lane_cur
指自车当前车道区域对应的环境势场，PF
lane_actionbest
指自车决策最优动作所选的车道区域对应的环境势场；步骤九：参考轨迹生成模块从凸空间中搜寻最低点作为参考轨迹；基于上一步的规划凸空间和自车当前位置，通过寻找势场值最低的点作为参考轨迹：Referenceline(action
best
)＝min(PF
planning
(action
best
))参考轨迹中主要包...

【专利技术属性】
技术研发人员：马小涵，杨林，于文浩，王伟达，杨超，王红，
申请(专利权)人：清华大学，
类型：发明
国别省市：