车辆路径规划方法和系统与流程
本技术涉及智能驾驶领域,具体而言,涉及一种车辆路径规划方法和系统。
背景技术:
1、在园区接驳车、景区代步车、物流配送车等低速自动驾驶车辆的局部路径规划场景中,车辆通常需要根据周围环境实时生成行驶路径,以避开障碍物并沿预定路线行驶。
2、相关技术中,路径规划方法通常需要在计算资源有限的车载平台上运行。然而,现有的路径规划方法难以兼顾计算资源利用效率与路径精度。例如,当路径搜索过程较为精细时,计算资源的消耗相应增加;当路径搜索过程较为粗略时,路径搜索结果的精度可能下降。因此,相关技术中的路径规划方法在计算资源利用效率与路径精度之间存在矛盾,难以同时满足两方面需求。
3、针对上述的问题,目前尚未提出有效的解决方案。
技术实现思路
1、本技术实施例提供了一种车辆路径规划方法和系统,以至少解决现有技术中路径规划中难以兼顾计算资源利用效率与路径精度的技术问题。
2、根据本技术实施例的一个方面,提供了一种车辆路径规划方法,包括:获取车辆在参考线上的定位信息以及车辆周围区域的障碍物信息;根据定位信息构建网格图,其中,网格图用于表征基于参考线的方向所构成的路径搜索空间;根据障碍物信息确定路径规划模式,并基于路径规划模式确定网格图的网格分辨率,其中,网格分辨率用于表征网格图的离散精度;根据网格分辨率对网格图进行离散化,得到多个网格节点,并确定多个网格节点中每个节点的障碍物代价,其中,每个节点对应车辆的一个候选位置,每个节点的障碍物代价用于表征当车辆位于该节点对应的候选位置时,车辆轮廓所覆盖区域与障碍物之间的冲突程度;基于每个节点的障碍物代价和网格图,确定车辆的目标路径。
3、示例性地,根据障碍物信息确定路径规划模式,包括:根据障碍物信息判断车辆前方是否存在障碍物;在判断车辆前方存在障碍物,且车辆的驾驶模式配置为允许绕障的情况下,确定路径规划模式为绕障模式;在判断车辆前方不存在障碍物,或车辆的驾驶模式配置为不允许绕障的情况下,确定路径规划模式为非绕障模式。
4、示例性地,车辆路径规划方法还包括:在确定路径规划模式为绕障模式之后,若在第一预设时长内未检测到车辆的前方存在障碍物,则确定障碍物已经不存在,并将路径规划模式切换至非绕障模式;在确定路径规划模式为非绕障模式之后,若在非绕障模式下未检测到车辆的可通行路径,则确定车辆处于路径阻塞状态,其中,路径阻塞状态用于表征车辆在非绕障模式下无法通行而需要停车等待;在确定车辆处于路径阻塞状态之后,若在第二预设时长内未检测到车辆的前方存在障碍物,则确定车辆从路径阻塞状态恢复为正常通行状态;其中,第一预设时长大于第二预设时长。
5、示例性地,基于路径规划模式确定网格图的网格分辨率,包括:在路径规划模式为绕障模式的情况下,确定网格图沿参考线方向的网格分辨率为第一分辨率,网格图垂直于参考线方向的网格分辨率为第二分辨率;在路径规划模式为非绕障模式的情况下,确定网格图沿参考线方向的网格分辨率为第三分辨率,网格图垂直于参考线方向的网格分辨率为第四分辨率;其中,第一分辨率大于第三分辨率,第二分辨率大于第四分辨率。
6、示例性地,基于每个节点的障碍物代价和网格图,确定车辆的目标路径,包括:根据路径规划模式确定网格图对应的中心线偏离权重、横向变化平滑权重和参考线跟踪权重;其中,中心线偏离权重用于表征每个节点的横向偏移在路径规划代价中的影响程度,横向变化平滑权重用于表征每个节点与相邻节点之间的横向偏移变化量在路径规划代价中的影响程度,参考线跟踪权重用于表征每个节点与参考横向偏移之间的偏差在路径规划代价中的影响程度,参考横向偏移为参考线在每个节点处的横向偏移目标值;基于每个节点的障碍物代价、中心线偏离权重、横向变化平滑权重、参考线跟踪权重以及网格图,确定车辆的目标路径。
7、示例性地,在路径规划模式为绕障模式的情况下,确定中心线偏离权重为第一权重、横向变化平滑权重为第二权重、参考线跟踪权重为第三权重;在路径规划模式为非绕障模式的情况下,确定中心线偏离权重为第四权重、横向变化平滑权重为第五权重、参考线跟踪权重为第六权重;第一权重小于第四权重,第二权重小于第五权重,第三权重小于第六权重。
8、示例性地,确定多个网格节点中每个节点的障碍物代价,包括:将多个网格节点中的每个节点通过坐标变换映射至占据栅格地图;其中,占据栅格地图用于表征车辆周围区域的环境信息,占据栅格地图中的每个栅格具有占据值和代价值,占据值用于表征该栅格被障碍物占据的程度,代价值用于表征该栅格作为障碍物对于车辆通行的影响程度;根据车辆轮廓模型确定在第x个节点对应的候选位置下,车辆轮廓在占据栅格地图中所覆盖的至少一个占据栅格,并将至少一个占据栅格分别对应的代价值中的最大值作为第x个节点的障碍物代价;其中,第x个节点为多个网格节点中的任意一个节点;在车辆轮廓所覆盖的至少一个占据栅格中存在占据值大于预设阈值的栅格的情况下,将第x个节点标记为不可通行。
9、示例性地,基于每个节点的障碍物代价、中心线偏离权重、横向变化平滑权重、参考线跟踪权重以及网格图,确定车辆的目标路径,包括:对网格图逐行执行动态规划递推,按照从起始行向终止行的顺序,对于第i行中的第j个节点,执行以下步骤:获取第i行第j个节点的障碍物代价,其中,i为大于1的整数,j为正整数;根据第i行第j个节点的障碍物代价、中心线偏离权重、横向变化平滑权重以及参考线跟踪权重,确定第i行第j个节点的g个候选累计代价,其中,g为第i-1行中可达节点的数量,可达节点为第i-1行中与第i行第j个节点的横向偏移之间的差值小于或等于预设横向跳变阈值的节点;将g个候选累计代价中最小的候选累计代价作为第i行第j个节点的累计代价,并将最小的候选累计代价对应的可达节点记录为第i行第j个节点的最优父节点;在动态规划递推完成后,在检测到网格图的最后一有效行中存在节点未被标记为不可通行的情况下,从最后一有效行中选取累计代价最小的节点作为路径终点,并基于所记录的每个节点的最优父节点,沿路径终点逐行向上回溯,直至到达起始行,形成初始路径;在检测到最后一有效行中所有节点均被标记为不可通行的情况下,确定车辆处于路径阻塞状态;根据初始路径确定车辆的目标路径。
10、示例性地,根据第i行第j个节点的障碍物代价、中心线偏离权重、横向变化平滑权重以及参考线跟踪权重,确定第i行第j个节点的g个候选累计代价,包括:对于第i-1行中的第k个可达节点,根据第i行第j个节点的横向偏移、第i-1行第k个可达节点的横向偏移、第k个可达节点的最优父节点的横向偏移以及中心线偏离权重、横向变化平滑权重、参考线跟踪权重,确定从第k个可达节点转移至第j个节点的横向转移代价;根据第i行第j个节点的障碍物代价、第i-1行第k个可达节点的累计代价以及横向转移代价,确定第i行第j个节点的第k个候选累计代价,其中,k依次取1至g,得到g个候选累计代价。
11、示例性地,根据初始路径确定车辆的目标路径,包括:遍历初始路径中沿路径方向相邻的路径点;对于初始路径中的每两个相邻的路径点,确定该两个相邻的路径点之间的纵向里程差和横向偏移变化量,其中,纵向里程差为该两个相邻的路径点对应的纵向里程之差,纵向里程为沿参考线方向从参考线起点至路径点的距离,横向偏移变化量为该两个相邻的路径点对应的横向偏移之差,横向偏移为垂直于参考线方向的偏移量;在初始路径中存在纵向里程差小于第一阈值且横向偏移变化量大于第二阈值的相邻路径点的情况下,将初始路径确定为非目标路径;其中,在上一路径规划周期输出了目标路径的情况下,维持车辆沿上一路径规划周期输出的目标路径行驶;在上一路径规划周期未输出目标路径,或者不存在上一路径规划周期的情况下,触发紧急停车;在初始路径中不存在纵向里程差小于第一阈值且横向偏移变化量大于第二阈值的相邻路径点的情况下,将初始路径作为车辆的目标路径。
12、根据本技术实施例的另一方面,还提供了一种车辆路径规划系统,包括:获取模块,用于获取车辆在参考线上的定位信息以及车辆周围区域的障碍物信息;构建模块,用于根据定位信息构建网格图,其中,网格图用于表征基于参考线的方向所构成的路径搜索空间;模式确定模块,用于根据障碍物信息确定路径规划模式,并基于路径规划模式确定网格图的网格分辨率;其中,网格分辨率用于表征网格图的离散精度;代价确定模块,用于根据网格分辨率对网格图进行离散化,得到多个网格节点,并确定多个网格节点中每个节点的障碍物代价,其中,每个节点对应车辆的一个候选位置,每个节点的障碍物代价用于表征当车辆位于该节点对应的候选位置时,车辆轮廓所覆盖区域与障碍物之间的冲突程度;路径确定模块,用于基于每个节点的障碍物代价和网格图,确定车辆的目标路径。
13、在本技术实施例中,根据障碍物信息确定路径规划模式,并基于路径规划模式确定网格图的网格分辨率,由此,网格分辨率与障碍物信息之间通过路径规划模式建立了关联,网格分辨率可以随障碍物信息的变化而变化,而不再保持固定。网格分辨率表征网格图的离散精度,离散精度越高,按照网格分辨率对网格图进行离散化后得到的网格节点数量相对越多;离散精度越低,按照网格分辨率对网格图进行离散化后得到的网格节点数量相对越少。在确定多个网格节点中每个节点的障碍物代价以及基于每个节点的障碍物代价和网格图确定车辆的目标路径的过程中,网格节点数量影响计算资源的消耗,网格节点的离散精度影响目标路径的精度。因此,在障碍物信息表明需要较高路径精度的情况下,可以基于路径规划模式确定较高的网格分辨率,从而有利于改善目标路径的精度;在障碍物信息表明可以接受较低路径精度的情况下,可以基于路径规划模式确定较低的网格分辨率,从而有利于减少网格节点的数量,进而有利于降低计算资源的消耗。通过根据障碍物信息确定路径规划模式,并基于路径规划模式确定网格分辨率,使网格分辨率能够适应障碍物信息所表征的场景,从而有利于平衡计算资源利用效率与路径精度,进而解决了现有技术中路径规划中难以兼顾计算资源利用效率与路径精度的技术问题。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com