本发明专利技术公开了一种车辆的路径规划方法及装置、存储介质、车辆、终端,涉及自动驾驶技术领域,主要目的在于解决现有车辆的路径规划效率差的问题。包括:获取车辆在第一坐标系下的轨迹里程信息;在第二坐标系下构建与所述轨迹里程信息匹配的车辆包络模型,并根据所述车辆包络模型确定所述车辆与障碍物之间的干涉关系;在根据所述干涉关系确定所述车辆与所述障碍物发生碰撞条件下,基于所述干涉关系在所述第一坐标系下确定发生碰撞的轨迹点信息,并根据所述轨迹点信息进行路径规划。
【技术实现步骤摘要】
本专利技术涉及智能驾驶,特别是涉及一种车辆的路径规划方法及装置、存储介质、车辆、终端。
技术介绍
1、随着智能化驾驶技术的快速发展,对车辆行驶过程的控制越来越精细化。其中,车辆在行驶过程中通常在弗朗内特(frenet)坐标系下进行纵向规划,规划出车辆自动行驶的路径。
2、目前,现有在frenet坐标系下进行纵向路径规划时通常基于车辆在参考路径上的投影来规划在不同曲率转弯场景中的路径,然而,由于在大曲率转弯场景中,相距不同位置的障碍物在frenet坐标系下于车辆的投影距离相同,使得车辆与障碍物的投影无法有效的确认是否发生碰撞,大大降低了碰撞检测的准确性,产生较大的碰撞风险,从而降低了车辆的路径规划有效性。
技术实现思路
1、有鉴于此,本专利技术提供一种车辆的路径规划方法及装置、存储介质、车辆、终端,主要目的在于解决现有车辆的路径规划效率差的问题。
2、依据本专利技术一个方面,提供了一种车辆的路径规划方法,包括:
3、获取车辆在第一坐标系下的轨迹里程信息;
4、在第二坐标系下构建与所述轨迹里程信息匹配的车辆包络模型,并根据所述车辆包络模型确定所述车辆与障碍物之间的干涉关系;
5、在根据所述干涉关系确定所述车辆与所述障碍物发生碰撞条件下,基于所述干涉关系在所述第一坐标系下确定发生碰撞的轨迹点信息,并根据所述轨迹点信息进行路径规划。
6、进一步地,所述在第二坐标系下构建与所述轨迹里程信息匹配的车辆包络模型包括:
7、将所述第一坐标系下的轨迹里程信息转换为在所述第二坐标系下的车辆轮廓模型;
8、基于所述车辆的速度影响系数、车速、预设速度膨胀系数、曲率影响系数、轨迹曲率、预设曲率膨胀系数确定延伸长度;
9、在所述车辆轮廓模型的纵向方向上,按照所述延伸长度对所述车辆轮廓模型进行延伸构建,得到所述车辆包络模型。
10、进一步地,所述基于所述车辆的速度影响系数、车速、预设速度膨胀系数、曲率影响系数、轨迹曲率、预设曲率膨胀系数确定延伸长度包括:
11、从所述速度影响系数与所述车速的点乘值、所述预设速度膨胀系数中选取最大速度系数,并从所述曲率影响系数与所述轨迹曲率的点乘值、所述预设曲率膨胀系数中选取最大曲率系数;
12、根据所述最大速度系数与所述最大曲率系数的和运算,得到所述延伸长度。
13、进一步地,所述根据所述车辆包络模型确定所述车辆与障碍物之间的干涉关系包括:
14、获取所述障碍物在所述第二坐标系下的障碍物轮廓信息;
15、计算所述障碍物轮廓信息与所述车辆包络模型之间的重叠信息,并基于所述重叠信息确定干涉关系,所述干涉关系包括重叠干涉、非重叠干涉;
16、所述根据所述车辆包络模型确定所述车辆与障碍物之间的干涉关系之后,所述方法还包括:
17、若所述干涉关系为重叠干涉,则确定所述车辆与所述障碍物发生碰撞。
18、进一步地,所述基于所述干涉关系在所述第一坐标系下确定发生碰撞的轨迹点信息包括:
19、基于所述重叠信息将所述车辆在所述第二坐标系下发生碰撞的位置转换至所述第一坐标系下;
20、在所述第一坐标系下根据所述位置生成发生碰撞的轨迹点信息,所述轨迹点信息包括轨迹点索引以及碰撞轨迹里程信息。
21、进一步地,所述获取车辆在第一坐标系下的轨迹里程信息包括:
22、在所述第一坐标系下,获取预设规划帧中所述车辆横向轨迹规划的参考轨迹;
23、根据所述参考轨迹计算各轨迹点的轨迹里程信息。
24、进一步地,所述根据所述轨迹点信息进行路径规划包括:
25、在所述第一坐标系下,根据所述轨迹点信息中最小的碰撞轨迹里程信息更新用于纵向路径规划决策的路径边界;
26、根据更新后的所述路径边界进行纵向路径轨迹规划。
27、依据本专利技术另一个方面,提供了一种车辆的路径规划装置,包括:
28、获取模块,用于获取车辆在第一坐标系下的轨迹里程信息;
29、确定模块,用于在第二坐标系下构建与所述轨迹里程信息匹配的车辆包络模型,并根据所述车辆包络模型确定所述车辆与障碍物之间的干涉关系;
30、规划模块,用于在根据所述干涉关系确定所述车辆与所述障碍物发生碰撞条件下,基于所述干涉关系在所述第一坐标系下确定发生碰撞的轨迹点信息,并根据所述轨迹点信息进行路径规划。
31、进一步地,所述确定模块包括:
32、转换单元,用于将所述第一坐标系下的轨迹里程信息转换为在所述第二坐标系下的车辆轮廓模型;
33、确定单元,用于基于所述车辆的速度影响系数、车速、预设速度膨胀系数、曲率影响系数、轨迹曲率、预设曲率膨胀系数确定延伸长度;
34、构建单元,用于在所述车辆轮廓模型的纵向方向上,按照所述延伸长度对所述车辆轮廓模型进行延伸构建,得到所述车辆包络模型。
35、进一步地,所述确定单元,具体用于从所述速度影响系数与所述车速的点乘值、所述预设速度膨胀系数中选取最大速度系数,并从所述曲率影响系数与所述轨迹曲率的点乘值、所述预设曲率膨胀系数中选取最大曲率系数;根据所述最大速度系数与所述最大曲率系数的和运算,得到所述延伸长度。
36、进一步地,所述确定模块,具体用于获取所述障碍物在所述第二坐标系下的障碍物轮廓信息;计算所述障碍物轮廓信息与所述车辆包络模型之间的重叠信息,并基于所述重叠信息确定干涉关系,所述干涉关系包括重叠干涉、非重叠干涉;
37、所述确定模块,还用于若所述干涉关系为重叠干涉,则确定所述车辆与所述障碍物发生碰撞。
38、进一步地,所述规划模块包括:
39、转换单元,用于基于所述重叠信息将所述车辆在所述第二坐标系下发生碰撞的位置转换至所述第一坐标系下;
40、生成单元,用于在所述第一坐标系下根据所述位置生成发生碰撞的轨迹点信息,所述轨迹点信息包括轨迹点索引以及碰撞轨迹里程信息。
41、进一步地,所述获取模块,具体用于在所述第一坐标系下,获取预设规划帧中所述车辆横向轨迹规划的参考轨迹;根据所述参考轨迹计算各轨迹点的轨迹里程信息。
42、进一步地,所述规划模块还包括:
43、更新单元,用于在所述第一坐标系下,根据所述轨迹点信息中最小的碰撞轨迹里程信息更新用于纵向路径规划决策的路径边界;
44、规划单元,用于根据更新后的所述路径边界进行纵向路径轨迹规划。
45、依据本专利技术一个方面,提供了一种车辆,包括上述车辆的路径规划装置。
46、根据本专利技术的一方面,提供了一种存储介质,所述存储介质中存储有至少一可执行指令,所述可执行指令使处理器执行如上述车辆的路径规划方法对应的操作。
47、根据本专利技术的一方面,提供了一种终端,包括:处理器、存储器、通信接口和通信总本文档来自技高网
...
【技术保护点】
1.一种车辆的路径规划方法,其特征在于,包括:
2.根据权利要求1所述的方法,其特征在于,所述在第二坐标系下构建与所述轨迹里程信息匹配的车辆包络模型包括:
3.根据权利要求2所述的方法,其特征在于,所述基于所述车辆的速度影响系数、车速、预设速度膨胀系数、曲率影响系数、轨迹曲率、预设曲率膨胀系数确定延伸长度包括:
4.根据权利要求1所述的方法,其特征在于,所述根据所述车辆包络模型确定所述车辆与障碍物之间的干涉关系包括:
5.根据权利要求4所述的方法,其特征在于,所述基于所述干涉关系在所述第一坐标系下确定发生碰撞的轨迹点信息包括:
6.根据权利要求1-5任一项所述的方法,其特征在于,所述获取车辆在第一坐标系下的轨迹里程信息包括:
7.根据权利要求6所述的方法,其特征在于,所述根据所述轨迹点信息进行路径规划包括:
8.一种车辆的路径规划装置,其特征在于,包括:
9.一种车辆,其特征在于,包括权利要求8所述的车辆的路径规划装置。
10.一种存储介质,所述存储介质中存储有至少一可执行指令,所述可执行指令使处理器执行如权利要求1-7中任一项所述的用于车辆的路径规划方法对应的操作。
11.一种终端,包括:处理器、存储器、通信接口和通信总线,所述处理器、所述存储器和所述通信接口通过所述通信总线完成相互间的通信;
...
【技术特征摘要】
1.一种车辆的路径规划方法,其特征在于,包括:
2.根据权利要求1所述的方法,其特征在于,所述在第二坐标系下构建与所述轨迹里程信息匹配的车辆包络模型包括:
3.根据权利要求2所述的方法,其特征在于,所述基于所述车辆的速度影响系数、车速、预设速度膨胀系数、曲率影响系数、轨迹曲率、预设曲率膨胀系数确定延伸长度包括:
4.根据权利要求1所述的方法,其特征在于,所述根据所述车辆包络模型确定所述车辆与障碍物之间的干涉关系包括:
5.根据权利要求4所述的方法,其特征在于,所述基于所述干涉关系在所述第一坐标系下确定发生碰撞的轨迹点信息包括:
6.根据权利要求1-5...
【专利技术属性】
技术研发人员:王斌,王睿,刘偲,冉旭,
申请(专利权)人:魔门塔苏州科技有限公司,
类型:发明
国别省市:
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。