CN116659539A - 路径规划方法、装置和域控制器 - Google Patents
路径规划方法、装置和域控制器 Download PDFInfo
- Publication number
- CN116659539A CN116659539A CN202310950750.4A CN202310950750A CN116659539A CN 116659539 A CN116659539 A CN 116659539A CN 202310950750 A CN202310950750 A CN 202310950750A CN 116659539 A CN116659539 A CN 116659539A
- Authority
- CN
- China
- Prior art keywords
- vehicle
- time
- lane
- point
- driving
- 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.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 58
- 238000004590 computer program Methods 0.000 claims description 11
- 238000004364 calculation method Methods 0.000 abstract description 9
- 230000008859 change Effects 0.000 description 24
- 230000008569 process Effects 0.000 description 20
- 230000001133 acceleration Effects 0.000 description 18
- 238000010586 diagram Methods 0.000 description 13
- 238000005516 engineering process Methods 0.000 description 11
- 238000004422 calculation algorithm Methods 0.000 description 10
- 238000001228 spectrum Methods 0.000 description 8
- 230000006870 function Effects 0.000 description 5
- 238000012545 processing Methods 0.000 description 5
- 230000003044 adaptive effect Effects 0.000 description 2
- 238000013500 data storage Methods 0.000 description 2
- 238000011161 development Methods 0.000 description 2
- 239000011159 matrix material Substances 0.000 description 2
- 238000010845 search algorithm Methods 0.000 description 2
- OKTJSMMVPCPJKN-UHFFFAOYSA-N Carbon Chemical compound [C] OKTJSMMVPCPJKN-UHFFFAOYSA-N 0.000 description 1
- 108010001267 Protein Subunits Proteins 0.000 description 1
- 238000004458 analytical method Methods 0.000 description 1
- 230000036461 convulsion Effects 0.000 description 1
- 238000006073 displacement reaction Methods 0.000 description 1
- 238000002474 experimental method Methods 0.000 description 1
- 229910021389 graphene Inorganic materials 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 230000008447 perception Effects 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
- 230000007704 transition Effects 0.000 description 1
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
-
- 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
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T10/00—Road transport of goods or passengers
- Y02T10/10—Internal combustion engine [ICE] based vehicles
- Y02T10/40—Engine management systems
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Traffic Control Systems (AREA)
- Steering Control In Accordance With Driving Conditions (AREA)
- Navigation (AREA)
Abstract
本申请涉及一种路径规划方法、装置和域控制器,其中,该路径规划方法包括:基于地图信息,确定自车由当前车道驶入待驶入车道的驶入范围,驶入范围内包括多个驶入点;基于自车与每一驶入点之间的距离,由小到大的顺序依次将多个驶入点确定为候选驶入点;基于候选驶入点的顺序,将首次出现时间交集的候选驶入点确定为最优驶入点,时间交集是基于自车从当前位置到达候选驶入点的驶入时间范围与多个障碍车到达对应的候选驶入点的间隔时间确定的,障碍车为待驶入车道中预设范围内的车辆;基于最优驶入点进行路径规划。通过本申请,解决了自动驾驶场景中路径规划的算力成本较高的问题,有效地降低了自动驾驶场景中路径规划的算力成本。
Description
技术领域
本申请涉及自动驾驶技术领域,特别是涉及一种路径规划方法、装置和域控制器。
背景技术
随着技术的发展,自动驾驶技术得到广泛地应用。其中,可行域求解是自动驾驶技术中的一项关键技术,它依赖于地图、传感器、路径规划、决策算法等多种技术,旨在确定出现实道路环境中可以安全运行的范围,保障行驶过程中的安全和舒适性。
目前,在自动驾驶的可行域求解过程中,主要是遍历循环可行域范围内的所有解,从而计算出最优解,进一步,执行最优解的路径,通过遍历循环可行域范围内的最优解的路径规划方式复杂,且计算量大,从而导致自动驾驶场景中路径规划的算力成本较高。
针对自动驾驶场景中路径规划的算力成本较高的问题,目前还没有提出有效的解决方案。
发明内容
在本实施例中提供了一种路径规划方法、装置和域控制器,以解决自动驾驶场景中路径规划的算力成本较高的问题。
第一个方面,在本实施例中提供了一种路径规划方法,包括:
基于地图信息,确定自车由当前车道驶入待驶入车道的驶入范围,所述驶入范围内包括多个驶入点;
基于所述自车与每一驶入点之间的距离,由小到大的顺序依次将多个驶入点确定为候选驶入点;
基于候选驶入点的顺序,将首次出现时间交集的候选驶入点确定为最优驶入点,所述时间交集是基于所述自车从当前位置到达候选驶入点的驶入时间范围与多个障碍车到达对应的候选驶入点的间隔时间确定的,所述障碍车为所述待驶入车道中预设范围内的车辆;
基于所述最优驶入点进行路径规划。
在其中的一些实施例中,所述基于地图信息,确定自车由当前车道驶入待驶入车道的驶入范围,包括:
基于地图信息,获取当前车道的车道线与待驶入车道的车道线之间的交点;所述交点包括第一交点以及第二交点,所述第一交点到所述自车的距离小于所述第二交点到所述自车的距离;
基于所述自车从所述当前位置到所述待驶入车道的车道线之间的横向距离,确定最小预留时间;
基于所述最小预留时间以及所述自车的车辆信息,确定所述自车的最小预留纵向距离;
基于所述最小预留纵向距离以及所述第一交点的纵向位置信息,确定所述驶入范围的最小值;
基于所述第二交点的纵向位置信息以及第一预设距离,确定所述驶入范围的最大值。
在其中的一些实施例中,所述基于所述自车与每一驶入点之间的距离,由小到大的顺序依次将多个驶入点确定为候选驶入点,包括:
根据第二预设距离在所述驶入范围内确定多个驶入点;
根据多个驶入点与所述自车的距离,由小到大的顺序,依次将多个驶入点确定为候选驶入点。
在其中的一些实施例中,在所述基于所述候选驶入点的顺序,将首次出现时间交集的候选驶入点确定为最优驶入点之前,还包括:
基于所述当前车道驶入所述待驶入车道场景下的最小设定速度,确定所述自车从当前位置到达候选驶入点的最大驶入时间;
基于所述当前车道驶入所述待驶入车道场景下的最大设定速度以及所述自车的参数信息,确定所述自车从当前位置到达对应的候选驶入点的最小驶入时间;
基于所述最大驶入时间以及所述最小驶入时间确定所述驶入时间范围。
在其中的一些实施例中,所述时间交集根据下述方式确定:
基于多个所述障碍车中两两障碍车分别到达候选驶入点的时间,确定多个间隔时间;
基于障碍车到达对应候选驶入点的顺序,依次确定对应的间隔时间与所述驶入时间范围是否存在时间交集。
在其中的一些实施例中,所述基于多个所述障碍车中两两障碍车分别到达候选驶入点的时间,确定多个间隔时间,包括:
基于多个所述障碍车中两两障碍车分别到达候选驶入点的时间,确定多个基础间隔时间;
基于冗余时间以及多个所述基础间隔时间,确定多个所述间隔时间。
在其中的一些实施例中,所述基于所述最优驶入点进行路径规划,包括:
基于所述时间交集,确定所述自车驶入所述待驶入车道的最小期望时间;
基于所述最小期望时间、所述自车的当前位置以及所述最优驶入点的位置,确定所述自车从当前位置到达所述最优驶入点的平均速度;
基于所述平均速度进行路径规划。
在其中的一些实施例中,所述基于所述平均速度进行路径规划,包括:
将所述平均速度作为所述自车驶入所述待驶入车道的终态速度约束;
基于所述终态速度约束进行纵向路径规划,得到纵向路径规划结果;
基于所述纵向路径规划结果,确定所述自车驶入所述待驶入车道的终态车辆信息;
基于所述终态车辆信息以及所述自车当前状态信息进行横向路径规划。
第二个方面,在本实施例中提供了一种路径规划装置,包括:
第一确定模块,用于基于地图信息,确定自车由当前车道驶入待驶入车道的驶入范围,所述驶入范围内包括多个驶入点;
第二确定模块,用于基于所述自车与每一驶入点之间的距离,由小到大的顺序依次将多个驶入点确定为候选驶入点;
第三确定模块,用于基于候选驶入点的顺序,将首次出现时间交集的候选驶入点确定为最优驶入点,所述时间交集是基于所述自车从当前位置到达候选驶入点的驶入时间范围与多个障碍车到达对应的候选驶入点的间隔时间确定的,所述障碍车为所述待驶入车道中预设范围内的车辆;
路径规划模块,用于基于最优驶入点进行路径规划。
第三个方面,在本实施例中提供了一种域控制器,包括存储器、处理器以及存储在所述存储器上并可在所述处理器上运行的计算机程序,所述处理器执行所述计算机程序时实现上述第一个方面所述的路径规划方法。
第四个方面,在本实施例中提供了一种存储介质,其上存储有计算机程序,该程序被处理器执行时实现上述第一个方面所述的路径规划方法。
与相关技术相比,在本实施例中提供的路径规划方法,通过地图信息,确定出自车由当前车道驶入待驶入车道的驶入范围,并确定出驶入范围内的多个驶入点,进一步地,根据自车与每一驶入点之间的距离,由小到大的顺序依次将多个驶入点确定为候选驶入点,从而使确定出的驶入点为当前状态下自车驶入待驶入车道的最优位置,进一步地,基于候选驶入点的顺序,将首次出现时间交集的候选驶入点确定为最优驶入点,其中,时间交集是根据自车从当前位置到达候选驶入点的驶入时间范围与多个障碍车到达对应的候选驶入点的间隔时间确定的,从而使确定出第一个满足条件的候选驶入点即为最优驶入点,并且在最优驶入点进行变道时,能够满足当前环境的变道条件,从而无需遍历可行域范围内的所有解后才能确定最优解,进而有效地降低了自动驾驶场景中路径规划的算力成本。
本申请的一个或多个实施例的细节在以下附图和描述中提出,以使本申请的其他特征、目的和优点更加简明易懂。
附图说明
此处所说明的附图用来提供对本申请的进一步理解,构成本申请的一部分,本申请的示意性实施例及其说明用于解释本申请,并不构成对本申请的不当限定。在附图中:
图1是本申请实施例提供的一种路径规划应用场景示意图;
图2是本申请实施例提供的一种路径规划方法的流程图;
图3是本申请实施例提供的一种自车变道场景中驶入范围的示意图;
图4是本申请实施例提供的一种障碍车的间隔时间示意图;
图5是本申请实施例提供的一种间隔时间确定方法的示意图;
图6是本申请实施例提供的一种路径规划方法的实施例流程图;
图7是本申请实施例提供的一种路径规划装置的结构框图;
图8是本申请实施例提供的一种域控器的内部结构图。
具体实施方式
为更清楚地理解本申请的目的、技术方案和优点,下面结合附图和实施例,对本申请进行了描述和说明。
除另作定义外,本申请所涉及的技术术语或者科学术语应具有本申请所属技术领域具备一般技能的人所理解的一般含义。在本申请中的“一”、“一个”、“一种”、“该”、“这些”等类似的词并不表示数量上的限制,它们可以是单数或者复数。在本申请中所涉及的术语“包括”、“包含”、“具有”及其任何变体,其目的是涵盖不排他的包含;例如,包含一系列步骤或模块(单元)的过程、方法和系统、产品或设备并未限定于列出的步骤或模块(单元),而可包括未列出的步骤或模块(单元),或者可包括这些过程、方法、产品或设备固有的其他步骤或模块(单元)。在本申请中所涉及的“连接”、“相连”、“耦接”等类似的词语并不限定于物理的或机械连接,而可以包括电气连接,无论是直接连接还是间接连接。在本申请中所涉及的“多个”是指两个或两个以上。“和/或”描述关联对象的关联关系,表示可以存在三种关系,例如,“A和/或B”可以表示:单独存在A,同时存在A和B,单独存在B这三种情况。通常情况下,字符“/”表示前后关联的对象是一种“或”的关系。在本申请中所涉及的术语“第一”、“第二”、“第三”等,只是对相似对象进行区分,并不代表针对对象的特定排序。
本申请实施例提供的路径规划方法,可以应用于如图1所示的应用场景中,图1是本申请实施例提供的一种路径规划应用场景示意图,如图1所示,终端102通过网络与服务器104进行通信。数据存储系统可以存储服务器104需要处理的数据。数据存储系统可以集成在服务器104上,也可以放在云上或其他网络服务器上。其中,终端102可以但不限于是各种个人计算机、笔记本电脑、智能手机、平板电脑、物联网设备和便携式可穿戴设备,物联网设备可为智能音箱、智能电视、智能空调、智能车载设备等,本申请实施例中的终端102以智能车载设备为例。服务器104可以用独立的服务器或者是多个服务器组成的服务器集群来实现。
具体的,服务器104也可以被配置成实施自主驾驶或高级驾驶员辅助系统(ADAS)交通工具功能性,此类功能性可包括能够提供一定驾驶自动化水平的交通工具机载控制系统。驾驶自动化可包括涉及多个交通工具功能(例如,转向、加速和/或制动)的同时控制的某种水平的自动控制或干预。驾驶自动化可包括交通工具驾驶功能的同时自动控制(包括转向、加速和制动),其中,驾驶员在行程期间对于一段时间周期放弃交通工具的控制。驾驶自动化可包括交通工具驾驶功能的同时自动控制(包括转向、加速和制动)。驾驶自动化包括硬件和控制器,其被配置成在各种驾驶模式下监测空间环境,以在动态交通工具操作期间执行各种驾驶任务。通过非限制性示例的方式,驾驶自动化可包括巡航控制、自适应巡航控制、车道变换警告、干预和控制、自动停车、加速、制动和类似。通过非限制性示例的方式,自主交通工具功能包括自适应巡航控制(ACC)操作、车道引导和车道保持操作、车道变换操作、转向辅助操作、对象避让操作、停车辅助操作、交通工具制动操作、交通工具速度和加速操作、交通工具横向运动操作,例如,作为车道引导、车道保持和车道变换操作等等的部分。
随着技术的发展,自动驾驶技术得到广泛地应用。其中,可行域求解是自动驾驶技术中的一项关键技术,它依赖于地图、传感器、路径规划、决策算法等多种技术,旨在确定出现实道路环境中可以安全运行的范围,保障行驶过程中的安全和舒适性。
目前,在自动驾驶的可行域求解过程中,主要是遍历循环可行域范围内的所有解,从而计算出最优解,进一步,执行最优解的路径,通过遍历循环可行域范围内的最优解的路径规划方式复杂,且计算量大,从而导致自动驾驶场景中路径规划的算力成本较高。
因此,如何降低自动驾驶场景中路径规划的算力成本,是一个需要解决的问题。
在本申请实施例中提供了一种路径规划方法,图2是本申请实施例提供的一种路径规划方法的流程图,该方法的执行主体可以是电子装置,可选的,电子装置可以是服务器,也可以是终端设备,但本申请不限于此。具体的,如图2所示,该流程包括如下步骤:
步骤S201,基于地图信息,确定自车由当前车道驶入待驶入车道的驶入范围。
其中,驶入范围包括多个驶入点。
步骤S202,基于自车与每一驶入点之间的距离,由小到大的顺序依次将多个驶入点确定为候选驶入点。
步骤S203,基于候选驶入点的顺序,将首次出现时间交集的候选驶入点确定为最优驶入点。
其中,时间交集是基于自车从当前位置到达候选驶入点的驶入时间范围与多个障碍车到达对应的候选驶入点的间隔时间确定的,障碍车为待驶入车道中预设范围内的车辆。
步骤S204,基于最优驶入点进行路径规划。
示例性地,本申请的路径规划可以应用在自动驾驶的变道场景中,具体的,以自车从匝道进入主道的变道场景为例进行说明,本申请的路径规划也可以应用于其它变道前与变道后的车道线存在相交的场景中,在此不做限制。
若自车的当前车道为匝道,待驶入车道为主道,则可以根据自车在当前环境中的地图信息,确定出自车从匝道驶入主道的驶入范围,即自车的变道范围。
具体的,该驶入范围可以是匝道的两边界线分别与主道最先相交的边界线的两个交点之间的范围,该驶入范围可以包括多个驶入点,即在该驶入范围内,自车可以从多个驶入点对应的位置进入主道。
进一步地,根据自车当前与每一驶入点之间的距离,由小到大的顺序依次将多个驶入点确定为候选驶入点。进一步地,根据候选驶入点的顺序,将首次出现时间交集的候选驶入点确定为最优驶入点。
根据候选驶入点的顺序,依次预测出自车从当前位置到达当前的候选驶入点的驶入时间范围,以及多个障碍车到达对应的候选驶入点之间的间隔时间。其中,障碍车可以是待驶入车道中预设范围内的车辆,也可以是在待驶入车道中,在驶入范围之外预设范围内的车辆,可以是自车在当前位置能够捕捉到的在待驶入车道中的所有车辆。
具体的,可以根据自车当前的车辆信息预测出自车从当前位置到候选驶入点的最大时间和最小时间,从而得到自车的驶入时间范围,并预测出多个障碍车分别到达对应的候选驶入点的时间,进而确定两两障碍车之间的间隔时间。
进一步地,根据自车的驶入时间范围以及多个障碍车之间的间隔时间,确定对应的候选驶入点的驶入时间范围与间隔时间是否存在时间交集,并且,将第一次出现时间交集的候选驶入点确定为最优驶入点。
具体的,将自车与多个驶入点的距离,由小到大的顺序,依次将多个驶入点确定为候选驶入点,作为一种示例,可以根据该顺序,将多个候选驶入点分别命名为第一候选驶入点、第二候选驶入点、第三候选驶入点、…、第N候选驶入点,N为驶入点的总数。
首先确定出自车从当前位置到第一候选驶入点的第一驶入时间范围,以及根据多个障碍车分别到达第一候选驶入点的时间,确定多个第一时间间隔,进一步地,确定第一驶入时间范围与多个第一时间间隔是否存在时间交集,若第一驶入时间范围与任一第一时间间隔存在时间交集,则将第一候选驶入点确定为最优驶入点。
若第一驶入时间范围与所有第一时间间隔都不存在时间交集,则确定出自车从当前位置到第二候选驶入点的第二驶入时间范围,以及根据多个障碍车分别到达第二候选驶入点的时间,确定多个第二时间间隔,进一步地,确定第二驶入时间范围与多个第二时间间隔是否存在时间交集,以此类推,直至确定出驶入时间范围与时间间隔存在时间交集的候选驶入点为止,并将首次出现时间交集的候选驶入点确定为最优驶入点。
若遍历完所有候选驶入点后,驶入时间范围与时间间隔都不存在时间交集,则返回规划失败的结果。
进一步地,根据确定出的最优驶入点进行自车从匝道进入主道的路径规划。
在上述实现过程中,通过地图信息,确定出自车由当前车道驶入待驶入车道的驶入范围,并确定出驶入范围内的多个驶入点,进一步地,根据自车与每一驶入点之间的距离,由小到大的顺序依次将多个驶入点确定为候选驶入点,从而使确定出的驶入点为当前状态下自车驶入待驶入车道的最优位置,进一步地,基于候选驶入点的顺序,将首次出现时间交集的候选驶入点确定为最优驶入点,其中,时间交集是根据自车从当前位置到达候选驶入点的驶入时间范围与多个障碍车到达对应的候选驶入点的间隔时间确定的,进而确定出当前的候选驶入点是否满足当前环境的变道条件,若当前的候选驶入点不满足当前环境的变道条件,确定下一候选驶入点是否满足当前环境的变道条件,直至确定出满足变道条件的最优驶入点为止,进一步地,根据最优驶入点进行路径规划,从而使确定出的第一个驶入点即为最优驶入点,并且在最优驶入点进行变道时,能够满足当前环境的变道条件,从而无需遍历可行域范围内的所有解后才能确定最优解,进而有效地降低了自动驾驶场景中路径规划的算力成本。
在其中的一些实施例中,基于地图信息,确定自车由当前车道驶入待驶入车道的驶入范围,可以包括以下步骤:
步骤1:基于地图信息,获取当前车道的车道线与待驶入车道的车道线之间的交点,交点包括第一交点以及第二交点,第一交点到自车的距离小于第二交点到自车的距离。
步骤2:基于自车从当前位置到待驶入车道的车道线之间的横向距离,确定最小预留时间。
步骤3:基于最小预留时间以及自车的车辆信息,确定自车的最小预留纵向距离。
步骤4:基于最小预留纵向距离以及第一交点的纵向位置信息,确定驶入范围的最小值。
步骤5:基于第二交点的纵向位置信息以及第一预设距离,确定驶入范围的最大值。
示例性地,图3是本申请实施例提供的一种自车变道场景中驶入范围的示意图,如图3所示,根据地图信息可以确定出匝道的两车道线与主道最先相交的车道线的交点包括图3中的点M1和点M2两个点,并且,在自车充匝道进入主道的场景中,点M1到自车的距离小于点M2到自车的距离,因此,点M1为第一交点,点M2为第二交点。
进一步地,根据自车从当前位置从匝道到主道之间的横向距离,如图3中的L1,确定出最小预留时间。具体的,可以通过贝塞尔算法确定出在横向距离为LI时,自车从当前位置移动到主道的最小预留时间,该最小预留时间即为满足自车横向舒适性的最小预留时间t。
进一步地,根据最小预留时间t以及自车的车辆信息确定出自车的最小预留纵向距离,具体的,自车的车辆信息可以包括自车当前的速度v,自车满足纵向舒适性要求下的最大加速度Accmax。
具体的,可以根据纵向运动学公式,确定出最小预留纵向距离Smin。
进一步地,根据第一交点的纵向位置以及最小预留纵向距离Smin确定出驶入范围的最小值,具体的,根据自车进入主道的驶入方向、第一交点的纵向位置以及最小预留纵向距离Smin确定出驶入范围的最小值,如图3所示,自车进入主道后由下至上运动,则将第一交点沿纵向由下至上移动最小预留纵向距离Smin,得到的点即为驶入范围的最小值对应的点。
进一步地,在实际场景中自车由匝道进入主道时,不能直接从点M2对应的位置进入主道,需要在点M2之前的位置进入主道,因此,将第二交点M2的纵向位置沿第一交点M1的方向移动第一预设距离,得到的点即为驶入范围的最大值对应的点。若以第一交点为坐标原点,主道中车辆的形式方向为纵向的正方向,即图3中由下至上的方向,则驶入范围的最大值对应的点/>的纵向位置大于驶入范围的最小值对应的点/>的纵向位置。
需要说明的是,本申请实施例中的第一预设距离可以根据多次试验预先确定的,也可以根据当前匝道的宽度以及预先确定的距离进行适应性调整得到的,在此不做限制。
进一步地,如图3所示,驶入范围的最小值对应的点与驶入范围的最大值对应的点/>之间的范围即为驶入范围/>。
在上述实现过程中,根据自车从当前位置到带驶入车道的横向距离,确定最小预留时间,进而根据最小预留时间确定自车的最小预留纵向距离,从而确保自车从当前车道驶入待驶入车道的过程中的横向运行的舒适性,进一步地,根据最小预留纵向距离以及第一交点的纵向距离确定出驶入范围的最小值,即确定出自车变道时的起始位置,并且,根据第二交点的纵向位置以及第一预设距离确定驶入范围的最大值,从而确定出自车变道时的终点位置,实现了自车变道时驶入范围的确定。
在其中的一些实施例中,基于自车与每一驶入点之间的距离,由小到大的顺序依次将多个驶入点确定为候选驶入点,可以包括以下步骤:
步骤1:根据第二预设距离在驶入范围内确定多个驶入点。
步骤2:根据多个驶入点与自车的距离,由小到大的顺序,依次将多个驶入点确定为候选驶入点。
作为其中的一个实施例,根据第二预设距离在驶入范围内确定多个驶入点可以包括:确定驶入范围的最小值对应的点与驶入范围的最大值对应的点之间的距离,若该距离小于或等于第三预设距离,则在驶入范围内确定一个驶入点,若该距离大于第三预设距离,则根据第二预设距离在驶入范围内确定多个驶入点。
示例性地,若点与点/>之间的距离小于或等于第三预设距离,则可以只在驶入范围内确定一个驶入点,该驶入点可以是点/>与点/>的中点,也可以是点/>与点/>之间的任意一点,在此不做限制。
若点与点/>之间的距离大于第三预设距离,则在驶入范围内从驶入范围的最小值对应的点/>开始,朝着点/>的方向,将每隔第二预设距离对应的点作为一个驶入点,从而可以得到在驶入范围内确定多个驶入点。
进一步地,根据多个驶入点与自车的距离由小到大的顺序,依次将多个驶入点确定为候选驶入点,即自车由近及远地将多个驶入点依次作为当前的候选驶入点,从而确保自车到达驶入点的距离最近。
在上述实现过程中,根据多个驶入点与自车的距离,由小到大的顺序,依次将多个驶入点确定为最优驶入点,从而确保了满足变道条件的候选驶入点距自车的距离最近,从而无需遍历可行域中的所有解进行路径规划最优解的计算,有效地降低了自动驾驶场景中路径规划的算力成本。
在其中的一些实施例中,在基于候选驶入点的顺序,将首次出现时间交集的候选驶入点确定为最优驶入点之前,还可以包括以下步骤:
步骤1:基于当前车道驶入待驶入车道场景下的最小设定速度,确定自车从当前位置到达候选驶入点的最大驶入时间。
步骤2:基于当前车道驶入待驶入车道场景下的最大设定速度以及自车的参数信息,确定自车从当前位置到达对应的候选驶入点的最小驶入时间。
步骤3:基于最大驶入时间以及最小驶入时间确定驶入时间范围。
示例性地,当前自车的变道场景为从匝道进入主道,则可以根据匝道进入主道的交通场景中最小设定速度确定出自车从当前位置到达候选驶入点的最大驶入时间。
具体的,可以将匝道进入主道的交通环境中最小设定速度作为自车进入主道时的终态速度的约束条件,该速度可以为40km/h,也可以为45km/h,也可以根据实际场景确定,在此不做限制。
进一步地,通过二阶运动规划算法(Jerk Limited Trajectory,JLT)规划出终态速度约束下的纵向速度谱,进而根据纵向速度谱并通过二分搜索算法迭代计算出到达候选驶入点的最大驶入时间。
进一步地,根据匝道进入主道的交通环境中的最大设定速度以及自车的参数信息,确定出自车从当前位置到达对应的候选驶入点的最小驶入时间,具体的,自车的参数信息可以包括自车的最高车速以及最大加速度,作为一种示例,自车的最高车速以及最大加速度可以对应的为环境所允许最高车速、最大加速度。具体的,根据三阶JLT规划算法,在自车当前的速度约束、终止状态速度约束以及自车最高车速、最大加速度等动力学最大限制下规划出自车到达候选驶入点的纵向速度谱以及到该候选驶入点的最小时间,此时,自车终止状态速度可以是当前车道驶入待驶入车道场景下的最大设定速度。
进一步地,将最大驶入时间与最小驶入时间对应的时间范围确定为自车从当前车道驶入待驶入车道的驶入时间范围。
在上述实现过程中,根据当前变道环境中的最大设定速度和最小设定速度作为变道场景下自车的速度约束,从而确定出自车当前位置驶入待驶入车道的驶入时间范围。
在其中的一些实施例中,时间交集的方式确定方式,可以包括以下步骤:
步骤1:基于多个障碍车中两两障碍车分别到达候选驶入点的时间,确定多个间隔时间。
步骤2:基于障碍车到对应的候选驶入点的顺序,依次确定对应的间隔时间与驶入时间范围是否存在交集。
示例性地,在自车变道的场景中,为了避免自车进入待驶入车道时,不与待驶入车道中的其他车辆发生碰撞,则还需要考虑待驶入车道中其他车辆的状态信息。具体的,在自车变道场景中,将自车能够捕捉到的待驶入车道中的所有车辆确定为障碍车。
可以根据自车各种传感器获取到每一障碍车的速度以及加速度等车辆信息,并根据每一障碍车的车辆信息确定出每一障碍车到达当前的候选驶入点的时间,进而可以根据两两障碍车分别到达当前的候选驶入点的时间,确定两两障碍车之间的时间间隔,从而可以得到多个间隔时间。
图4是本申请实施例提供的一种障碍车的间隔时间示意图,如图4所示,若当前场景的主道中包括A、B、C、D、E、F共6辆障碍车,点Q为当前的候选驶入点,则根据障碍车的车辆信息可以确定出6辆障碍车分别到达点Q的时间点,从而可以得到5个间隔时间。
进一步地,根据障碍车到达最优驶入点Q的顺序,依次将对应的间隔时间与自车到达候选驶入点Q的驶入时间范围(TQ1,TQ2)进行对比,确定两个时间范围是否存在交集。具体的,如图4所示,障碍车A、B、C、D、E、F分别依次到达候选驶入点Q,则先将障碍车A与障碍车B之间的间隔时间1与驶入时间范围(TQ1,TQ2)进行对比,确定间隔时间1与驶入时间范围是否存在交集,若间隔时间1与驶入时间范围存在交集,则将候选驶入点Q确定为最优驶入点,若间隔时间1与驶入时间范围(TQ1,TQ2)不存在交集,确定下一间隔时间2与驶入时间范围是否存在交集,若间隔时间1、2、3、4、5与候选驶入点Q都不存在交集,则确定出下一候选驶入点P,并确定出该6辆障碍车到达下一候选驶入点P的每一时间间隔与自车到达候选驶入点P的驶入时间范围(TP1,TP2)是否存在交集,当驶入时间范围与间隔时间存在交集时,即存在时间可行域,进而将对应的候选驶入点确定为最优驶入点。
在上述实现过程中,根据障碍车到达候选驶入点的顺序依次将对应的间隔时间与驶入时间范围进行比较,若两者存在交集,则表示存在时间可行域,自车可以在时间可行域范围内进行变道。
在其中的一些实施例中,基于多个障碍车中两两障碍车分别到达候选驶入点的时间,确定多个间隔时间,可以包括以下步骤:
步骤1:基于多个障碍车中两两障碍车分别到达候选驶入点的时间,确定多个基础间隔时间。
步骤2:基于冗余时间以及多个基础间隔时间,确定多个间隔时间。
示例性地,为了使自车进入待驶入车道后,与前后车之间保持安全的行驶距离,则需要在间隔时间范围内考虑车辆之间行驶安全距离对应的冗余时间。
具体的,前后车的冗余时间可以是预先设定的,且前后车的冗余时间可以相等,也可以不相等,在此不做限制,本申请实施例中以前后车的冗余时间相等为例进行说明。
在多个障碍车中,根据两两障碍车分别到达候选驶入点的时间,确定基础间隔时间,并分别在基础间隔时间范围的前后缩小冗余时间,则得到对应的间隔时间。
图5是本申请实施例提供的一种间隔时间确定方法的示意图,如图5所示,在基础间隔时间的最小值的基础上增加后车冗余时间,得到间隔时间范围的最小值,在基础间隔时间的最大值的基础上减少前车冗余时间,得到间隔时间范围的最大值,从而根据间隔时间范围的最小值和间隔时间范围的最大值,得到间隔时间,进一步地,可以判断驶入时间范围与间隔时间是否存在交集。
在上述实现过程中,根据冗余时间以及基础间隔时间确定间隔时间,从而能够使自车从当前车道进入待驶入车道后能够与前后车保持安全距离行驶。
在其中的一些实施例中,基于最优驶入点进行路径规划,可以包括以下步骤:
步骤1:基于时间交集,确定自车驶入待驶入车道的最小期望时间。
步骤2:基于最小期望时间、自车的当前位置以及最优驶入点的位置,确定自车从当前位置到达最优驶入点的平均速度。
步骤3:基于平均速度进行路径规划。
示例性地,在确定间隔时间与驶入时间范围存在时间交集后,将该时间交集的最小值确定为自车驶入待驶入车道的最小期望时间值,即该最小期望时间为自车从当前位置通过最优驶入点进入待驶入车道的最小时间。
进一步地,确定自车的当前位置至最优驶入点的位置之间的待行驶距离,并根据待行驶距离以及最小期望时间确定自车从当前位置到达最优驶入点的平均速度,具体的,可以将待行驶距离与最小期望时间的商确定为自车从当前位置到达最优驶入点的平均速度,从而根据该平均速度进行自车从匝道进入主道的路径规划。
在上述实现过程中,间隔时间与驶入时间范围确定最小期望时间,从而根据最小期望时间、自车当前位置以及最优驶入点的位置,确定变道过程中的平均速度,进而根据平均速度进行自车的路径规划,从而便于提高自车从当前位置到最优驶入点的路径规划的准确度。
在其中的一些实施例中,基于平均速度进行路径规划,可以包括以下步骤:
步骤1:将平均速度作为自车驶入待驶入车道的终态速度约束。
步骤2:基于终态速度约束进行纵向路径规划,得到纵向路径规划结果。
步骤3:基于纵向路径规划结果,确定自车驶入待驶入车道的终态车辆信息。
步骤4:基于终态车辆信息以及自车当前状态信息进行横向路径规划。
示例性地,将该平均速度作为终态速度约束以及最高速度约束,将有效的最优驶入点作为终态位置约束,通过三阶JLT规划算法得到一条先加速后匀速的速度谱,从而使得纵向控制平顺,并在换道过程中的纵向加速度尽量小,从而保持匀速换道,从而实现了纵向路径规划,得到了纵向路径规划结果,具体的,纵向路径规划结果可以包括当前位置到最优驶入点的距离、自车当前的状态以及自车驶入主道最终状态,自车当前的状态包括自车跨过车道中心线的具体位置,速度以及航向角,自车驶入主道最终状态包括自车完成上匝道的终点,终点速度以及航向角。
进一步地,根据纵向路径规划结果包括自车驶入待驶入车道的终态车辆信息,例如,自车驶入主道最终状态包括自车完成上匝道的终点,终点速度以及航向角,则可以根据自车驶入主道最终状态进行分段式的贝塞尔曲线的规划,如果此时环境条件不出现车道线、车辆控制状态的外界跳变,则认为规划有效,此时会融合规划出的路径与驶入的待驶入车道的中心线,使自车能够平滑变到待驶入车道,同时能够平滑的过度到常规的车道保持状态,完成横向规划。
在上述实现过程中,根据平均速度作为自车变道后的终态速度约束,从而根据终态速度约束进行纵向路径规划,进而根据纵向路径规划结果进行横向路径规划,从而实现了自车纵向以及横向的路径规划。
图6是本申请实施例提供的一种路径规划方法的实施例流程图,本申请的路径规划方法应用在自车从匝道进入主道的变道场景中,如图6所示,该流程包括如下步骤:
步骤S601,基于地图信息,确定自车进入目标车道的驶入范围。
具体的,根据地图信息,确定匝道车道线与目标车道的车道线的交点,其中,目标车道为主道。如图3所示,该交点包括点M1和点M2,进一步地,根据自车变道的横向舒适性以及纵向运动学原理,确定出自车进入目标车道的驶入范围。
具体的,根据自车到驶入点的横向位移CutInOffset,通过贝塞尔算法,求解出车辆横向移动CutInOffset距离下所需要的时间MinCutInTime,该时间即为满足横向舒适性要求的最小汇入时间。
通过MinCutInTime,并根据纵向运动学公式,计算出自车当前状态下换道所需要的最小纵向距离Smin,其中v为自车当前车速,Accmax为满足纵向舒适性要求的最大加速度,t为满足横向舒适性要求的最小汇入时间。该最小纵向距离即为到达满足车辆横向动力学约束后的换道起始点/>的距离。由于车辆不能从地图上直接获得的驶入终止点M2驶过,所以,将驶入终止点M2向驶入起始点方向移动第二预设距离后做为最终的驶入终止点/>,得到了基于横向动力学约束后的匝道驶入主道的始末点/>。
步骤S602,根据驶入范围内多个驶入点到自车当前的距离,由小到大的顺序依次将多个驶入点确定为当前的候选驶入点。
进一步地,在驶入范围内,从驶入范围的最小值对应的点开始,将每隔第二预设距离的点确定为驶入点,从而得到驶入范围内的多个驶入点,并根据多个驶入点到自车当前的距离,由小到大的顺序依次将多个驶入点确定为当前的候选驶入点。具体的,若点/>与点/>之间的距离小于或等于第三预设距离,则在驶入范围内只确定一个驶入点,若点/>与点/>之间的距离大于第三预设距离,则从匝道驶入主道的起始点/>开始由近及远以第二预设距离间隔遍历获取到多个驶入点。
步骤S603,根据目标车道中多个障碍车到达当前的候选驶入点的时间,确定多个间隔时间,以及确定自车到达当前的候选驶入点的当前驶入时间范围。
进一步地,根据当前变道环境中允许速度最大值、允许速度最小值以及自车的车辆信息,确定出自车到达当前的候选驶入点的当前驶入时间范围。
具体的,通过二阶JLT规划算法确定出终态速度约束为上匝道最小工作速度(40km/h左右)下的纵向速度谱,之后,根据纵向速度谱并通过二分搜索算法迭代计算出到达候选驶入点的最大驶入时间。通过三阶JLT算法并在自车初始状态约束、终止状态约束以及自车最高车速、最大加速度等动力学最大限制下规划出自车到达候选驶入点的纵向速度谱以及到达候选驶入点的最小驶入时间,其中,为了使得能够以最小驶入时间到候选驶入点,将终态速度设定为环境所允许最大车速,自车车速、加速度限值设定为环境所允许最高车速、最大加速度等。最终,得到自车到达候选驶入点的最大驶入时间和最小驶入时间。
进一步地,根据目标车道中多个障碍车分别到达当前的候选驶入点的时间,确定多个障碍车对应的间隔时间。
本申请实施例中以6个障碍车为例,根据对障碍车的预测信息、对地图数据进行分析后障碍车到达的候选驶入点时间信息,从而得到5个间隔时间,其中感知范围最前最后为虚构障碍车,构成成对的前后车。
在确定出每一间隔时间好之后,则对每一间隔时间求取其上下限,间隔时间的上限定义为在行驶方向上位于该间隔时间前部的车辆到达前方某候选驶入点所需的时间,间隔时间的下限定义为在行驶方向上位于该间隔时间后部的车辆到达前方同一候选驶入点所需的时间,并对每一间隔时间做offset处理,以得到安全冗余处理后的间隔时间,即在每一间隔时间范围内进行前后车的时间冗余,得到处理后的5个间隔时间,可以用一个的矩阵{(SA,SB),(SB,SC),(SC,SD),(SD,SE),(SE,SF)}表示。矩阵中的每个元素代表相应车辆到候选驶入点的时间。
步骤S604,根据间隔时间的先后顺序,依次确定当前间隔时间,并将当前间隔时间与当前驶入时间范围进行对比。
根据多个间隔时间的先后顺序,依次将多个间隔时间确定为当前间隔时间,并将当前间隔时间与当前驶入时间范围进行对比,从而确定当前间隔时间与当前驶入时间范围是否存在时间交集。
步骤S605,判断当前间隔时间与当前驶入时间范围是否存在交集。
具体的,判断当前间隔时间与当前驶入时间范围是否存在时间交集,若当前间隔时间与当前驶入时间范围存在时间交集,则当前间隔时间与驶入时间范围存在可行域,并将当期的候选驶入点确定为最优驶入点,并执行步骤S609。若当前间隔时间与当前驶入时间范围不存在交集,则当前间隔时间与当前驶入时间范围不存在可行域,执行步骤S606。
步骤S606,判断多个间隔时间是否遍历结束。
具体的,若当前间隔时间与当前驶入时间范围不存在时间交集,则当前间隔时间与当前驶入时间范围不存在可行域,则需要判断下一间隔时间与当前驶入时间范围是否存在交集,因此,在判断下一间隔时间与当前驶入时间范围是否存在交集之前,需要判断是否将多个间隔时间都遍历完成,多个间隔时间都遍历结束,则执行步骤S608。
若多个间隔时间未遍历完成,则执行步骤S607。
步骤S607,确定下一间隔时间。
具体的,若当前间隔时间为(SA,SB),(SB,SC),(SC,SD),(SD,SE)中的任何一个,则多个间隔时间未遍历结束,则可以确定当前间隔时间的下一间隔时间,并返回步骤S604,判断下一间隔时间与当前驶入时间范围是否存在交集。
若当前间隔时间为(SE,SF),则多个间隔时间已遍历结束,从而执行步骤S608。
步骤S608,确定下一候选驶入点。
若当前候选驶入点对应的多个间隔时间与当前驶入时间范围都不存在交集,则确定下一候选驶入点,具体的,返回步骤S603,确定下一候选驶入点,并根下一候选驶入点对应的多个时间间隔以及驶入时间范围确定下一候选驶入点是否存在可行域,直到确定出存在可行域的候选驶入点为止。
若将所有驶入点都遍历结束后,都未得到最优驶入点,则返回规划失败的结果。
步骤S609,根据最优驶入点进行路径规划。
若多个时间间隔以及驶入时间范围存在时间交集,则将第一次确定出的候选驶入点确定为最优驶入点,并根据最优驶入点进行自车从匝道进入主道的路径规划。
具体的,将间隔时间与驶入时间范围交集的最小值确定为最小期望时间,并根据最小期望时间、自车的当前位置以及最优驶入点的位置,确定自车从当前位置到达最优驶入点的平均速度,将此平均车速做为三阶JLT规划算法的终态速度及最高速度约束,以规划出一条先加速后匀速的速度谱,使得纵向控制平顺,并尽量使得换道过程中的纵向加速度很小,保持匀速换道。
进一步地,通过纵向规划得到的当前位置到最优驶入点的距离、自车当前的状态确定自车驶入主道最终状态,自车驶入主道最终状态包括自车完成上匝道的终点,终点速度以及航向角,并进行分三段式的贝塞尔曲线的规划,如果此时环境条件不出现车道线、车辆控制状态的外界跳变,则认为规划有效,此时会融合规划出的路径与驶入的目标车道的中心线,使其能够平滑变到主道,同时能够平滑的过度到常规的车道保持状态,完成横向规划。
需要说明的是,虽然如上所述的各实施例所涉及的流程图中的各个步骤按照箭头的指示依次显示,但是这些步骤并不是必然按照箭头指示的顺序依次执行。除非本文中有明确的说明,这些步骤的执行并没有严格的顺序限制,这些步骤可以以其它的顺序执行。而且,如上所述的各实施例所涉及的流程图中的至少一部分步骤可以包括多个步骤或者多个阶段,这些步骤或者阶段并不必然是在同一时刻执行完成,而是可以在不同的时刻执行,这些步骤或者阶段的执行顺序也不必然是依次进行,而是可以与其它步骤或者其它步骤中的步骤或者阶段的至少一部分轮流或者交替地执行。
在本实施例中还提供了一种路径规划装置,该装置用于实现上述实施例及优选实施方式,已经进行过说明的不再赘述。以下所使用的术语“模块”、“单元”、“子单元”等可以实现预定功能的软件和/或硬件的组合。尽管在以下实施例中所描述的装置较佳地以软件来实现,但是硬件,或者软件和硬件的组合的实现也是可能并被构想的。
图7是本申请实施例提供的一种路径规划装置的结构框图,如图7所示,该装置包括:
第一确定模块701,用于基于地图信息,确定自车由当前车道驶入待驶入车道的驶入范围,驶入范围内包括多个驶入点;
第二确定模块702,用于基于自车与每一驶入点之间的距离,由小到大的顺序依次将多个驶入点确定为候选驶入点;
第三确定模块703,用于用于基于候选驶入点的顺序,将首次出现时间交集的候选驶入点确定为最优驶入点,时间交集是基于自车从当前位置到达候选驶入点的驶入时间范围与多个障碍车到达对应的候选驶入点的间隔时间确定的,障碍车为待驶入车道中预设范围内的车辆;
路径规划模块704,用于基于最优驶入点进行路径规划。
在其中的一些实施例中,第一确定模块701具体用于:
基于地图信息,获取当前车道的车道线与待驶入车道的车道线之间的交点;交点包括第一交点以及第二交点,第一交点到自车的距离小于第二交点到自车的距离;
基于自车从当前位置到待驶入车道的车道线之间的横向距离,确定最小预留时间;
基于最小预留时间以及自车的车辆信息,确定自车的最小预留纵向距离;
基于最小预留纵向距离以及第一交点的纵向位置信息,确定驶入范围的最小值;
基于第二交点的纵向位置信息以及第一预设距离,确定驶入范围的最大值。
在其中的一些实施例中,第二确定模块702具体用于:
根据第二预设距离在驶入范围内确定多个驶入点;
根据多个驶入点与自车的距离,由小到大的顺序,依次将多个驶入点确定为候选驶入点。
在其中的一些实施例中,第三确定模块703还用于:
基于当前车道驶入待驶入车道场景下的最小设定速度,确定自车从当前位置到达候选驶入点的最大驶入时间;
基于当前车道驶入待驶入车道场景下的最大设定速度以及自车的参数信息,确定自车从当前位置到达对应的候选驶入点的最小驶入时间;
基于最大驶入时间以及最小驶入时间确定驶入时间范围。
在其中的一些实施例中,第三确定模块703具体用于:
基于多个障碍车中两两障碍车分别到达候选驶入点的时间,确定多个间隔时间;
基于障碍车到达对应候选驶入点的顺序,依次确定对应的间隔时间与驶入时间范围是否存在时间交集。
在其中的一些实施例中,第三确定模块703具体用于:
基于多个障碍车中两两障碍车分别到达候选驶入点的时间,确定多个基础间隔时间;
基于冗余时间以及多个基础间隔时间,确定多个间隔时间。
在其中的一些实施例中,路径规划模块704具体用于:
基于时间交集,确定自车驶入待驶入车道的最小期望时间;
基于最小期望时间、自车的当前位置以及最优驶入点的位置,确定自车从当前位置到达最优驶入点的平均速度;
基于平均速度进行路径规划。
在其中的一些实施例中,路径规划模块704具体用于:
将平均速度作为自车驶入待驶入车道的终态速度约束;
基于终态速度约束进行纵向路径规划,得到纵向路径规划结果;
基于纵向路径规划结果,确定自车驶入待驶入车道的终态车辆信息;
基于终态车辆信息以及自车当前状态信息进行横向路径规划。
需要说明的是,上述各个模块可以是功能模块也可以是程序模块,既可以通过软件来实现,也可以通过硬件来实现。对于通过硬件来实现的模块而言,上述各个模块可以位于同一处理器中;或者上述各个模块还可以按照任意组合的形式分别位于不同的处理器中。
在一个实施例中,提供了一种域控器,该域控器可以是服务器,其内部结构图可以如图8所示,图8是本申请实施例提供的一种域控器的内部结构图,该域控器包括通过系统总线连接的处理器、存储器和网络接口。其中,该域控器的处理器用于提供计算和控制能力。该域控器的存储器包括非易失性存储介质和内存储器。该非易失性存储介质存储有操作系统、计算机程序和数据库。该内存储器为非易失性存储介质中的操作系统和计算机程序的运行提供环境。该域控器的数据库用于存储传感器获取的数据。该域控器的网络接口用于与外部的终端通过网络连接通信。该计算机程序被处理器执行时以实现一种路径规划方法。
本领域技术人员可以理解,图8中示出的结构,仅仅是与本申请方案相关的部分结构的框图,并不构成对本申请方案所应用于其上的计算机设备的限定,具体的计算机设备可以包括比图中所示更多或更少的部件,或者组合某些部件,或者具有不同的部件布置。
在一个实施例中,还提供了一种计算机设备,包括存储器和处理器,存储器中存储有计算机程序,该处理器执行计算机程序时实现上述各方法实施例中的步骤。
在一个实施例中,提供了一种计算机可读存储介质,其上存储有计算机程序,该计算机程序被处理器执行时实现上述各方法实施例中的步骤。
需要说明的是,本申请所涉及的用户信息(包括但不限于用户设备信息、用户个人信息等)和数据(包括但不限于用于分析的数据、存储的数据、展示的数据等),均为经用户授权或者经过各方充分授权的信息和数据。
本领域普通技术人员可以理解实现上述实施例方法中的全部或部分流程,是可以通过计算机程序来指令相关的硬件来完成,所述的计算机程序可存储于一非易失性计算机可读取存储介质中,该计算机程序在执行时,可包括如上述各方法的实施例的流程。其中,本申请所提供的各实施例中所使用的对存储器、数据库或其它介质的任何引用,均可包括非易失性和易失性存储器中的至少一种。非易失性存储器可包括只读存储器(Read-OnlyMemory,ROM)、磁带、软盘、闪存、光存储器、高密度嵌入式非易失性存储器、阻变存储器(ReRAM)、磁变存储器(Magnetoresistive Random Access Memory,MRAM)、铁电存储器(Ferroelectric Random AccessMemory,FRAM)、相变存储器(Phase Change Memory,PCM)、石墨烯存储器等。易失性存储器可包括随机存取存储器(Random Access Memory,RAM)或外部高速缓冲存储器等。作为说明而非局限,RAM可以是多种形式,比如静态随机存取存储器(StaticRandom Access Memory,SRAM)或动态随机存取存储器(Dynamic Random AccessMemory,DRAM)等。本申请所提供的各实施例中所涉及的数据库可包括关系型数据库和非关系型数据库中至少一种。非关系型数据库可包括基于区块链的分布式数据库等,不限于此。本申请所提供的各实施例中所涉及的处理器可为通用处理器、中央处理器、图形处理器、数字信号处理器、可编程逻辑器、基于量子计算的数据处理逻辑器等,不限于此。
以上实施例的各技术特征可以进行任意的组合,为使描述简洁,未对上述实施例中的各个技术特征所有可能的组合都进行描述,然而,只要这些技术特征的组合不存在矛盾,都应当认为是本说明书记载的范围。
以上所述实施例仅表达了本申请的几种实施方式,其描述较为具体和详细,但并不能因此而理解为对专利保护范围的限制。应当指出的是,对于本领域的普通技术人员来说,在不脱离本申请构思的前提下,还可以做出若干变形和改进,这些都属于本申请的保护范围。因此,本申请的保护范围应以所附权利要求为准。
Claims (10)
1.一种路径规划方法,其特征在于,包括:
基于地图信息,确定自车由当前车道驶入待驶入车道的驶入范围,所述驶入范围内包括多个驶入点;
基于所述自车与每一驶入点之间的距离,由小到大的顺序依次将多个驶入点确定为候选驶入点;
基于候选驶入点的顺序,将首次出现时间交集的候选驶入点确定为最优驶入点,所述时间交集是基于所述自车从当前位置到达候选驶入点的驶入时间范围与多个障碍车到达对应的候选驶入点的间隔时间确定的,所述障碍车为所述待驶入车道中预设范围内的车辆;
基于所述最优驶入点进行路径规划。
2.根据权利要求1所述的路径规划方法,其特征在于,所述基于地图信息,确定自车由当前车道驶入待驶入车道的驶入范围,包括:
基于地图信息,获取当前车道的车道线与待驶入车道的车道线之间的交点;所述交点包括第一交点以及第二交点,所述第一交点到所述自车的距离小于所述第二交点到所述自车的距离;
基于所述自车从所述当前位置到所述待驶入车道的车道线之间的横向距离,确定最小预留时间;
基于所述最小预留时间以及所述自车的车辆信息,确定所述自车的最小预留纵向距离;
基于所述最小预留纵向距离以及所述第一交点的纵向位置信息,确定所述驶入范围的最小值;
基于所述第二交点的纵向位置信息以及第一预设距离,确定所述驶入范围的最大值。
3.根据权利要求2所述的路径规划方法,其特征在于,所述基于所述自车与每一驶入点之间的距离,由小到大的顺序依次将多个驶入点确定为候选驶入点,包括:
根据第二预设距离在所述驶入范围内确定多个驶入点;
根据多个驶入点与所述自车的距离,由小到大的顺序,依次将多个驶入点确定为候选驶入点。
4.根据权利要求1所述的路径规划方法,其特征在于,在所述基于所述候选驶入点的顺序,将首次出现时间交集的候选驶入点确定为最优驶入点之前,还包括:
基于所述当前车道驶入所述待驶入车道场景下的最小设定速度,确定所述自车从当前位置到达候选驶入点的最大驶入时间;
基于所述当前车道驶入所述待驶入车道场景下的最大设定速度以及所述自车的参数信息,确定所述自车从当前位置到达对应的候选驶入点的最小驶入时间;
基于所述最大驶入时间以及所述最小驶入时间确定所述驶入时间范围。
5.根据权利要求4所述的路径规划方法,其特征在于,所述时间交集根据下述方式确定:
基于多个所述障碍车中两两障碍车分别到达候选驶入点的时间,确定多个间隔时间;
基于障碍车到达对应候选驶入点的顺序,依次确定对应的间隔时间与所述驶入时间范围是否存在时间交集。
6.根据权利要求5所述的路径规划方法,其特征在于,所述基于多个所述障碍车中两两障碍车分别到达候选驶入点的时间,确定多个间隔时间,包括:
基于多个所述障碍车中两两障碍车分别到达候选驶入点的时间,确定多个基础间隔时间;
基于冗余时间以及多个所述基础间隔时间,确定多个所述间隔时间。
7.根据权利要求5所述的路径规划方法,其特征在于,所述基于所述最优驶入点进行路径规划,包括:
基于所述时间交集,确定所述自车驶入所述待驶入车道的最小期望时间;
基于所述最小期望时间、所述自车的当前位置以及所述最优驶入点的位置,确定所述自车从当前位置到达所述最优驶入点的平均速度;
基于所述平均速度进行路径规划。
8.根据权利要求7所述的路径规划方法,其特征在于,所述基于所述平均速度进行路径规划,包括:
将所述平均速度作为所述自车驶入所述待驶入车道的终态速度约束;
基于所述终态速度约束进行纵向路径规划,得到纵向路径规划结果;
基于所述纵向路径规划结果,确定所述自车驶入所述待驶入车道的终态车辆信息;
基于所述终态车辆信息以及所述自车当前状态信息进行横向路径规划。
9.一种路径规划装置,其特征在于,包括:
第一确定模块,用于基于地图信息,确定自车由当前车道驶入待驶入车道的驶入范围,所述驶入范围内包括多个驶入点;
第二确定模块,用于基于所述自车与每一驶入点之间的距离,由小到大的顺序依次将多个驶入点确定为候选驶入点;
第三确定模块,用于基于候选驶入点的顺序,将首次出现时间交集的候选驶入点确定为最优驶入点,所述时间交集是基于所述自车从当前位置到达候选驶入点的驶入时间范围与多个障碍车到达对应的候选驶入点的间隔时间确定的,所述障碍车为所述待驶入车道中预设范围内的车辆;
路径规划模块,用于基于所述最优驶入点进行路径规划。
10.一种域控制器,包括存储器和处理器,其特征在于,所述存储器中存储有计算机程序,所述处理器被设置为运行所述计算机程序以执行权利要求1至权利要求8中任一项所述的路径规划方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202310950750.4A CN116659539B (zh) | 2023-07-31 | 2023-07-31 | 路径规划方法、装置和域控制器 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202310950750.4A CN116659539B (zh) | 2023-07-31 | 2023-07-31 | 路径规划方法、装置和域控制器 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN116659539A true CN116659539A (zh) | 2023-08-29 |
CN116659539B CN116659539B (zh) | 2023-10-13 |
Family
ID=87722807
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202310950750.4A Active CN116659539B (zh) | 2023-07-31 | 2023-07-31 | 路径规划方法、装置和域控制器 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN116659539B (zh) |
Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2015161966A (ja) * | 2014-02-26 | 2015-09-07 | 株式会社デンソーアイティーラボラトリ | 車線変更計画装置及び車線変更計画方法 |
US20170113665A1 (en) * | 2015-10-27 | 2017-04-27 | GM Global Technology Operations LLC | Algorithms for avoiding automotive crashes at left and right turn intersections |
US20220081002A1 (en) * | 2020-09-16 | 2022-03-17 | Shenzhen Guo Dong Intelligent Drive Technologies Co., Ltd | Autonomous driving vehicle and dynamic planning method of drivable area |
CN114485670A (zh) * | 2022-01-21 | 2022-05-13 | 清华大学 | 一种移动单元的路径规划方法、装置、电子设备及介质 |
CN114600053A (zh) * | 2019-10-24 | 2022-06-07 | 祖克斯有限公司 | 基于碰撞区域的行驶路线修改 |
CN114674340A (zh) * | 2022-03-21 | 2022-06-28 | 北京百度网讯科技有限公司 | 地图数据的处理方法、装置、电子设备和存储介质 |
CN115042788A (zh) * | 2022-06-01 | 2022-09-13 | 智道网联科技(北京)有限公司 | 交通路口通行方法、装置及电子设备、存储介质 |
CN115204455A (zh) * | 2022-05-26 | 2022-10-18 | 清华大学 | 适用于高速与环路交通场景的长时域驾驶行为决策方法 |
WO2022259733A1 (ja) * | 2021-06-08 | 2022-12-15 | 株式会社アイシン | 運転支援装置 |
CN115782905A (zh) * | 2023-01-31 | 2023-03-14 | 北京航空航天大学 | 一种自动驾驶车辆驾驶安全度量化系统 |
CN116176588A (zh) * | 2023-03-17 | 2023-05-30 | 浙江吉利控股集团有限公司 | 自动辅助导航驾驶方法及控制装置 |
-
2023
- 2023-07-31 CN CN202310950750.4A patent/CN116659539B/zh active Active
Patent Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2015161966A (ja) * | 2014-02-26 | 2015-09-07 | 株式会社デンソーアイティーラボラトリ | 車線変更計画装置及び車線変更計画方法 |
US20170113665A1 (en) * | 2015-10-27 | 2017-04-27 | GM Global Technology Operations LLC | Algorithms for avoiding automotive crashes at left and right turn intersections |
CN114600053A (zh) * | 2019-10-24 | 2022-06-07 | 祖克斯有限公司 | 基于碰撞区域的行驶路线修改 |
US20220081002A1 (en) * | 2020-09-16 | 2022-03-17 | Shenzhen Guo Dong Intelligent Drive Technologies Co., Ltd | Autonomous driving vehicle and dynamic planning method of drivable area |
WO2022259733A1 (ja) * | 2021-06-08 | 2022-12-15 | 株式会社アイシン | 運転支援装置 |
CN114485670A (zh) * | 2022-01-21 | 2022-05-13 | 清华大学 | 一种移动单元的路径规划方法、装置、电子设备及介质 |
CN114674340A (zh) * | 2022-03-21 | 2022-06-28 | 北京百度网讯科技有限公司 | 地图数据的处理方法、装置、电子设备和存储介质 |
CN115204455A (zh) * | 2022-05-26 | 2022-10-18 | 清华大学 | 适用于高速与环路交通场景的长时域驾驶行为决策方法 |
CN115042788A (zh) * | 2022-06-01 | 2022-09-13 | 智道网联科技(北京)有限公司 | 交通路口通行方法、装置及电子设备、存储介质 |
CN115782905A (zh) * | 2023-01-31 | 2023-03-14 | 北京航空航天大学 | 一种自动驾驶车辆驾驶安全度量化系统 |
CN116176588A (zh) * | 2023-03-17 | 2023-05-30 | 浙江吉利控股集团有限公司 | 自动辅助导航驾驶方法及控制装置 |
Non-Patent Citations (3)
Title |
---|
JINXIANG FENG; JIUHONG RUAN; YIBIN LI: "Study on Intelligent Vehicle Lane Change Path Planning and Control Simulation", 2006 IEEE INTERNATIONAL CONFERENCE ON INFORMATION ACQUISITION * |
上官望义,黄玉美,要小朋,等: "操舵构型移动机器人局部路径规划与跟踪", 中国机械工程, vol. 18, no. 15 * |
姜岩;龚建伟;熊光明;陈慧岩;: "基于运动微分约束的无人车辆纵横向协同规划算法的研究", 自动化学报, vol. 39, no. 12 * |
Also Published As
Publication number | Publication date |
---|---|
CN116659539B (zh) | 2023-10-13 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US10678248B2 (en) | Fast trajectory planning via maneuver pattern selection | |
US10860023B2 (en) | Systems and methods for safe decision making of autonomous vehicles | |
US10948919B2 (en) | Dynamic programming and gradient descent based decision and planning for autonomous driving vehicles | |
EP3702230B1 (en) | Method and apparatus for planning travelling path, and vehicle | |
US9096267B2 (en) | Efficient data flow algorithms for autonomous lane changing, passing and overtaking behaviors | |
CN112148002B (zh) | 一种局部轨迹规划方法、系统及装置 | |
US9457807B2 (en) | Unified motion planning algorithm for autonomous driving vehicle in obstacle avoidance maneuver | |
US20190080266A1 (en) | Cost based path planning for autonomous driving vehicles | |
US11586209B2 (en) | Differential dynamic programming (DDP) based planning architecture for autonomous driving vehicles | |
US11106212B2 (en) | Path planning for complex scenes with self-adjusting path length for autonomous driving vehicles | |
CN111177934B (zh) | 参考路径规划的方法、设备和存储介质 | |
US11353878B2 (en) | Soft-boundary based path optimization for complex scenes for autonomous driving vehicles | |
US20210387645A1 (en) | Vehicle and method of controlling the same | |
CN116476840B (zh) | 变道行驶方法、装置、设备及存储介质 | |
CN116659539B (zh) | 路径规划方法、装置和域控制器 | |
CN113320544B (zh) | 车辆驾驶行为的规划方法、装置、电子设备、存储介质 | |
CN111176285A (zh) | 一种行进路径规划的方法及装置、车辆、可读存储介质 | |
CN113327456A (zh) | 一种车道结构检测方法及装置 | |
CN116653963B (zh) | 车辆变道控制方法、系统和智能驾驶域控制器 | |
US20240043006A1 (en) | Method and apparatus for generating virtual stop line | |
US11767033B2 (en) | System and method for avoiding collision based on vision | |
RU2789921C2 (ru) | Способ и устройство для управления беспилотным автомобилем | |
CN115309145A (zh) | 车辆的避障控制方法及装置、存储介质、终端 | |
CN117774960A (zh) | 一种基于安全充要约束的车辆行驶实时优化避撞方法 | |
CN114777804A (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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant |