CN112394725A - 用于自动驾驶的基于预测和反应视场的计划 - Google Patents
用于自动驾驶的基于预测和反应视场的计划 Download PDFInfo
- Publication number
- CN112394725A CN112394725A CN202010799899.3A CN202010799899A CN112394725A CN 112394725 A CN112394725 A CN 112394725A CN 202010799899 A CN202010799899 A CN 202010799899A CN 112394725 A CN112394725 A CN 112394725A
- Authority
- CN
- China
- Prior art keywords
- locations
- route
- cost
- cost function
- static
- 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
- 230000003068 static effect Effects 0.000 claims abstract description 45
- 238000000034 method Methods 0.000 claims abstract description 44
- 230000008859 change Effects 0.000 claims abstract description 16
- 230000006870 function Effects 0.000 claims description 56
- 230000008569 process Effects 0.000 claims description 18
- 238000005457 optimization Methods 0.000 description 14
- 238000004891 communication Methods 0.000 description 6
- 230000004048 modification Effects 0.000 description 5
- 238000012986 modification Methods 0.000 description 5
- 239000000470 constituent Substances 0.000 description 4
- 238000013459 approach Methods 0.000 description 3
- 230000004888 barrier function Effects 0.000 description 3
- 230000007423 decrease Effects 0.000 description 3
- 238000001514 detection method Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 238000012545 processing Methods 0.000 description 2
- 230000000007 visual effect Effects 0.000 description 2
- 238000010276 construction Methods 0.000 description 1
- 230000009977 dual effect Effects 0.000 description 1
- 230000001788 irregular Effects 0.000 description 1
- 239000000463 material Substances 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0217—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory in accordance with energy consumption, time reduction or distance reduction criteria
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0268—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means
- G05D1/0274—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means using mapping information stored in a memory device
-
- 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/0023—Planning or execution of driving tasks in response to energy consumption
-
- 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/3453—Special cost functions, i.e. other than distance or default speed limit of road segments
-
- 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/3469—Fuel consumption; Energy use; Emission aspects
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0214—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory in accordance with safety or protection criteria, e.g. avoiding hazardous areas
-
- 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/80—Technologies aiming to reduce greenhouse gasses emissions common to all road transportation technologies
- Y02T10/84—Data processing systems or methods, management, administration
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Aviation & Aerospace Engineering (AREA)
- Human Computer Interaction (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Traffic Control Systems (AREA)
Abstract
控制自动驾驶车辆以从起点到目的地行驶的系统和方法包括使用地图确定起点和目的地之间的路线。一种方法包括通过优化第一成本函数来确定沿该路线的初始路径,第一成本函数包括在沿该路线的第一组位置处的静态成本构成,以及在沿着该路线的第一组位置中的每个位置处的静态成本构成对应于由在地图上指示的位置处的一个或多个静态障碍物引起的自动驾驶车辆的一个或多个传感器的视场的改变。该方法还包括控制自动驾驶车辆以沿着初始路径在该路线上开始行驶。
Description
技术领域
本主题公开涉及用于自动驾驶的基于预测和反应视场的计划。
背景技术
车辆的自动驾驶操作依赖于一种或多种类型的传感器来检测和监视车辆及其环境。示例性车辆包括汽车、卡车、摩托车、建筑设备、农场设备、自动化工厂设备。示例性传感器包括光检测和测距(激光)系统、无线电检测和测距(雷达)系统以及相机。大多数传感器都具有与其相关的标称视场(FOV),并且传感器在其各自的FOV内检测对象或获取图像。考虑自动驾驶车辆的一个或多个传感器的标称视场以计划车辆的未来轨迹。例如,为从给定起点到给定目的地的行驶开发了静态路线计划。然后,在行驶过程中使用该路线计划以及来自传感器的标称FOV的检测数据来生成动态轨迹,该轨迹指示车辆的路径点和速度。但是,由于遮挡,给定传感器的标称FOV可能会降低。遮挡(occlusion)可能是静态的(例如建筑物,灌木丛),也可能是动态的(例如当前路径中的其他车辆)。因此,期望提供用于自动驾驶的基于预测和反应视场的计划。
发明内容
在一个示例性实施例中,一种控制自动驾驶车辆从起点到目的地行驶的方法,包括使用地图确定起点和目的地之间的路线。该方法还包括通过优化第一成本函数来确定沿路线的初始路径,第一成本函数包括沿该路线在第一组位置处的静态成本构成(component),以及沿着该路线在第一组位置中的每个位置处的静态成本构成对应于由在该地图上指示的位置处的一个或多个静态障碍物引起的自动驾驶车辆的一个或多个传感器的视场的改变。该方法还包括控制自动驾驶车辆以开始沿着初始路径的路线上的行驶。
除了本文描述的一个或多个特征之外,该方法还包括在行驶期间实时动态地修改初始路径。
除了本文描述的一个或多个特征之外,修改初始路径还包括实时优化第二成本函数。
除了本文描述的一个或多个特征之外,优化第二成本函数包括在沿路线的第二组位置处使用动态成本构成,在沿着该路线的第二组位置处中的每个位置处的动态成本构成对应于由在该位置处的一个或多个静态和动态障碍物引起的自动驾驶车辆的一个或多个传感器的视场的改变,其中动态障碍物包括其他车辆。
除了本文所述的一个或多个特征之外,第二组位置和第一组位置具有一个或多个共同的位置。
除了本文所述的一个或多个特征之外,该方法还包括确定在第二组位置的每个处的两个或多个网格点处的自动驾驶车辆的一个或多个传感器的视场的变化。
除了本文描述的一个或多个特征之外,该方法还包括估计两个或多个网格点中的每个网格点处的遮挡度,并提供在第二组位置处在两个或更多个网格点中的每个网格点处的遮挡度作为动态成本构成。估计遮挡度包括获得谐波平均值。
除了本文描述的一个或多个特征之外,优化第一成本函数和优化第二成本函数包括执行算法成本最小化过程。
除了本文所述的一个或多个特征之外,该方法还包括确定在第一组位置的每个处在两个或更多个网格点处的自动驾驶车辆的一个或多个传感器的视场的变化。
除了本文所述的一个或多个特征之外,该方法还包括估计在两个或更多个网格点中的每个网格点处的遮挡度,并提供在第一组位置的每个处在两个或更多个网格点中的每个网格点处的遮挡度作为静态成本构成。估计遮挡度包括获得谐波平均值。
在另一个示例性实施例中,一种控制自动驾驶车辆从起点到目的地行驶的系统包括存储器装置,用于存储地图;以及控制器,用于确定起点与目的地之间的路线。控制器还通过优化第一成本函数来确定沿路线的初始路径,该第一成本函数包括在沿该路线的第一组位置处的静态成本构成,以及在沿着该路线的第一组位置中的每个位置处的静态成本构成对应于由在地图上指示的位置处的一个或多个静态障碍物引起的自动驾驶车辆的一个或多个传感器的视场的改变。控制器进一步控制自动驾驶车辆以沿着初始路径在该路线上开始行驶。
除了本文描述的一个或多个特征之外,控制器在行驶期间实时地动态地修改初始路径。
除了本文描述的一个或多个特征之外,控制器通过实时优化第二成本函数来修改初始路径。
除了本文所述的一个或多个特征之外,控制器还通过使用在沿该路线的第二组位置处的动态成本构成来优化第二成本函数,在沿着该路线的第二组位置中的每个位置处的动态成本构成对应于由在该位置处的一个或多个静态和动态障碍物引起的自动驾驶车辆的一个或多个传感器的视场的改变,动态障碍物包括其他车辆。
除了本文所述的一个或多个特征之外,第二组位置和第一组位置具有一个或多个共同的位置。
除了本文所述的一个或多个特征之外,控制器确定在第二组位置中的每个位置处在两个或更多个网格点处的自动驾驶车辆的一个或多个传感器的视场的变化。
除了本文描述的一个或多个特征之外,控制器估计两个或更多个网格点中的每个网格点处的遮挡度,并提供在第二组位置的每个处在两个或更多个网格点处的每个网格点处的遮挡度作为动态成本构成,并且估计遮挡度包括获得谐波均值。
除了本文所述的一个或多个特征之外,控制器通过执行算法成本最小化过程来优化第一成本函数并优化第二成本函数。
除了本文所述的一个或多个特征之外,控制器确定在第一组位置中的每个处在两个或更多个网格点处的自动驾驶车辆的一个或多个传感器的视场的变化。
除了本文描述的一个或多个特征之外,控制器估计在两个或更多个网格点中的每个网格点处的遮挡度,并提供在第一组位置中的每个处在两个或更多个网格点中的每个网格点处的遮挡度作为静态成本构成,以及估计遮挡度包括获得谐波均值。
当结合附图考虑时,从以下详细描述,本公开的以上特征和优点以及其他特征和优点将显而易见。
附图说明
在下面的详细描述中,仅以示例的方式出现其他特征、优点和细节,该详细描述参考附图,在附图中:
图1是根据一个或多个实施例的实现用于自动驾驶的基于预测和反应视场的计划的车辆的框图;
图2是根据一个或多个实施例的用于使用基于预测和反应视场的计划来执行自动驾驶的示例性地图;
图3是根据一个或多个实施例的使用基于预测和反应视场的计划进行自动驾驶的方法的处理流程;
图4示出了根据一个或多个实施例的基于预测视场的计划的各方面;
图5示出了根据一个或多个实施例的作为基于预测视场的计划的一部分的用于网格点的遮挡度(DOO)的估计;
图6是在图3所示的方法中进一步详细描述基于反应视场的计划的各方面的方法的处理流程;和
图7图示了根据一个或多个实施例的作为基于反应视场的计划的一部分的用于网格点的DOO的估计。
具体实施方式
以下描述本质上仅是示例性的,并且不意图限制本公开、其应用或用途。应当理解,在所有附图中,相应的附图标记表示相同或相应的部件和特征。
如前所述的,自动驾驶涉及计划自动驾驶车辆将采用的静态路线以及定义沿该路线的特定路径点和速度的动态轨迹。静态路线提供从起点到目的地的车道级路径,而无需考虑是否存在任何其他车辆。然后在行驶过程中修改此静态路线,以使用实时轨迹计划器考虑道路上的动态对象。静态和动态计划都使用地图来指示道路、道路上允许的行驶方向、车道线以及其他有助于在起点和目的地之间自动穿越的信息。例如,路线计划可以指示将用于到达指定目的地的车道以及沿着路线的每个部分的速度。轨迹计划可以指定自动驾驶车辆沿路线的更详细的位置和速度(例如,在车道线之间居中,在车道的右侧)。通常,具有几个成本构成的成本函数被优化以确定轨迹计划(例如,路径、速度)。示例性成本构成可以是到其他车辆的距离。即,随着与其他车辆的距离减小,成本增加。因此,可以基于优化成本函数来确定中心车道的中心或右侧车道的右侧的路径。
成本函数可以使用许多其他成本构成来优化路径和沿到达目的地的路线的车辆操作。另外,成本函数可用于在两个不同阶段优化路径。在穿越路线之前,可以通过基于地图信息优化成本函数来调整标称路径点(即,路线中车道的中心线)。在穿越路线期间,例如,可以基于事件或特定位置通过周期性地或以不规则的间隔优化成本函数来实时更新初始路线计划。
本文详细描述的系统和方法的实施例将有效视场(eFOV)作为成本构成(组件,组成部分)添加到成本函数中,以提供用于自动驾驶的预基于测性和反应视场的计划。基于预测视场的计划是指在穿越路径之前将eFOV视为成本函数分析的一部分。基于反应视场的计划是指在路径穿越期间将eFOV视为成本函数分析的一部分。通过考虑沿地图路线指示的静态障碍物(例如,建筑物、广告牌、围栏、交叉路口几何形状)来执行基于预测视场的计划。通过考虑沿路线遇到的静态和动态障碍物(例如,其他车辆、行人),在沿路线行驶期间动态执行基于反应视场的计划。
通常,根据一个或多个实施例,在基于预测视场的计划(即,行驶前的路线计划)和基于反应视场的计划(即,行驶期间轨迹计划),成本优化目标之一就是使eFOV最大化(即,使自动驾驶车辆传感器的遮挡最小化)。根据一个或多个实施例,基于预测和反应视场的计划都使用遮挡度(DOO)的估计作为引入成本优化过程中的成本构成。DOO,特别是DOO的减少,与eFOV的增加相对应。因此,如本文所详细获得的DOO的估计代表成本函数中的eFOV。
根据示例性实施例,图1是车辆100的框图,该车辆实施用于自动驾驶的基于预测和反应视场的计划。图1所示的示例性车辆100是汽车101。车辆100包括传感器110a至110n(通常称为110)。示例性传感器110包括一个或多个雷达系统、激光雷达系统和相机。基于其类型和其围绕车辆100的位置,每个传感器110具有已知的不同标称FOV。本文中对FOV或eFOV的参考考虑了车辆100的整个传感器110的套件。即,即使车辆100的传感器110之一的视图被遮挡,如果一个或多个其他传感器110的视图没有被遮挡,eFOV也不会从标称FOV减小。考虑车辆100的一组传感器110的FOV和eFOV。
车辆100还包括控制器120。控制器120可基于来自传感器110的信息来控制车辆100的操作的一个或多个方面。根据一个或多个示例性实施例,控制器120执行基于预测视场计划以在车辆100开始沿路线210行驶之前,确定沿路线210(图2)的初始路径420(图4)。然后,控制器120在沿路线210的行程期间实时地对初始路径420进行修改,作为基于反应视场的计划的一部分。如前所述的,例如,初始路径420可以沿着路线中的车道的中心线。控制器120还可包括促进通信的组件。例如,车辆100可以与图1所示的另一车辆140、卡车145执行车辆到车辆(V2V)的通信,或者与图1中所示的灯柱150内的通信电路进行车辆到基础设施(V2I)或车辆到所有的(V2X)的通信。通信可以是直接的或经由云服务器130,如所示的。除了通信组件之外,控制器120可以包括处理电路,该处理电路可以包括专用集成电路(ASIC)、电子电路、处理器(共享的、专用的或成组的)以及执行一个或多个软件或固件程序的存储器、组合逻辑电路和/或提供所述功能的其他合适的组件。如本文中详细描述的,根据一个或多个实施例,控制器120实施用于自动驾驶的基于预测和反应视场的计划。
图2是根据一个或多个实施例的用于使用基于预测和反应视场的计划来执行自动驾驶的示例性地图200。地图200用于例示传达的信息的类型,而不是图示和限制由控制器120用于计划路线210或识别静态障碍物220的地图的定义或实际外观。指示从起点O到目的地D的路线210。图2中所示的示例性静态障碍物220包括路灯柱150、树篱225、建筑物230、树235和围栏240。一旦确定了路线210,则执行基于预测视场计划以基于地图中的静态障碍物220来确定沿路线210的特定初始路径420(图4)。然后,在行驶期间,考虑到动态障碍物(例如,其他车辆140),实时地执行基于反应视场的计划,以修改沿路线210的初始路径420。
如前所述的,轨迹计划包括优化成本函数。即,考虑了一组成本构成,并且实现了成本函数最小化的已知过程。示例性成本构成可包括车道保持(即,成本随着车辆100离开车道430而增加(图4)),以及在实时轨迹计划中,到其他车辆140的距离(即,成本随着车辆100越来越靠近其他车辆140而增加)。根据本发明的一个或多个实施例,基于预测视场的计划包括提供由静态障碍物220产生的DOO的估计,作为用于确定初始路径420的成本构成之一。根据本发明的一个或多个实施例,基于反应视场的计划包括提供由静态障碍物220和动态障碍物(即,其他车辆140)产生的实时的DOO的估计,作为确定对初始路径420的修改的成本构成之一。
图3是根据一个或多个实施例的使用基于预测和反应视场的计划来执行自动驾驶的方法300的处理流程。在框310处,确定到目的地的路线210是指控制器120使用地图200来绘制车辆100的起始位置与目的地D之间的线路。在框320处,优化成本函数是指使总成本最小化的算法方法。在路径选择的相关上下文中,优化成本函数是指确定与两条或更多条路径相关的成本,并在这两条或更多条路径中选择与最小成本相关的路径。每个路径由两个或多个位置(例如,网格点405(图4))定义,与该路径相关联的成本是指与构成该路径的每个位置相关联的成本之和。与每个位置相关的成本是该成本构成在该位置的之和。
在框325处,根据一个或多个实施例,为了执行基于预测视场的计划,该过程包括基于地图200上指示的静态障碍物220估计沿路线210的感兴趣位置处的DOO。将参考图4和图5进一步讨论。如所注意到的,在框320处,在感兴趣的第一位置处的DOO估计(在框325处估计的)被提供为用于成本函数的优化的成本构成。即,尽管可以在沿路线210的任何数量的位置执行成本函数的优化(在框320处),但是基于静态障碍物220(在框325处)的DOO的估计可以在这些位置的子组处(出于解释目的称为第一感兴趣位置)执行。框320处的优化导致在框330处产生初始路径420(图4)。基于初始路径420,该过程包括在框340处开始行程。
在行程期间,所述过程包括在框350处实时优化成本函数。作为基于反应视场的计划的一部分,成本函数包括从框355获得的第二感兴趣位置的成本构成。在框355处,该过程包括基于静态障碍物220和诸如其他车辆140的动态障碍物来估计感兴趣位置处的DOO。这将参考图6和图7进一步讨论。如注意到的,在框350处,在第二感兴趣位置处的DOO估计值(在框355处估计的)被提供作为用于成本函数的优化的成本构成。即,尽管可以在沿着路线210的任何数量的位置处执行成本函数的优化(在框350处),但是基于静态障碍物220和动态障碍物(例如其他车辆140)的DOO估计(在框325处)可以在这些位置的子组(出于解释目的被称为第二感兴趣位置)处执行。
对沿路线210的所有感兴趣位置处的成本函数的优化(在框320处),其可以包括指示作为基于预测视场的计划的一部分的在第一感兴趣位置处的DOO的估计值的成本构成(在框325处)被一起执行,用于该整个路线210。这导致在车辆100穿越路线210之前确定初始路径420。但是,随着车辆100接近每个感兴趣的位置,在沿着路线210的所有感兴趣位置处的成本函数(在框350)的优化,其可以包括指示作为基于反应视场的计划的在第二感兴趣位置处的DOO的估计的成本构成,是逐段实时执行的。第一感兴趣的位置和第二感兴趣的位置可以是不同的、相同的或可以重叠的。基于优化的成本函数,在框350处,沿路线210的给定位置处的初始路径420的修改可以在框360处实时地执行。在框370处,到达目的地D,结束方法300的处理流程。
图4示出了根据一个或多个实施例的基于预测视场的计划的各方面。示例性交叉路口410被示为用于框325处的处理的第一感兴趣位置之一(图3)。示出的车道430被双车道线435分开。该交叉路口410可以是用于计划和执行车辆100的行程的地图200的一部分。图4中所示的静态障碍物220包括墙壁425、建筑物230、围栏240和路灯柱150。网格点405指示车辆100的不同位置,考虑这些位置以便提供从框325到框320的成本构成(图3)以优化成本函数。具体地,在每个网格点405处,确定eFOV。由于静态障碍物220,eFOV可以是从标称FOV减小的FOV。该eFOV用于估计DOO,如参考图5所详述的。
一旦估计了与每个网格点405相对应的DOO,就可以将网格点405的位置和相对应的DOO作为成本构成来提供(从框325到框320)。在框320处发生的成本函数最小化考虑了与每个网格点405处的DOO相关的成本构成(来自框325),以及其他成本构成,例如与初始路径420的偏离,转向成本(即,跟随一组网格点405需要多少转向)。成本函数的优化结果是初始路径420,如图4所示。初始路径420由特定的一组网格点405组成,这导致在考虑的成组网格点405中具有最小的成本。如前注意到的,DOO估计(在框325处)可能不是在成本函数针对其优化的每个位置处都感兴趣(在框320处)。因此,尽管在第一感兴趣位置(例如,交叉路口410)处提供了不同网格点405处的DOO估计,但是在其他位置处,成本函数可能不包括传达eFOV的成本构成。同样如前所述的,沿路线210的初始路径420的确定是在由车辆100沿路线210开始行驶之前,在第一感兴趣位置和其他任何感兴趣的位置(其不包括DOO估计作为成本构成)确定的。
图5图示了根据一个或多个实施例的作为基于预测视场的计划的一部分的对网格点405的DOO的估计。在图5中示出了在图4中所示的网格点中的一个示例性网格点405。该网格点405表示车辆100的一个可能的位置(例如,前方的中心的位置)。示出了车辆100的传感器110(图1)的标称FOV 510。由于墙壁425起到从网格点405的位置起的静态障碍物220的作用,因此eFOV 520(也已指示)从FOV 510减小了。围栏240和灯柱150被定位成不影响在网格点405的位置处的标称FOV510。基于eFOV 520,确定距离X1、X2和X3。这些距离X1、X2或X3中的每一个都是从地图200上的指定相交点505到eFOV 520的最接近边界的距离。
仅使用与为车辆100绘制的路线201相关的交叉点505。例如,假设在道路的右侧驾驶是合法的,则X1、X2和X3都与车道430有关,在该车道430处或从该车道430会发生车辆140与车辆100的可能的碰撞。然而,交叉点505x表示车道430,在该车道430中任何车辆140应远离由网格点405所表示的车辆100行驶。对于表示以秒为单位的计划范围T的时间段(例如5-6秒),与图5所示的示例性网格点405相对应的DOO可以使用谐波均值估计为:
在等式1中,v1、v2和v3是相应车道430中的标称速度。在地图200中列出了这些标称速度(例如,速度极限)。如图5所示,v1和v2可以是相同的值,因为它们涉及相同的行驶车道430。如前所述的,根据等式1,针对第一感兴趣位置中的给定感兴趣位置处的每个网格点405确定DOO估算值(在图3的框325处)。网格点405和相应的DOO估计值被提供作为在框320(图3)处用于成本函数最小化的成本构成之一,以便获得初始路径420(在框330处,图3)。
图6是方法600的处理流程,其进一步详细说明了图3所示的方法300中基于反应视场的计划的各个方面。在框340处,开始行程是指车辆100沿着初始路径420(图4)。在框330(图3)处部分地基于基于预测视场的计划来生成该初始路径420,该计划使用了由静态障碍物220产生的DOO的估计,如参考图4和图5所详细描述的。当车辆100接近每个感兴趣的位置时,重复图6所示的处理流程。感兴趣的位置可以是例如车辆100将要转弯的交叉路口410(图4)或实时场景由于建筑而与地图200不同的区域。通常,感兴趣的位置是任何成本构成都可能与生成初始路径420时所考虑的位置(在图3的框320处)已经改变的位置。
在框610处,检查车辆100正在接近的感兴趣位置是否也是第二感兴趣位置。如前所述的,出于解释目的,第二感兴趣位置是对需要基于反应视场的计划的位置的参考。也就是说,在框610处的检查确定由于诸如其他车辆140的动态障碍物,与DOO相关联的成本构成是否可能已经与所提供的成本构成(来自图3的框325)有所改变。如果感兴趣的位置也不是第二感兴趣位置,则以不包括任何DOO估计的成本构成执行成本函数优化(在图3的框350处)。
如果感兴趣的位置也是第二感兴趣的位置,根据框610处的检查,则进行类似于参考图4和5所述的处理流程,除了诸如在确定eFOV时还考虑了其他车辆140之外,这随后影响了DOO估计。在框620处,选择网格点405(图4)是指在第二感兴趣位置处为车辆100选择两个或更多个替代未来位置之一。在框630处,针对所选网格点405计算DOO涉及使用等式1。参照图7对此进行驶一步讨论。在框640处,检查当前网格点405是否为最后一个网格点(即,所有其他网格点405已被处理)。如果当前网格点405不是最后一个网格点,则在框620处执行从选择另一个网格点405开始的另一迭代。如果当前网格点405是最后一个网格点,则在框650处提供网格点405和相应的DOO值作为成本构成,以在框350处进行成本函数优化。除了参照基于预测视场的计划所讨论的那些以外,其他示例性成本构成包括与其他车辆140的接近度。如所示的,框620至650处的过程详述了框355处的DOO估计。
图7示出了根据一个或多个实施例的、作为基于反应视场的计划的一部分的、针对网格点405的DOO的估计。如图5与图7的比较所示,eFOV 710与eFOV 520不同。这是因为在沿路线210行驶期间实时确定的eFOV 701考虑了动态障碍物,例如其他车辆140,而不仅仅是标称FOV 510内的静态障碍物220。基于其他车辆140的位置和生成的eFOV 710,在图7所示的场景中,距离X1小于图5所示的距离。由此,根据等式1计算的DOO高于参考图5讨论的DOO。如前所述的,针对代表车辆100可在特定的第二感兴趣位置处沿路线210行驶的每个位置的每个网格点405进行该DOO估计。提供网格点405和相应的DOO估计作为用于成本函数优化的成本构成(在框350处)。成本函数优化的结果(在框350处)可以是在第二感兴趣位置处的初始路径420的修改。
尽管已经参考示例性实施例描述了以上公开,但是本领域技术人员将理解,在不脱离本发明范围的情况下,可以进行各种改变并且可以用等同物替代其要素。另外,在不脱离本公开的实质范围的情况下,可以做出许多修改以使特定情况或材料适应本公开的教导。因此,意图是本公开不限于所公开的特定实施例,而是将包括落入其范围内的所有实施例。
Claims (10)
1.一种控制自动驾驶车辆从起点到目的地行驶的方法,该方法包括:
使用处理器,使用地图确定起点和目的地之间的路线;
使用处理器,通过优化第一成本函数来确定沿该路线的初始路径,该第一成本函数包括在沿该路线的第一组位置处的静态成本构成,以及在沿着该路线的第一组位置中的每个位置处的静态成本构成对应于由在地图上指示的位置处的一个或多个静态障碍物引起的自动驾驶车辆的一个或多个传感器的视场的改变;和
控制自动驾驶车辆以开始沿初始路径在该路线上行驶。
2.根据权利要求1所述的方法,还包括在行驶期间实时动态地修改该初始路径,其中,修改该初始路径包括实时地优化第二成本函数。
3.根据权利要求2所述的方法,其中,优化第二成本函数包括在沿所述路线的第二组位置处使用动态成本构成,在沿着该路线的第二组位置中的每个位置处的动态成本构成对应于由在该位置处的一个或多个静态和动态障碍物引起的自动驾驶车辆的一个或多个传感器的视场的改变,其中动态障碍物包括其他车辆,以及第二组位置和第一组位置具有一个或多个共同的位置,并且该方法还包括确定在第二组位置中的每个处在两个或更多个网格点处的自动驾驶车辆的一个或多个传感器的视场的改变,以及估计在两个或更多个网格点中的每个网格点处的遮挡度,并提供在第二组位置的每个处在两个或更多个网格点中的每个网格点处的遮挡度作为动态成本构成,其中估计遮挡度包括获得谐波均值。
4.根据权利要求2所述的方法,其中,优化第一成本函数和优化第二成本函数包括执行算法成本最小化过程。
5.根据权利要求1所述的方法,进一步包括确定在第一组位置中的每个处在两个或更多个网格点处的自动驾驶车辆的一个或多个传感器的视场的改变,以及估计在两个或更多个网格点中的每个网格点处的遮挡度,并提供在第一组位置的每个处在两个或更多个网格点中的每个网格点处的遮挡度作为静态成本构成,其中,估计遮挡度包括获得谐波均值。
6.一种控制自动驾驶车辆从起点到目的地行驶的系统,该系统包括:
存储器装置,用于存储地图;和
控制器,配置为确定起点与目的地之间的路线,以通过优化第一成本函数来确定沿该路线的初始路径,该第一成本函数包括在沿该路线的第一组位置处的静态成本构成,以及在沿该路线的第一组位置中的每个位置处的静态成本构成对应于由在地图上指示的位置处的一个或多个静态障碍物引起的自动驾驶车辆的一个或多个传感器的视场的改变,并控制自动驾驶车辆开始沿初始路径在该路线上行驶。
7.根据权利要求6所述的系统,其中,所述控制器还被配置为在行驶期间实时地动态地修改所述初始路径,并且所述控制器被配置为通过实时地优化第二成本函数来修改所述初始路径。
8.根据权利要求7所述的系统,其中,所述控制器被配置为通过在沿该路线的第二位置处使用动态成本构成来优化所述第二成本函数,在沿着该路线的第二组位置中的每个位置处的动态成本构成对应于由在该位置处的一个或多个静态和动态障碍物引起的自动驾驶车辆的一个或多个传感器的视场的改变,以及动态障碍物包括其他车辆,以及第二组位置和第一组位置具有一个或多个共同的位置,并且所述控制器被配置为确定在第二组位置中的每个处在两个或更多个网格点处的自动驾驶车辆的一个或多个传感器的视场的改变,以及所述控制器被配置为估计在两个或更多个网格点中的每个网格点处的遮挡度,并提供在第二组位置的每个处在两个或更多个网格点中的每个网格点处的遮挡度作为动态成本构成,并且估计遮挡度包括获得谐波均值。
9.根据权利要求7所述的系统,其中,所述控制器被配置为通过执行算法成本最小化过程来优化第一成本函数并优化第二成本函数。
10.根据权利要求6所述的系统,其中,所述控制器还被配置为确定在第一组位置中的每个处在两个或更多个网格点处的自动驾驶车辆的一个或多个传感器的视场的改变,以及所述控制器还被配置为估计在两个或更多个网格点中的每个网格点处的遮挡度,并提供在第一组位置的每个处在两个或更多个网格点中的每个网格点处的遮挡度作为静态成本构成,并且估计遮挡度包括获得谐波均值。
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
US16/539,306 | 2019-08-13 | ||
US16/539,306 US20210048825A1 (en) | 2019-08-13 | 2019-08-13 | Predictive and reactive field-of-view-based planning for autonomous driving |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112394725A true CN112394725A (zh) | 2021-02-23 |
CN112394725B CN112394725B (zh) | 2024-04-09 |
Family
ID=74567277
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010799899.3A Active CN112394725B (zh) | 2019-08-13 | 2020-08-11 | 用于自动驾驶的基于预测和反应视场的计划 |
Country Status (2)
Country | Link |
---|---|
US (1) | US20210048825A1 (zh) |
CN (1) | CN112394725B (zh) |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE102018218835A1 (de) * | 2018-11-05 | 2020-05-07 | Hyundai Motor Company | Verfahren zur zumindest teilweisen Entblockung eines Sichtfeldes eines Kraftfahrzeugs, insbesondere während Fahrspurwechseln |
US11981349B2 (en) * | 2020-02-19 | 2024-05-14 | Nvidia Corporation | Behavior planning for autonomous vehicles |
US11691645B2 (en) * | 2020-03-19 | 2023-07-04 | Honda Motor Co., Ltd. | Method and system for controlling autonomous vehicles to affect occupant view |
US11407432B2 (en) * | 2020-04-30 | 2022-08-09 | Toyota Motor Engineering & Manufacturing North America, Inc. | Connectivity-enabled traffic-aware supplemental sensor control for informed driving |
US11585669B2 (en) * | 2020-08-31 | 2023-02-21 | Hitachi, Ltd. | Vehicle routing using connected data analytics platform |
Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102235879A (zh) * | 2010-04-01 | 2011-11-09 | 株式会社电装 | 路线搜索装置和路线引导系统 |
KR101409323B1 (ko) * | 2013-03-19 | 2014-07-02 | 국방과학연구소 | 무인자율차량 및 이의 동적환경 주행경로생성방법 |
US20170219364A1 (en) * | 2013-03-15 | 2017-08-03 | Volkswagen Aktiengesellschaft | Automatic driving route planning application |
US20180095465A1 (en) * | 2017-11-22 | 2018-04-05 | GM Global Technology Operations LLC | Systems and methods for manuevering around obstacles in autonomous vehicles |
US10074279B1 (en) * | 2017-03-07 | 2018-09-11 | Denso International America, Inc. | Inference-aware motion planning |
US20190064840A1 (en) * | 2017-08-31 | 2019-02-28 | Uber Technologies, Inc. | Systems and Methods for Controlling an Autonomous Vehicle with Occluded Sensor Zones |
US20190079523A1 (en) * | 2017-09-11 | 2019-03-14 | Baidu Usa Llc | Dp and qp based decision and planning for autonomous driving vehicles |
CN109491376A (zh) * | 2017-09-11 | 2019-03-19 | 百度(美国)有限责任公司 | 用于自动驾驶车辆的基于动态规划和梯度下降的决策和规划 |
CN109489675A (zh) * | 2017-09-11 | 2019-03-19 | 百度(美国)有限责任公司 | 用于自动驾驶车辆的基于成本的路径规划 |
CN109947090A (zh) * | 2017-12-21 | 2019-06-28 | 百度(美国)有限责任公司 | 用于自动驾驶车辆规划的非阻塞边界 |
-
2019
- 2019-08-13 US US16/539,306 patent/US20210048825A1/en not_active Abandoned
-
2020
- 2020-08-11 CN CN202010799899.3A patent/CN112394725B/zh active Active
Patent Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102235879A (zh) * | 2010-04-01 | 2011-11-09 | 株式会社电装 | 路线搜索装置和路线引导系统 |
US20170219364A1 (en) * | 2013-03-15 | 2017-08-03 | Volkswagen Aktiengesellschaft | Automatic driving route planning application |
KR101409323B1 (ko) * | 2013-03-19 | 2014-07-02 | 국방과학연구소 | 무인자율차량 및 이의 동적환경 주행경로생성방법 |
US10074279B1 (en) * | 2017-03-07 | 2018-09-11 | Denso International America, Inc. | Inference-aware motion planning |
US20190064840A1 (en) * | 2017-08-31 | 2019-02-28 | Uber Technologies, Inc. | Systems and Methods for Controlling an Autonomous Vehicle with Occluded Sensor Zones |
US20190079523A1 (en) * | 2017-09-11 | 2019-03-14 | Baidu Usa Llc | Dp and qp based decision and planning for autonomous driving vehicles |
CN109491376A (zh) * | 2017-09-11 | 2019-03-19 | 百度(美国)有限责任公司 | 用于自动驾驶车辆的基于动态规划和梯度下降的决策和规划 |
CN109491377A (zh) * | 2017-09-11 | 2019-03-19 | 百度(美国)有限责任公司 | 用于自动驾驶车辆的基于dp和qp的决策和规划 |
CN109489675A (zh) * | 2017-09-11 | 2019-03-19 | 百度(美国)有限责任公司 | 用于自动驾驶车辆的基于成本的路径规划 |
US20180095465A1 (en) * | 2017-11-22 | 2018-04-05 | GM Global Technology Operations LLC | Systems and methods for manuevering around obstacles in autonomous vehicles |
CN109947090A (zh) * | 2017-12-21 | 2019-06-28 | 百度(美国)有限责任公司 | 用于自动驾驶车辆规划的非阻塞边界 |
Also Published As
Publication number | Publication date |
---|---|
CN112394725B (zh) | 2024-04-09 |
US20210048825A1 (en) | 2021-02-18 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US11714417B2 (en) | Initial trajectory generator for motion planning system of autonomous vehicles | |
US11561542B2 (en) | Safety and comfort constraints for navigation | |
CN112394725B (zh) | 用于自动驾驶的基于预测和反应视场的计划 | |
US20190329768A1 (en) | Navigation Based on Detected Size of Occlusion Zones | |
US9127956B2 (en) | Technique for lane assignment in a vehicle | |
US11474532B2 (en) | Systems and methods for detecting anomalies in a vehicle system | |
US20220188695A1 (en) | Autonomous vehicle system for intelligent on-board selection of data for training a remote machine learning model | |
US11685398B2 (en) | Lane based routing system for autonomous driving vehicles | |
US11878712B2 (en) | Trajectory planning with obstacle avoidance for autonomous driving vehicles | |
US12030485B2 (en) | Vehicle operation using maneuver generation | |
WO2023092451A1 (zh) | 预测可行驶车道的方法和装置 | |
CN111505690A (zh) | 实时检测应急车辆并规划行驶路径的方法及装置 | |
JP2021113816A (ja) | 出力装置、制御方法、プログラム及び記憶媒体 | |
EP3857327B1 (en) | Implementation of dynamic cost function of self-driving vehicles | |
US12055407B2 (en) | Mixed regular and open-space trajectory planning method for autonomous driving vehicle | |
JP7167732B2 (ja) | 地図情報システム | |
Chipka et al. | Estimation and navigation methods with limited information for autonomous urban driving | |
US20230145561A1 (en) | Systems and methods for validating camera calibration in real-time | |
CN112550301A (zh) | 用于自主车辆的并行树状决策方案 | |
US12043290B2 (en) | State identification for road actors with uncertain measurements based on compliant priors | |
CN112829769B (zh) | 自动驾驶车辆的混合规划系统 | |
US20240166239A1 (en) | Trajectory planning for navigating small objects on road | |
KR20240055023A (ko) | 자동차의 운행 환경을 모델링하는 방법 | |
CN117897749A (zh) | 一种车辆位置的预测方法、装置、车辆及存储介质 | |
CN118251638A (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 |