[发明专利]一种车辆的路径规划方法、装置、设备及介质在审
| 申请号: | 202210114333.1 | 申请日: | 2022-01-30 |
| 公开(公告)号: | CN114442634A | 公开(公告)日: | 2022-05-06 |
| 发明(设计)人: | 高原;刘金波;张建;刘秋铮;王宇;袁文建;周添 | 申请(专利权)人: | 中国第一汽车股份有限公司 |
| 主分类号: | G05D1/02 | 分类号: | G05D1/02 |
| 代理公司: | 北京远智汇知识产权代理有限公司 11659 | 代理人: | 刘欣 |
| 地址: | 130011 吉林省长*** | 国省代码: | 吉林;22 |
| 权利要求书: | 查看更多 | 说明书: | 查看更多 |
| 摘要: | |||
| 搜索关键词: | 一种 车辆 路径 规划 方法 装置 设备 介质 | ||
1.一种车辆的路径规划方法,其特征在于,包括:
根据车辆起点、车辆终点以及障碍物的位置信息,通过第一路径规划算法确定从车辆起点至车辆终点距离最近的第一路径;
从所述第一路径中的各个第一路径节点中确定至少一个目标节点,并根据相邻的目标节点确定至少一个连通的第二路径;
采用第二路径规划算法分别对各所述第二路径进行路径规划,以确定所述车辆的行驶路径。
2.根据权利要求1所述的方法,其特征在于,采用第二路径规划算法分别对各所述第二路径进行路径规划,包括:
对于任一第二路径,确定该第二路径的起始路径节点和结束路径节点;
确定与所述起始路径节点关联的结束路径节点引力、第二路径引力、障碍物斥力以及道路边界斥力;
将所述结束路径节点引力、第二路径引力、障碍物斥力以及道路边界斥力的合力作为所述起始路径节点的合力;
根据所述起始路径节点的合力以及预设步长确定下一个第二路径节点;
若确定下一个第二路径节点不是该第二路径的结束路径节点,则将下一个第二路径节点作为起始路径节点,并返回执行确定与所述起始路径节点关联的结束路径节点引力、第二路径引力、障碍物斥力以及道路边界斥力,直至下一个第二路径节点为该第二路径的结束路径节点。
3.根据权利要求2所述的方法,其特征在于,根据所述起始路径节点的合力以及预设步长确定下一个第二路径节点,包括:
根据所述起始路径节点的合力以及预设步长确定规划半径;
确定所述规划半径是否小于车辆的最小转弯半径;
若是,则确定车辆的最小转弯半径为目标半径;
若否,则确定所述规划半径为目标半径;
根据所述起始路径节点、目标半径以及预设步长确定下一个第二路径节点。
4.根据权利要求3所述的方法,其特征在于,根据所述起始路径节点、目标半径以及预设步长确定下一个第二路径节点,包括:
根据目标半径确定目标角度;
根据所述目标角度以及所述预设步长确定所述预设步长在第一坐标轴上的第一步长以及所述预设步长在第二坐标轴上的第二步长;
根据所述起始路径节点分别确定所述起始路径节点在第一坐标轴上的第一分量以及所述起始路径节点在第二坐标轴上的第二分量;
将所述第一步长与第一分量的和作为所述下一个第二路径节点的第一目标分量,并将所述第二步长与第二分量的和作为所述下一个第二路径节点的第二目标分量。
5.根据权利要求1所述的方法,其特征在于,从所述第一路径中的各个第一路径节点中确定至少一个目标节点,包括:
将各所述第一路径节点中的至少一个航向角突变点作为候选目标节点;
对于任一个候选目标节点,将其后的与该候选目标节点连通的其他候选目标节点以及该候选目标节点作为目标节点。
6.根据权利要求5所述的方法,其特征在于,对于任一个候选目标节点,将其后的与该候选目标节点连通的其他候选目标节点以及该候选目标节点作为目标节点,包括:
对于任一个候选目标节点,将其后的与该候选目标节点连通的其他候选目标节点以及该候选目标节点作为中间目标节点;
对于任意三个相邻的中间目标节点,若确定不相邻的两个中间目标节点的距离小于预设距离,则将所述不相邻的两个中间目标节点作为目标节点。
7.根据权利要求5所述的方法,其特征在于,航向角突变点的确定过程,包括:
确定与任一第一路径节点相邻的第一相邻路径节点以及第二相邻路径节点;
根据该第一路径节点与第一相邻路径节点确定第一斜率;
根据该第一路径节点与第二相邻路径节点确定第二斜率;
根据所述第一斜率与所述第二斜率确定该第一路径节点的斜率差;
若所述斜率差不为0,则确定该第一路径节点为航向角突变点。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于中国第一汽车股份有限公司,未经中国第一汽车股份有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202210114333.1/1.html,转载请声明来源钻瓜专利网。





