CN111238520B - 自动驾驶变道路径规划方法、装置和电子设备 - Google Patents
自动驾驶变道路径规划方法、装置和电子设备 Download PDFInfo
- Publication number
- CN111238520B CN111238520B CN202010081762.4A CN202010081762A CN111238520B CN 111238520 B CN111238520 B CN 111238520B CN 202010081762 A CN202010081762 A CN 202010081762A CN 111238520 B CN111238520 B CN 111238520B
- Authority
- CN
- China
- Prior art keywords
- vehicle
- obstacle
- path
- running
- current position
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 49
- 230000008859 change Effects 0.000 title claims description 30
- 230000008569 process Effects 0.000 claims description 16
- 238000004364 calculation method Methods 0.000 claims description 7
- 238000006243 chemical reaction Methods 0.000 claims description 4
- 238000004590 computer program Methods 0.000 claims description 4
- 230000003993 interaction Effects 0.000 claims description 4
- 238000010276 construction Methods 0.000 claims description 2
- 238000001514 detection method Methods 0.000 claims description 2
- 239000000126 substance Substances 0.000 claims 1
- 230000004888 barrier function Effects 0.000 abstract description 10
- 230000006870 function Effects 0.000 description 8
- 238000010586 diagram Methods 0.000 description 6
- 238000005516 engineering process Methods 0.000 description 4
- 238000012545 processing Methods 0.000 description 3
- 238000004891 communication Methods 0.000 description 2
- 238000000926 separation method Methods 0.000 description 2
- 230000003238 somatosensory effect Effects 0.000 description 2
- 230000003068 static effect Effects 0.000 description 2
- 238000013473 artificial intelligence Methods 0.000 description 1
- 238000013500 data storage Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 238000012549 training Methods 0.000 description 1
- 230000007723 transport mechanism Effects 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W60/00—Drive control systems specially adapted for autonomous road vehicles
- B60W60/001—Planning or execution of driving tasks
- B60W60/0027—Planning or execution of driving tasks using trajectory prediction for other traffic participants
- B60W60/00272—Planning or execution of driving tasks using trajectory prediction for other traffic participants relying on extrapolation of current movement
-
- 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
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W30/00—Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units, or advanced driver assistance systems for ensuring comfort, stability and safety or drive control systems for propelling or retarding the vehicle
- B60W30/18—Propelling the vehicle
- B60W30/18009—Propelling the vehicle related to particular drive situations
- B60W30/18163—Lane change; Overtaking manoeuvres
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W30/00—Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units, or advanced driver assistance systems for ensuring comfort, stability and safety or drive control systems for propelling or retarding the vehicle
- B60W30/10—Path keeping
- B60W30/12—Lane keeping
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W40/00—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
- B60W40/10—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to vehicle motion
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W40/00—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
- B60W40/10—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to vehicle motion
- B60W40/114—Yaw movement
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W60/00—Drive control systems specially adapted for autonomous road vehicles
- B60W60/001—Planning or execution of driving tasks
- B60W60/0011—Planning or execution of driving tasks involving control alternatives for a single driving scenario, e.g. planning several paths to avoid obstacles
-
- 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/343—Calculating itineraries, i.e. routes leading from a starting point to a series of categorical destinations using a global route restraint, round trips, touristic trips
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06V—IMAGE OR VIDEO RECOGNITION OR UNDERSTANDING
- G06V20/00—Scenes; Scene-specific elements
- G06V20/50—Context or environment of the image
- G06V20/56—Context or environment of the image exterior to a vehicle by using sensors mounted on the vehicle
- G06V20/58—Recognition of moving objects or obstacles, e.g. vehicles or pedestrians; Recognition of traffic objects, e.g. traffic signs, traffic lights or roads
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W50/00—Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
- B60W2050/0001—Details of the control system
- B60W2050/0002—Automatic control, details of type of controller or control system architecture
- B60W2050/0004—In digital systems, e.g. discrete-time systems involving sampling
- B60W2050/0005—Processor details or data handling, e.g. memory registers or chip architecture
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2552/00—Input parameters relating to infrastructure
- B60W2552/50—Barriers
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2554/00—Input parameters relating to objects
- B60W2554/40—Dynamic objects, e.g. animals, windblown objects
- B60W2554/404—Characteristics
- B60W2554/4041—Position
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2554/00—Input parameters relating to objects
- B60W2554/80—Spatial relation or speed relative to objects
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2554/00—Input parameters relating to objects
- B60W2554/80—Spatial relation or speed relative to objects
- B60W2554/801—Lateral distance
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60Y—INDEXING SCHEME RELATING TO ASPECTS CROSS-CUTTING VEHICLE TECHNOLOGY
- B60Y2300/00—Purposes or special features of road vehicle drive control systems
- B60Y2300/10—Path keeping
- B60Y2300/12—Lane keeping
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60Y—INDEXING SCHEME RELATING TO ASPECTS CROSS-CUTTING VEHICLE TECHNOLOGY
- B60Y2300/00—Purposes or special features of road vehicle drive control systems
- B60Y2300/18—Propelling the vehicle
- B60Y2300/18008—Propelling the vehicle related to particular drive situations
- B60Y2300/18166—Overtaking, changing lanes
Abstract
本公开实施例提供了一种自动驾驶变道路径规划方法、装置和电子设备,该方法包括:根据检测到的障碍物的位置,确定车辆绕行障碍物时需要通过的障碍物参考位置;通过车辆和障碍物之间的位置关系,预估车辆绕行障碍物的终点位置;基于车辆的当前位置,障碍物参考位置和终点位置,确定车辆绕行障碍物的路径。
Description
技术领域
本公开实施例涉及自动驾驶技术领域,特别涉及一种自动驾驶变道路径规划方法、装置和电子设备。
背景技术
随着计算机技术和人工智能的发展,自动驾驶车辆在交通、军事、物流仓储、日常生活等方面具有广阔的应用前景。
路径规划是自动驾驶技术中关键的部分,其基于感知系统的环境数据,车辆需要在复杂的道路环境中基于一定的性能指标规划出一条安全可靠、从起始位置到目标位置的最短无碰撞路径。并且,在车辆行驶过程中,需要保证车辆距离障碍物有一定的安全距离。
发明内容
本公开实施例提供一种自动驾驶变道路径规划方法、装置和电子设备,能够在路径行驶过程中,保证距离障碍物有一定的安全距离。
第一方面,本公开实施例提供一种自动驾驶变道路径规划方法,包括:根据检测到的障碍物的位置,确定车辆绕行障碍物时需要通过的障碍物参考位置;通过车辆和障碍物之间的位置关系,预估车辆绕行障碍物的终点位置;基于车辆的当前位置,障碍物参考位置和终点位置,确定车辆绕行障碍物的路径。
第二方面,本公开实施例提供一种自动驾驶变道路径规划装置,包括:参考位置确定模块,用于根据检测到的障碍物的位置,确定车辆绕行障碍物时需要通过的障碍物参考位置;终点位置预估模块,用于通过车辆和障碍物之间的位置关系,预估车辆绕行障碍物的终点位置;行驶路径选取模块,用于基于车辆的当前位置,障碍物参考位置和终点位置,确定车辆绕行障碍物的路径。
第三方面,本公开实施例提供一种电子设备,其包括:一个或多个处理器;存储器,其上存储有一个或多个程序,当一个或多个程序被一个或多个处理器执行,使得一个或多个处理器上述任意一种自动驾驶变道路径规划方法;一个或多个I/O接口,连接在处理器与存储器之间,配置为实现处理器与存储器的信息交互。
第四方面,本公开实施例提供一种计算机可读介质,其上存储有计算机程序,程序被处理器执行时实现上述任意一种自动驾驶变道路径规划方法。
本公开实施例提供的自动驾驶变道路径规划方法、装置、电子设备和计算机可读介质,计算车辆绕行障碍物时需要通过的障碍物参考位置,并根据车辆和障碍物之间的位置关系,预估车辆绕行所述障碍物的终点位置,从而规划该车辆绕行障碍物的路径,在行驶过程中与检测到的障碍物保持安全距离。
附图说明
附图用来提供对本公开实施例的进一步理解,并且构成说明书的一部分,与本公开的实施例一起用于解释本公开,并不构成对本公开的限制。通过参考附图对详细示例实施例进行描述,以上和其它特征和优点对本领域技术人员将变得更加显而易见,在附图中:
图1为本公开实施例提供的自动驾驶车辆在变道过程中绕行障碍物的场景示意图;
图2为本公开实施例提供的一种变道路径规划方法的流程图;
图3为本公开实施例提供的一种变道路径规划装置的组成框图;
图4为本公开实施例提供的一种电子设备的组成框图;
图5为本公开实施例提供的一种计算机可读介质的组成框图。
具体实施方式
为使本领域的技术人员更好地理解本发明的技术方案,下面结合附图对本发明提供的变道路径规划方法、装置、电子设备和计算机可读介质进行详细描述。
在下文中将参考附图更充分地描述示例实施例,但是所述示例实施例可以以不同形式来体现且不应当被解释为限于本文阐述的实施例。反之,提供这些实施例的目的在于使本公开透彻和完整,并将使本领域技术人员充分理解本公开的范围。在不冲突的情况下,本公开各实施例及实施例中的各特征可相互组合。
在本文实施例中描述的车辆,可以是自动驾驶汽车(Autonomous vehicles)或无人驾驶汽车(Self-driving Automobile)。该车辆可以被配置为处于自动驾驶模式,在自动驾驶模式下该车辆可以在极少或没有来自驾驶员的输入的情况下导航通过环境。在下述实施例中,该车辆也可以称为主车(Ego car),即可以使用本车角度感知环境,并以本车为中心进行变道路径规划的车辆。
图1为本公开实施例的自动驾驶车辆在变道过程中绕行障碍物的场景示意图。在图1所示的场景中,示意性地示出了自动驾驶车辆主车11在变道过程中的当前车道12、目标车道13、位于目标车道13的障碍物1。
在本公开实施例中,主车11在行驶过程中,可以对主车11自身的位置信息和运行状态进行检测,并可以对障碍物的位置信息和障碍物的运行状态进行检测。示例性地,该运动状态可以包括运动方向和运动速度等信息。
在一个实施例中,可以根据车辆行驶过程中沿道路中线的方向(视为纵向)和垂直于道路中线的方向(视为横向)构建坐标系,从而确定主车11和检测到的障碍物在构建的该坐标系中的位置信息。
参考图1,示例性地示出主车11的当前位置T1(s0,l0),主车11绕行第一障碍物1时的障碍物参考位置T2(s1,l1),预估的车辆绕行第一障碍物1的终点位置T3(st,lt)。
其中,第一障碍物1包括两条车辆边界:靠近主车11的车辆边界和远离主车11的车辆边界。并且其中,主车11与第一障碍物1的靠近主车11的车辆边界之间,在垂直于道路中线的方向上应保持预定偏移距离。
本发明实施例提供一种变道路径规划方法、装置、电子设备和计算机可读介质,可以利用障碍物参考点位置,确定能够躲避障碍物的行驶终点位置,并规划能够躲避障碍物的行驶路径。
需要说明的是,图1示出的路径规划的实际变道场景,可以是高速公路或中低速的公路上进行变道路径规划的应用场景,或其他应用场景,本文实施例中对此不做具体限定。
图2为本公开实施例提供的变道路径规划方法的流程图。如图2所示,该变道路径规划方法可以包括如下步骤。
S110,根据检测到的障碍物的位置,确定车辆绕行障碍物时需要通过的障碍物参考位置。
S120,通过车辆和障碍物之间的位置关系,预估车辆绕行障碍物的终点位置。
S130,基于车辆的当前位置,障碍物参考位置和终点位置,确定车辆绕行障碍物的路径。
在本公开实施例的方案中,可以根据障碍物与主车之间的位置关系,预估车辆绕行障碍物的终点位置,从而规划从车辆的当前位置开始,经过障碍物参考位置和终点位置的路径,在行驶过程中与检测到的障碍物保持安全距离。
在一个实施例中,在根据检测到的障碍物的位置,确定车辆绕行障碍物时需要通过的障碍物参考位置之前,还包括:在车辆变道开始之前,检测障碍物的位置信息和障碍物的运动状态。
本公开实施例的方案可以应用与自动驾驶过程变道过程中,在开始变道之前,检测障碍物的位置信息和障碍物的运动状态,利用障碍物位置信息估计变道结束位置,规划能够躲避障碍物的变道路径。
在一个实施例中,步骤S110,具体可以包括:S21,从检测到的障碍物的位置信息中,获取障碍物的靠近车辆侧的车辆边界的位置信息;S22,计算与车辆边界的位置间隔预定偏移距离的位置,得到车辆绕行障碍物时需要通过的障碍物参考位置。
在一个实施例中,预定偏移距离,为预先设定的与障碍物在垂直与道路中线方向的间隔距离,且预定偏移距离大于0。
作为一个示例,利用检测的障碍物信息估算的需要绕行(nudge)通过的位置点的位置信息可以表示为下述表达式(1):
(s1,l1)=(scenter,l_center+nudge_buffer) (1)
在上述表达式(1)中,scenter表示障碍物在沿道路中线方向的位置信息,l_center表示障碍物在垂直于道路中线方向的位置信息,nudge_buffer表示在垂直于道路中线方向主车与障碍物的偏移距离。
通过上述表达式(1)可知,在该实施例中,通过设置预定的偏移距离,可以调整自动驾驶车辆与障碍物之间保持安全距离的程度,从而保证正常行车或变道过程中能够躲避障碍物。
在一个实施例中,该变道路径规划方法还可以包括:根据检测的车辆的当前位置和车辆运动状态,以及检测的障碍物的位置和障碍物运动状态,预估车辆绕行障碍物的终点位置。
在该实施例中,预估车辆绕行障碍物的终点位置的步骤,具体可以包括:S31,根据车辆的当前位置和车辆运动状态,以及障碍物的位置和障碍物运动状态,确定车辆和障碍物之间在车辆行驶过程中的位置关系;S41,利用车辆行驶过程中的位置关系,预估车辆能够绕行障碍物的终点位置。
在本公开实施例的变道路径规划方法中,当障碍物为静态,障碍物的位置固定不变且障碍物运动状态为静止状态;当障碍物为动态时,车辆和障碍物之间的位置关系,随车辆行驶过程动态变化,根据主车与障碍物之间动态变化的位置关系,预估能够躲避障碍物的变道终点位置。
在一个实施例中,预估的能够躲避障碍物的变道终点位置,可以预先利用车辆的位置、车辆运动状态、障碍物的位置和障碍物运动状态,对进行车辆绕行障碍物的终点位置进行预估的模型进行训练,并利用训练得到的该模型,预估车辆能够躲避障碍物的终点位置。
在一个实施例中,步骤S130具体可以包括:S41,将车辆的当前位置、障碍物参考位置和终点位置的路径,作为车辆绕行障碍物的路径的轨迹点;S42,沿道路中线方向,计算车辆从当前位置到终点位置的行驶角速度;S43,构建以行驶角速度通过轨迹点的路径,作为车辆绕行障碍物的路径。
在一个实施例中,步骤S32,具体可以包括:S51,根据车辆的当前位置和预估的终点距离,在沿道路中线方向,计算车辆从当前位置到终点位置的行驶路径长度;S52,根据车辆的行驶状态和行驶路径长度,计算车辆的行驶线速度;S53,利用行驶线速度和行驶角速度之间的转换关系,计算得到车辆从当前位置到终点位置的行驶角速度。
作为一个示例,构建的主车绕行障碍物的曲线可以表示为下述表达式(2):
在上述表达式(2)中,f(s)=a(1+cos(bs+c))为构建的主车绕行障碍物的曲线函数,其中,a、b和c分别为该曲线函数的参数;并且,该曲线函数需要满足:f(s0)=l0,表示该曲线函数应通过主车的起始位置点T1(s0,l0));f(s1)=l1,表示该曲线函数应通过主车绕行障碍物时的障碍物参考位置T2(s1,l1);以及f(st)=lt,表示该曲线函数应通过预估的车辆绕行障碍物的终点位置T3(st,lt)。
并且,在上述表达式(2)中,st-s0表示在沿道路中线方向,计算得到的车辆从当前位置到终点位置的行驶路径长度,b表示车辆从当前位置到终点位置的行驶角速度。
在一个实施例中,根据上述表达式(2)求解得到构建的主车绕行障碍物的曲线中的参数a、b和c。
通过上述描述可知,b为车辆绕行障碍物是的行驶角速度,且该行驶角速度可以用于衡量车辆行驶时的体感和线性的稳定程度,且b的取值决定于车辆与障碍物之间的位置关系,该位置关系既包括车辆与障碍物之间在沿道路中线方向上的位置关系和在垂直于道路中线方向上的位置关系。
因此,根据本发明实施例的变道路径规划方法,可以在变道开始时利用障碍物位置信息估计变道距离,结合障碍物与主车的位置关系规划变道路径,从而躲避障碍物,保证变道过程安全性,并实现体感最优和线型稳定。
图3示出本公开实施例提供的路径规划组成框图。如图3所示,变道路径规划装置包括如下模块。
参考位置确定模块310,用于根据检测到的障碍物的位置,确定车辆绕行障碍物时需要通过的障碍物参考位置。
终点位置预估模块320,用于通过车辆和障碍物之间的位置关系,预估车辆绕行障碍物的终点位置。
行驶路径选取模块330,用于基于车辆的当前位置,障碍物参考位置和终点位置,确定车辆绕行障碍物的路径。
根据本公开实施例的变道路径规划装置,根据障碍物与主车之间的位置关系,预估车辆绕行障碍物的终点位置,从而规划从车辆的当前位置开始,经过障碍物参考位置和终点位置的路径,在行驶过程中与检测到的障碍物保持安全距离。
在一个实施例中,变道路径规划装置还可以包括:信息检测模块,用于在车辆变道开始之前,检测障碍物的位置信息和障碍物的运动状态。
在一个实施例中,参考位置确定模块310,具体可以包括:边界位置获取单元,用于从检测到的障碍物的位置中,获取障碍物的靠近车辆侧的车辆边界的位置;参考位置计算单元,用于计算与车辆边界的位置间隔预定偏移距离的位置,得到车辆绕行障碍物时需要通过的障碍物参考位置。
在一个实施例中,预定偏移距离,为预先设定的与障碍物在垂直与道路中线方向的间隔距离,且预定偏移距离大于0。
在一个实施例中,终点位置预估模块320,具体还可以用于:根据检测的车辆的当前位置和车辆运动状态,以及检测的障碍物的位置和障碍物运动状态,预估车辆绕行障碍物的终点位置。
在该实施例中,终点位置预估模块320具体可以包括:位置关系确定单元,用于根据车辆的当前位置和车辆运动状态,以及障碍物的位置和障碍物运动状态,确定车辆和障碍物之间在车辆行驶过程中的位置关系;终点位置预估模块320,具体还用于利用车辆行驶过程中的位置关系,预估车辆能够绕行障碍物的终点位置。
在一个实施例中,行驶路径选取模块330,具体可以包括:轨迹点确定单元,用于将车辆的当前位置、障碍物参考位置和终点位置的路径,作为车辆绕行障碍物的路径的轨迹点;角速度计算单元,用于沿道路中线方向,计算车辆从当前位置到终点位置的行驶角速度;路径构建单元,用于构建以行驶角速度通过轨迹点的路径,作为车辆绕行障碍物的路径。
在一个实施例中,角速度计算单元,具体可以包括:行驶长度计算子单元,用于根据车辆的当前位置和预估的终点距离,在沿道路中线方向,计算车辆从当前位置到终点位置的行驶路径长度;线速度计算子单元,用于根据车辆的行驶状态和行驶路径长度,计算车辆的行驶线速度;角速度计算单元,具体还可以利用行驶线速度和行驶角速度之间的转换关系,计算得到车辆从当前位置到终点位置的行驶角速度。
根据本发明实施例的变道路径规划装置,可以在变道开始时利用障碍物位置信息估计变道距离,结合障碍物与主车的位置关系规划变道路径,从而躲避障碍物,保证变道过程安全性,并实现体感最优和线型稳定。
图4示出本公开实施例提供的一种电子设备的组成框图;如图4所示,本公开实施例提供一种电子设备400,包括:一个或多个处理器501;存储器402,其上存储有一个或多个程序,当一个或多个程序被一个或多个处理器执行,使得一个或多个处理器实现上述任意一项的变道路径规划方法;一个或多个I/O接口403,连接在处理器与存储器之间,配置为实现处理器与存储器的信息交互。
其中,处理器401为具有数据处理能力的器件,其包括但不限于中央处理器(CPU)等;存储器402为具有数据存储能力的器件,其包括但不限于随机存取存储器(RAM,更具体如SDRAM、DDR等)、只读存储器(ROM)、带电可擦可编程只读存储器(EEPROM)、闪存(FLASH);I/O接口(读写接口)403连接在处理器401与存储器402间,能实现处理器401与存储器402的信息交互,其包括但不限于数据总线(Bus)等。
在一些实施例中,处理器401、存储器402和I/O接口403通过总线404相互连接,进而与电子设备800的其他组件连接。
图5示出本公开实施例提供的一种计算机可读介质的组成框图。如图5所示,本公开实施例提供一种计算机可读介质,其上存储有计算机程序,程序被处理器执行时实现上述任意一种变道路径规划方法。
本领域普通技术人员可以理解,上文中所公开方法中的全部或某些步骤、系统、装置中的功能模块/单元可以被实施为软件、固件、硬件及其适当的组合。在硬件实施方式中,在以上描述中提及的功能模块/单元之间的划分不一定对应于物理组件的划分;例如,一个物理组件可以具有多个功能,或者一个功能或步骤可以由若干物理组件合作执行。某些物理组件或所有物理组件可以被实施为由处理器,如中央处理器、数字信号处理器或微处理器执行的软件,或者被实施为硬件,或者被实施为集成电路,如专用集成电路。这样的软件可以分布在计算机可读介质上,计算机可读介质可以包括计算机存储介质(或非暂时性介质)和通信介质(或暂时性介质)。如本领域普通技术人员公知的,术语计算机存储介质包括在用于存储信息(诸如计算机可读指令、数据结构、程序模块或其它数据)的任何方法或技术中实施的易失性和非易失性、可移除和不可移除介质。计算机存储介质包括但不限于RAM、ROM、EEPROM、闪存或其它存储器技术、CD-ROM、数字多功能盘(DVD)或其它光盘存储、磁盒、磁带、磁盘存储或其它磁存储装置、或者可以用于存储期望的信息并且可以被计算机访问的任何其它的介质。此外,本领域普通技术人员公知的是,通信介质通常包含计算机可读指令、数据结构、程序模块或者诸如载波或其它传输机制之类的调制数据信号中的其它数据,并且可包括任何信息递送介质。
本文已经公开了示例实施例,并且虽然采用了具体术语,但它们仅用于并仅应当被解释为一般说明性含义,并且不用于限制的目的。在一些实例中,对本领域技术人员显而易见的是,除非另外明确指出,否则可单独使用与特定实施例相结合描述的特征、特性和/或元素,或可与其它实施例相结合描述的特征、特性和/或元件组合使用。因此,本领域技术人员将理解,在不脱离由所附的权利要求阐明的本公开的范围的情况下,可进行各种形式和细节上的改变。
Claims (16)
1.一种自动驾驶变道路径规划方法,包括:
根据检测到的障碍物的位置,确定车辆绕行所述障碍物时需要通过的障碍物参考位置;其中,所述障碍物参考位置,是与所述障碍物的靠近车辆侧的车辆边界的位置在垂直于道路中线方向上间隔预定偏移距离的位置;
通过所述车辆和所述障碍物之间的位置关系,预估所述车辆绕行所述障碍物的终点位置;
基于所述车辆的当前位置,所述障碍物参考位置和所述终点位置,确定所述车辆绕行所述障碍物的路径。
2.根据权利要求1所述的方法,其中,在根据检测到的障碍物的位置,确定车辆绕行所述障碍物时需要通过的障碍物参考位置之前,还包括:
在车辆变道开始之前,检测障碍物的位置信息和所述障碍物的运动状态。
3.根据权利要求1所述的方法,其中,所述根据检测到的障碍物的位置,确定车辆绕行所述障碍物时需要通过的障碍物参考位置,包括:
从检测到的所述障碍物的位置中,获取所述障碍物的靠近所述车辆侧的车辆边界的位置;
计算与所述车辆边界的位置间隔预定偏移距离的位置,得到所述车辆绕行所述障碍物时需要通过的障碍物参考位置;其中,
所述预定偏移距离,为预先设定的与所述障碍物在垂直于道路中线方向的间隔距离,且所述预定偏移距离大于0。
4.根据权利要求1所述的方法,其中,所述方法还包括:
根据检测的所述车辆的当前位置和车辆运动状态,以及检测的所述障碍物的位置和障碍物运动状态,预估所述车辆绕行所述障碍物的终点位置。
5.根据权利要求1所述的方法,其中,所述预估所述车辆绕行所述障碍物的终点位置,包括:
根据所述车辆的当前位置和所述车辆运动状态,以及所述障碍物的位置和所述障碍物运动状态,确定所述车辆和所述障碍物之间在车辆行驶过程中的位置关系;
利用所述车辆行驶过程中的位置关系,预估所述车辆能够绕行所述障碍物的终点位置。
6.根据权利要求1至5任意一项所述的方法,其中,所述基于所述车辆的当前位置,所述障碍物参考位置和所述终点位置,确定所述车辆绕行所述障碍物的路径,包括:
将所述车辆的当前位置、所述障碍物参考位置和所述终点位置的路径,作为所述车辆绕行所述障碍物的路径的轨迹点;
沿道路中线方向,计算所述车辆从所述当前位置到所述终点位置的行驶角速度;
构建以行驶角速度通过所述轨迹点的路径,作为所述车辆绕行所述障碍物的路径。
7.根据权利要求6所述的方法,其中,所述沿道路中线方向,计算所述车辆从所述当前位置到所述终点位置的行驶角速度,包括:
根据所述车辆的当前位置和预估的终点距离,在沿道路中线方向,计算所述车辆从所述当前位置到所述终点位置的行驶路径长度;
根据所述车辆的行驶状态和所述行驶路径长度,计算所述车辆的行驶线速度;
利用所述行驶线速度和行驶角速度之间的转换关系,计算得到所述车辆从所述当前位置到所述终点位置的行驶角速度。
8.一种自动驾驶变道路径规划装置,包括:
参考位置确定模块,用于根据检测到的障碍物的位置,确定车辆绕行所述障碍物时需要通过的障碍物参考位置;其中,所述障碍物参考位置,是与所述障碍物的靠近车辆侧的车辆边界的位置在垂直于道路中线方向上间隔预定偏移距离的位置;
终点位置预估模块,用于通过所述车辆和所述障碍物之间的位置关系,预估所述车辆绕行所述障碍物的终点位置;
行驶路径选取模块,用于从所述车辆的当前位置开始,选取经过所述障碍物参考位置和所述终点位置的路径,作为所述车辆绕行所述障碍物的路径。
9.根据权利要求8所述的装置,其中,所述装置还包括:
信息检测模块,用于在车辆变道开始之前,检测障碍物的位置信息和所述障碍物的运动状态。
10.根据权利要求8所述的装置,其中,所述参考位置确定模块包括:
边界位置获取单元,用于从检测到的所述障碍物的位置中,获取所述障碍物的靠近所述车辆侧的车辆边界的位置;
参考位置计算单元,用于计算与所述车辆边界的位置间隔预定偏移距离的位置,得到所述车辆绕行所述障碍物时需要通过的障碍物参考位置;
其中,所述预定偏移距离,为预先设定的与所述障碍物在垂直于道路中线方向的间隔距离,且所述预定偏移距离大于0。
11.根据权利要求8所述的装置,其中,
所述终点位置预估模块,还用于根据检测的所述车辆的当前位置和车辆运动状态,以及检测的所述障碍物的位置和障碍物运动状态,预估所述车辆绕行所述障碍物的终点位置。
12.根据权利要求8所述的装置,其中,所述终点位置预估模块包括:
位置关系确定单元,用于根据所述车辆的当前位置和所述车辆运动状态,以及所述障碍物的位置和所述障碍物运动状态,确定所述车辆和所述障碍物之间在车辆行驶过程中的位置关系;
所述终点位置预估模块,具体用于利用所述车辆行驶过程中的位置关系,预估所述车辆能够绕行所述障碍物的终点位置。
13.根据权利要求8-12任意一项所述的装置,其中,所述行驶路径选取模块包括:
轨迹点确定单元,用于将所述车辆的当前位置、所述障碍物参考位置和所述终点位置的路径,作为所述车辆绕行所述障碍物的路径的轨迹点;
角速度计算单元,用于沿道路中线方向,计算所述车辆从所述当前位置到所述终点位置的行驶角速度;
路径构建单元,用于构建以行驶角速度通过所述轨迹点的路径,作为所述车辆绕行所述障碍物的路径。
14.根据权利要求13所述的装置,其中,所述角速度计算单元包括:
行驶长度计算子单元,用于根据所述车辆的当前位置和预估的终点距离,在沿道路中线方向,计算所述车辆从所述当前位置到所述终点位置的行驶路径长度;
线速度计算子单元,用于根据所述车辆的行驶状态和所述行驶路径长度,计算所述车辆的行驶线速度;
所述角速度计算单元,具体用于利用所述行驶线速度和行驶角速度之间的转换关系,计算得到所述车辆从所述当前位置到所述终点位置的行驶角速度。
15.一种电子设备,包括:
一个或多个处理器;
存储装置,其上存储有一个或多个程序,当所述一个或多个程序被所述一个或多个处理器执行,使得所述一个或多个处理器实现根据权利要求1-7任意一项所述的自动驾驶变道路径规划方法;
一个或多个I/O接口,连接在所述处理器与存储器之间,配置为实现所述处理器与存储器的信息交互。
16.一种计算机可读介质,其上存储有计算机程序,所述程序被处理器执行时实现根据权利要求1-7任意一项所述的自动驾驶变道路径规划方法。
Priority Applications (5)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010081762.4A CN111238520B (zh) | 2020-02-06 | 2020-02-06 | 自动驾驶变道路径规划方法、装置和电子设备 |
US17/031,410 US20210245786A1 (en) | 2020-02-06 | 2020-09-24 | Method for planning path for lane changing, electronic device and computer readable medium |
EP21150227.3A EP3862241A1 (en) | 2020-02-06 | 2021-01-05 | Method and apparatus for planning path for lane changing, electronic device and computer readable medium |
JP2021010793A JP7320008B2 (ja) | 2020-02-06 | 2021-01-27 | 車線変更経路を計画する方法、装置、電子機器及びコンピュータ読み取り可能な媒体 |
KR1020210016668A KR20210100553A (ko) | 2020-02-06 | 2021-02-05 | 차선 변경 경로 계획 방법, 장치, 전자기기 및 컴퓨터 판독가능 매체 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010081762.4A CN111238520B (zh) | 2020-02-06 | 2020-02-06 | 自动驾驶变道路径规划方法、装置和电子设备 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111238520A CN111238520A (zh) | 2020-06-05 |
CN111238520B true CN111238520B (zh) | 2022-10-14 |
Family
ID=70863128
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010081762.4A Active CN111238520B (zh) | 2020-02-06 | 2020-02-06 | 自动驾驶变道路径规划方法、装置和电子设备 |
Country Status (5)
Country | Link |
---|---|
US (1) | US20210245786A1 (zh) |
EP (1) | EP3862241A1 (zh) |
JP (1) | JP7320008B2 (zh) |
KR (1) | KR20210100553A (zh) |
CN (1) | CN111238520B (zh) |
Families Citing this family (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111724598B (zh) * | 2020-06-29 | 2022-04-05 | 北京百度网讯科技有限公司 | 用于自动驾驶规划路径的方法、装置、设备以及存储介质 |
CN112265542B (zh) * | 2020-09-11 | 2022-05-27 | 武汉智行者科技有限公司 | 一种自动驾驶会车场景处理方法及其装置、车辆 |
CN113804208A (zh) * | 2020-09-18 | 2021-12-17 | 北京京东乾石科技有限公司 | 无人车路径优化方法及相关设备 |
CN114537381A (zh) * | 2020-11-24 | 2022-05-27 | 郑州宇通客车股份有限公司 | 一种自动驾驶车辆的车道避障方法及装置 |
US20220198107A1 (en) * | 2020-12-23 | 2022-06-23 | Waymo Llc | Simulations for evaluating driving behaviors of autonomous vehicles |
CN114852099A (zh) * | 2021-02-03 | 2022-08-05 | 郑州宇通客车股份有限公司 | 机动车换道行为的预测方法 |
CN113954838B (zh) * | 2021-11-24 | 2023-04-07 | 上海安亭地平线智能交通技术有限公司 | 车辆换道的控制方法和装置、电子设备和存储介质 |
CN114379584B (zh) * | 2021-12-17 | 2023-12-22 | 阿波罗智联(北京)科技有限公司 | 车辆控制方法、装置、车辆、设备和存储介质 |
CN116476840B (zh) * | 2023-06-21 | 2023-09-01 | 北京斯年智驾科技有限公司 | 变道行驶方法、装置、设备及存储介质 |
Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
GB2562376A (en) * | 2017-03-31 | 2018-11-14 | Ford Global Tech Llc | Virtual Steerable Path |
Family Cites Families (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP5630583B2 (ja) * | 2011-08-31 | 2014-11-26 | 日産自動車株式会社 | 車両運転支援装置 |
JP5919186B2 (ja) * | 2012-12-25 | 2016-05-18 | 日立建機株式会社 | 地図作成支援システム |
DE102014016567A1 (de) * | 2014-11-08 | 2016-05-12 | GM Global Technology Operations LLC (n. d. Ges. d. Staates Delaware) | Verfahren zum Bestimmen einer Ausweichtrajektorie und Fahrerassistenzsystem dafür |
KR102036050B1 (ko) * | 2014-12-30 | 2019-10-24 | 주식회사 만도 | 차선 변경 장치 및 방법 |
US9511767B1 (en) * | 2015-07-01 | 2016-12-06 | Toyota Motor Engineering & Manufacturing North America, Inc. | Autonomous vehicle action planning using behavior prediction |
CN109050533B (zh) * | 2017-06-09 | 2020-11-17 | 蔚来(安徽)控股有限公司 | 一种车辆自动换道控制方法和装置 |
CN107792073B (zh) * | 2017-09-29 | 2019-10-25 | 东软集团股份有限公司 | 一种车辆换道控制方法、装置及相关设备 |
WO2019087380A1 (ja) * | 2017-11-06 | 2019-05-09 | 本田技研工業株式会社 | 車両制御装置 |
JP2019159500A (ja) * | 2018-03-08 | 2019-09-19 | トヨタ自動車株式会社 | 車両制御装置 |
JP2020004017A (ja) * | 2018-06-27 | 2020-01-09 | アイシン・エィ・ダブリュ株式会社 | 画像データ送信装置、及び、画像データ送信プログラム |
CN110103967B (zh) * | 2019-05-15 | 2020-10-20 | 广州小鹏汽车科技有限公司 | 一种车辆自动变道方法及车辆控制系统、车辆 |
-
2020
- 2020-02-06 CN CN202010081762.4A patent/CN111238520B/zh active Active
- 2020-09-24 US US17/031,410 patent/US20210245786A1/en not_active Abandoned
-
2021
- 2021-01-05 EP EP21150227.3A patent/EP3862241A1/en active Pending
- 2021-01-27 JP JP2021010793A patent/JP7320008B2/ja active Active
- 2021-02-05 KR KR1020210016668A patent/KR20210100553A/ko not_active Application Discontinuation
Patent Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
GB2562376A (en) * | 2017-03-31 | 2018-11-14 | Ford Global Tech Llc | Virtual Steerable Path |
Also Published As
Publication number | Publication date |
---|---|
US20210245786A1 (en) | 2021-08-12 |
CN111238520A (zh) | 2020-06-05 |
EP3862241A1 (en) | 2021-08-11 |
JP7320008B2 (ja) | 2023-08-02 |
JP2021123330A (ja) | 2021-08-30 |
KR20210100553A (ko) | 2021-08-17 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111238520B (zh) | 自动驾驶变道路径规划方法、装置和电子设备 | |
CN108297861B (zh) | 车辆在垂直停车位中的自主泊车 | |
US10281921B2 (en) | Autonomous parking of vehicles in perpendicular parking spots | |
US9283967B2 (en) | Accurate curvature estimation algorithm for path planning of autonomous driving vehicle | |
WO2019230038A1 (ja) | 自己位置推定装置 | |
EP3405374B1 (en) | Deceleration curb-based direction checking and lane keeping system for autonomous driving vehicles | |
CN111186443B (zh) | 变道路径规划方法、装置、电子设备和计算机可读介质 | |
JP6261832B1 (ja) | 走行路認識装置及び走行路認識方法 | |
CN104276178A (zh) | 用于探测车辆前方窄路的装置和方法 | |
CN112433531A (zh) | 一种自动驾驶车辆的轨迹跟踪方法、装置及计算机设备 | |
US20210373138A1 (en) | Dynamic lidar alignment | |
CN113009539A (zh) | 一种车辆自动变道处理方法、车辆及设备 | |
JP6836446B2 (ja) | 車両の走行車線推定装置 | |
EP4001844A1 (en) | Method and apparatus with localization | |
CN113867343A (zh) | 机器人移动方法、装置、机器人及存储介质 | |
KR20200052997A (ko) | 자율주행 차량의 추측항법 성능 향상을 위한 직진 주행 판단 장치 및 그 방법 | |
US20180038696A1 (en) | A system for use in a vehicle | |
JP6948151B2 (ja) | 走行車線特定装置 | |
CN116559899B (zh) | 自动驾驶车辆的融合定位方法、装置和电子设备 | |
CN116481548B (zh) | 自动驾驶车辆的定位方法、装置及电子设备 | |
US11640716B2 (en) | Lane curvature determination | |
US20220410885A1 (en) | Vehicle and control method thereof | |
WO2022168353A1 (ja) | 車両位置推定装置、自動運転装置および車両位置推定方法 | |
WO2020202498A1 (ja) | 位置推定装置、位置推定システム、位置推定方法、および位置推定プログラム | |
KR101561337B1 (ko) | 주행체 위치 추정 방법 및 그 장치 |
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 | ||
TA01 | Transfer of patent application right | ||
TA01 | Transfer of patent application right |
Effective date of registration: 20211014 Address after: 105 / F, building 1, No. 10, Shangdi 10th Street, Haidian District, Beijing 100085 Applicant after: Apollo Intelligent Technology (Beijing) Co.,Ltd. Address before: 2 / F, baidu building, 10 Shangdi 10th Street, Haidian District, Beijing 100085 Applicant before: BEIJING BAIDU NETCOM SCIENCE AND TECHNOLOGY Co.,Ltd. |
|
GR01 | Patent grant | ||
GR01 | Patent grant |