掉头路径规划方法、装置、电子设备及存储介质与流程

文档序号:32784047发布日期:2022-12-31 19:05阅读:220来源:国知局
技术简介:
本专利针对车辆掉头时路径规划不合理、易与障碍物碰撞的问题,提出基于边界点位置信息动态确定目标掉头起点、中间点和终点的方法,并结合预设路径规划算法生成避障路径,提升掉头灵活性与安全性。通过横向/纵向偏移量计算和多方向步长调整机制,实现复杂路况下的自适应路径优化。
关键词:掉头路径规划,障碍物避让

1.本发明涉及路径规划领域,具体涉及一种掉头路径规划方法、装置、电子设备及存储介质。


背景技术:

2.随着自动驾驶的发展,在封闭或者半封闭的非结构化道路中l4级别的自动驾驶越来越有实际落地的需求,而根据不同掉头口的大小进行自动掉头是常见的场景。
3.现有的掉头技术,通常是像农用机械一样,采用导航自动循迹模型,实现掉头。但是上述方法,并不能实现针对不同掉头口的大小进行自动掉头。


技术实现要素:

4.有鉴于此,本发明实施例提供了一种掉头路径规划方法,旨在解决现有技术不能实现针对不同掉头口的大小进行自动掉头的问题。
5.根据第一方面,本发明实施例提供了一种掉头路径规划方法,包括:获取目标车辆对应的掉头区域,并获取掉头区域中的第一掉头边界点对应的第一位置信息以及第二掉头边界点对应的第二位置信息;其中,第一掉头边界点是指目标车辆掉头过程中先经过的掉头边界点,第二掉头边界点是指目标车辆掉头过程中不需要经过的掉头边界点;根据第一位置信息与第二位置信息之间的关系,确定掉头区域对应的目标掉头起点;当目标车辆从目标车辆的第一当前位置行驶至目标掉头起点或者目标车辆在行驶至目标掉头起点的过程中,遇到障碍物在停障位置的停障时间超过预设时间阈值时,根据第一位置信息与第二位置信息之间的关系,确定掉头区域对应的目标掉头中间点以及目标掉头终点;其中,停障位置是指目标车辆遇到障碍物之后停下的位置;利用预设路径规划算法规划目标车辆从目标掉头起点或者停障位置到目标掉头中间点的第一规划路径以及从目标掉头中间点到目标掉头终点的第二规划路径。
6.本发明实施例提供的掉头路径规划方法,获取目标车辆对应的掉头区域,并获取掉头区域中的第一掉头边界点对应的第一位置信息以及第二掉头边界点对应的第二位置信息,然后,根据第一位置信息与第二位置信息之间的关系,确定掉头区域对应的目标掉头起点,保证了确定的掉头区域对应的目标掉头起点的准确性。当目标车辆从目标车辆的第一当前位置行驶至目标掉头起点或者目标车辆在行驶至目标掉头起点的过程中,遇到障碍物在停障位置的停障时间超过预设时间阈值时,根据第一位置信息与第二位置信息之间的关系,确定掉头区域对应的目标掉头中间点以及目标掉头终点,保证了确定的掉头区域对应的目标掉头中间点以及目标掉头终点的准确性。然后,利用预设路径规划算法规划目标车辆从目标掉头起点或者停障位置到目标掉头中间点的第一规划路径以及从目标掉头中间点到目标掉头终点的第二规划路径,保证了规划得到的第一规划路径和第二规划路径的
准确性。上述方法,可以根据第一掉头边界点对应的第一位置信息以及第二掉头边界点对应的第二位置信息,确定目标掉头起点、目标掉头中间点以及目标掉头终点,并规划了掉头路径,从而可以实现在任何掉头路口进行掉头,提高了目标车辆进行掉头的灵活性。
7.结合第一方面,在第一方面第一实施方式中,第一位置信息包括第一掉头边界点对应的第一坐标信息以及第一航向角信息,第二位置信息包括第二掉头边界点对应的第二坐标信息以及第二航向角信息;其中,第一航向角是指第一掉头边界点指向第二掉头边界点的方向角,第二航向角等于第一航向角;根据第一位置信息与第二位置信息之间的关系,确定掉头区域对应的目标掉头起点,包括:根据第一位置信息以及第二位置信息,确定第一掉头边界点与第二掉头边界点之间的掉头边界距离;根据初始掉头起点相对于第一掉头边界点的横向偏移量、纵向偏移量以及航向角偏移量分别与掉头边界距离之间的对应关系,确定初始掉头起点相对于第一掉头边界点的第一横向偏移量、第一纵向偏移量以及第一航向角偏移量;根据第一横向偏移量、第一纵向偏移量以及第一航向角偏移量与第一位置信息之间的关系,确定掉头区域对应的初始掉头起点对应的第三位置信息;利用预设路径规划算法规划从目标车辆的第一当前位置到初始掉头起点的初始规划路径;当目标车辆根据初始规划路径行驶不会发生碰撞时,将初始掉头起点确定为目标掉头起点。
8.本发明实施例提供的掉头路径规划方法,根据第一位置信息以及第二位置信息,确定第一掉头边界点与第二掉头边界点之间的掉头边界距离,保证了确定的掉头边界距离的准确性。根据初始掉头起点相对于第一掉头边界点的横向偏移量、纵向偏移量以及航向角偏移量分别与掉头边界距离之间的对应关系,确定初始掉头起点相对于第一掉头边界点的第一横向偏移量、第一纵向偏移量以及第一航向角偏移量,保证了确定的第一横向偏移量、第一纵向偏移量以及第一航向角偏移量的准确性。然后,根据第一横向偏移量、第一纵向偏移量以及第一航向角偏移量与第一位置信息之间的关系,确定掉头区域对应的初始掉头起点对应的第三位置信息,保证了确定的掉头区域对应的初始掉头起点对应的第三位置信息的准确性,利用预设路径规划算法规划从目标车辆的第一当前位置到初始掉头起点的初始规划路径,保证了规划的初始规划路径的准确性。当目标车辆根据初始规划路径行驶不会发生碰撞时,将初始掉头起点确定为目标掉头起点,保证了确定的目标掉头起点的准确性,且避免了目标车辆从第一当前位置行驶至目标掉头起点发生碰撞。
9.结合第一方面第一实施方式,在第一方面第二实施方式中,方法还包括:当目标车辆根据初始规划路径行驶会发生碰撞时,沿第一预设方向,以第一预设步长移动初始掉头起点,得到第一候选掉头起点;利用预设路径规划算法规划从目标车辆的第一当前位置到第一候选掉头起点的第一候选规划路径;当目标车辆根据第一候选规划路径行驶不会发生碰撞时,将第一候选掉头起点确定为目标掉头起点;如此循环,直至道路边界,当不存在目标车辆根据第一候选规划路径行驶不会发
生碰撞的第一候选规划路径时,沿第二预设方向,以第一预设步长移动初始掉头起点,得到第二选掉头起点;利用预设路径规划算法规划从目标车辆的第一当前位置到第二候选掉头起点的第二候选规划路径;当存在目标车辆根据第二候选规划路径行驶不会发生碰撞时,将第二候选掉头起点确定为目标掉头起点。
10.本发明实施例提供的掉头路径规划方法,当目标车辆根据初始规划路径行驶会发生碰撞时,沿第一预设方向,以第一预设步长移动初始掉头起点,得到第一候选掉头起点,保证了得到的第一候选掉头起点的准确性。利用预设路径规划算法规划从目标车辆的第一当前位置到第一候选掉头起点的第一候选规划路径,保证了规划得到的第一候选规划路径的准确性。当目标车辆根据第一候选规划路径行驶不会发生碰撞时,将第一候选掉头起点确定为目标掉头起点,保证了确定的目标掉头起点的准确性,且避免了目标车辆从第一当前位置行驶至目标掉头起点发生碰撞。如此循环,直至道路边界,当不存在目标车辆根据第一候选规划路径行驶不会发生碰撞的第一候选规划路径时,沿第二预设方向,以第一预设步长移动初始掉头起点,得到第二选掉头起点,保证了得到的第二选掉头起点的准确性。利用预设路径规划算法规划从目标车辆的第一当前位置到第二候选掉头起点的第二候选规划路径,保证了规划的第二候选规划路径的准确性。当存在目标车辆根据第二候选规划路径行驶不会发生碰撞时,将第二候选掉头起点确定为目标掉头起点。
11.结合第一方面第一实施方式,在第一方面第三实施方式中,根据第一位置信息与第二位置信息之间的关系,确定掉头区域对应的目标掉头中间点以及目标掉头终点,包括:根据初始掉头中间点相对于第一掉头边界点的横向偏移量、纵向偏移量以及航向角偏移量分别与掉头边界距离之间的对应关系,确定初始掉头中间点相对于第一掉头边界点的第二横向偏移量、第二纵向偏移量以及第二航向角偏移量;根据第二横向偏移量、第二纵向偏移量以及第二航向角偏移量与第一位置信息之间的关系,确定掉头区域对应的初始掉头中间点对应的第四位置信息;同理,确定掉头区域对应的初始掉头终点对应的第五位置信息;获取掉头区域中各个目标障碍物对应的目标障碍物位置信息;根据第四位置信息与目标障碍物位置信息之间的关系,确定掉头区域对应的目标掉头中间点;同理,根据第五位置信息与目标障碍物位置信息之间的关系,确定掉头区域对应的目标掉头终点。
12.本发明实施例提供的掉头路径规划方法,根据初始掉头中间点相对于第一掉头边界点的横向偏移量、纵向偏移量以及航向角偏移量分别与掉头边界距离之间的对应关系,确定初始掉头中间点相对于第一掉头边界点的第二横向偏移量、第二纵向偏移量以及第二航向角偏移量,保证了确定的初始掉头中间点相对于第一掉头边界点的第二横向偏移量、第二纵向偏移量以及第二航向角偏移量的准确性。根据第二横向偏移量、第二纵向偏移量以及第二航向角偏移量与第一位置信息之间的关系,确定掉头区域对应的初始掉头中间点对应的第四位置信息,保证了确定的掉头区域对应的初始掉头中间点对应的第四位置信息的准确性。同理,保证了确定的掉头区域对应的初始掉头终点对应的第五位置信息的准确
性。获取掉头区域中各个目标障碍物对应的目标障碍物位置信息;根据第四位置信息与目标障碍物位置信息之间的关系,确定掉头区域对应的目标掉头中间点,保证了确定的掉头区域对应的目标掉头中间点的准确性。同理,根据第五位置信息与目标障碍物位置信息之间的关系,确定掉头区域对应的目标掉头终点,保证了确定的掉头区域对应的目标掉头终点的准确性。
13.结合第一方面第三实施方式,在第一方面第四实施方式中,根据第四位置信息与目标障碍物位置信息之间的关系,确定掉头区域对应的目标掉头中间点,包括:根据第四位置信息与目标障碍物位置信息,确定当目标车辆行驶至初始掉头中间点,不会与目标障碍物发生碰撞时,将初始掉头中间点确定为目标掉头中间点;当目标车辆行驶至初始掉头中间点,会与目标障碍物发生碰撞时,沿第三预设方向,以第二预设步长移动初始掉头中间点,得到候选掉头中间点;当目标车辆行驶至候选掉头中间点,不会与目标障碍物发生碰撞时,将候选掉头中间点确定为目标掉头中间点。
14.本发明实施例提供的掉头路径规划方法,根据第四位置信息与目标障碍物位置信息,确定当目标车辆行驶至初始掉头中间点,不会与目标障碍物发生碰撞时,将初始掉头中间点确定为目标掉头中间点,保证了确定的目标掉头中间点的准确性。当目标车辆行驶至初始掉头中间点,会与目标障碍物发生碰撞时,沿第三预设方向,以第二预设步长移动初始掉头中间点,得到候选掉头中间点,保证了确定的候选掉头中间点的准确性。当目标车辆行驶至候选掉头中间点,不会与目标障碍物发生碰撞时,将候选掉头中间点确定为目标掉头中间点,保证了确定的目标掉头中间点的准确性。
15.结合第一方面第三实施方式,在第一方面第五实施方式中,根据第五位置信息与目标障碍物位置信息之间的关系,确定掉头区域对应的目标掉头终点,包括:根据第五位置信息与目标障碍物位置信息,确定当目标车辆行驶至初始掉头终点,不会与目标障碍物发生碰撞时,将初始掉头终点确定为目标掉头终点;当目标车辆行驶至初始掉头终点时,会与目标障碍物发生碰撞时,沿第一预设方向,以第三预设步长移动初始掉头终点,得到第一候选掉头终点;当目标车辆行驶至第一候选掉头终点,不会与目标障碍物发生碰撞时,将第一候选掉头终点确定为目标掉头终点;如此循环,直至道路边界,当不存在目标车辆行驶至第一候选掉头终点,不会与目标障碍物发生碰撞时,沿第二预设方向,以第三预设步长移动初始掉头终点,得到第二候选掉头终点;当目标车辆行驶至第二候选掉头终点,不会与目标障碍物发生碰撞时,将第二候选掉头终点确定为目标掉头终点。
16.本发明实施例提供的掉头路径规划方法,根据第五位置信息与目标障碍物位置信息,确定当目标车辆行驶至初始掉头终点,不会与目标障碍物发生碰撞时,将初始掉头终点确定为目标掉头终点,保证了确定的目标掉头终点的准确性。当目标车辆行驶至初始掉头终点时,会与目标障碍物发生碰撞时,沿第一预设方向,以第三预设步长移动初始掉头终点,得到第一候选掉头终点,保证了得到的第一候选掉头终点的准确性。当目标车辆行驶至第一候选掉头终点,不会与目标障碍物发生碰撞时,将第一候选掉头终点确定为目标掉头
终点,保证了确定的目标掉头终点的准确性。如此循环,直至道路边界,当不存在目标车辆行驶至第一候选掉头终点,不会与目标障碍物发生碰撞时,沿第二预设方向,以第三预设步长移动初始掉头终点,得到第二候选掉头终点,保证了得到的各个候选掉头终点的准确性。当目标车辆行驶至第二候选掉头终点,不会与目标障碍物发生碰撞时,将第二候选掉头终点确定为目标掉头终点,保证了确定的目标掉头终点的准确性。
17.结合第一方面,在第一方面第六实施方式中,上述方法还包括:当目标车辆按照第一规划路径和第二规划路径行驶过程中,遇到障碍物停止,且停止时间大于预设停止时长阈值时,获取目标车辆当前停止的第二当前位置;当根据第二当前位置以及目标掉头中间点的位置,确定目标车辆未经过目标掉头中间点时,重新规划第一规划路径以及第二规划路径;当根据第二当前位置以及目标掉头中间点的位置,确定目标车辆已经过目标掉头中间点时,重新规划第二规划路径。
18.本发明实施例提供的掉头路径规划方法,当目标车辆按照第一规划路径和第二规划路径行驶过程中,遇到障碍物停止,且停止时间大于预设停止时长阈值时,获取目标车辆当前停止的第二当前位置,保证了获取到的第二当前位置的准确性。当根据第二当前位置以及目标掉头中间点的位置,确定目标车辆未经过目标掉头中间点时,重新规划第一规划路径以及第二规划路径,保证了重新规划得到的第一规划路径以及第二规划路径的准确性。当根据第二当前位置以及目标掉头中间点的位置,确定目标车辆已经过目标掉头中间点时,重新规划第二规划路径,保证了重新规划得到的第二规划路径的准确。
19.根据第二方面,本发明实施例还提供了一种掉头路径规划装置,包括:第一获取模块,用于获取目标车辆对应的掉头区域,并获取掉头区域中的第一掉头边界点对应的第一位置信息以及第二掉头边界点对应的第二位置信息;其中,第一掉头边界点是指目标车辆掉头过程中先经过的掉头边界点,第二掉头边界点是指目标车辆掉头过程中不需要经过的掉头边界点;第一确定模块,用于根据第一位置信息与第二位置信息之间的关系,确定掉头区域对应的目标掉头起点;第二确定模块,当目标车辆从目标车辆的第一当前位置行驶至目标掉头起点或者目标车辆在行驶至目标掉头起点的过程中,遇到障碍物在停障位置的停障时间超过预设时间阈值时,根据第一位置信息与第二位置信息之间的关系,确定掉头区域对应的目标掉头中间点以及目标掉头终点;其中,停障位置是指目标车辆遇到障碍物之后停下的位置;第一规划模块,用于利用预设路径规划算法规划目标车辆从目标掉头起点或者停障位置到目标掉头中间点的第一规划路径以及从目标掉头中间点到目标掉头终点的第二规划路径。
20.本发明实施例提供的掉头路径规划装置,获取目标车辆对应的掉头区域,并获取掉头区域中的第一掉头边界点对应的第一位置信息以及第二掉头边界点对应的第二位置信息,然后,根据第一位置信息与第二位置信息之间的关系,确定掉头区域对应的目标掉头起点,保证了确定的掉头区域对应的目标掉头起点的准确性。当目标车辆从目标车辆的第一当前位置行驶至目标掉头起点或者目标车辆在行驶至目标掉头起点的过程中,遇到障碍物在停障位置的停障时间超过预设时间阈值时,根据第一位置信息与第二位置信息之间的
关系,确定掉头区域对应的目标掉头中间点以及目标掉头终点,保证了确定的掉头区域对应的目标掉头中间点以及目标掉头终点的准确性。然后,利用预设路径规划算法规划目标车辆从目标掉头起点或者停障位置到目标掉头中间点的第一规划路径以及从目标掉头中间点到目标掉头终点的第二规划路径,保证了规划得到的第一规划路径和第二规划路径的准确性。上述装置,可以根据第一掉头边界点对应的第一位置信息以及第二掉头边界点对应的第二位置信息,确定目标掉头起点、目标掉头中间点以及目标掉头终点,并规划了掉头路径,从而可以实现在任何掉头路口进行掉头,提高了目标车辆进行掉头的灵活性。
21.根据第三方面,本发明实施例提供了一种电子设备,包括存储器和处理器,存储器和处理器之间互相通信连接,存储器中存储有计算机指令,处理器通过执行计算机指令,从而执行第一方面或者第一方面的任意一种实施方式中的掉头路径规划方法。
22.根据第四方面,本发明实施例提供了一种计算机可读存储介质,计算机可读存储介质存储计算机指令,计算机指令用于使计算机执行第一方面或者第一方面的任意一种实施方式中的掉头路径规划方法。
附图说明
23.为了更清楚地说明本发明具体实施方式或现有技术中的技术方案,下面将对具体实施方式或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图是本发明的一些实施方式,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
24.图1 是应用本发明实施例提供的掉头路径规划方法的流程图;图2 是应用本发明另一实施例提供的掉头路径规划的示意图;图3是应用本发明另一实施例提供的掉头路径规划方法的流程图;图4是应用本发明另一实施例提供的掉头路径规划方法的流程图;图5是应用本发明另一实施例提供的掉头路径规划方法的流程图;图6是应用本发明实施例提供的掉头路径规划装置的功能模块图;图7是应用本发明实施例提供的掉头路径规划装置的功能模块图;图8是应用本发明实施例提供的电子设备的硬件结构示意图。
具体实施方式
25.为使本发明实施例的目的、技术方案和优点更加清楚,下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
26.需要说明的是,本技术实施例提供的掉头路径规划的方法,其执行主体可以是掉头路径规划的装置,该掉头路径规划的装置可以通过软件、硬件或者软硬件结合的方式实现成为电子设备的部分或者全部,其中,该电子设备可以是目标车辆的主控制器,也可以是独立于目标车辆的服务器或者终端。其中,本技术实施例中的服务器可以为一台服务器,也可以为由多台服务器组成的服务器集群,本技术实施例中的终端可以是智能手机、个人电脑、平板电脑以及智能机器人等其他智能硬件设备。下述方法实施例中,均以执行主体是电
子设备为例来进行说明。
27.在本技术一个实施例中,如图1所示,提供了一种掉头路径规划方法,以该方法应用于电子设备为例进行说明,包括以下步骤:s11、获取目标车辆对应的掉头区域,并获取掉头区域中的第一掉头边界点对应的第一位置信息以及第二掉头边界点对应的第二位置信息。
28.其中,第一掉头边界点是指目标车辆掉头过程中先经过的掉头边界点,第二掉头边界点是指目标车辆掉头过程中不需要经过的掉头边界点。
29.在一种可选的实施方式中,电子设备可以对车载导航地图进行识别,在地图中获取目标车辆对应的掉头区域,然后,根据掉头区域中的第一掉头边界点和第二掉头边界点在车载导航地图中的位置,确定掉头区域中的第一掉头边界点对应的第一位置信息以及第二掉头边界点对应的第二位置信息。
30.在另一种种可选的实施方式中,电子设备可以接收服务器设备或者其他设备发送的目标车辆对应的掉头区域以及掉头区域中的第一掉头边界点对应的第一位置信息和第二掉头边界点对应的第二位置信息。
31.本技术实施例对电子设备获取到目标车辆对应的掉头区域以及掉头区域中的第一掉头边界点对应的第一位置信息和第二掉头边界点对应的第二位置信息的方式不做具体限定。
32.s12、根据第一位置信息与第二位置信息之间的关系,确定掉头区域对应的目标掉头起点。
33.在申请一种可可选的实施方式中,电子设备可以根据目标掉头起点与第一位置信息与第二位置信息之间的对应的关系,确定掉头区域对应的目标掉头起点。
34.关于该步骤将在下文进行详细介绍。
35.s13、当目标车辆从目标车辆的第一当前位置行驶至目标掉头起点或者目标车辆在行驶至目标掉头起点的过程中,遇到障碍物在停障位置的停障时间超过预设时间阈值时,根据第一位置信息与第二位置信息之间的关系,确定掉头区域对应的目标掉头中间点以及目标掉头终点。
36.其中,停障位置是指目标车辆遇到障碍物之后停下的位置。
37.在本技术一种可选的实施方式中,当目标车辆从目标车辆的第一当前位置行驶至目标掉头起点或者目标车辆在行驶至目标掉头起点的过程中,遇到障碍物在停障位置的停障时间超过预设时间阈值时,电子设备可以根据掉头中间点与第一位置信息与第二位置信息之间对应关系,确定掉头区域对应的目标掉头中间点。然后,根据掉头终点与第一位置信息与第二位置信息之间对应关系,确定掉头区域对应的目标掉头终点。
38.关于该步骤将在下文进行详细介绍。
39.s14、利用预设路径规划算法规划目标车辆从目标掉头起点或者停障位置到目标掉头中间点的第一规划路径以及从目标掉头中间点到目标掉头终点的第二规划路径。
40.具体地,电子设备在确定了掉头区域对应的目标掉头中间点以及目标掉头终点之后,电子设备可以利用预设路径规划算法规划目标车辆从目标掉头起点或者停障位置到目标掉头中间点的第一规划路径以及从目标掉头中间点到目标掉头终点的第二规划路径。
41.其中,预设路径规划算法可以是五次多项式路径规划算法,也可以是hybird a*路
径规划算法,还可以是人工势场路径规划算法,本技术实施例对路径规划算法不做具体限定。
42.示例性的,如图2所示,p1为第一掉头边界点,p2为第二掉头边界点,电子设备可以根据p1对应的第一位置信息和p2对应的第二位置信息,确定目标掉头起点、目标掉头中间点以及目标掉头终点。
43.本发明实施例提供的掉头路径规划方法,获取目标车辆对应的掉头区域,并获取掉头区域中的第一掉头边界点对应的第一位置信息以及第二掉头边界点对应的第二位置信息,然后,根据第一位置信息与第二位置信息之间的关系,确定掉头区域对应的目标掉头起点,保证了确定的掉头区域对应的目标掉头起点的准确性。当目标车辆从目标车辆的第一当前位置行驶至目标掉头起点或者目标车辆在行驶至目标掉头起点的过程中,遇到障碍物在停障位置的停障时间超过预设时间阈值时,根据第一位置信息与第二位置信息之间的关系,确定掉头区域对应的目标掉头中间点以及目标掉头终点,保证了确定的掉头区域对应的目标掉头中间点以及目标掉头终点的准确性。然后,利用预设路径规划算法规划目标车辆从目标掉头起点或者停障位置到目标掉头中间点的第一规划路径以及从目标掉头中间点到目标掉头终点的第二规划路径,保证了规划得到的第一规划路径和第二规划路径的准确性。上述方法,可以根据第一掉头边界点对应的第一位置信息以及第二掉头边界点对应的第二位置信息,确定目标掉头起点、目标掉头中间点以及目标掉头终点,并规划了掉头路径,从而可以实现在任何掉头路口进行掉头,提高了目标车辆进行掉头的灵活性。
44.在本技术一个实施例中,如图3所示,提供了一种掉头路径规划方法,以该方法应用于电子设备为例进行说明,包括以下步骤:s21、获取目标车辆对应的掉头区域,并获取掉头区域中的第一掉头边界点对应的第一位置信息以及第二掉头边界点对应的第二位置信息。
45.其中,第一掉头边界点是指目标车辆掉头过程中先经过的掉头边界点,第二掉头边界点是指目标车辆掉头过程中不需要经过的掉头边界点。
46.关于该步骤请参见图1对s11的介绍,在此不进行赘述。
47.s22、根据第一位置信息与第二位置信息之间的关系,确定掉头区域对应的目标掉头起点。
48.在本技术一种可选的实施方式中,第一位置信息包括第一掉头边界点对应的第一坐标信息以及第一航向角信息,第二位置信息包括第二掉头边界点对应的第二坐标信息以及第二航向角信息;其中,第一航向角是指第一掉头边界点指向第二掉头边界点的方向角,第二航向角等于第一航向角。上述s22“根据第一位置信息与第二位置信息之间的关系,确定掉头区域对应的目标掉头起点”,可以包括如下步骤:s221、根据第一位置信息以及第二位置信息,确定第一掉头边界点与第二掉头边界点之间的掉头边界距离。
49.具体地,电子设备可以利用第一位置信息中的第一坐标信息和第二位置信息中的第二坐标信息,计算第一掉头边界点与第二掉头边界点之间的掉头边界距离。
50.s222、根据初始掉头起点相对于第一掉头边界点的横向偏移量、纵向偏移量以及航向角偏移量分别与掉头边界距离之间的对应关系,确定初始掉头起点相对于第一掉头边界点的第一横向偏移量、第一纵向偏移量以及第一航向角偏移量。
51.具体地,电子设备在确定了第一掉头边界点与第二掉头边界点之间的掉头边界距离之后,可以根据初始掉头起点相对于第一掉头边界点的横向偏移量、纵向偏移量以及航向角偏移量分别与掉头边界距离之间的对应关系,确定初始掉头起点相对于第一掉头边界点的第一横向偏移量、第一纵向偏移量以及第一航向角偏移量。
52.示例性的,如下表1所示,为初始掉头起点相对于第一掉头边界点的横向偏移量、纵向偏移量以及航向角偏移量分别与掉头边界距离之间的对应关系表:表1:初始掉头起点相对于第一掉头边界点的横向偏移量、纵向偏移量以及航向角偏移量分别与掉头边界距离之间的对应关系表假设,掉头边界距离为10米,则初始掉头起点相对于第一掉头边界点的第一横向偏移量9米、第一纵向偏移量-15米以及第一航向角偏移量0度。
53.s223、根据第一横向偏移量、第一纵向偏移量以及第一航向角偏移量与第一位置信息之间的关系,确定掉头区域对应的初始掉头起点对应的第三位置信息。
54.具体地,电子设备在确定了初始掉头起点相对于第一掉头边界点的第一横向偏移量、第一纵向偏移量以及第一航向角偏移量之后,可以根据根据第一横向偏移量、第一纵向偏移量以及第一航向角偏移量与第一位置信息之间的关系,确定掉头区域对应的初始掉头起点对应的第三位置信息。
55.s224、利用预设路径规划算法规划从目标车辆的第一当前位置到初始掉头起点的初始规划路径。
56.其中,第一当前位置是指目标车辆在准确掉头之前的当前位置。
57.具体地,在确定了初始掉头起点之后,电子设备可以利用预设路径规划算法规划从目标车辆的第一当前位置到初始掉头起点的初始规划路径。
58.其中,预设路径规划算法可以是五次多项式路径规划算法,也可以是hybird a*路径规划算法,还可以是人工势场路径规划算法,本技术实施例对路径规划算法不做具体限定。
59.s225、当目标车辆根据初始规划路径行驶不会发生碰撞时,将初始掉头起点确定为目标掉头起点。
60.具体地,当电子设备控制目标车辆按照初始规划路径从第一当前位置行驶到初始
掉头起点时,确定目标车辆不会与周围障碍物发生碰撞,电子设备认为初始规划路径成功,并将初始掉头起点确定为目标掉头起点。
61.s226、当目标车辆根据初始规划路径行驶会发生碰撞时,沿第一预设方向,以第一预设步长移动初始掉头起点,得到第一候选掉头起点。
62.具体地,当电子设备控制目标车辆按照初始规划路径从第一当前位置行驶到初始掉头起点的过程中,目标车辆会与周围障碍物发生碰撞,电子设备认为初始规划路径不成功。电子设备沿第一预设方向,以第一预设步长移动初始掉头起点,得到第一候选掉头起点。
63.其中,第一预设方向可以是第一航向角π/2的方向,也可以是其他方向,本技术实施例对第一预设方向不做具体限定。其中,第一预设步长可以是0.5米,也可以是0.3米,本技术实施例对第一预设步长不做具体限定。
64.s227、利用预设路径规划算法规划从目标车辆的第一当前位置到第一候选掉头起点的第一候选规划路径。
65.具体地,电子设备在得到第一候选掉头起点之后,可以利用预设路径规划算法规划从目标车辆的第一当前位置到第一候选掉头起点的第一候选规划路径。
66.其中,预设路径规划算法可以是五次多项式路径规划算法,也可以是hybird a*路径规划算法,还可以是人工势场路径规划算法,本技术实施例对路径规划算法不做具体限定。
67.s228、当目标车辆根据第一候选规划路径行驶不会发生碰撞时,将第一候选掉头起点确定为目标掉头起点。
68.具体地,当目标车辆根据第一候选规划路径从第一当前位置行驶至第一候选掉头起点的过程中目标车辆不会与周围障碍物发生碰撞时,电子设备将第一候选掉头起点确定为目标掉头起点。
69.s229、如此循环,直至道路边界,当不存在目标车辆根据第一候选规划路径行驶不会发生碰撞的第一候选规划路径时,沿第二预设方向,以第一预设步长移动初始掉头起点,得到第二选掉头起点。
70.具体地,电子设备循环上述步骤,当不存在目标车辆根据第一候选规划路径从第一当前位置行驶至第一候选掉头起点的过程中目标车辆不会与周围障碍物发生碰撞的第一候选规划路径时,电子设备沿第二预设方向,以第一预设步长移动初始掉头起点,得到第二选掉头起点。
71.其中,第二预设方向可以是第一航向角负π/2的方向,也可以是其他方向,本技术实施例对第二预设方向不做具体限定。其中,第一预设步长可以是0.5米,也可以是0.3米,本技术实施例对第一预设步长不做具体限定。
72.s2210、利用预设路径规划算法规划从目标车辆的第一当前位置到第二候选掉头起点的第二候选规划路径。
73.具体地,电子设备在得到第二候选掉头起点之后,可以利用预设路径规划算法规划从目标车辆的第一当前位置到第二候选掉头起点的第二候选规划路径。
74.其中,预设路径规划算法可以是五次多项式路径规划算法,也可以是hybird a*路径规划算法,还可以是人工势场路径规划算法,本技术实施例对路径规划算法不做具体限
定。
75.s2211、当存在目标车辆根据第二候选规划路径行驶不会发生碰撞时,将第二候选掉头起点确定为目标掉头起点。
76.具体地,当目标车辆根据第二候选规划路径从第一当前位置行驶至第二候选掉头起点的过程中目标车辆不会与周围障碍物发生碰撞时,电子设备将第二候选掉头起点确定为目标掉头起点。
77.具体地,电子设备循环上述步骤,当不存在目标车辆根据第二候选规划路径从第一当前位置行驶至第二候选掉头起点的过程中目标车辆不会与周围障碍物发生碰撞的第二候选路径时,电子设备可以确定当前掉头区域不能进行掉头。
78.s23、当目标车辆从目标车辆的第一当前位置行驶至目标掉头起点或者目标车辆在行驶至目标掉头起点的过程中,遇到障碍物在停障位置的停障时间超过预设时间阈值时,根据第一位置信息与第二位置信息之间的关系,确定掉头区域对应的目标掉头中间点以及目标掉头终点。
79.其中,停障位置是指目标车辆遇到障碍物之后停下的位置。
80.关于该步骤请参见图1对s13的介绍,在此不进行赘述。
81.s24、利用预设路径规划算法规划目标车辆从目标掉头起点或者停障位置到目标掉头中间点的第一规划路径以及从目标掉头中间点到目标掉头终点的第二规划路径。
82.关于该步骤请参见图1对s14的介绍,在此不进行赘述。
83.本发明实施例提供的掉头路径规划方法,根据第一位置信息以及第二位置信息,确定第一掉头边界点与第二掉头边界点之间的掉头边界距离,保证了确定的掉头边界距离的准确性。根据初始掉头起点相对于第一掉头边界点的横向偏移量、纵向偏移量以及航向角偏移量分别与掉头边界距离之间的对应关系,确定初始掉头起点相对于第一掉头边界点的第一横向偏移量、第一纵向偏移量以及第一航向角偏移量,保证了确定的第一横向偏移量、第一纵向偏移量以及第一航向角偏移量的准确性。然后,根据第一横向偏移量、第一纵向偏移量以及第一航向角偏移量与第一位置信息之间的关系,确定掉头区域对应的初始掉头起点对应的第三位置信息,保证了确定的掉头区域对应的初始掉头起点对应的第三位置信息的准确性,利用预设路径规划算法规划从目标车辆的第一当前位置到初始掉头起点的初始规划路径,保证了规划的初始规划路径的准确性。当目标车辆根据初始规划路径行驶不会发生碰撞时,将初始掉头起点确定为目标掉头起点,保证了确定的目标掉头起点的准确性,且避免了目标车辆从第一当前位置行驶至目标掉头起点发生碰撞。
84.当目标车辆根据初始规划路径行驶会发生碰撞时,沿第一预设方向,以第一预设步长移动初始掉头起点,得到第一候选掉头起点,保证了得到的第一候选掉头起点的准确性。利用预设路径规划算法规划从目标车辆的第一当前位置到第一候选掉头起点的第一候选规划路径,保证了规划得到的第一候选规划路径的准确性。当目标车辆根据第一候选规划路径行驶不会发生碰撞时,将第一候选掉头起点确定为目标掉头起点,保证了确定的目标掉头起点的准确性,且避免了目标车辆从第一当前位置行驶至目标掉头起点发生碰撞。如此循环,直至道路边界,当不存在目标车辆根据第一候选规划路径行驶不会发生碰撞的第一候选规划路径时,沿第二预设方向,以第一预设步长移动初始掉头起点,得到第二选掉头起点,保证了得到的第二选掉头起点的准确性。利用预设路径规划算法规划从目标车辆
的第一当前位置到第二候选掉头起点的第二候选规划路径,保证了规划的第二候选规划路径的准确性。当存在目标车辆根据第二候选规划路径行驶不会发生碰撞时,将第二候选掉头起点确定为目标掉头起点。
85.在本技术一个实施例中,如图4所示,提供了一种掉头路径规划方法,以该方法应用于电子设备为例进行说明,包括以下步骤:s31、获取目标车辆对应的掉头区域,并获取掉头区域中的第一掉头边界点对应的第一位置信息以及第二掉头边界点对应的第二位置信息。
86.其中,第一掉头边界点是指目标车辆掉头过程中先经过的掉头边界点,第二掉头边界点是指目标车辆掉头过程中不需要经过的掉头边界点。
87.关于该步骤请参见图3对s21的介绍,在此不进行赘述。
88.s32、根据第一位置信息与第二位置信息之间的关系,确定掉头区域对应的目标掉头起点。
89.关于该步骤请参见图3对s22的介绍,在此不进行赘述。
90.s33、当目标车辆从目标车辆的第一当前位置行驶至目标掉头起点或者目标车辆在行驶至目标掉头起点的过程中,遇到障碍物在停障位置的停障时间超过预设时间阈值时,根据第一位置信息与第二位置信息之间的关系,确定掉头区域对应的目标掉头中间点以及目标掉头终点。
91.其中,停障位置是指目标车辆遇到障碍物之后停下的位置。
92.在本技术一种可选的实施方式中,上述s33中的“根据第一位置信息与第二位置信息之间的关系,确定掉头区域对应的目标掉头中间点以及目标掉头终点”,可以包括如下步骤:s331、根据初始掉头中间点相对于第一掉头边界点的横向偏移量、纵向偏移量以及航向角偏移量分别与掉头边界距离之间的对应关系,确定初始掉头中间点相对于第一掉头边界点的第二横向偏移量、第二纵向偏移量以及第二航向角偏移量。
93.具体地,电子设备可以根据初始掉头中间点相对于第一掉头边界点的横向偏移量、纵向偏移量以及航向角偏移量分别与掉头边界距离之间的对应关系,确定初始掉头中间点相对于第一掉头边界点的第二横向偏移量、第二纵向偏移量以及第二航向角偏移量。
94.示例性的,如下表2所示,为初始掉头中间点相对于第一掉头边界点的横向偏移量、纵向偏移量以及航向角偏移量分别与掉头边界距离之间的对应关系表:表2:初始掉头中间点相对于第一掉头边界点的横向偏移量、纵向偏移量以及航向角偏移量分别与掉头边界距离之间的对应关系
假设,掉头边界距离为10米,则初始掉头中间点相对于第一掉头边界点的第一横向偏移量5米、第一纵向偏移量-1.0米以及第一航向角偏移量68度。
95.s332、根据第二横向偏移量、第二纵向偏移量以及第二航向角偏移量与第一位置信息之间的关系,确定掉头区域对应的初始掉头中间点对应的第四位置信息。
96.具体地,电子设备在确定了初始掉头中间点相对于第一掉头边界点的第二横向偏移量、第二纵向偏移量以及第二航向角偏移量之后,可以根据根据第二横向偏移量、第二纵向偏移量以及第二航向角偏移量与第一位置信息之间的关系,确定掉头区域对应的初始掉头中间点对应的第四位置信息。
97.s333、同理,确定掉头区域对应的初始掉头终点对应的第五位置信息。
98.具体地,电子设备可以根据初始掉头终点相对于第一掉头边界点的横向偏移量、纵向偏移量以及航向角偏移量分别与掉头边界距离之间的对应关系,确定初始掉头终点相对于第一掉头边界点的第三横向偏移量、第三纵向偏移量以及第三航向角偏移量。
99.然后,电子设备在确定了初始掉头终点相对于第一掉头边界点的第三横向偏移量、第三纵向偏移量以及第三航向角偏移量之后,可以根据根据第三横向偏移量、第三纵向偏移量以及第三航向角偏移量与第一位置信息之间的关系,确定掉头区域对应的初始掉头终点对应的第五位置信息。
100.s334、获取掉头区域中各个目标障碍物对应的目标障碍物位置信息。
101.在一种可选的实施方式中,电子设备可以对车载导航地图进行识别,在地图中获取对车载导航地图进行识别,在地图中获取目标车辆对应的掉头区域。
102.在另一种可选的实施方式中,电子设备可以感知模块获取掉头区域中各个目标障碍物对应的目标障碍物位置信息。
103.s335、根据第四位置信息与目标障碍物位置信息之间的关系,确定掉头区域对应的目标掉头中间点。
104.在本技术一种可选的实施方式中,上述s335”根据第四位置信息与目标障碍物位置信息之间的关系,确定掉头区域对应的目标掉头中间点”,可以包括如下步骤:(1)根据第四位置信息与目标障碍物位置信息,确定当目标车辆行驶至初始掉头中间点,不会与目标障碍物发生碰撞时,将初始掉头中间点确定为目标掉头中间点。
105.具体地,电子设备可以根据第四位置信息与目标障碍物位置信息,确定当目标车辆行驶至初始掉头中间点,不会与目标障碍物发生碰撞时,将初始掉头中间点确定为目标掉头中间点。
106.(2)当目标车辆行驶至初始掉头中间点,会与目标障碍物发生碰撞时,沿第三预设方向,以第二预设步长移动初始掉头中间点,得到候选掉头中间点。
107.具体的,当目标车辆行驶至初始掉头中间点,会与目标障碍物发生碰撞时,电子设备可以沿第三预设方向,以第二预设步长移动初始掉头中间点,得到候选掉头中间点。
108.(3)当目标车辆行驶至候选掉头中间点,不会与目标障碍物发生碰撞时,将候选掉头中间点确定为目标掉头中间点。
109.具体地,当目标车辆行驶至候选掉头中间点,不会与目标障碍物发生碰撞时,电子设备可以将候选掉头中间点确定为目标掉头中间点。
110.当目标车辆行驶至候选掉头中间点,会与目标障碍物发生碰撞时,电子设备继续沿第三预设方向,以第二预设步长移动初始掉头中间点,得到下一个候选掉头中间点,如此循环,直至达到预设位置。
111.其中,第三预设方向可是第一航向角方向,也可以是其他方向,本技术实施例对第三预设方向不做具体限定。
112.其中,第二预设步长可以是0.5米,也可以是0.3米,第二预设步长可以与第一预设步长相同,也可以与第一预设步长不同,本技术实施例对第二预设步长不做具体限定。第三预设方向可以是第一航向角方向,预设位置可以是距离第二掉头边界点预设距离的位置,预设距离可以是0.5米,也可以是0.6米,本技术实施例对预设距离不做具体限定。
113.s336、同理,根据第五位置信息与目标障碍物位置信息之间的关系,确定掉头区域对应的目标掉头终点。
114.在本技术一种可选的实施方式中,上述s336“根据第五位置信息与目标障碍物位置信息之间的关系,确定掉头区域对应的目标掉头终点”,可以包括如下步骤:(1)根据第五位置信息与目标障碍物位置信息,确定当目标车辆行驶至初始掉头终点,不会与目标障碍物发生碰撞时,将初始掉头终点确定为目标掉头终点。
115.具体地,电子设备可以根据第五位置信息与目标障碍物位置信息,确定当目标车辆行驶至初始掉头终点,不会与目标障碍物发生碰撞时,将初始掉头终点确定为目标掉头终点。
116.(2)当目标车辆行驶至初始掉头终点时,会与目标障碍物发生碰撞时,沿第一预设方向,以第三预设步长移动初始掉头终点,得到第一候选掉头终点;具体地,当目标车辆行驶至初始掉头终点时,会与目标障碍物发生碰撞时,电子设备可以沿第一预设方向,以第三预设步长移动初始掉头终点,得到第一候选掉头终点。
117.其中,第一预设方向可以是第一航向角π/2的方向,也可以是其他方向,本技术实施例对第一预设方向不做具体限定。其中,第三预设步长可以是0.5米,也可以是0.3米,第三预设步长可以与第一预设步长、第二预设步长相同,也可以与第一预设步长、第二预设步长不同,本技术实施例对第三预设步长不做具体限定。
118.(3)当目标车辆行驶至第一候选掉头终点,不会与目标障碍物发生碰撞时,将第一候选掉头终点确定为目标掉头终点。
119.具体地,当目标车辆行驶至第一候选掉头终点,不会与目标障碍物发生碰撞时,电子设备将第一候选掉头终点确定为目标掉头终点。
120.(4)如此循环,直至道路边界,当不存在目标车辆行驶至第一候选掉头终点,不会与目标障碍物发生碰撞时,沿第二预设方向,以第三预设步长移动初始掉头终点,得到第二候选掉头终点;具体地,电子设备循环执行上述步骤,直至沿第一预设方向将初始掉头终点移动到道路边界,还是不存在目标车辆行驶至第一候选掉头终点,不会与目标障碍物发生碰撞的第一候选掉头终点时,电子设备沿第二预设方向,以第三预设步长移动初始掉头终点,得到第二候选掉头终点。
121.其中,第二预设方向可以是第一航向角负π/2的方向,也可以是其他方向,本技术实施例对第二预设方向不做具体限定。其中,第三预设步长可以是0.5米,也可以是0.3米,第三预设步长可以与第一预设步长、第二预设步长相同,也可以与第一预设步长、第二预设步长不同,本技术实施例对第三预设步长不做具体限定。
122.(5)当目标车辆行驶至第二候选掉头终点,不会与目标障碍物发生碰撞时,将第二候选掉头终点确定为目标掉头终点。
123.具体地,当目标车辆行驶至第二候选掉头终点,不会与目标障碍物发生碰撞时,电子设备将第二候选掉头终点确定为目标掉头终点。
124.s34、利用预设路径规划算法规划目标车辆从目标掉头起点或者停障位置到目标掉头中间点的第一规划路径以及从目标掉头中间点到目标掉头终点的第二规划路径。
125.关于该步骤请参见图3对s24的介绍,在此不进行赘述。
126.本发明实施例提供的掉头路径规划方法,根据初始掉头中间点相对于第一掉头边界点的横向偏移量、纵向偏移量以及航向角偏移量分别与掉头边界距离之间的对应关系,确定初始掉头中间点相对于第一掉头边界点的第二横向偏移量、第二纵向偏移量以及第二航向角偏移量,保证了确定的初始掉头中间点相对于第一掉头边界点的第二横向偏移量、第二纵向偏移量以及第二航向角偏移量的准确性。根据第二横向偏移量、第二纵向偏移量以及第二航向角偏移量与第一位置信息之间的关系,确定掉头区域对应的初始掉头中间点对应的第四位置信息,保证了确定的掉头区域对应的初始掉头中间点对应的第四位置信息的准确性。同理,保证了确定的掉头区域对应的初始掉头终点对应的第五位置信息的准确性。获取掉头区域中各个目标障碍物对应的目标障碍物位置信息;本发明实施例提供的掉头路径规划方法,根据初始掉头中间点相对于第一掉头边界点的横向偏移量、纵向偏移量以及航向角偏移量分别与掉头边界距离之间的对应关系,确定初始掉头中间点相对于第一掉头边界点的第二横向偏移量、第二纵向偏移量以及第二航向角偏移量,保证了确定的初始掉头中间点相对于第一掉头边界点的第二横向偏移量、第二纵向偏移量以及第二航向角偏移量的准确性。根据第二横向偏移量、第二纵向偏移量以及第二航向角偏移量与第一位置信息之间的关系,确定掉头区域对应的初始掉头中间点对应的第四位置信息,保证了确定的掉头区域对应的初始掉头中间点对应的第四位置信息的准确性。同理,保证了确定的掉头区域对应的初始掉头终点对应的第五位置信息的准确性。获取掉头区域中各个目标障碍物对应的目标障碍物位置信息;根据第四位置信息与目标障碍物位置信息之间的关系,确定掉头区域对应的目标掉头中间点,保证了确定的掉头区域对应的目标掉头中间点的准
确性。同理,根据第五位置信息与目标障碍物位置信息之间的关系,确定掉头区域对应的目标掉头终点,保证了确定的掉头区域对应的目标掉头终点的准确性。
127.同理,根据第五位置信息与目标障碍物位置信息,确定当目标车辆行驶至初始掉头终点,不会与目标障碍物发生碰撞时,将初始掉头终点确定为目标掉头终点,保证了确定的目标掉头终点的准确性。当目标车辆行驶至初始掉头终点时,会与目标障碍物发生碰撞时,沿第一预设方向,以第三预设步长移动初始掉头终点,得到第一候选掉头终点,保证了得到的第一候选掉头终点的准确性。当目标车辆行驶至第一候选掉头终点,不会与目标障碍物发生碰撞时,将第一候选掉头终点确定为目标掉头终点,保证了确定的目标掉头终点的准确性。如此循环,直至道路边界,当不存在目标车辆行驶至第一候选掉头终点,不会与目标障碍物发生碰撞时,沿第二预设方向,以第三预设步长移动初始掉头终点,得到第二候选掉头终点,保证了得到的各个候选掉头终点的准确性。当目标车辆行驶至第二候选掉头终点,不会与目标障碍物发生碰撞时,将第二候选掉头终点确定为目标掉头终点,保证了确定的目标掉头终点的准确性。
128.在本技术一个实施例中,如图5所示,提供了一种掉头路径规划方法,以该方法应用于电子设备为例进行说明,包括以下步骤:s41、获取目标车辆对应的掉头区域,并获取掉头区域中的第一掉头边界点对应的第一位置信息以及第二掉头边界点对应的第二位置信息。
129.其中,第一掉头边界点是指目标车辆掉头过程中先经过的掉头边界点,第二掉头边界点是指目标车辆掉头过程中不需要经过的掉头边界点。
130.关于该步骤请参加图4对s31的介绍,在此不进行赘述。
131.s42、根据第一位置信息与第二位置信息之间的关系,确定掉头区域对应的目标掉头起点。
132.关于该步骤请参加图4对s32的介绍,在此不进行赘述。
133.s43、当目标车辆从目标车辆的第一当前位置行驶至目标掉头起点或者目标车辆在行驶至目标掉头起点的过程中,遇到障碍物在停障位置的停障时间超过预设时间阈值时,根据第一位置信息与第二位置信息之间的关系,确定掉头区域对应的目标掉头中间点以及目标掉头终点。
134.其中,停障位置是指目标车辆遇到障碍物之后停下的位置。
135.关于该步骤请参加图4对s33的介绍,在此不进行赘述。
136.s44、利用预设路径规划算法规划目标车辆从目标掉头起点或者停障位置到目标掉头中间点的第一规划路径以及从目标掉头中间点到目标掉头终点的第二规划路径。
137.关于该步骤请参加图4对s34的介绍,在此不进行赘述。
138.s45、当目标车辆按照第一规划路径和第二规划路径行驶过程中,遇到障碍物停止,且停止时间大于预设停止时长阈值时,获取目标车辆当前停止的第二当前位置。
139.具体地,当目标车辆按照第一规划路径和第二规划路径行驶过程中,遇到障碍物停止,且停止时间大于预设停止时长阈值时,电子设备可以获取目标车辆当前停止的第二当前位置。
140.s46、当根据第二当前位置以及目标掉头中间点的位置,确定目标车辆未经过目标掉头中间点时,重新规划第一规划路径以及第二规划路径。
141.具体地,电子设备可以将第二当前位置与目标掉头中间点对应的位置进行对比,当确定目标掉头中间点在目标车辆行驶方向的前方时,确定目标车辆未经过目标掉头中间点时,电子设备利用预设路径规划算法重新规划第一规划路径以及第二规划路径。
142.s47、当根据第二当前位置以及目标掉头中间点的位置,确定目标车辆已经过目标掉头中间点时,重新规划第二规划路径。
143.具体地,电子设备可以将第二当前位置与目标掉头中间点对应的位置进行对比,当确定目标掉头中间点在目标车辆行驶方向的后方时,确定目标车辆已经过目标掉头中间点时,电子设备利用预设路径规划算法重新规划第二规划路径。
144.本发明实施例提供的掉头路径规划方法,当目标车辆按照第一规划路径和第二规划路径行驶过程中,遇到障碍物停止,且停止时间大于预设停止时长阈值时,获取目标车辆当前停止的第二当前位置,保证了获取到的第二当前位置的准确性。当根据第二当前位置以及目标掉头中间点的位置,确定目标车辆未经过目标掉头中间点时,重新规划第一规划路径以及第二规划路径,保证了重新规划得到的第一规划路径以及第二规划路径的准确性。当根据第二当前位置以及目标掉头中间点的位置,确定目标车辆已经过目标掉头中间点时,重新规划第二规划路径,保证了重新规划得到的第二规划路径的准确。
145.应该理解的是,虽然图1、图3-图5的流程图中的各个步骤按照箭头的指示依次显示,但是这些步骤并不是必然按照箭头指示的顺序依次执行。除非本文中有明确的说明,这些步骤的执行并没有严格的顺序限制,这些步骤可以以其它的顺序执行。而且,图1、图3-图5中的至少一部分步骤可以包括多个步骤或者多个阶段,这些步骤或者阶段并不必然是在同一时刻执行完成,而是可以在不同的时刻执行,这些步骤或者阶段的执行顺序也不必然是依次进行,而是可以与其它步骤或者其它步骤中的步骤或者阶段的至少一部分轮流或者交替地执行。
146.如图6所示,本实施例提供一种掉头路径规划装置,包括:第一获取模块51,用于获取目标车辆对应的掉头区域,并获取掉头区域中的第一掉头边界点对应的第一位置信息以及第二掉头边界点对应的第二位置信息;其中,第一掉头边界点是指目标车辆掉头过程中先经过的掉头边界点,第二掉头边界点是指目标车辆掉头过程中不需要经过的掉头边界点;第一确定模块52,用于根据第一位置信息与第二位置信息之间的关系,确定掉头区域对应的目标掉头起点;第二确定模块53,当目标车辆从目标车辆的第一当前位置行驶至目标掉头起点或者目标车辆在行驶至目标掉头起点的过程中,遇到障碍物在停障位置的停障时间超过预设时间阈值时,根据第一位置信息与第二位置信息之间的关系,确定掉头区域对应的目标掉头中间点以及目标掉头终点;其中,停障位置是指目标车辆遇到障碍物之后停下的位置;第一规划模块54,用于利用预设路径规划算法规划目标车辆从目标掉头起点或者停障位置到目标掉头中间点的第一规划路径以及从目标掉头中间点到目标掉头终点的第二规划路径。
147.在本技术一个实施例中,上述第一确定模块52,具体用于根据第一位置信息以及第二位置信息,确定第一掉头边界点与第二掉头边界点之间的掉头边界距离;根据初始掉头起点相对于第一掉头边界点的横向偏移量、纵向偏移量以及航向角偏移量分别与掉头边
界距离之间的对应关系,确定初始掉头起点相对于第一掉头边界点的第一横向偏移量、第一纵向偏移量以及第一航向角偏移量;根据第一横向偏移量、第一纵向偏移量以及第一航向角偏移量与第一位置信息之间的关系,确定掉头区域对应的初始掉头起点对应的第三位置信息;利用预设路径规划算法规划从目标车辆的第一当前位置到初始掉头起点的初始规划路径;当目标车辆根据初始规划路径行驶不会发生碰撞时,将初始掉头起点确定为目标掉头起点。
148.在本技术一个实施例中,上述第一确定模块52,具体用于当目标车辆根据初始规划路径行驶会发生碰撞时,沿第一预设方向,以第一预设步长移动初始掉头起点,得到第一候选掉头起点;利用预设路径规划算法规划从目标车辆的第一当前位置到第一候选掉头起点的第一候选规划路径;当目标车辆根据第一候选规划路径行驶不会发生碰撞时,将第一候选掉头起点确定为目标掉头起点;如此循环,直至道路边界,当不存在目标车辆根据第一候选规划路径行驶不会发生碰撞的第一候选规划路径时,沿第二预设方向,以第一预设步长移动初始掉头起点,得到第二选掉头起点;利用预设路径规划算法规划从目标车辆的第一当前位置到第二候选掉头起点的第二候选规划路径;当存在目标车辆根据第二候选规划路径行驶不会发生碰撞时,将第二候选掉头起点确定为目标掉头起点。
149.在本技术一个实施例中,上述第二确定模块53,具体用于根据初始掉头中间点相对于第一掉头边界点的横向偏移量、纵向偏移量以及航向角偏移量分别与掉头边界距离之间的对应关系,确定初始掉头中间点相对于第一掉头边界点的第二横向偏移量、第二纵向偏移量以及第二航向角偏移量;根据第二横向偏移量、第二纵向偏移量以及第二航向角偏移量与第一位置信息之间的关系,确定掉头区域对应的初始掉头中间点对应的第四位置信息;同理,确定掉头区域对应的初始掉头终点对应的第五位置信息;获取掉头区域中各个目标障碍物对应的目标障碍物位置信息;根据第四位置信息与目标障碍物位置信息之间的关系,确定掉头区域对应的目标掉头中间点;同理,根据第五位置信息与目标障碍物位置信息之间的关系,确定掉头区域对应的目标掉头终点。
150.在本技术一个实施例中,上述第二确定模块53,具体用于根据第四位置信息与目标障碍物位置信息,确定当目标车辆行驶至初始掉头中间点,不会与目标障碍物发生碰撞时,将初始掉头中间点确定为目标掉头中间点;当目标车辆行驶至初始掉头中间点,会与目标障碍物发生碰撞时,沿第三预设方向,以第二预设步长移动初始掉头中间点,得到候选掉头中间点;当目标车辆行驶至候选掉头中间点,不会与目标障碍物发生碰撞时,将候选掉头中间点确定为目标掉头中间点。
151.在本技术一个实施例中,上述第二确定模块53,具体用于根据第五位置信息与目标障碍物位置信息,确定当目标车辆行驶至初始掉头终点,不会与目标障碍物发生碰撞时,将初始掉头终点确定为目标掉头终点;当目标车辆行驶至初始掉头终点时,会与目标障碍物发生碰撞时,沿第一预设方向,以第三预设步长移动初始掉头终点,得到第一候选掉头终点;当目标车辆行驶至第一候选掉头终点,不会与目标障碍物发生碰撞时,将第一候选掉头终点确定为目标掉头终点;如此循环,直至道路边界,当不存在目标车辆行驶至第一候选掉头终点,不会与目标障碍物发生碰撞时,沿第二预设方向,以第三预设步长移动初始掉头终点,得到第二候选掉头终点;当目标车辆行驶至第二候选掉头终点,不会与目标障碍物发生碰撞时,将第二候选掉头终点确定为目标掉头终点。
152.如图7所示,本实施例提供一种掉头路径规划装置,还包括:第二获取模块55,用于当目标车辆按照第一规划路径和第二规划路径行驶过程中,遇到障碍物停止,且停止时间大于预设停止时长阈值时,获取目标车辆当前停止的第二当前位置;第二规划模块56,用于当根据第二当前位置以及目标掉头中间点的位置,确定目标车辆未经过目标掉头中间点时,重新规划第一规划路径以及第二规划路径;第三规划模块57,用于当根据第二当前位置以及目标掉头中间点的位置,确定目标车辆已经过目标掉头中间点时,重新规划第二规划路径。
153.关于掉头路径规划装置的具体限定以及有益效果可以参见上文中对于掉头路径规划方法的限定,在此不再赘述。上述掉头路径规划装置中的各个模块可全部或部分通过软件、硬件及其组合来实现。上述各模块可以硬件形式内嵌于或独立于电子设备中的处理器中,也可以以软件形式存储于电子设备中的存储器中,以便于处理器调用执行以上各个模块对应的操作。
154.本发明实施例还提供一种电子设备,具有上述图6以及图7所示的掉头路径规划装置。
155.如图8所示,图8是本发明可选实施例提供的一种电子设备的结构示意图,如图8所示,该电子设备可以包括:至少一个处理器61,例如cpu(central processing unit,中央处理器),至少一个通信接口63,存储器64,至少一个通信总线62。其中,通信总线62用于实现这些组件之间的连接通信。其中,通信接口63可以包括显示屏(display)、键盘(keyboard),可选通信接口63还可以包括标准的有线接口、无线接口。存储器64可以是高速ram存储器(random access memory,易挥发性随机存取存储器),也可以是非不稳定的存储器(non-volatile memory),例如至少一个磁盘存储器。存储器64可选的还可以是至少一个位于远离前述处理器61的存储装置。其中处理器61可以结合图6或图7所描述的装置,存储器64中存储应用程序,且处理器61调用存储器64中存储的程序代码,以用于执行上述任一方法步骤。
156.其中,通信总线62可以是外设部件互连标准(peripheral component interconnect,简称pci)总线或扩展工业标准结构(extended industry standard architecture,简称eisa)总线等。通信总线62可以分为地址总线、数据总线、控制总线等。为便于表示,图8中仅用一条粗线表示,但并不表示仅有一根总线或一种类型的总线。
157.其中,存储器64可以包括易失性存储器(英文:volatile memory),例如随机存取存储器(英文:random-access memory,缩写:ram);存储器也可以包括非易失性存储器(英文:non-volatile memory),例如快闪存储器(英文:flash memory),硬盘(英文:hard disk drive,缩写:hdd)或固态硬盘(英文:solid-state drive,缩写:ssd);存储器64还可以包括上述种类的存储器的组合。
158.其中,处理器61可以是中央处理器(英文:central processing unit,缩写:cpu),网络处理器(英文:network processor,缩写:np)或者cpu和np的组合。
159.其中,处理器61还可以进一步包括硬件芯片。上述硬件芯片可以是专用集成电路(英文:application-specific integrated circuit,缩写:asic),可编程逻辑器件(英文:programmable logic device,缩写:pld)或其组合。上述pld可以是复杂可编程逻辑器件
(英文:complex programmable logic device,缩写:cpld),现场可编程逻辑门阵列(英文:field-programmable gate array,缩写:fpga),通用阵列逻辑(英文:generic array logic, 缩写:gal)或其任意组合。
160.可选地,存储器64还用于存储程序指令。处理器61可以调用程序指令,实现如本技术图1、图3至图5实施例中所示的掉头路径规划方法。
161.本发明实施例还提供了一种非暂态计算机存储介质,所述计算机存储介质存储有计算机可执行指令,该计算机可执行指令可执行上述任意方法实施例中的掉头路径规划方法。其中,所述存储介质可为磁碟、光盘、只读存储记忆体(read-only memory,rom)、随机存储记忆体(random access memory,ram)、快闪存储器(flash memory)、硬盘(hard disk drive,缩写:hdd)或固态硬盘(solid-state drive,ssd)等;所述存储介质还可以包括上述种类的存储器的组合。
162.虽然结合附图描述了本发明的实施例,但是本领域技术人员可以在不脱离本发明的精神和范围的情况下做出各种修改和变型,这样的修改和变型均落入由所附权利要求所限定的范围之内。
当前第1页1 2 
网友询问留言 留言:0条
  • 还没有人留言评论。精彩留言会获得点赞!