基于边界扩展和融合规划的自动驾驶路径规划方法及装置制造方法及图纸

本发明专利技术提供一种基于边界扩展和融合规划的自动驾驶路径规划方法及装置，该方法包括：S1：基于当前参考线构造多条路径边界，当前参考线为自车所在车道的中心线；S2：通过决策模块提供的障碍物车道信息和障碍物运动意图，为多条路径边界筛选障碍物；S3：利用步骤S2中筛选后的障碍物压缩多条路径边界的相关边界；S4：采用二次规划构造方法对路径进行优化求解；S5：将路径评估结果传递给速度规划，以通过速度规划来避免与动态障碍物发生碰撞，并对路径进行光滑性评估；S6：输出路径规划结果。本发明专利技术能够确保每一帧都有路径优化成功，提高路径规划稳定性，且基于多条路径做速度规划，增加找到全局最优或近似最优轨迹的概率。找到全局最优或近似最优轨迹的概率。找到全局最优或近似最优轨迹的概率。

【技术实现步骤摘要】
基于边界扩展和融合规划的自动驾驶路径规划方法及装置


[0001]本专利技术属于自动驾驶
，具体涉及一种基于边界扩展和融合规划的自动驾驶路径规划方法及装置。

技术介绍

[0002]自动驾驶技术在近十年来取得了飞速的发展，规划是其中至关重要的一环。目前，业内常用的时空解耦的规划方案将规划分解成路径规划和速度规划，其中路径规划负责输出一条光滑且不会发生碰撞的路径。在城市结构化道路中，基于优化的路径规划依赖于高精度地图提供的车道信息，在Frenet坐标系构造初始的路径边界来确保自动驾驶车辆行驶在车道内。除此之外，路径规划还需要感知和预测模块提供障碍物信息来构造碰撞约束来保证不会和其他交通参与者发生碰撞。
[0003]上述提到的路径规划技术方案有以下不足之处：
[0004]第一，高精度地图提供车道信息不是完全准确导致在分离或者合并车道路径规划不稳定，这些车道可能比自动驾驶车辆窄从而导致路径优化失败，或者这些折线车道导致优化出来的路径曲率变化大对控制跟踪不友好导致自车行驶到车道边界外。
[0005]第二，路径规划和速度规划解耦在复杂动态环境不够智能，因为路径规划对路径的安全性评估过于粗糙，很有可能会滤掉最优的那条路径，比如他车稍微占据自车车道且相邻车道有行驶的车辆，左前方两个排队等红灯车辆，右侧一直有行驶的车辆，最优路径会过滤掉从而选择其他路径传递给速度规划导致自车一直堵在当前位置。

技术实现思路

[0006]为了解决上述技术问题，本专利技术公开了一种基于边界扩展和融合规划的自动驾驶路径规划方法及装置。
[0007]一方面，本专利技术公开一种基于边界扩展和融合规划的自动驾驶路径规划方法，包括如下步骤：
[0008]S1：基于当前参考线构造多条路径边界，当前参考线为自车所在车道的中心线；
[0009]S2：通过决策模块提供的障碍物车道信息和障碍物运动意图，为多条路径边界筛选障碍物；
[0010]S3：利用步骤S2中筛选后的障碍物压缩多条路径边界的相关边界；
[0011]S4：采用二次规划构造方法对路径进行优化求解；
[0012]S5：将路径评估结果传递给速度规划，以通过速度规划来避免与动态障碍物发生碰撞，并对路径进行光滑性评估；
[0013]S6：输出路径规划结果。
[0014]在上述技术方案的基础上，还可做如下改进：
[0015]作为优选的方案，决策模块提供的障碍物车道信息包括：在参考线车道且在自车前LEADING，在参考线车道且在自车后FOLLOWING，在参考线车道右侧车道RIGTH_PARAL，在
参考线车道左侧车道LEFT_PARAL。
[0016]作为优选的方案，决策模块提供的障碍物运动意图包括：排队QUEUE，停车PARKING，他车从其他车道进入自车车道CUT_IN，车道保持LANE_KEEP。
[0017]作为优选的方案，在步骤S2中筛选的障碍物分类包括：
[0018]NON：路径无关障碍物；
[0019]HARD：路径边界相关障碍物，用来压缩路径边界；
[0020]SOFT：指引路径相关障碍物，用来改变指引路径。
[0021]作为优选的方案，步骤S2中的障碍物筛选方法包括以下中的至少一个：
[0022]纵向筛选：过滤掉车前路径长度外和车后一定距离的障碍物；
[0023]横向筛选：根据决策模块提供的障碍物车道信息只保留三个车道内的障碍物；
[0024]根据障碍物意图和速度信息筛选障碍物。
[0025]作为优选的方案，在步骤S5中，在路径进行光滑性评估时，如果路径不平滑，则采用平滑方法对路径进行平滑优化。
[0026]作为优选的方案，所构造的多条路径边界的每一个包括左边界和右边界，在S3中对多条路径边界进行边界压缩是对每个路径边界的左边界或者右边界进行压缩。
[0027]另一方面，本专利技术还公开一种基于边界扩展和融合规划的自动驾驶路径规划装置，包括如下模块：
[0028]路径边界构造模块，用于基于当前参考线构造多条路径边界，当前参考线为自车所在车道的中心线；
[0029]障碍物筛选模块，用于通过车辆的决策模块提供的障碍物车道信息和障碍物运动意图，为多条路径边界筛选障碍物；
[0030]路径边界压缩模块，用于利用通过障碍物筛选模块筛选后的障碍物，来压缩多条路径边界的相关边界；
[0031]路径优化求解模块，用于采用二次规划构造方法对路径进行优化求解；
[0032]速度规划和路径平滑模块，用于将路径评估结果传递给速度规划，以通过速度规划来避免与动态障碍物发生碰撞，并对路径进行光滑性评估；
[0033]路径输出模块，用于输出路径规划结果。
[0034]本专利技术公开一种基于边界扩展和融合规划的自动驾驶路径规划方法及装置，具有以下有益效果：
[0035]第一，本专利技术能够解决由高精度地图不准确的车道信息导致路径优化失败或者曲率变化大的问题，确保每一帧都有路径优化成功，提高路径规划稳定性。
[0036]第二，在轨迹存在全局最优解的前提下，在多个局部空间中分别找到路径最优解，然后基于多条路径做速度规划，增加找到全局最优轨迹或者全局近似最优轨迹的概率。
附图说明
[0037]为了更清楚地说明本专利技术实施例的技术方案，下面将对实施例中所需要使用的附图作简单地介绍，应当理解，以下附图仅示出了本专利技术的某些实施例，因此不应被看作是对范围的限定，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其他相关的附图。
[0038]图1是本专利技术的方法的整体流程图；
[0039]图2是本专利技术的多路径边界构造的示意图；
[0040]图3的(a)
‑
(c)是本专利技术的利用筛选后的路径相关障碍物来压缩边界的示意图；
[0041]图4是本专利技术的方法的整体流程示意图；
[0042]图5是本专利技术障碍物筛选示意图。
具体实施方式
[0043]下面结合附图详细说明本专利技术的优选实施方式。
[0044]下面将结合本专利技术实施例中的附图，对本专利技术实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本专利技术一部分实施例，而不是全部的实施例。基于本专利技术中的实施例，本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例，都属于本专利技术保护的范围。
[0045]使用序数词“第一”、“第二”、“第三”等等来描述普通对象仅仅表示涉及类似对象的不同实例，并且并不意图暗示这样被描述的对象必须具有时间上、空间上、排序方面或者以任意其它方式的给定顺序。
[0046]另外，“包括”元件的表述是“开放式”表述，该“开放式”表述仅仅是指存在对应的部件或步骤，不应当解释为排除附加的部件或步骤。
[0047]为了达到本专利技术的目的，基于边界扩展和融合规划的自动驾驶路径规划方法及装置的其中一些实施例中，本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.基于边界扩展和融合规划的自动驾驶路径规划方法，其特征在于，包括如下步骤：S1：基于当前参考线构造多条路径边界，当前参考线为自车所在车道的中心线；S2：通过决策模块提供的障碍物车道信息和障碍物运动意图，为所述多条路径边界筛选障碍物；S3：利用步骤S2中筛选后的障碍物压缩所述多条路径边界的相关边界；S4：采用二次规划构造方法对路径进行优化求解；S5：将路径评估结果传递给速度规划，以通过速度规划来避免与动态障碍物发生碰撞，并对路径进行光滑性评估；S6：输出路径规划结果。2.根据权利要求1所述的自动驾驶路径规划方法，其特征在于，所述决策模块提供的障碍物车道信息包括：在参考线车道且在自车前LEADING，在参考线车道且在自车后FOLLOWING，在参考线车道右侧车道RIGTH_PARAL，在参考线车道左侧车道LEFT_PARAL。3.根据权利要求2所述的自动驾驶路径规划方法，其特征在于，所述决策模块提供的障碍物运动意图包括：排队QUEUE，停车PARKING，他车从其他车道进入自车车道CUT_IN，车道保持LANE_KEEP。4.根据权利要求1所述的自动驾驶路径规划方法，其特征在于，在步骤S2中筛选的障碍物分类包括：NON：路径无关障碍物；HARD：路径边界相关障碍物，用来压缩路径边界；SOFT：指引路径相关障碍物，用来改变指引路径。5.根据权利要求1所述的自动驾驶路...

【专利技术属性】
技术研发人员：廖文龙，朱恒，何弢，张润玺，
申请(专利权)人：上海酷移机器人有限公司，
类型：发明
国别省市：