一种路径规划方法和路径规划装置制造方法及图纸

技术编号:29767301 阅读:44 留言:0更新日期:2021-08-20 21:22
本申请实施例提供了一种路径规划方法,应用于智能驾驶领域。通过改进的A星算法,规划出不受栅格限制的平滑的路径。具体的,该方法通过路径中的当前节点确定下一节点搜索区域,通过在搜索区域中采样确定多个采样点,然后从多个采样点中确定下一节点的位置。本申请提供的方法,可以应用在智能汽车、新能源汽车、自动驾驶汽车上。由于本方法中的采样点并不受栅格限制,因此,规划得到的目标路径能满足目标的动力学约束,且相较现有技术的路径更平滑。

【技术实现步骤摘要】
【国外来华专利技术】一种路径规划方法和路径规划装置
本申请涉及智能驾驶领域,尤其涉及一种路径规划方法和路径规划装置。
技术介绍
智能驾驶技术是未来汽车产业升级的重点。智能驾驶系统大致可以分为三个主要模块,分别是感知识别、决策规划和控制执行。智能汽车通过雷达、摄像头等传感器对外部环境进行感知识别。在多信息融合的基础上,智能驾驶系统进行相应的决策规划,包括驾驶任务决策、轨迹规划、异常处理等。决策规划的结果将传给下层控制执行来实现。在大部分的智能驾驶系统中,决策规划都是一个核心模块,其中路径规划又是决策规划中的重要一环。基于搜索的路径规划方法多用于全局路径规划或者驾驶导航,常见算法有迪杰斯特拉(Dijkstra)算法、A星(A-Star,A*)算法、快速扩展随机树(rapid-explorationrandomtree,RRT)算法等等。A*搜索算法是一种广泛流行的启发式搜索算法,它以地图栅格为节点,在Dijkstra算法的基础上引入代价函数,能够快速高效地搜索出从起点到终点的最短路径。如图1a和图1b所示,传统A*搜索算法需要遍历考察当前节点周围相邻的本文档来自技高网...

【技术保护点】
1.一种路径规划方法,其特征在于,包括:/n获取地图中移动目标的终点的位置;/n根据所述第一节点的位置确定在所述地图中的搜索区域;/n在所述搜索区域中获取多个采样点;/n从所述多个采样点中获取使得代价函数最小的采样点为第二节点,所述第二节点为目标路径中所述第一节点的下一个节点;/n根据所述终点的位置、所述第一节点的位置和所述第二节点的位置确定所述目标路径。/n

【技术特征摘要】
【国外来华专利技术】1.一种路径规划方法,其特征在于,包括:
获取地图中移动目标的终点的位置;
根据所述第一节点的位置确定在所述地图中的搜索区域;
在所述搜索区域中获取多个采样点;
从所述多个采样点中获取使得代价函数最小的采样点为第二节点,所述第二节点为目标路径中所述第一节点的下一个节点;
根据所述终点的位置、所述第一节点的位置和所述第二节点的位置确定所述目标路径。


2.根据权利要求1所述的方法,其特征在于,
所述根据所述第一节点的位置确定在所述地图中的搜索区域具体包括:
根据所述第一节点的位置和所述移动目标在所述第一节点的位置的航向角确定所述搜索区域。


3.根据权利要求2所述的方法,其特征在于,所述方法还包括:
获取所述移动目标在所述第一节点的位置时的动力学约束信息和/或所述第一节点的位置的周边的道路信息;
所述动力学约束信息包括以下至少一项:所述移动目标在所述第一节点的位置的速度、所述移动目标在所述第一节点的位置的航向角变化率;
所述道路信息包括以下至少一项:所述第一节点的位置周边的障碍物的位置、道路边界的位置;
所述根据所述第一节点的位置确定在所述地图中的搜索区域具体包括:
根据所述第一节点的位置和所述移动目标在所述第一节点的位置的航向角,及以下至少一项:所述动力学约束信息、所述道路信息,确定所述搜索区域。


4.根据权利要求1至3中任一项所述的方法,其特征在于,所述搜索区域在沿所述移动目标的航向角的方向上延伸的长度,与所述移动目标当前的速度正相关。


5.根据权利要求1至4中任一项所述的方法,其特征在于,所述搜索区域为扇形或者三角形。


6.根据权利要求1至5中任一项所述的方法,其特征在于,所述搜索区域为以所述第一节点的位置为边界点的区域。


7.根据权利要求6所述的方法,其特征在于,所述搜索区域的搜索角度小于或等于180度,所述搜索区域的搜索角度为过所述第一节点的两条切线构成的夹角,所述夹角包含所述移动目标在所述第一节点的位置的航向角的方向。


8.根据权利要求7所述的方法,其特征在于,所述搜索区域的搜索角度的大小与所述移动目标在所述第一节点的位置的航向角变化率正相关。


9.根据权利要求1至8中任一项所述的方法,其特征在于,
所述在所述搜索区域中获取多个采样点具体包括:
在所述搜索区域中通过随机采样获取所述多个采样点;或者,
对所述搜索区域通过系统抽样的方式获取多个采样点。


10.一种路径规划装置,其特征在于,包括:
获取单元,用于获取地图中移动目标的终点的位置;
确定单元,用于根据所述第一节点的位置确定在所述地图中的搜索区域;
所述获取单元还用于:在所述搜索区域中获取多个采样点;
所述获取单元还用于:从所述多个采样点中获取使得代价函数最小的采样点为第二节点,所述第二节点为目标路径中所述第一节点的下一个节点;...

【专利技术属性】
技术研发人员:陈可际刘亚林
申请(专利权)人:华为技术有限公司
类型:发明
国别省市:广东;44

网友询问留言 已有0条评论
  • 还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。

1