【技术实现步骤摘要】
一种路径搜索方法及装置、设备、存储介质
[0001]本申请实施例涉及自动驾驶
,涉及但不限于一种路径搜索方法及装置、设备、存储介质。
技术介绍
[0002]在自动驾驶技术中,当需要停车入库或出车位,或在复杂环境中倒车绕行时,常常需要将规划空间作为自由空间(free space),结合自动驾驶汽车或无人配送车等自动驾驶车辆的运动学模型的特点进行路径规划的算法设计。常用的路径规划方法包括基于搜索及基于采样的两类主要的算法,例如:混A星(hybrid A*)算法、快速扩展随机树(rapidly exploring random tree,RRT)算法等。但这些算法无法适应小区、商场门口等复杂区域。
技术实现思路
[0003]有鉴于此,本申请实施例为解决相关技术中存在的至少一个问题而提供一种路径搜索方法及装置、设备、存储介质,能够降低控制延迟,保证自动驾驶过程中的安全。
[0004]本申请实施例的技术方案是这样实现的:
[0005]第一方面,本申请实施例提供一种路径搜索方法,所述方法包括:
[0006]根据起始位置点构建起始圆,并根据所述目标位置点构建目标圆;
[0007]根据所述起始圆和所述目标圆,确定具有方向的中间圆;其中,沿着所述中间圆的方向,所述起始圆、所述中间圆和所述目标圆构成一条有向圆路径;所述有向圆路径中每一圆与相邻的圆存在重叠;
[0008]根据所述有向圆路径所经过的圆,确定位于所述有向圆路径中的中间节点;所述起始位置对应的起始节点、所述中间节点和 ...
【技术保护点】
【技术特征摘要】
1.一种路径搜索方法,其特征在于,所述方法包括:根据起始位置点构建起始圆,并根据所述目标位置点构建目标圆;根据所述起始圆和所述目标圆,确定具有方向的中间圆;其中,沿着所述中间圆的方向,所述起始圆、所述中间圆和所述目标圆构成一条有向圆路径;所述有向圆路径中每一圆与相邻的圆存在重叠;根据所述有向圆路径所经过的圆,确定位于所述有向圆路径中的中间节点;所述起始位置对应的起始节点、所述中间节点和所述目标位置点对应的目标点构成目标路径。2.根据权利要求1所述的方法,其特征在于,所述根据所述起始圆和所述目标圆,确定中间圆,包括:将所述起始圆作为第一参考圆;扩展所述第一参考圆的子圆;从所述第一参考圆的子圆中选取最优圆;判断所述最优圆与所述目标圆是否满足第一约束条件;如果不满足所述第一约束条件,以所述最优圆为新的第一参考圆,重复扩展所述第一参考圆的子圆,直到满足所述第一约束条件;所述中间圆包括所述最优圆。3.根据权利要求2所述的方法,其特征在于,所述扩展所述第一参考圆的子圆,包括:在所述第一参考圆的圆弧上确定N个圆心;N>1;对于所述N个圆心中的每个圆心执行以下处理:确定所述圆心与障碍对象之间的最小距离;基于所述最小距离、第一参考半径与第二参考半径,建立所述圆心对应的子圆;所述第一参考半径小于所述第二参考半径。4.根据权利要求3所述的方法,其特征在于,所述基于所述最小距离、第一参考半径与第二参考半径,建立所述圆心对应的子圆,包括:如果所述最小距离小于所述第一参考半径,忽略所述圆心;如果所述最小距离介于所述第一参考半径和所述第二参考半径之间,则将所述最小距离作为所述圆心对应的子圆的半径,建立所述圆心对应的子圆;如果所述最小距离大于所述第二参考半径,则将所述第二参考半径作为所述圆心对应的子圆的半径,建立所述圆心对应的子圆。5.根据权利要求3所述的方法,其特征在于,所述基于所述最小距离、第一参考半径与第二参考半径,建立所述圆心对应的子圆,包括:如果所述最小距离小于所述第一参考半径,忽略所述圆心;如果所述最小距离介于所述第一参考半径和第三参考半径之间,则将第四参考半径作为所述圆心对应的子圆的半径,建立所述圆心对应的子圆;所述第三参考半径为所述第二参考半径与缓冲距离之和;所述最小距离为所述第四参考半径和缓冲距离的和;如果所述最小距离大于所述第三参考半径,则将所述第二参考半径作为所述圆心对应的子圆的半径,建立所述圆心对应的子圆。6.根据权利要求2所述的方法,其特征在于,在从所述第一参考圆的子圆中选取最优圆之前,所述方法还包括:根据所述子圆的位置所述起始圆的位置确定第一估计子值;
根据所述子圆的位置所述目标圆的位置确定第二估计子值;根据所述第一估计子值和所述第二估计子值确定所述子圆的第一估计值;对应的,所述从所述第一参考圆的子圆中选取最优圆,包括:根据所述第一参考圆的子圆中各子圆的第一估计值,确定所述最优圆。7.根据权利要求2所述的方法,其特征在于,所述根据所述起始圆和所述目标圆,确定中间圆,还包括:沿着所述第一参考圆的圆心和所述子圆的圆心,确定所述子圆的方向所在的参考线段;根据所述第一参考圆的方向,沿着所述参考线段确定所述子圆的方向,所述子圆的方向与所述第一参考圆的方向之间的夹角小于第一夹角阈值。8.根据权利要求1所述的方法,其特征在于,所述根据所述有向圆路径所经过的圆,确定位于所述有向圆路径中的中间节点,包括:将所述起始节点作为第一参考节点;基于所述有向圆路径扩展所述第一参考节点的子节点;...
【专利技术属性】
技术研发人员:李杨,
申请(专利权)人:京东鲲鹏江苏科技有限公司,
类型:发明
国别省市:
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。