CN115597620A - 路径规划方法、装置、电子设备及存储介质 - Google Patents
路径规划方法、装置、电子设备及存储介质 Download PDFInfo
- Publication number
- CN115597620A CN115597620A CN202211278116.2A CN202211278116A CN115597620A CN 115597620 A CN115597620 A CN 115597620A CN 202211278116 A CN202211278116 A CN 202211278116A CN 115597620 A CN115597620 A CN 115597620A
- Authority
- CN
- China
- Prior art keywords
- target
- path
- target vehicle
- area
- position information
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
- G01C21/34—Route searching; Route guidance
- G01C21/3407—Route searching; Route guidance specially adapted for specific applications
- G01C21/3415—Dynamic re-routing, e.g. recalculating the route when the user deviates from calculated route or after detecting real-time traffic data or accidents
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
- G01C21/34—Route searching; Route guidance
- G01C21/3446—Details of route searching algorithms, e.g. Dijkstra, A*, arc-flags, using precalculated routes
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
- G01C21/34—Route searching; Route guidance
- G01C21/3453—Special cost functions, i.e. other than distance or default speed limit of road segments
- G01C21/3492—Special cost functions, i.e. other than distance or default speed limit of road segments employing speed data or traffic data, e.g. real-time or historical
Abstract
本发明涉及自动驾驶领域领域,具体涉及一种路径规划方法、装置、电子设备及存储介质。包括:获取目标坐标系下目标车辆对应的第一位置信息以及目标车辆行驶方向预设范围内的各个障碍物对应的第二位置信息;对目标车辆行驶方向预设范围内的区域利用不同大小的网格进行划分;根据网格划分结果,对不同网格大小的区域分别进行不同的路径规划,生成目标车辆行驶方向预设范围内目标规划路径;根据目标规划路径中各个路径点的曲率以及各个障碍物对应的第二位置信息,对目标规划路径对应的速度进行规划,确定目标车辆行驶目标规划路径对应的目标速度。保证了目标规划路径的准确性,且减少计算量,适用于封闭场景的自动驾驶车辆进行路径规划。
Description
技术领域
本发明涉及自动驾驶领域,具体涉及一种路径规划方法、装置、电子设备及存储介质。
背景技术
随着人类生活水平的不断提高以及工业自动化、智能化程度的迅速发展,自动驾驶技术的应用越来越广泛,研究也越来越深入。自动驾驶技术在农业、工业、服务业、航天、医疗、军事等不同的领域发展迅猛并被广泛运用,具有很大的社会价值。自动驾驶车辆在移动过程中,会遇到许多障碍物,而如何在复杂多变的工作环境中规划一条从起点到终点的无碰撞的路径,是自动驾驶技术研究的一大课题。
现有技术中,通常是自动驾驶车辆每次获取预设范围内的感知数据,然后根据感知数据,利用预设路径规划算法,以一定步长对预设范围内的路径进行规划。
上述方法,计算量较大,需要很高的算力消耗。适用于较为复杂的驾驶场景。在封闭场景的车辆自动驾驶上,由于场景比较简单,不存在大量的障碍物与决策场景,同时我们期望车辆搭载轻量化计算平台,具备不同路况下的行驶、停、绕障,因此,上述方法并不适用于封闭场景的自动驾驶车辆进行路径规划。
发明内容
有鉴于此,本发明实施例提供了一种路径规划方法,旨在解决现有技术中路径规划方法不适用于封闭场景的自动驾驶车辆进行路径规划。
根据第一方面,本发明实施例提供了一种路径规划方法,方法包括:
获取目标坐标系下目标车辆对应的第一位置信息以及目标车辆行驶方向预设范围内的各个障碍物对应的第二位置信息;
根据第一位置信息以及第二位置信息之间的关系,对目标车辆行驶方向预设范围内的区域利用不同大小的网格进行划分;
根据网格划分结果,对不同网格大小的区域分别进行不同的路径规划,生成目标车辆行驶方向预设范围内目标规划路径;
根据目标规划路径中各个路径点的曲率以及各个障碍物对应的第二位置信息,对目标规划路径对应的速度进行规划,确定目标车辆行驶目标规划路径对应的目标速度。
本发明实施例提供的路径规划方法,获取目标坐标系下目标车辆对应的第一位置信息以及目标车辆行驶方向预设范围内的各个障碍物对应的第二位置信息,保证了获取的第一位置信息以及第二位置信息之间的准确性。然后,根据第一位置信息以及第二位置信息之间的关系,对目标车辆行驶方向预设范围内的区域利用不同大小的网格进行划分,保证了得到的网格划分结果的准确性。根据网格划分结果,对不同网格大小的区域分别进行不同的路径规划,生成目标车辆行驶方向预设范围内目标规划路径,保证了生成的目标车辆行驶方向预设范围内目标规划路径的准确性。然后,根据目标规划路径中各个路径点的曲率以及各个障碍物对应的第二位置信息,对目标规划路径对应的速度进行规划,确定目标车辆行驶目标规划路径对应的目标速度,保证了确定的目标规划路径对应的目标速度的准确性。上述方法,根据第一位置信息以及第二位置信息之间的关系,对目标车辆行驶方向预设范围内的区域利用不同大小的网格进行划分,因此,可以根据网格划分结果,对不同网格大小的区域分别进行不同的路径规划,生成目标车辆行驶方向预设范围内目标规划路径。从而可以实现针对没有障碍物的路径进行简单的路径规划,针对有障碍物的路径进行较为细致的路径规划。不仅可以保证规划得到的目标规划路径的准确性,还可以减少路径规划的计算量,尽可能的节省计算平台的占用,将宝贵的计算资源提供给大量的感知传感器数据处理和AI推理部分。上述方法,更加适用于封闭场景的自动驾驶车辆进行路径规划。
结合第一方面,在第一方面第一实施方式中,获取目标坐标系下目标车辆对应的第一位置信息以及目标车辆行驶方向预设范围内的各个障碍物对应的第二位置信息,包括:
获取目标车辆的中心点,以中心点为目标坐标系的原点,目标车辆行驶方向为纵轴,垂直于目标车辆行驶方向为横轴,建立目标坐标系;
根据目标坐标系与目标车辆之间的关系,确定第一位置信息;
获取各个障碍物对应的行驶轨迹,将各个障碍物对应的行驶轨迹投影到目标坐标系下,获取各个障碍物在目标坐标系下的投影列表;
对投影列表进行分析,确定各个障碍物在目标坐标系下对应的第二位置信息。
本发明实施例提供的路径规划方法,获取目标车辆的中心点,以中心点为目标坐标系的原点,目标车辆行驶方向为纵轴,垂直于目标车辆行驶方向为横轴,建立目标坐标系,保证了建立的目标坐标系的准确性。然后,根据目标坐标系与目标车辆之间的关系,确定第一位置信息,保证了确定的第一位置信息的准确性。获取各个障碍物对应的行驶轨迹,将各个障碍物对应的行驶轨迹投影到目标坐标系下,获取各个障碍物在目标坐标系下的投影列表,保证了获取到的各个障碍物在目标坐标系下的投影列表的准确性。对投影列表进行分析,确定各个障碍物在目标坐标系下对应的第二位置信息,保证了确定的各个障碍物在目标坐标系下对应的第二位置信息的准确性。
结合第一方面,在第一方面第二实施方式中,根据第一位置信息以及第二位置信息之间的关系,对目标车辆行驶方向预设范围内的区域利用不同大小的网格进行划分,包括:
获取目标车辆对应的最小转弯距离;
根据各第二位置信息,确定各障碍物在目标坐标系中占用的第一坐标范围;
将第一坐标范围沿目标坐标系的横轴向两侧扩宽最小转弯距离,得到各障碍物在目标坐标系中占用的第二坐标范围;
根据第一位置信息以及各第二坐标范围之间的位置关系,确定目标车辆与距离最近的第二坐标范围之间的第一区域或/和各第二坐标范围之间的第二区域或/和距离预设范围的终点最近的第二坐标范围到终点之间的第三区域;
利用第一网格对第一区域或/和第二区域或/和第三区域进行网格划分;
根据第一位置信息以及各第二坐标范围之间的位置关系,确定目标车辆经过各第二坐标范围对应的第四区域;
利用第二网格对第四区域进行网格划分,第二网格的尺寸小于第一网格。
本发明实施例提供的路径规划方法,获取目标车辆对应的最小转弯距离。根据各第二位置信息,确定各障碍物在目标坐标系中占用的第一坐标范围,保证了确定的各障碍物在目标坐标系中占用的第一坐标范围的准确性。然后,将第一坐标范围沿目标坐标系的横轴向两侧扩宽最小转弯距离,得到各障碍物在目标坐标系中占用的第二坐标范围,保证了得到的各障碍物在目标坐标系中占用的第二坐标范围的准确性,且保证了目标车辆可以安全通过第二坐标范围。然后,根据第一位置信息以及各第二坐标范围之间的位置关系,确定目标车辆与距离最近的第二坐标范围之间的第一区域或/和各第二坐标范围之间的第二区域或/和距离预设范围的终点最近的第二坐标范围到终点之间的第三区域,保证了确定的第一区域或/和第二区域或/和第三区域的准确性。利用第一网格对第一区域或/和第二区域或/和第三区域进行网格划分,保证了对第一区域或/和第二区域或/和第三区域进行网格划分的准确性。根据第一位置信息以及各第二坐标范围之间的位置关系,确定目标车辆经过各第二坐标范围对应的第四区域,保证了确定的第四区域的准确性,并利用第二网格对第四区域进行网格划分,保证了对第四区域进行网格划分的准确性。
结合第一方面第二实施方式,在第一方面第三实施方式中,根据网格划分结果,对不同网格大小的区域分别进行不同的路径规划,生成目标车辆行驶方向预设范围内目标规划路径;
针对利用第二网格进行网格划分的第四区域,将各第二网格中障碍物占用的区域进行剔除;
根据各第二网格到障碍物的第一最小距离、各第二网格到道路边界的第二最小距离以及各第二网格到终点的第三距离之间的关系,计算各第二网格对应的网格代价;
获取目标车辆的转向约束代价,根据转向约束代价以及各网格代价之间的关系,利用预设的路径规划算法,对第四区域进行网格路径搜索,得到第一候选规划路径;
对第一候选规划路径进行多项式插值处理,得到第一参考规划路径。
本发明实施例提供的路径规划方法,针对利用第二网格进行网格划分的第四区域,将各第二网格中障碍物占用的区域进行剔除,避免了目标车辆与障碍物之间发生碰撞。根据各第二网格到障碍物的第一最小距离、各第二网格到道路边界的第二最小距离以及各第二网格到终点的第三距离之间的关系,计算各第二网格对应的网格代价,保证了计算得到的网格代价的准确性。然后,获取目标车辆的转向约束代价,根据转向约束代价以及各网格代价之间的关系,利用预设的路径规划算法,对第四区域进行网格路径搜索,得到第一候选规划路径,保证了得到的第一候选规划路径的准确性。然后,对第一候选规划路径进行多项式插值处理,得到第一参考规划路径,保证了得到的第一参考规划路径的准确性。
结合第一方面第三实施方式,在第一方面第四实施方式中,根据网格划分结果,对不同网格大小的区域分别进行不同的路径规划,生成目标车辆行驶方向预设范围内目标规划路径;
针对利用第一网格进行网格划分的第一区域或/和第二区域或/和第三区域,获取目标车辆在预设范围的预设路径;
将第一区域或/和第二区域或/和第三区域对应的预设路径,作为第一区域或/和第二区域或/和第三区域对应的第二参考路径;
将第一参考路径和第二参考路径进行拼接,生成目标车辆行驶方向预设范围内目标规划路径。
本发明实施例提供的路径规划方法,针对利用第一网格进行网格划分的第一区域或/和第二区域或/和第三区域,获取目标车辆在预设范围的预设路径,将第一区域或/和第二区域或/和第三区域对应的预设路径,作为第一区域或/和第二区域或/和第三区域对应的第二参考路径,保证了确定的第一区域或/和第二区域或/和第三区域对应的第二参考路径的准确性,将第一参考路径和第二参考路径进行拼接,生成目标车辆行驶方向预设范围内目标规划路径,保证了生成的目标规划路径的准确性。上述方法,将第一区域或/和第二区域或/和第三区域对应的预设路径,作为第一区域或/和第二区域或/和第三区域对应的第二参考路径,因此不仅可以保证规划得到的第二参考路径的准确性,还可以减少路径规划的计算量,尽可能的节省计算平台的占用,将宝贵的计算资源提供给大量的感知传感器数据处理和AI推理部分。
结合第一方面,在第一方面第五实施方式中,根据目标规划路径中各个路径点的曲率以及各个障碍物对应的第二位置信息,对目标规划路径对应的速度进行规划,确定目标车辆行驶目标规划路径对应的目标速度,包括:
利用预设的速度规划算法,对目标规划路径对应的速度进行规划得到参考速度;
根据目标规划路径中各个路径点的曲率以及各个障碍物对应的第二位置信息,对参考速度进行速度修正,确定目标车辆行驶目标规划路径对应的目标速度。
本发明实施例提供的路径规划方法,利用预设的速度规划算法,对目标规划路径对应的速度进行规划得到参考速度,保证了得到的参考速度的准确性。然后,根据目标规划路径中各个路径点的曲率以及各个障碍物对应的第二位置信息,对参考速度进行速度修正,确定目标车辆行驶目标规划路径对应的目标速度,保证了生成的目标速度的准确性。
结合第一方面,在第一方面第六实施方式中,方法还包括:
当满足对目标车辆对应的行驶路径进行重新规划的预设条件时,将最后一个未处理完的障碍物对应的第二位置信息添加到下一周期进行路径规划。
本发明实施例提供的路径规划方法,当满足对目标车辆对应的行驶路径进行重新规划的预设条件时,将最后一个未处理完的障碍物对应的第二位置信息添加到下一周期进行路径规划,保证了下一周期路径规划的准确性。
根据第二方面,本发明实施例还提供了一种路径规划装置,装置包括:
获取模块,用于获取目标坐标系下目标车辆对应的第一位置信息以及目标车辆行驶方向预设范围内的各个障碍物对应的第二位置信息;
网格划分模块,用于根据第一位置信息以及第二位置信息之间的关系,对目标车辆行驶方向预设范围内的区域利用不同大小的网格进行划分;
路径规划模块,用于根据网格划分结果,对不同网格大小的区域分别进行不同的路径规划,生成目标车辆行驶方向预设范围内目标规划路径;
速度规划模块,用于根据目标规划路径中各个路径点的曲率以及各个障碍物对应的第二位置信息,对目标规划路径对应的速度进行规划,确定目标车辆行驶目标规划路径对应的目标速度。
本发明实施例提供的路径规划装置,获取目标坐标系下目标车辆对应的第一位置信息以及目标车辆行驶方向预设范围内的各个障碍物对应的第二位置信息,保证了获取的第一位置信息以及第二位置信息之间的准确性。然后,根据第一位置信息以及第二位置信息之间的关系,对目标车辆行驶方向预设范围内的区域利用不同大小的网格进行划分,保证了得到的网格划分结果的准确性。根据网格划分结果,对不同网格大小的区域分别进行不同的路径规划,生成目标车辆行驶方向预设范围内目标规划路径,保证了生成的目标车辆行驶方向预设范围内目标规划路径的准确性。然后,根据目标规划路径中各个路径点的曲率以及各个障碍物对应的第二位置信息,对目标规划路径对应的速度进行规划,确定目标车辆行驶目标规划路径对应的目标速度,保证了确定的目标规划路径对应的目标速度的准确性。上述装置,根据第一位置信息以及第二位置信息之间的关系,对目标车辆行驶方向预设范围内的区域利用不同大小的网格进行划分,因此,可以根据网格划分结果,对不同网格大小的区域分别进行不同的路径规划,生成目标车辆行驶方向预设范围内目标规划路径。从而可以实现针对没有障碍物的路径进行简单的路径规划,针对有障碍物的路径进行较为细致的路径规划。不仅可以保证规划得到的目标规划路径的准确性,还可以减少路径规划的计算量,尽可能的节省计算平台的占用,将宝贵的计算资源提供给大量的感知传感器数据处理和AI推理部分。上述方法,更加适用于封闭场景的自动驾驶车辆进行路径规划。
根据第三方面,本发明实施例提供了一种电子设备,包括存储器和处理器,存储器和处理器之间互相通信连接,存储器中存储有计算机指令,处理器通过执行计算机指令,从而执行第一方面或者第一方面的任意一种实施方式中的路径规划方法。
根据第四方面,本发明实施例提供了一种计算机可读存储介质,计算机可读存储介质存储计算机指令,计算机指令用于使计算机执行第一方面或者第一方面的任意一种实施方式中的路径规划方法。
附图说明
为了更清楚地说明本发明具体实施方式或现有技术中的技术方案,下面将对具体实施方式或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图是本发明的一些实施方式,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1是应用本发明实施例提供的路径规划方法的流程图;
图2是应用本发明另一实施例提供的路径规划方法的流程图;
图3是应用本发明另一实施例提供的路径规划方法的流程图;
图4是应用本发明另一实施例提供的路径规划方法的流程图;
图5是应用本发明实施例提供的路径规划装置的功能模块图;
图6是应用本发明实施例提供的路径规划装置的功能模块图;
图7是应用本发明实施例提供的电子设备的硬件结构示意图。
具体实施方式
为使本发明实施例的目的、技术方案和优点更加清楚,下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
需要说明的是,本申请实施例提供的路径规划的方法,其执行主体可以是路径规划的装置,该路径规划的装置可以通过软件、硬件或者软硬件结合的方式实现成为电子设备的部分或者全部,其中,该电子设备可以是智能驾驶车辆中的控制设备,也可以是与智能驾驶车辆连接,但独立于智能驾驶车辆的终端设备或者服务器设备,其中,本申请实施例中的服务器可以为一台服务器,也可以为由多台服务器组成的服务器集群,本申请实施例中的终端可以是智能手机、个人电脑、平板电脑、可穿戴设备以及智能机器人等其他智能硬件设备。下述方法实施例中,均以执行主体是电子设备为例来进行说明。
在本申请一个实施例中,如图1所示,提供了一种路径规划方法,以该方法应用于电子设备为例进行说明,包括以下步骤:
S11、获取目标坐标系下目标车辆对应的第一位置信息以及目标车辆行驶方向预设范围内的各个障碍物对应的第二位置信息。
在本申请一种可选的实施方式中,电子设备可以利用定位系统获取目标坐标系下目标车辆对应的第一位置信息,并通过传感器、雷达等设备检测目标车辆行驶方向预设范围内的各个障碍物,并获取各个障碍物对应的第二位置信息。
在本申请另一种可选的实施方式中,电子设备还可以接收与电子设备连接的目标车辆或者其他设备发送的目标坐标系下目标车辆对应的第一位置信息以及目标车辆行驶方向预设范围内的各个障碍物对应的第二位置信息。
本申请实施例对电子设备获取目标坐标系下目标车辆对应的第一位置信息以及目标车辆行驶方向预设范围内的各个障碍物对应的第二位置信息的方式不做具体限定。
关于该步骤将在下文进行详细介绍。
S12、根据第一位置信息以及第二位置信息之间的关系,对目标车辆行驶方向预设范围内的区域利用不同大小的网格进行划分。
具体地,电子设备在获取到第一位置信息以及第二位置信息之后,可以根据第一位置信息以及第二位置信息之间的位置关系,对目标车辆行驶方向预设范围内的区域进行划分,然后根据区域划分结果,利用不同大小的网格对不同的区域进行网格划分。
关于该步骤将在下文进行详细介绍。
S13、根据网格划分结果,对不同网格大小的区域分别进行不同的路径规划,生成目标车辆行驶方向预设范围内目标规划路径。
具体地,电子设备在对目标车辆行驶方向预设范围内的区域利用不同大小的网格进行划分之后,根据网格划分结果,针对不同网格大小的区域分别进行不同的路径规划,然后将各个区域对应的规划路径进行拼接,生成分别进行不同的路径规划。
关于该步骤将在下文进行详细介绍。
S14、根据目标规划路径中各个路径点的曲率以及各个障碍物对应的第二位置信息,对目标规划路径对应的速度进行规划,确定目标车辆行驶目标规划路径对应的目标速度。
具体地,电子设备在规划得到目标车辆行驶方向预设范围内的目标规划路径之后,可以根据各个障碍物对应的第二位置信息计算目标规划路径上的各个路径点到第二位置信息之间距离,然后,将各个路径点到第二位置信息之间距离和目标规划路径中各个路径点的曲率加入到路径点速度约束进行速度规划,从而确定目标车辆行驶目标规划路径对应的目标速度。
本发明实施例提供的路径规划方法,获取目标坐标系下目标车辆对应的第一位置信息以及目标车辆行驶方向预设范围内的各个障碍物对应的第二位置信息,保证了获取的第一位置信息以及第二位置信息之间的准确性。然后,根据第一位置信息以及第二位置信息之间的关系,对目标车辆行驶方向预设范围内的区域利用不同大小的网格进行划分,保证了得到的网格划分结果的准确性。根据网格划分结果,对不同网格大小的区域分别进行不同的路径规划,生成目标车辆行驶方向预设范围内目标规划路径,保证了生成的目标车辆行驶方向预设范围内目标规划路径的准确性。然后,根据目标规划路径中各个路径点的曲率以及各个障碍物对应的第二位置信息,对目标规划路径对应的速度进行规划,确定目标车辆行驶目标规划路径对应的目标速度,保证了确定的目标规划路径对应的目标速度的准确性。上述方法,根据第一位置信息以及第二位置信息之间的关系,对目标车辆行驶方向预设范围内的区域利用不同大小的网格进行划分,因此,可以根据网格划分结果,对不同网格大小的区域分别进行不同的路径规划,生成目标车辆行驶方向预设范围内目标规划路径。从而可以实现针对没有障碍物的路径进行简单的路径规划,针对有障碍物的路径进行较为细致的路径规划。不仅可以保证规划得到的目标规划路径的准确性,还可以减少路径规划的计算量,尽可能的节省计算平台的占用,将宝贵的计算资源提供给大量的感知传感器数据处理和AI推理部分。上述方法,更加适用于封闭场景的自动驾驶车辆进行路径规划。
在本申请一个实施例中,如图2所示,提供了一种路径规划方法,以该方法应用于电子设备为例进行说明,包括以下步骤:
S21、获取目标坐标系下目标车辆对应的第一位置信息以及目标车辆行驶方向预设范围内的各个障碍物对应的第二位置信息。
在本申请一种可选的实施方式中,上述S21“取目标坐标系下目标车辆对应的第一位置信息以及目标车辆行驶方向预设范围内的各个障碍物对应的第二位置信息”,可以包括如下步骤:
S211、获取目标车辆的中心点,以中心点为目标坐标系的原点,目标车辆行驶方向为纵轴,垂直于目标车辆行驶方向为横轴,建立目标坐标系。
具体地,电子设备可以通过定位系统对目标车辆进行定位,然后根据对目标车辆进行定位后的定位信息,确定目标车辆的中心点。在确定目标车辆的中心点以后,电子设备可以以目标车辆的中心点为目标坐标系的原点,目标车辆行驶方向为纵轴,垂直于目标车辆行驶方向为横轴,建立目标坐标系。
S212、根据目标坐标系与目标车辆之间的关系,确定第一位置信息。
具体地,在确定了目标坐标系之后,电子设备可以根据目标坐标系的原点为目标车辆的中心点这一关系,确定目标车辆在目标坐标系下的第一位置信息。
S213、获取各个障碍物对应的行驶轨迹,将各个障碍物对应的行驶轨迹投影到目标坐标系下,获取各个障碍物在目标坐标系下的投影列表。
具体地,电子设备可以基于感知系统获取预设时间段内的感知数据,然后对感知数据进行研究分析,获取各个障碍物对应的行驶轨迹,然后,电子设备将各个障碍物对应的各个顶点的行驶轨迹投影到目标坐标系下,然后根据投影结果,获取各个障碍物在目标坐标系下的投影列表。
示例性的,根据实际需求进行配置,假设目标车辆当前的位置表示为P,障碍物i表示为Obs(i),Obs(i)的第j个顶点表示为Obs(i)(j)。Obs(i)(j)投影到目标坐标系下为Obs_SL(i)(j),P投影到目标坐标系下为P_SL。
S214、对投影列表进行分析,确定各个障碍物在目标坐标系下对应的第二位置信息。
具体地,电子设备在获取到各个障碍物在目标坐标系下的投影列表之后,电子设备可以对投影列表进行读取分析,确定各个障碍物在目标坐标系下对应的第二位置信息。
S22、根据第一位置信息以及第二位置信息之间的关系,对目标车辆行驶方向预设范围内的区域利用不同大小的网格进行划分。
关于该步骤请参见图1对S12的介绍,在此不进行赘述。
S23、根据网格划分结果,对不同网格大小的区域分别进行不同的路径规划,生成目标车辆行驶方向预设范围内目标规划路径。
关于该步骤请参见图1对S13的介绍,在此不进行赘述。
S24、根据目标规划路径中各个路径点的曲率以及各个障碍物对应的第二位置信息,对目标规划路径对应的速度进行规划,确定目标车辆行驶目标规划路径对应的目标速度。
关于该步骤请参见图1对S14的介绍,在此不进行赘述。
本发明实施例提供的路径规划方法,获取目标车辆的中心点,以中心点为目标坐标系的原点,目标车辆行驶方向为纵轴,垂直于目标车辆行驶方向为横轴,建立目标坐标系,保证了建立的目标坐标系的准确性。然后,根据目标坐标系与目标车辆之间的关系,确定第一位置信息,保证了确定的第一位置信息的准确性。获取各个障碍物对应的行驶轨迹,将各个障碍物对应的行驶轨迹投影到目标坐标系下,获取各个障碍物在目标坐标系下的投影列表,保证了获取到的各个障碍物在目标坐标系下的投影列表的准确性。对投影列表进行分析,确定各个障碍物在目标坐标系下对应的第二位置信息,保证了确定的各个障碍物在目标坐标系下对应的第二位置信息的准确性。
在本申请一个实施例中,如图3所示,提供了一种路径规划方法,以该方法应用于电子设备为例进行说明,包括以下步骤:
S31、获取目标坐标系下目标车辆对应的第一位置信息以及目标车辆行驶方向预设范围内的各个障碍物对应的第二位置信息。
关于该步骤请参见图2对S21的介绍,在此不进行赘述。
S32、根据第一位置信息以及第二位置信息之间的关系,对目标车辆行驶方向预设范围内的区域利用不同大小的网格进行划分。
在本申请一种可选的实施方式中,S32“根据第一位置信息以及第二位置信息之间的关系,对目标车辆行驶方向预设范围内的区域利用不同大小的网格进行划分”,可以包括如下步骤:
S321、获取目标车辆对应的最小转弯距离。
在一种可选的实施方式中,电子设备可以获取目标车辆的参数信息,然后根据目标车辆的参数计算目标车辆对应的最小转弯距离。其中,参数信息可以包括目标车辆的长度、宽度、前轴长、后轴长等信息。
S322、根据各第二位置信息,确定各障碍物在目标坐标系中占用的第一坐标范围。
具体地,电子设备对各个障碍物在目标坐标系下的第二位置信息进行分析,确定各障碍物在目标坐标系中占用的第一坐标范围。
S323、将第一坐标范围沿目标坐标系的横轴向两侧扩宽最小转弯距离,得到各障碍物在目标坐标系中占用的第二坐标范围。
具体地,在确定了各障碍物在目标坐标系中占用的第一坐标范围之后,将第一坐标范围沿目标坐标系的横轴向两侧扩宽最小转弯距离,得到各障碍物在目标坐标系中占用的第二坐标范围。
示例性的,假设第一坐标范围在目标坐标下的横轴范围为[1m,5m],且目标车辆对应的最小转弯距离为1m,电子设备将第一坐标范围沿目标坐标系的横轴向两侧扩宽1m,得到第二坐标范围,得到的第二坐标范围在目标坐标下的横轴范围为[0m,6m]。
S324、根据第一位置信息以及各第二坐标范围之间的位置关系,确定目标车辆与距离最近的第二坐标范围之间的第一区域或/和各第二坐标范围之间的第二区域或/和距离预设范围的终点最近的第二坐标范围到终点之间的第三区域。
具体地,电子设备根据第一位置信息以及各第二坐标范围之间的位置关系,确定目标车辆与距离最近的第二坐标范围之间的第一区域或/和各第二坐标范围之间的第二区域或/和距离预设范围的终点最近的第二坐标范围到终点之间的第三区域。
S325、利用第一网格对第一区域或/和第二区域或/和第三区域进行网格划分。
具体地,电子设备可以利用第一网格对第一区域或/和第二区域或/和第三区域进行网格划分。
示例性的,电子设备可以将第一区域或/和第二区域或/和第三区域均视为一个网格,该网格的尺寸可以根据第一区域或/和第二区域或/和第三区域的大小确定。
S326、根据第一位置信息以及各第二坐标范围之间的位置关系,确定目标车辆经过各第二坐标范围对应的第四区域。
具体地,电子设备根据第一位置信息以及各第二坐标范围之间的位置关系,确定目标车辆经过各第二坐标范围对应的第四区域。
S327、利用第二网格对第四区域进行网格划分。
其中,第二网格的尺寸小于第一网格。
具体地,电子设备可以利用第二网格对第四区域进行网格划分。其中,第二网格的尺寸可以根据用户需求进行设定。
示例性的,电子设备可以在目标坐标系横轴方向以及纵轴方向上按照一定步长step(0.5m)进行采采样,构成了Obs(i)的网格空间。
S33、根据网格划分结果,对不同网格大小的区域分别进行不同的路径规划,生成目标车辆行驶方向预设范围内目标规划路径。
在本申请一种可选的实施方式中,S33“根据网格划分结果,对不同网格大小的区域分别进行不同的路径规划,生成目标车辆行驶方向预设范围内目标规划路径”,可以包括如下步骤:
S331、针对利用第二网格进行网格划分的第四区域,将各第二网格中障碍物占用的区域进行剔除。
具体地,针对利用第二网格进行网格划分的第四区域,电子设备可以根据目标坐标系下各个障碍物的第二位置信息,将各第二网格中障碍物占用的区域进行剔除。
S332、根据各第二网格到障碍物的第一最小距离、各第二网格到道路边界的第二最小距离以及各第二网格到终点的第三距离之间的关系,计算各第二网格对应的网格代价。
在本申请一种可选的实施方式中,针对各个第二网格的,电子设备可以计算各第二网格到障碍物的第一最小距离、各第二网格到左右道路边界的第二最小距离以及各第二网格到目标车辆行驶方向预设范围内的终点的第三距离,电子设备可以将第一最小距离、第二最小距离以及第三距离进行相加,计算得到各第二网格对应的网格代价。
针对各个第二网格的,电子设备可以计算各第二网格到障碍物的第一最小距离、各第二网格到左右道路边界的第二最小距离以及各第二网格到目标车辆行驶方向预设范围内的终点的第三距离,然后分别将第一最小距离、第二最小距离以及第三距离乘以相应的权重系数之后进行相加,计算得到各第二网格对应的网格代价。
示例性的,将第二网格i表示为grid(i),grid(i)距离障碍物的第一最小距离为grid(i)_d_obs、grid(i)距离左右道路边界的第二最小距离为grid(i)_d_l,grid(i)距离标车辆行驶方向预设范围内的终点的距离为grid(i)_d_tar,电子设备可以基于利用如下公式计算第二网格对应的网格代价:
grid(i)_f=a*grid(i)_d_obs+b*grid(i)_d_l+c*grid(i)_d_tar (1)
其中,a、b、c分别保证第一距离、第二距离以及第三距离对应的权重系数。
S333、获取目标车辆的转向约束代价,根据转向约束代价以及各网格代价之间的关系,利用预设的路径规划算法,对第四区域进行网格路径搜索,得到第一候选规划路径。
具体地,电子设备在计算得到的各个第二网格对应的网格代价之后,电子设备获取目标车辆的转向约束代价,然后根据转向约束代价以及各网格代价之间的关系,利用预设的路径规划算法,对第四区域进行网格路径搜索,得到第一候选规划路径。
其中,路径规划算法可以是A*搜索算法,也可以是其他路径规划算法,本申请实施例对路径规划算法不做具体限定。
示例性的,利用预设的路径规划算法,对第四区域进行网格路径搜索时,在从第二网格grid(i)到第二网格grid(j)的搜索过程中,到下一grid的代价为:f=grid(j)_f+theta,theta为转向角。
S334、对第一候选规划路径进行多项式插值处理,得到第一参考规划路径。
具体地,在生成第一候选规划路径之后,电子设备可以对第一候选规划路径进行多项式插值处理,得到第一参考规划路径。
S335、针对利用第一网格进行网格划分的第一区域或/和第二区域或/和第三区域,获取目标车辆在预设范围的预设路径。
具体地,针对利用第一网格进行网格划分的第一区域或/和第二区域或/和第三区域,电子设备可以获取目标车辆在预设范围的候选路径,对候选路径进行平滑处理,生成预设路径。
S336、将第一区域或/和第二区域或/和第三区域对应的预设路径,作为第一区域或/和第二区域或/和第三区域对应的第二参考路径。
具体地,电子设备可以将第一区域或/和第二区域或/和第三区域对应的预设路径,作为第一区域或/和第二区域或/和第三区域对应的第二参考路径。
S337、将第一参考路径和第二参考路径进行拼接,生成目标车辆行驶方向预设范围内目标规划路径。
具体地,电子设备将第一参考路径和第二参考路径进行拼接,生成目标车辆行驶方向预设范围内目标规划路径。
S34、根据目标规划路径中各个路径点的曲率以及各个障碍物对应的第二位置信息,对目标规划路径对应的速度进行规划,确定目标车辆行驶目标规划路径对应的目标速度。
关于该步骤请参见图2对S24的介绍,在此不进行赘述。
本发明实施例提供的路径规划方法,获取目标车辆对应的最小转弯距离。根据各第二位置信息,确定各障碍物在目标坐标系中占用的第一坐标范围,保证了确定的各障碍物在目标坐标系中占用的第一坐标范围的准确性。然后,将第一坐标范围沿目标坐标系的横轴向两侧扩宽最小转弯距离,得到各障碍物在目标坐标系中占用的第二坐标范围,保证了得到的各障碍物在目标坐标系中占用的第二坐标范围的准确性,且保证了目标车辆可以安全通过第二坐标范围。然后,根据第一位置信息以及各第二坐标范围之间的位置关系,确定目标车辆与距离最近的第二坐标范围之间的第一区域或/和各第二坐标范围之间的第二区域或/和距离预设范围的终点最近的第二坐标范围到终点之间的第三区域,保证了确定的第一区域或/和第二区域或/和第三区域的准确性。利用第一网格对第一区域或/和第二区域或/和第三区域进行网格划分,保证了对第一区域或/和第二区域或/和第三区域进行网格划分的准确性。根据第一位置信息以及各第二坐标范围之间的位置关系,确定目标车辆经过各第二坐标范围对应的第四区域,保证了确定的第四区域的准确性,并利用第二网格对第四区域进行网格划分,保证了对第四区域进行网格划分的准确性。
此外,针对利用第二网格进行网格划分的第四区域,将各第二网格中障碍物占用的区域进行剔除,避免了目标车辆与障碍物之间发生碰撞。根据各第二网格到障碍物的第一最小距离、各第二网格到道路边界的第二最小距离以及各第二网格到终点的第三距离之间的关系,计算各第二网格对应的网格代价,保证了计算得到的网格代价的准确性。然后,获取目标车辆的转向约束代价,根据转向约束代价以及各网格代价之间的关系,利用预设的路径规划算法,对第四区域进行网格路径搜索,得到第一候选规划路径,保证了得到的第一候选规划路径的准确性。然后,对第一候选规划路径进行多项式插值处理,得到第一参考规划路径,保证了得到的第一参考规划路径的准确性。
针对利用第一网格进行网格划分的第一区域或/和第二区域或/和第三区域,获取目标车辆在预设范围的预设路径,将第一区域或/和第二区域或/和第三区域对应的预设路径,作为第一区域或/和第二区域或/和第三区域对应的第二参考路径,保证了确定的第一区域或/和第二区域或/和第三区域对应的第二参考路径的准确性,将第一参考路径和第二参考路径进行拼接,生成目标车辆行驶方向预设范围内目标规划路径,保证了生成的目标规划路径的准确性。上述方法,将第一区域或/和第二区域或/和第三区域对应的预设路径,作为第一区域或/和第二区域或/和第三区域对应的第二参考路径,因此不仅可以保证规划得到的第二参考路径的准确性,还可以减少路径规划的计算量,尽可能的节省计算平台的占用,将宝贵的计算资源提供给大量的感知传感器数据处理和AI推理部分。
在本申请一个实施例中,如图4所示,提供了一种路径规划方法,以该方法应用于电子设备为例进行说明,包括以下步骤:
S41、获取目标坐标系下目标车辆对应的第一位置信息以及目标车辆行驶方向预设范围内的各个障碍物对应的第二位置信息。
关于该步骤请参见图3对S31的介绍,在此不进行赘述。
S42、根据第一位置信息以及第二位置信息之间的关系,对目标车辆行驶方向预设范围内的区域利用不同大小的网格进行划分。
关于该步骤请参见图3对S32的介绍,在此不进行赘述。
S43、根据网格划分结果,对不同网格大小的区域分别进行不同的路径规划,生成目标车辆行驶方向预设范围内目标规划路径。
关于该步骤请参见图3对S33的介绍,在此不进行赘述。
S44、根据目标规划路径中各个路径点的曲率以及各个障碍物对应的第二位置信息,对目标规划路径对应的速度进行规划,确定目标车辆行驶目标规划路径对应的目标速度。
在本申请一种可选的实施方式中,上述S44“根据目标规划路径中各个路径点的曲率以及各个障碍物对应的第二位置信息,对目标规划路径对应的速度进行规划,确定目标车辆行驶目标规划路径对应的目标速度”,可以包括如下步骤:
S441、利用预设的速度规划算法,对目标规划路径对应的速度进行规划得到参考速度。
具体地,电子设备可以利用预设的速度规划算法,对目标规划路径对应的速度进行规划得到参考速度。
其中,速度规划算法可以是T型速度规划算法,也可以是其他速度规划算法,本申请实施例对速度规划算法不做具体限定。
S442、根据目标规划路径中各个路径点的曲率以及各个障碍物对应的第二位置信息,对参考速度进行速度修正,确定目标车辆行驶目标规划路径对应的目标速度。
具体地,在得到参考速度之后,电子设备可以根据各个障碍物对应的第二位置信息计算目标规划路径中各个路径点到最近障碍物的距离,然后,根据目标规划路径中各个路径点到最近障碍物的距离以及目标规划路径中各个路径点的曲率,对参考速度进行速度修正,确定目标车辆行驶目标规划路径对应的目标速度。
示例性的,目标规划路径中的路径点i表示为traj(i),其速度为可以利用如下公式进行修正:
traj(i).v=1/exp(d_obs)*1/exp(kappa)*traj(i).v (2)
其中,d_obs为路径点到最近障碍物的距离,kappa为路径点的曲率。
S45、当满足对目标车辆对应的行驶路径进行重新规划的预设条件时,将最后一个未处理完的障碍物对应的第二位置信息添加到下一周期进行路径规划。
具体地,电子设备还可以实时检测是否满足对目标车辆对应的行驶路径进行重新规划的预设条件,也可以周期性地检测是否满足对目标车辆对应的行驶路径进行重新规划的预设条件。其中,预设条件可以包括电子设备再次检测目标车辆行驶方向存在障碍物,还可以包括目标车辆到行驶方向预设范围内的终点的距离小于等于预设距离阈值,也可以包括其他条件,本申请实施例对预设条件不做具体限定。
当满足对目标车辆对应的行驶路径进行重新规划的预设条件时,电子设备将最后一个未处理完的障碍物对应的第二位置信息添加到下一周期进行路径规划。
本发明实施例提供的路径规划方法,利用预设的速度规划算法,对目标规划路径对应的速度进行规划得到参考速度,保证了得到的参考速度的准确性。然后,根据目标规划路径中各个路径点的曲率以及各个障碍物对应的第二位置信息,对参考速度进行速度修正,确定目标车辆行驶目标规划路径对应的目标速度,保证了生成的目标速度的准确性。
此外,本发明实施例提供的路径规划方法,当满足对目标车辆对应的行驶路径进行重新规划的预设条件时,将最后一个未处理完的障碍物对应的第二位置信息添加到下一周期进行路径规划,保证了下一周期路径规划的准确性。
应该理解的是,虽然图1-4的流程图中的各个步骤按照箭头的指示依次显示,但是这些步骤并不是必然按照箭头指示的顺序依次执行。除非本文中有明确的说明,这些步骤的执行并没有严格的顺序限制,这些步骤可以以其它的顺序执行。而且,图1-4中的至少一部分步骤可以包括多个步骤或者多个阶段,这些步骤或者阶段并不必然是在同一时刻执行完成,而是可以在不同的时刻执行,这些步骤或者阶段的执行顺序也不必然是依次进行,而是可以与其它步骤或者其它步骤中的步骤或者阶段的至少一部分轮流或者交替地执行。
如图5所示,本实施例提供一种路径规划装置,包括:
获取模块51,用于获取目标坐标系下目标车辆对应的第一位置信息以及目标车辆行驶方向预设范围内的各个障碍物对应的第二位置信息;
网格划分模块52,用于根据第一位置信息以及第二位置信息之间的关系,对目标车辆行驶方向预设范围内的区域利用不同大小的网格进行划分;
路径规划模块53,用于根据网格划分结果,对不同网格大小的区域分别进行不同的路径规划,生成目标车辆行驶方向预设范围内目标规划路径;
速度规划模块54,用于根据目标规划路径中各个路径点的曲率以及各个障碍物对应的第二位置信息,对目标规划路径对应的速度进行规划,确定目标车辆行驶目标规划路径对应的目标速度。
在本申请一个实施例中,上述获取模块51,具体用于获取目标车辆的中心点,以中心点为目标坐标系的原点,目标车辆行驶方向为纵轴,垂直于目标车辆行驶方向为横轴,建立目标坐标系;根据目标坐标系与目标车辆之间的关系,确定第一位置信息;获取各个障碍物对应的行驶轨迹,将各个障碍物对应的行驶轨迹投影到目标坐标系下,获取各个障碍物在目标坐标系下的投影列表;对投影列表进行分析,确定各个障碍物在目标坐标系下对应的第二位置信息。
在本申请一个实施例中,上述网格划分模块52,具体用于获取目标车辆对应的最小转弯距离;根据各第二位置信息,确定各障碍物在目标坐标系中占用的第一坐标范围;将第一坐标范围沿目标坐标系的横轴向两侧扩宽最小转弯距离,得到各障碍物在目标坐标系中占用的第二坐标范围;根据第一位置信息以及各第二坐标范围之间的位置关系,确定目标车辆与距离最近的第二坐标范围之间的第一区域或/和各第二坐标范围之间的第二区域或/和距离预设范围的终点最近的第二坐标范围到终点之间的第三区域;利用第一网格对第一区域或/和第二区域或/和第三区域进行网格划分;根据第一位置信息以及各第二坐标范围之间的位置关系,确定目标车辆经过各第二坐标范围对应的第四区域;利用第二网格对第四区域进行网格划分,第二网格的尺寸小于第一网格。
在本申请一个实施例中,上述路径规划模块53,具体用于针对利用第二网格进行网格划分的第四区域,将各第二网格中障碍物占用的区域进行剔除;根据各第二网格到障碍物的第一最小距离、各第二网格到道路边界的第二最小距离以及各第二网格到终点的第三距离之间的关系,计算各第二网格对应的网格代价;获取目标车辆的转向约束代价,根据转向约束代价以及各网格代价之间的关系,利用预设的路径规划算法,对第四区域进行网格路径搜索,得到第一候选规划路径;对第一候选规划路径进行多项式插值处理,得到第一参考规划路径。
在本申请一个实施例中,上述路径规划模块53,具体用于针对利用第一网格进行网格划分的第一区域或/和第二区域或/和第三区域,获取目标车辆在预设范围的预设路径;将第一区域或/和第二区域或/和第三区域对应的预设路径,作为第一区域或/和第二区域或/和第三区域对应的第二参考路径;将第一参考路径和第二参考路径进行拼接,生成目标车辆行驶方向预设范围内目标规划路径。
在本申请一个实施例中,上述速度规划模块54,具体用于利用预设的速度规划算法,对目标规划路径对应的速度进行规划得到参考速度;根据目标规划路径中各个路径点的曲率以及各个障碍物对应的第二位置信息,对参考速度进行速度修正,确定目标车辆行驶目标规划路径对应的目标速度。
在本申请一个实施例中,如图6所示,上述路径规划装置,还包括:
添加模块55,用于当满足对目标车辆对应的行驶路径进行重新规划的预设条件时,将最后一个未处理完的障碍物对应的第二位置信息添加到下一周期进行路径规划。
关于路径规划装置的具体限定以及有益效果可以参见上文中对于路径规划方法的限定,在此不再赘述。上述路径规划装置中的各个模块可全部或部分通过软件、硬件及其组合来实现。上述各模块可以硬件形式内嵌于或独立于电子设备中的处理器中,也可以以软件形式存储于电子设备中的存储器中,以便于处理器调用执行以上各个模块对应的操作。
本发明实施例还提供一种电子设备,具有上述图6所示的路径规划装置。
如图7所示,图7是本发明可选实施例提供的一种电子设备的结构示意图,如图7所示,该电子设备可以包括:至少一个处理器61,例如CPU(Central Processing Unit,中央处理器),至少一个通信接口63,存储器64,至少一个通信总线62。其中,通信总线62用于实现这些组件之间的连接通信。其中,通信接口63可以包括显示屏(Display)、键盘(Keyboard),可选通信接口63还可以包括标准的有线接口、无线接口。存储器64可以是高速RAM存储器(Random Access Memory,易挥发性随机存取存储器),也可以是非不稳定的存储器(non-volatile memory),例如至少一个磁盘存储器。存储器64可选的还可以是至少一个位于远离前述处理器61的存储装置。其中处理器61可以结合图5或图6所描述的装置,存储器64中存储应用程序,且处理器61调用存储器64中存储的程序代码,以用于执行上述任一方法步骤。
其中,通信总线62可以是外设部件互连标准(peripheral componentinterconnect,简称PCI)总线或扩展工业标准结构(extended industry standardarchitecture,简称EISA)总线等。通信总线62可以分为地址总线、数据总线、控制总线等。为便于表示,图7中仅用一条粗线表示,但并不表示仅有一根总线或一种类型的总线。
其中,存储器64可以包括易失性存储器(英文:volatile memory),例如随机存取存储器(英文:random-access memory,缩写:RAM);存储器也可以包括非易失性存储器(英文:non-volatile memory),例如快闪存储器(英文:flash memory),硬盘(英文:hard diskdrive,缩写:HDD)或固态硬盘(英文:solid-state drive,缩写:SSD);存储器64还可以包括上述种类的存储器的组合。
其中,处理器61可以是中央处理器(英文:central processing unit,缩写:CPU),网络处理器(英文:network processor,缩写:NP)或者CPU和NP的组合。
其中,处理器61还可以进一步包括硬件芯片。上述硬件芯片可以是专用集成电路(英文:application-specific integrated circuit,缩写:ASIC),可编程逻辑器件(英文:programmable logic device,缩写:PLD)或其组合。上述PLD可以是复杂可编程逻辑器件(英文:complex programmable logic device,缩写:CPLD),现场可编程逻辑门阵列(英文:field-programmable gate array,缩写:FPGA),通用阵列逻辑(英文:generic arraylogic,缩写:GAL)或其任意组合。
可选地,存储器64还用于存储程序指令。处理器61可以调用程序指令,实现如本申请图1至4实施例中所示的路径规划方法。
本发明实施例还提供了一种非暂态计算机存储介质,所述计算机存储介质存储有计算机可执行指令,该计算机可执行指令可执行上述任意方法实施例中的路径规划方法。其中,所述存储介质可为磁碟、光盘、只读存储记忆体(Read-Only Memory,ROM)、随机存储记忆体(Random Access Memory,RAM)、快闪存储器(Flash Memory)、硬盘(Hard DiskDrive,缩写:HDD)或固态硬盘(Solid-State Drive,SSD)等;所述存储介质还可以包括上述种类的存储器的组合。
虽然结合附图描述了本发明的实施例,但是本领域技术人员可以在不脱离本发明的精神和范围的情况下做出各种修改和变型,这样的修改和变型均落入由所附权利要求所限定的范围之内。
Claims (10)
1.一种路径规划方法,其特征在于,所述方法包括:
获取目标坐标系下目标车辆对应的第一位置信息以及所述目标车辆行驶方向预设范围内的各个障碍物对应的第二位置信息;
根据所述第一位置信息以及所述第二位置信息之间的关系,对所述目标车辆行驶方向预设范围内的区域利用不同大小的网格进行划分;
根据网格划分结果,对不同网格大小的区域分别进行不同的路径规划,生成所述目标车辆行驶方向预设范围内目标规划路径;
根据所述目标规划路径中各个路径点的曲率以及各个所述障碍物对应的所述第二位置信息,对所述目标规划路径对应的速度进行规划,确定所述目标车辆行驶所述目标规划路径对应的目标速度。
2.根据权利要求1所述的方法,其特征在于,所述获取目标坐标系下目标车辆对应的第一位置信息以及所述目标车辆行驶方向预设范围内的各个障碍物对应的第二位置信息,包括:
获取所述目标车辆的中心点,以所述中心点为所述目标坐标系的原点,所述目标车辆行驶方向为纵轴,垂直于所述目标车辆行驶方向为横轴,建立所述目标坐标系;
根据所述目标坐标系与所述目标车辆之间的关系,确定所述第一位置信息;
获取各个所述障碍物对应的行驶轨迹,将各个所述障碍物对应的行驶轨迹投影到所述目标坐标系下,获取各个所述障碍物在所述目标坐标系下的投影列表;
对所述投影列表进行分析,确定各个所述障碍物在所述目标坐标系下对应的所述第二位置信息。
3.根据权利要求1所述的方法,其特征在于,所述根据所述第一位置信息以及所述第二位置信息之间的关系,对所述目标车辆行驶方向预设范围内的区域利用不同大小的网格进行划分,包括:
获取所述目标车辆对应的最小转弯距离;
根据各所述第二位置信息,确定各所述障碍物在所述目标坐标系下上占用的第一坐标范围;
将所述第一坐标范围沿所述目标坐标系的横轴向两侧扩宽所述最小转弯距离,得到各所述障碍物在所述目标坐标系中占用的第二坐标范围;
根据所述第一位置信息以及各所述第二坐标范围之间的位置关系,确定所述目标车辆与距离最近的所述第二坐标范围之间的第一区域或/和各所述第二坐标范围之间的第二区域或/和距离所述预设范围的终点最近的所述第二坐标范围到所述终点之间的第三区域;
利用第一网格对所述第一区域或/和所述第二区域或/和所述第三区域进行网格划分;
根据所述第一位置信息以及各所述第二坐标范围之间的位置关系,确定所述目标车辆经过各所述第二坐标范围对应的第四区域;
利用第二网格对所述第四区域进行网格划分,所述第二网格的尺寸小于所述第一网格。
4.根据权利要求3所述的方法,其特征在于,所述根据网格划分结果,对不同网格大小的区域分别进行不同的路径规划,生成所述目标车辆行驶方向预设范围内目标规划路径;
针对利用所述第二网格进行网格划分的所述第四区域,将各所述第二网格中所述障碍物占用的区域进行剔除;
根据各所述第二网格到所述障碍物的第一最小距离、各所述第二网格到道路边界的第二最小距离以及各所述第二网格到所述终点的第三距离之间的关系,计算各所述第二网格对应的网格代价;
获取目标车辆的转向约束代价,根据所述转向约束代价以及各所述网格代价之间的关系,利用预设的路径规划算法,对所述第四区域进行网格路径搜索,得到第一候选规划路径;
对所述第一候选规划路径进行多项式插值处理,得到第一参考规划路径。
5.根据权利要求4所述的方法,其特征在于,所述根据网格划分结果,对不同网格大小的区域分别进行不同的路径规划,生成所述目标车辆行驶方向预设范围内目标规划路径;
针对利用所述第一网格进行网格划分的所述第一区域或/和所述第二区域或/和所述第三区域,获取所述目标车辆在所述预设范围的预设路径;
将所述第一区域或/和所述第二区域或/和第三区域对应的所述预设路径,作为所述第一区域或/和所述第二区域或/和第三区域对应的第二参考路径;
将所述第一参考路径和所述第二参考路径进行拼接,生成所述目标车辆行驶方向预设范围内所述目标规划路径。
6.根据权利要求1所述的方法,其特征在于,所述根据所述目标规划路径中各个路径点的曲率以及各个所述障碍物对应的所述第二位置信息,对所述目标规划路径对应的速度进行规划,确定所述目标车辆行驶所述目标规划路径对应的目标速度,包括:
利用预设的速度规划算法,对所述目标规划路径对应的速度进行规划得到参考速度;
根据所述目标规划路径中各个路径点的曲率以及各个所述障碍物对应的所述第二位置信息,对所述参考速度进行速度修正,确定所述目标车辆行驶所述目标规划路径对应的所述目标速度。
7.根据权利要求1所述的方法,其特征在于,所述方法还包括:
当满足对所述目标车辆对应的行驶路径进行重新规划的预设条件时,将最后一个未处理完的所述障碍物对应的所述第二位置信息添加到下一周期进行路径规划。
8.一种路径规划装置,其特征在于,所述装置包括:
获取模块,用于获取目标坐标系下目标车辆对应的第一位置信息以及所述目标车辆行驶方向预设范围内的各个障碍物对应的第二位置信息;
网格划分模块,用于根据所述第一位置信息以及所述第二位置信息之间的关系,对所述目标车辆行驶方向预设范围内的区域利用不同大小的网格进行划分;
路径规划模块,用于根据网格划分结果,对不同网格大小的区域分别进行不同的路径规划,生成所述目标车辆行驶方向预设范围内目标规划路径;
速度规划模块,用于根据所述目标规划路径中各个路径点的曲率以及各个所述障碍物对应的所述第二位置信息,对所述目标规划路径对应的速度进行规划,确定所述目标车辆行驶所述目标规划路径对应的目标速度。
9.一种电子设备,其特征在于,包括存储器和处理器,所述存储器中存储有计算机指令,所述处理器通过执行所述计算机指令,从而执行权利要求1-7中任一项所述的路径规划方法。
10.一种计算机可读存储介质,其特征在于,所述计算机可读存储介质存储有计算机指令,所述计算机指令用于使计算机执行权利要求1-7中任一项所述的路径规划方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211278116.2A CN115597620A (zh) | 2022-10-18 | 2022-10-18 | 路径规划方法、装置、电子设备及存储介质 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211278116.2A CN115597620A (zh) | 2022-10-18 | 2022-10-18 | 路径规划方法、装置、电子设备及存储介质 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN115597620A true CN115597620A (zh) | 2023-01-13 |
Family
ID=84849492
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202211278116.2A Pending CN115597620A (zh) | 2022-10-18 | 2022-10-18 | 路径规划方法、装置、电子设备及存储介质 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN115597620A (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN117073709A (zh) * | 2023-10-17 | 2023-11-17 | 福瑞泰克智能系统有限公司 | 路径规划方法、装置、计算机设备以及存储介质 |
CN117553804A (zh) * | 2024-01-11 | 2024-02-13 | 深圳市普渡科技有限公司 | 路径规划方法、装置、计算机设备和存储介质 |
-
2022
- 2022-10-18 CN CN202211278116.2A patent/CN115597620A/zh active Pending
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN117073709A (zh) * | 2023-10-17 | 2023-11-17 | 福瑞泰克智能系统有限公司 | 路径规划方法、装置、计算机设备以及存储介质 |
CN117073709B (zh) * | 2023-10-17 | 2024-01-16 | 福瑞泰克智能系统有限公司 | 路径规划方法、装置、计算机设备以及存储介质 |
CN117553804A (zh) * | 2024-01-11 | 2024-02-13 | 深圳市普渡科技有限公司 | 路径规划方法、装置、计算机设备和存储介质 |
CN117553804B (zh) * | 2024-01-11 | 2024-04-09 | 深圳市普渡科技有限公司 | 路径规划方法、装置、计算机设备和存储介质 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN115597620A (zh) | 路径规划方法、装置、电子设备及存储介质 | |
US11281229B2 (en) | Method and apparatus for outputting obstacle information | |
CN113715814B (zh) | 碰撞检测方法、装置、电子设备、介质及自动驾驶车辆 | |
US20190086543A1 (en) | Method And Apparatus For Tracking Obstacle | |
CN111813101B (zh) | 机器人路径规划方法、装置、终端设备及存储介质 | |
CN111209978B (zh) | 三维视觉重定位方法、装置及计算设备、存储介质 | |
CN112783144B (zh) | 路径生成方法和路径规划方法及其系统和设备 | |
CN113264066A (zh) | 障碍物轨迹预测方法、装置、自动驾驶车辆及路侧设备 | |
WO2022056770A1 (zh) | 一种路径规划方法和路径规划装置 | |
JP6914404B2 (ja) | 車両を制御するための方法及び装置 | |
CN111707258B (zh) | 一种外部车辆监测方法、装置、设备及存储介质 | |
CN112819864A (zh) | 一种行驶状态检测方法、装置及存储介质 | |
CN115609594A (zh) | 机械臂路径的规划方法、装置、上位控制端及存储介质 | |
CN116080687A (zh) | 一种预测轨迹后处理方法、系统、设备和介质 | |
CN115782867A (zh) | 轨迹碰撞风险评估方法、装置、电子设备和存储介质 | |
CN115249266A (zh) | 航路点位置预测方法、系统、设备及存储介质 | |
CN117141520B (zh) | 一种实时轨迹规划方法、装置和设备 | |
CN112622923A (zh) | 用于控制车辆的方法和装置 | |
CN113139696B (zh) | 一种轨迹预测模型构建方法及轨迹预测方法、装置 | |
CN112150538A (zh) | 一种在三维地图构建过程中车辆位姿的确定方法和装置 | |
CN113050660A (zh) | 误差补偿方法、装置、计算机设备及存储介质 | |
CN112558036B (zh) | 用于输出信息的方法和装置 | |
CN114812539B (zh) | 地图探索、地图使用方法、装置、机器人和存储介质 | |
CN116070903A (zh) | 通过障碍物区域的风险确定方法、装置以及电子设备 | |
CN112734810B (zh) | 一种障碍物追踪方法及装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination |