四轮转向车辆外轮廓无碰撞局部路径实时规划方法及系统技术方案

本申请公开了一种四轮转向车辆外轮廓无碰撞局部路径实时规划方法及系统，方法包括如下步骤：S1:获取车辆行驶的局部车道信息和障碍物信息；S2:基于局部车道信息提取车道中心线并预处理后作为参考线；S3:基于障碍物信息形成局部车道的道路边界；S4:获取车辆外轮廓形状并选定车辆参考点和筛选预设数量的点作为碰撞测试点；S5:构建道路边界与碰撞测试点的横向偏移量在无碰撞下的关系模型并进行碰撞检测。本发明专利技术的有益效果，本申请通过设置车辆外轮廓上的任意多个点，作为碰撞检测点，当车辆沿着所规划的路径行走时，可以保证所有检测点轨迹都是无碰撞的，当合理设置了检测点的位置和数量后，就能保证车辆的外轮廓无碰撞以及满足实时性要求。及满足实时性要求。及满足实时性要求。

【技术实现步骤摘要】
四轮转向车辆外轮廓无碰撞局部路径实时规划方法及系统


[0001]本申请涉及自动驾驶路径规划
，尤其涉及一种四轮转向车辆外轮廓无碰撞局部路径实时规划方法及系统。

技术介绍

[0002]车辆自动驾驶融合了感知、预测、高精地图、融合定位、导航、决策规划、控制等相关技术，其中决策规划模块是自动驾驶技术的重要组成部分，它根据导航模块给出的全局路径、定位模块给出的自车位置和感知预测模块给出的静、动态障碍物信息，规划出一条车辆可行驶的局部路径。
[0003]该局部路径应该是光滑(满足车辆动力学约束、曲率连续)、无碰撞的，可以直接作为下游控制模块的输入。由于一些障碍物是动态变化的，因此局部路径规划应该是实时进行的。
[0004]目前主流局部路径规划算法分为基于搜索的路径规划算法和基于优化的路径规划算法。基于搜索的路径规划算法，时间复杂度较高，很难满足实时性要求。在基于优化的路径规划算法中，基于二次规划的路径规划算法具有时间复杂度低、易于部署的特点。而针对前后轮转向可以同时转向的车辆，目前的二次规划算法，只能约束车辆参考点(后轴中心或者中心点)的位置，无法完全保证车辆的外轮廓无碰撞。

技术实现思路

[0005]为了解决上述技术问题，本申请实施例提供一种四轮转向车辆外轮廓无碰撞局部路径实时规划方法及系统，填补了目前针对四轮转向车辆的路径规划方面的空白。
[0006]本申请实施例第一方面提供了一种四轮转向车辆外轮廓无碰撞局部路径实时规划方法，可包括如下步骤：
[0007]S1:获取车辆行驶的局部车道信息和障碍物信息，其中，所述局部车道信息包括车道范围和车道类型；
[0008]S2:基于局部车道信息提取车道中心线并预处理后作为参考线；基于所述参考线生成道路坐标系；
[0009]S3:基于障碍物信息筛选车道范围内的静态障碍物信息和动态障碍物信息，并结合车道宽度形成局部车道的道路边界，将该道路边界转换至所述道路坐标系下；
[0010]S4:获取车辆外轮廓形状并选定车辆参考点和筛选预设数量的点作为碰撞测试点；基于车辆参考点与参考线的位置关系获取每个碰撞测试点的横向偏移量；
[0011]S5:构建道路边界与碰撞测试点的横向偏移量在无碰撞下的关系模型并进行碰撞检测，基于碰撞检测的结果输出是否存在无碰撞的行驶轨迹。
[0012]进一步，所述步骤S1)中的车道范围包括车后已行驶的预设距离的车道和车前即将行驶的预设距离的车道，车道类型包括直道和弯道。
[0013]进一步，所述步骤S2)中的预处理包括：对所述车道中心线进行平滑处理以使得参
考线的曲率连续且与中心线的偏差在预设范围内。
[0014]进一步，所述参考点选择车辆后轴中心。
[0015]进一步，所述步骤S5)中：所述碰撞检测点至少包含车外轮廓的四个顶点，该四个顶点构成矩形，若超过四个点则其他的可以在所构成的矩形的边上任意选取。
[0016]进一步，所述步骤S5)中：碰撞检测中若无碰撞的情况，将该路径作为规划路线，若有碰撞的情况，则将车辆参考点的行驶轨迹作为参考线，并重新进行碰撞检测，若依然有碰撞则说明不存在无碰撞路线。
[0017]本申请实施例第二方面提供了一种四轮转向车辆外轮廓无碰撞局部路径实时规划系统，包括：
[0018]局部地图信息模块，获取车辆行驶的局部车道信息和障碍物信息；
[0019]参考线构建模块，基于局部车道信息提取车道中心线并预处理后作为参考线，并基于所述参考线生成道路坐标系；
[0020]道路边界模块，基于局部地图信息模块的内容筛选车道范围内的静态障碍物信息和动态障碍物信息，并结合车道宽度形成局部车道在道路坐标系下的道路边界；
[0021]测试点行驶边界模块，获取车辆外轮廓形状并选定车辆参考点和筛选预设数量的点作为碰撞测试点，基于车辆参考点与参考线的位置关系获取每个碰撞测试点的横向偏移量，形成每个碰撞测试点的行驶边界；
[0022]无碰撞路径模块，构建道路边界与碰撞测试点的横向偏移量在无碰撞下的关系模型并进行碰撞检测，基于碰撞检测的结果输出是否存在无碰撞的行驶轨迹。
[0023]进一步地，所述局部地图信息模块包括车道范围和车道类型，其中车道范围包括车后已行驶的预设距离的车道和车前即将行驶的预设距离的车道，车道类型包括直道和弯道。
[0024]进一步地，所述参考线构建模块中对车道中心线进行平滑处理以使得参考线的曲率连续且与中心线的偏差在预设范围内。
[0025]进一步地，所述无碰撞路径模块在进行碰撞检测中若无碰撞的情况，将该路径作为规划路线输出，若有碰撞的情况，则将车辆参考点的行驶轨迹作为参考线，并重新进行碰撞检测，若依然有碰撞则说明不存在无碰撞路线。
[0026]本专利技术的有益效果，本申请通过设置车辆外轮廓上的任意多个点，作为碰撞检测点，当车辆沿着所规划的路径行走时，可以保证所有检测点轨迹都是无碰撞的，当合理设置了检测点的位置和数量后，就能保证车辆的外轮廓无碰撞以及满足实时性要求。
附图说明
[0027]为了更清楚地说明本申请实施例或现有技术中的技术方案，下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本申请的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其他的附图。
[0028]图1是本申请实施例提供的方法流程图；
[0029]图2是本申请提供的方法流图框图；
[0030]图3是车辆外轮廓检测点；
[0031]图4(a)(b)是参考点与检测点的横向偏移的多种状态示意图。
具体实施方式
[0032]为使得本申请的申请目的、特征、优点能够更加的明显和易懂，下面将结合本申请实施例中的附图，对本申请实施例中的技术方案进行清楚、完整地描述，显然，下面所描述的实施例仅仅是本申请一部分实施例，而非全部的实施例。基于本申请中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其它实施例，都属于本申请保护的范围。
[0033]下面结合附图和具体实施例，进一步阐明本专利技术。
[0034]在本申请的描述中，需要理解的是，术语“上”、“下”、“顶”、“底”、“内”、“外”等指示的方位或位置关系为基于附图所示的方位或位置关系，仅是为了便于描述本申请和简化描述，而不是指示或暗示所指的装置或元件必须具有特定的方位、以特定的方位构造和操作，因此不能理解为对本申请的限制。
[0035]本申请实施例提供了一种四轮转向车辆外轮廓无碰撞局部路径实时规划方法，该方法的前提是上游模块已经根据全局路径决策出了供车辆行驶的连续车道，可包括如下步骤：
[0036]步骤S1:获取车辆行驶的局部车道信息和障碍物信息，其中，局部车道信息包括车道范围和车道类型两方面，车道范围包括车后已行驶的预设距离的车道和车前即将行驶的预设距离的车道，车道类型包括直道和弯道。在一本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种四轮转向车辆外轮廓无碰撞局部路径实时规划方法，其特征在于，包括如下步骤：S1:获取车辆行驶的局部车道信息和障碍物信息，其中，所述局部车道信息包括车道范围和车道类型；S2:基于所述局部车道信息提取车道中心线并预处理后作为参考线；基于所述参考线生成道路坐标系；S3:基于所述障碍物信息筛选车道范围内的静态障碍物信息和动态障碍物信息，并结合车道宽度形成局部车道的道路边界，将该道路边界转换至所述道路坐标系下；S4:获取车辆外轮廓形状并选定车辆参考点和筛选预设数量的点作为碰撞测试点；基于车辆参考点与参考线的位置关系获取每个碰撞测试点的横向偏移量；S5:构建道路边界与碰撞测试点的横向偏移量在无碰撞下的关系模型并进行碰撞检测，基于碰撞检测的结果输出是否存在无碰撞的行驶轨迹。2.根据权利要求1所述的四轮转向车辆外轮廓无碰撞局部路径实时规划方法，其特征在于，所述步骤S1)中的车道范围包括车后已行驶的预设距离的车道和车前即将行驶的预设距离的车道，车道类型包括直道和弯道。3.根据权利要求1所述的四轮转向车辆外轮廓无碰撞局部路径实时规划方法，其特征在于，所述步骤S2)中的预处理包括：对所述车道中心线进行平滑处理以使得参考线的曲率连续且与中心线的偏差在预设范围内。4.根据权利要求1所述的四轮转向车辆外轮廓无碰撞局部路径实时规划方法，其特征在于，所述参考点选择车辆后轴中心。5.根据权利要求1所述的四轮转向车辆外轮廓无碰撞局部路径实时规划方法，其特征在于，所述步骤S5)中：碰撞检测中若无碰撞的情况，将该路径作为规划路线，若有碰撞的情况，则将车辆参考点的行驶轨迹作为参考线，并重新进行碰撞检测，若依然有碰撞则说...

【专利技术属性】
技术研发人员：陈冉，吴延俊，刘羿，何贝，
申请(专利权)人：北京斯年智驾科技有限公司，
类型：发明
国别省市：