CN112292719A - 使自我车辆的轨迹与运动的外来对象适配 - Google Patents
使自我车辆的轨迹与运动的外来对象适配 Download PDFInfo
- Publication number
- CN112292719A CN112292719A CN201980042562.3A CN201980042562A CN112292719A CN 112292719 A CN112292719 A CN 112292719A CN 201980042562 A CN201980042562 A CN 201980042562A CN 112292719 A CN112292719 A CN 112292719A
- Authority
- CN
- China
- Prior art keywords
- vehicle
- ego
- determining
- movement
- foreign object
- 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
- 230000033001 locomotion Effects 0.000 claims abstract description 80
- 238000000034 method Methods 0.000 claims abstract description 48
- 238000013442 quality metrics Methods 0.000 claims abstract description 9
- 238000004590 computer program Methods 0.000 claims abstract description 4
- 230000006870 function Effects 0.000 claims description 45
- 230000009471 action Effects 0.000 claims description 20
- 230000001364 causal effect Effects 0.000 claims description 5
- 230000008859 change Effects 0.000 claims description 5
- 230000004044 response Effects 0.000 claims description 2
- 230000006399 behavior Effects 0.000 description 9
- 238000005457 optimization Methods 0.000 description 4
- 230000008901 benefit Effects 0.000 description 3
- 230000008569 process Effects 0.000 description 2
- 230000002123 temporal effect Effects 0.000 description 2
- 241000283070 Equus zebra Species 0.000 description 1
- 230000001133 acceleration Effects 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 239000012530 fluid Substances 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 230000002787 reinforcement Effects 0.000 description 1
- 238000005096 rolling process Methods 0.000 description 1
- 230000007704 transition Effects 0.000 description 1
- 239000013598 vector Substances 0.000 description 1
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 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
- 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/08—Active safety systems predicting or avoiding probable or impending collision or attempting to minimise its consequences
- B60W30/095—Predicting travel path or likelihood of collision
- B60W30/0956—Predicting travel path or likelihood of collision the prediction being responsive to traffic or environmental parameters
-
- 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
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F18/00—Pattern recognition
- G06F18/20—Analysing
- G06F18/24—Classification techniques
- G06F18/241—Classification techniques relating to the classification model, e.g. parametric or non-parametric approaches
- G06F18/2415—Classification techniques relating to the classification model, e.g. parametric or non-parametric approaches based on parametric or probabilistic models, e.g. based on likelihood ratio or false acceptance rate versus a false rejection rate
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06N—COMPUTING ARRANGEMENTS BASED ON SPECIFIC COMPUTATIONAL MODELS
- G06N3/00—Computing arrangements based on biological models
- G06N3/02—Neural networks
- G06N3/08—Learning methods
- G06N3/092—Reinforcement learning
-
- 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
-
- 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
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
- G08G1/16—Anti-collision systems
- G08G1/166—Anti-collision systems for active traffic, e.g. moving vehicles, pedestrians, bikes
-
- 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/4049—Relationship among other objects, e.g. converging dynamic 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
- B60W2556/00—Input parameters relating to data
- B60W2556/20—Data confidence level
-
- 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
- B60W2556/00—Input parameters relating to data
- B60W2556/45—External transmission of data to or from the vehicle
- B60W2556/65—Data transmitted between vehicles
Abstract
一种用于预报自我车辆(1)的环境(11)中的外来对象(2‑4)的轨迹(2a‑4a)以及用于为自我车辆(1)确定与之适配的自身未来轨迹(1a)的方法(100、200),所述方法具有以下步骤:标识(110)外来对象(2‑4);确定(120)所述外来对象(2‑4)中的每一个的运动通向哪个近距目的地(2b‑4b)并且该运动根据哪些基本规则(2c‑4c)进行;确定(130)自我车辆(1)的运动通向哪个近距目的地(1b)以及该运动根据哪些基本规则(lc)进行;为自我车辆(1)以及为外来对象(2‑4)分别设置(140)质量函数RI‑4;为自我车辆(1)以及为外来对象(2‑4)分别设置(150)质量度量Q1‑4;确定(160)自我车辆和外来对象(2‑4)的使质量度量Q1‑4最大化的最佳运动策略π1‑4;从最佳运动策略π1‑4中确定(170)所寻求的轨迹(1a‑4a)。用于控制自我车辆1的方法(100)。所属的计算机程序。
Description
技术领域
本发明涉及尤其是在具有人控制的外来对象的混合交通中用于至少部分自动化的方法的轨迹规划。
背景技术
在街道交通中至少部分自动化地运动的车辆不将突然地排挤由人控制的车辆,并且也将不在单独的路线上与人控制的交通隔离。相反地,这些车辆将必须在具有人控制的外来对象的混合交通中安全地运动,其中这些外来对象也例如包括作为较弱的交通参与者的行人。在人控制的外来对象情况下,始终如下存在不安全性:这些外来对象接下来执行哪种运动行动。因此,用于至少部分地自动化地驾驶的控制系统被指示至少部分地从对迄今为止的行为的观测中来推断外来对象的未来行为。
WO 2017/197 170 A1公开一种用于运动的自主单元的控制单元,所述运动的自主单元可以是机器人或也可以是车辆。控制单元首先确定基本轨迹,利用所述基本轨迹来跟踪自主单元的首要目的地、例如行驶目的地。然后,通过安全模块改变基本轨迹,使得避免与人或其他人控制的单元碰撞。为此,对各自的人控制的运动进行预报。
发明内容
在本发明的范围内,开发了一种用于预报在自我车辆的环境中的外来对象的轨迹以及用于为自我车辆确定与之适配的自身未来轨迹的方法。
自我车辆是应该对其轨迹产生影响以便避免与外来对象碰撞的车辆。外来对象尤其是可以是人或由人控制的车辆、诸如常规的机动车或自行车。但是,也考虑不可控制的或仅受限制地可控制的外来对象、诸如停放在坡上之后滚落的车辆或从其牵引车挣脱的拖车。
首先标识外来对象。为此,可以考虑环境的物理观测的时间序列,诸如摄像机图像系列或基于事件的传感器输出的事件系列。可替代地或也以组合的方式,可以考虑经由车辆的无线接口接收的信息。这些信息可以由外部对象本身例如经由车辆对车辆(V2V)接口来传送。但是,信息也可以由基础设施例如经由车辆对基础设施(V2I)接口传送。
就此而论,标识意味着至少检测在自我车辆的环境中哪些外来对象可以彼此无关地运动。就此而论,检测外来对象详细地是什么也是有利的,但是并非是强制性需要的。
确定外来对象中的每一个的运动通向哪个近距目的地,并且该运动根据哪些基本规则进行。如何详细地执行该确定取决于哪些信息是可用的。因此,例如可以单独地从轨迹的时间变化过程外推出特定的近距目的地比其他的更有可能。使用越多的附加信息,近距目的地的预报(Vorhersage)就变得越准确。如果例如识别出作为外来对象的车辆已经设置了方向指示灯,则以高概率规划拐弯过程。但是作为外来对象的车辆也可以例如直接通过V2V通信宣布其当前的近距或甚至远距目的地。
外来对象的运动进行所根据的基本规则尤其是可以包括街道交通秩序的规则,并且还取决于外来对象的类型。因此,例如车辆必须使用行车道和两条行车道中的右行车道。而行人例如被保持在人行道上行走,并且如果存在如用于横穿行车道的斑马线或交通信号灯之类的人行横道,则也使用这些人行横道。
此外确定自我车辆的运动通向哪个近距目的地,并且该运动根据哪些基本规则进行。基本规则在这里尤其是可以再次包括街道交通秩序的规则,并且不必在所有状况下都相同。因此,当车辆拖曳拖车或利用防滑链行驶时,例如允许的最高速度分别被限制。因此,基本规则的确定例如也可以包括对自我车辆的配置的分析。
不仅为自我车辆而且为外来对象分别设置质量函数R1-4,所述质量函数给由自我车辆和外来对象的当前状态构成的总状况x以及可能的紧接着的运动行动a1-4分配针对在当前总状况x中行动a1-4对于分别所观察的交通参与者如何好的度量。质量函数R1-4尤其是可以包括例如针对在状况x中运动行动a1-4在何种程度上力争到达各自近距目的地并且力争遵守规则的度量。在此,从1达到直至4的数字索引不应被理解为关于可处置的外来对象的数量是限制性的,而是仅仅是解释性的,以便能够根据示例来阐述该方法。通常,还可以谈及质量函数Ri和紧接着的运动行动ai。
术语“状态”通常包括以下参量,即利用所述参量可以表征自我车辆或外来对象对交通状况的贡献。状态尤其是可以包括位置或也可以包括时间导数、即例如速度和加速度。
不仅为自我车辆而且为外来对象分别建立质量度量Q1-4,所述质量度量除了值R1-4(x,a1-4)之外也将状态变化x'的概率P(x')的分布的期望值E(P(x'))分配给总状况x和可能的紧接着的运动行动a1-4,其中其余交通参与者以所述概率对该紧接着的运动行动a1-4作出反应。例如,质量度量Q1-4可以是由质量函数的值R1-4(x,a1-4)和期望值E(P(x'))组成的加权和。
确定自我车辆和外来对象的那些使质量度量Q1-4最大化的最佳运动策略π1-4。从最佳运动策略π1-4中确定自我车辆和外来对象的所寻求的轨迹。
在此,运动策略的术语通常包括将数值π1-4(x,a1-4)分配给总状况x和紧接着的运动行动a1-4的每个函数π1-4。因此,与使该术语与确定性规则相关联的常见语言惯用法相比,该术语是广义的。确定性规则例如可以说明,在存在特定的总状况x时,应该由自我车辆执行或由外来对象完成刚好一个紧接着的运动行动a1-4。
已经认识到,尤其是外来对象的行为不总是遵循确定性规则。如果外来对象例如由人控制,则该控制虽然是智能的,但是不必然引向刚好对于跟踪各自的近距目的地是最佳的该运动行动。即使人类驾驶员原则上决定正确的驾驶机动动作,这也适用。因此例如,从其上为此未明确标记车行道的道路向左拐弯可以围绕理想的行驶路线发散(streuen)。车辆当在红色交通信号灯之前多次制动时虽然每次将大致在停车线处停止,但是速度的时间变化过程可能是不同的。驾驶员可以例如从开始有时较强而有时较弱地踩踏制动踏板,并且稍后下意识地再调节制动压力,以便最终在正确的位置处停止。对此的更深原因在于,驾驶任务总体上太复杂而不被完全有意识地被执行。为了完全能够以所要求的速度胜任多重任务执行(Multitasking),学习型驾驶员必须首先将特定的过程“自动化”到潜意识中。
甚至行人的正确行为也不是完全确定性的。当行人例如横穿行车道时,该行人不总是刚好以与行驶方向成直角地做这一点,而是以与之有随机偏差地做这一点。
只有当进行控制的人错误地决定时,外来对象的行为才不再遵循确定性规则。从而例如设置右方向指示灯不是对以下的保证:驾驶员实际上将从优先行驶路段向右转入下一道路并且相对于来自该道路的另一车辆放弃其优先行驶。相反地,也可能发生以下情况,即在驾驶员断定该驾驶员搞错了并且道路稍后才必须向右拐之后,该驾驶员笔直地继续行驶。人类驾驶员例如也不能对隐藏在其镜子的盲区中的对象作出反应。行人也总是再次有意识地越过使用安全人行横道的义务或在红色交通信号灯处的等候义务。
此外,甚至自我车辆的行为以一定方式是概率性的。如果例如将特定的制动压力给予到制动设备的制动缸用以停车,则自我车辆的由此引起的减速可能例如根据行车道的状态以及制动液的温度和水含量而变化。
通过现在将其余交通参与者的状态变化概括为概率分布P(x')的方式以及通过所有交通参与者的运动策略π1-4同样可以是概率性的方式,从而可以如此改良自我车辆对总状况x的反应,使得所述反应实际上以较高的概率是符合交通规则的,并且尤其是避免碰撞。以一定的方式,因此在技术上模仿每个人类驾驶员必须在驾驶学校中学习的预见性驾驶,以便用于至少部分自动化地驾驶的系统可以至少与人类驾驶员一样好地完成驾驶任务。
在一种特别有利的构型中,选择质量度量Q1-4,其关于运动策略π1-4的最佳值由贝尔曼最佳值给出。以一定的方式,这是质量度量Q1-4的相互耦合和递归定义的组合。
例如,在无限的时间范围情况下,质量度量Qi在完成优化的最终状态Q*下可以具有形式:
期望值E在概率性状态过渡以及其他交通参与者的策略上进行,所述其他交通参与者的索引是不同于i的索引。所述期望值通过
给出。
在另一特别有利的构型中,在最佳运动策略π1-4在相同的来历Ht情况下彼此无关的前提条件下确定所述最佳运动策略π1-4:
如果现在此外选择波尔兹曼-吉布斯(Boltzmann-Gibbs)分布作为状态变化x'的概率P(x')的分布,则交通参与者分别根据最大熵原理选择其运动策略:
方程式(1)至(3)构成成一组M个耦合的方程式,其中M是所观察的交通参与者的数量。所述方程可以被联合为
在这里Ti是方程式(1)的右侧。方程式(4)具有刚好一个最佳解Qi*,其可以利用以下算法获得:
其具有边界条件:
是在时间范围结束时处于最终优化状态下质量函数Ri的值。类似于有限时间范围的情况,期望值再次取决于其余交通参与者的策略,所述策略又有利地是波尔兹曼分布的:
因此,方程式(5)可以被写为:
其中,Ui是方程式(5)的右侧。例如,可以利用以下算法获得最佳解:
在本发明的范围中,开发了用于预报自我车辆的环境中的外来对象的轨迹以及用于为自我车辆确定与之适配的自身未来轨迹的另一方法。该方法首先如先前描述的方法一样开始,即标识外来对象,并且不仅为自我车辆而且为外来对象确定运动的基本规则和近距目的地。
与先前描述的方法不同地,不仅为自我车辆而且为外来对象分别设置特征函数F1-4为使得将F1-4应用于仍自由的参数的组θ1-4提供质量函数R1-4,其中该质量函数R1-4给由自我车辆和外来对象的当前状态构成的总状况x以及可能的紧接着的运动行动a1-4分配针对在当前总状况x中行动a1-4对于分别所观察的交通参与者如何好的度量。质量函数R1-4尤其是可以包括例如针对运动行动a1-4在状况x中在何种程度上力争达到各自的近距目的地并且力争遵守规则的度量。
特征函数F1-4可以例如体现各自交通参与者的特性和目的地,例如行人移向的目的地地点也或者所述行人的行进速度。在车辆情况下,除了目的地地点外,例如行驶应该安全地、流畅地和舒适地进行的要求可以进入特征函数F1-4中。因此,特征函数F1-4尤其是可以例如由涉及不同目的地的多个部分组成,其中这些目的地也可以是互相相反的。于是,参数的组θ1-4可以例如体现权重,不同的目的地和要求以所述权重包含在最终质量函数R1-4中。参数的组θ1-4尤其是可以例如作为参数的向量存在并且例如包含系数,由在特征函数F1-4中包含的不同目的地组成的线性组合以所述系统进入质量函数R1-4中。
最终获得的结果具有与根据先前描述的方法获得的结果相同的优点。特别是该方法的优点是,与对于直接确定质量函数R1-4相比,对于确定参数组θ1-4需要关于各自交通参与者的更加少的信息。但是在参数组θ1-4的另一侧上可以考虑每个附加信息,不管来自何种源。在优化时根据运动策略π1-4确定自由的参数θ1-4。
有利地,在以下边界条件下关于运动策略π1-4确定因果熵的最大值,即不仅对于自我车辆而且对于外来对象而言,各自特征函数F1-4在所有可能的总状况x和所有可能的紧接着的运动行动a1-4上的期望值与在迄今为止的轨迹中根据经验观测的特征函数F1-4的平均值相等。该平均值尤其是可以在迄今根据经验观测的所有状况x和运动a1-4上被构成:
的情况下可以说明方程式(7)的递归解:
在这里是
因此,最终从自我车辆的角度来看,可以促进“逆向强化学习(inversereinforcement learning)”,即在知道自我车辆的质量函数R1的情况下,可以单独地从其余交通参与者的观测中推断其质量函数R2-4。这例如可以利用以下算法发生:
算法3:用于自主车辆的MMCE-IRL
在另一特别有利的构型中,外来对象分别在其类型方面被分类,并且各自质量函数R2-4或各自特征函数F2-4根据该类型被选择。以这种方式,外来对象的最终轨迹以及因此还有自我车辆的与之适配的轨迹的确定可以更快速地收敛(konvergieren)并且获得更精确的结果。如先前所阐述的,运动的基本规则尤其是可以取决于对象的类型。可以根据物理观测和/或根据经由无线接口接收的信息进行分类。
如先前所阐述的,自我车辆的与运动的外来对象的存在适配的轨迹的确定不是目的本身,而是具有以下目的:特别是对于具有由人控制的外来对象的混合式交通而言改善至少部分自动化驾驶的车辆的适宜性。因此,本发明还涉及一种用于在自我车辆的环境中在具有运动的外来对象的交通状况下控制自我车辆的方法。
在该方法情况下,利用先前描述的方法之一确定自我车辆的与外来对象的行为适配的轨迹。适配的轨迹被传送给自我车辆的运动规划器。通过运动规划器确定用于自主车辆的驱动系统、转向系统和/或制动系统的操控程序,其中所述操控程序被构造用于在系统极限的范围内使车辆的实际行为尽可能好地与所确定的轨迹一致。
根据操控程序操控驱动系统、转向系统和/或制动系统。
因为由于借助于CAN总线的内部联网典型地存在从车辆中的每个位置对利用传感器系统检测的或经由无线接口获取的关于车辆环境中的外来对象的信息的访问,所以可以在自我车辆的任意已经存在的控制设备中实现该方法。同样,可以经由CAN总线从车辆中的每个位置操控运动规划器。该方法可以例如以软件的形式来实现,所述软件可以作为用于这种控制设备的更新或升级来出售,并且就此而言是自身的产品。因此,本发明还涉及一种具有机器可读指令的计算机程序,当在计算机上和/或在控制设备上执行所述计算机可读指令时,所述计算机可读指令促使计算机和/或控制设备执行由本发明提供的方法。同样,本发明还涉及具有计算机程序的机器可读数据载体或下载产品。
附图说明
下面根据附图与对本发明的优选实施例的描述一起更详细地描绘对本发明进行改善的其他措施。
实施例
图1示出方法100的实施例;
图2示出方法200的实施例;
图3是示出方法300的实施例;
图4示出具有自我车辆1和三个人控制的外来对象2-4的示例性交通场景。
具体实施方式
图1示出方法100的实施例。在步骤110中,与经由无线接口12接收的信息12a一起对在图1中未绘入的自我车辆1的环境11的物理观测的时间序列11a-11c进行处理。这些信息12a来自车辆环境11本身中的外来对象2-4和/或来自基础设施5。在步骤110中,标识外来对象2-4,即断定存在三个外来对象2-4,所述外来对象2-4以不同的方式运动。
在可选的步骤115中,根据类型2d-4d对外来对象2-4进行分类。在步骤120中,预测由外来对象2-4分别力求的近距目的地2b-4b,并且确定基本规则2c-4c,其中外来对象2-4的运动根据所述基本规则进行。与此类似地,在步骤130中确定自我车辆1的运动通向哪个近距目的地1b,并且该运动根据哪些基本规则1c进行。
在步骤140中,基于存在的信息为自我车辆1以及为外来对象2-4设置各自的质量函数R1-4,其中当外来对象2-4的各自类型2d-4d在可选的步骤115中已被确定时,根据可选的子步骤141可以考虑所述类型。
在步骤150中,将质量函数R1-4扩展成质量度量Q1-4,所述质量度量Q1-4附加地还包含状态变化x'的概率P(x')的分布的期望值E(P(x')),并且就此而言质量度量Q1-4也彼此耦合。在此,根据子步骤151,选择质量度量Q1-4,所述质量度量关于运动策略π1-4的最佳值由贝尔曼最佳值(Bellman-Optimum)给出。根据子步骤152,选择波尔兹曼-吉布斯分布作为状态变化x'的概率P(x')的分布。
在步骤160中,确定自我车辆和外来对象2-4的那些使质量度量Q1-4最大化的运动策略π1-4。由此,最后在步骤170中,从中确定外来对象2-4的所寻求的轨迹2a-4a以及自我车辆1的与之适配的额定轨迹1a。
图2示出方法200的实施例。步骤210、215、220和230与方法100的步骤110、115、120和130相同。
在方法200的步骤240中,与方法100的步骤140不同地,不确定完整的质量函数R1-4,而是确定特征函数F1-4,所述特征函数利用仍自由的参数的组θ1-4被参数化并且只有与这些参数θ1-4相结合才构成完整的质量函数R1-4。只要在步骤215中确定了外来对象2-4的类型2d-4d,就可以在可选的子步骤241中考虑所述类型用以选择各自特征函数F2-4。
在步骤250中,将自我车辆和外来对象的运动策略π1-4确定为那些使最大因果熵最大化的策略。同时,还确定特征函数F1-4的参数θ1-4。在此,根据子步骤251,预先给定边界条件,所述边界条件使得能够以递归方式确定运动策略π1-4。
在步骤260中,类似于方法100的步骤170,从运动策略π1-4中确定外来对象2-4的所寻求的轨迹2a-4a以及自我车辆1的与之适配的额定轨迹1a。
图3示出方法300的实施例。在步骤310中,利用方法100或200为自我车辆1确定与自我车辆1的环境11中的外来对象2-4的行为适配的额定轨迹1a。在步骤320中,将该适配的轨迹1a传送给自我车辆1的运动规划器13。在步骤330中,通过运动规划器13确定用于自我车辆1的驱动系统24、转向系统15和/或制动系统16的操控程序13a。
就此而论重要的是,轨迹的术语通常涉及组合式空间坐标和时间坐标中的轨道(Bahn)。这意味着不仅可以通过改变运动方向而且可以通过改变速度、诸如刹车、等待并且稍后重新开动来改变轨迹。
在步骤340中,根据操控程序13a来操控驱动系统14、转向系统15或制动系统16。
图4示出复杂的交通场景,其中可以有利地使用所描述的方法100、200、300。自我车辆1在道路50的右通车车道上笔直地朝近距目的地1b的方向行驶。
第一外来对象2是另一车辆,该另一车辆的方向指示灯2e表明其驾驶员打算拐向通往车辆2的近距目的地2b的横街51。第二外来对象3是另一车辆,该另一车辆从自我车辆1的角度看在道路50的相反行车道上处于笔直地朝其近距目的地3b的方向的路上。第三外来对象4是行人,所述行人在道路50的从其看来相对的侧上向近距目的地4b行进。
在图4中所示的状况下,行人4必须使用道路50上的人行横道52,这同时责成车辆3的驾驶员等待。因此,原则上,车辆2的驾驶员可以直接加速并且如打算的那样向左拐,这对于其快速到达近距目的地2b会是最佳的。与此相应地,自我车辆1在其车道中具有至少直至人行横道52的自由行驶。在车辆2的驾驶员将做对其而言最佳事情的简化假设下的控制方法因此将会使自我车辆1加速。但是,如果车辆2的驾驶员现在如下错误地估计该状况,即该驾驶员必须首先让迎面车流中的车辆3驶过(这当在人行横道52上无行人4的情况下确实也会是正确的),则自我车辆从后面撞在车辆2上。根据本发明的方法使得能够考虑这种不安全性。从而例如可以在如此程度上限制用于继续行驶的速度,使得对于车辆2实际上停住的情况,仍然可以利用全制动来防止相撞。
Claims (10)
1.一种用于预报自我车辆(1)的环境(11)中的外来对象(2-4)的轨迹(2a-4a)以及用于为所述自我车辆(1)确定与之适配的自身未来轨迹(1a)的方法(100),所述方法具有以下步骤:
•从所述环境(11)的物理观测的时间序列(11a-11c)中和/或从经由所述车辆(1)的无线接口(12)从所述外部对象(2-4)本身和/或从基础设施(5)接收的信息(12a)中,标识(110)所述外来对象(2-4);
•确定(120)所述外来对象(2-4)中的每一个的运动通向哪个近距目的地(2b-4b)以及该运动根据哪些基本规则(2c-4c)进行;
•确定(130)所述自我车辆(1)的运动通向哪个近距目的地(lb)以及该运动根据哪些基本规则(1c)进行;
•为所述自我车辆(1)以及为所述外来对象(2-4)分别设置(140)质量函数R1-4,所述质量函数给由所述自我车辆(1)和所述外来对象(2-4)的当前状态构成的总状况x和可能的紧接着的运动行动a1-4分配针对在当前总状况x中该行动a1-4对于分别观察的交通参与者(1-4)如何好的度量;
•为所述自我车辆(1)以及为所述外来对象(2-4)分别设置(150)质量度量Q1-4,所述质量度量除了值之外还将状态变化x'的概率P(x')的分布的期望值E(P(x'))分配给所述总状况x和所述可能的紧接着的运动行动a1-4,其中其余交通参与者(2-4;1、3、4;1-3)以所述概率对紧接着的运动行动a1-4作出反应;
•确定(160)所述自我车辆和所述外来对象(2-4)的那些使所述质量度量Q1-4最大化的最佳运动策略π1-4;
•从所述最佳运动策略π1-4中确定(170)所寻求的轨迹(1a-4a)。
2.根据权利要求1所述的方法(100),其中选择(151)其关于所述运动策略π1-4的最佳值由贝尔曼最佳值给出的质量度量Q1-4。
3.根据权利要求1至2中任一项所述的方法(100),其中选择(152)波尔兹曼-吉布斯分布作为状态变化x'的概率P(x')的分布。
4.一种用于预报在自我车辆(1)的环境(11)中的外来对象(2-4)的轨迹(2a-4a)并且用于为所述自我车辆(1)确定与之适配的自身未来轨迹(1a)的方法(200),所述方法具有以下步骤:
•从所述环境(11)的物理观测的时间序列(11a-11c)中和/或从经由所述车辆(1)的无线接口(12)从所述外部对象(2-4)本身和/或从基础设施(5)接收的信息(12a)中,标识(210)所述外来对象(2-4);
•确定(220)所述外来对象(2-4)中的每一个的运动通向哪个近距目的地(2b-4b)以及该运动根据哪些基本规则(2c-4c)进行;
•确定(230)所述自我车辆(1)的运动通向哪个近距目的地(lb)以及该运动根据哪些基本规则(1c)进行;
•为所述自我车辆(1)以及为所述外来对象(2-4)分别设置(240)特征函数F1-4为使得将F1-4应用于仍自由的参数的组θ1-4提供质量函数R1-4,其中所述质量函数R1-4给由所述自我车辆(1)和所述外来对象(2-4)的当前状态构成的总状况x以及可能的紧接着的运动行动a1-4分配针对在当前总状况x中行动a1-4对于分别观察的交通参与者(1-4)如何好的度量;
•从所述运动策略π1-4中确定(260)所寻求的轨迹(la-4a)。
7.根据权利要求1至6中任一项所述的方法(100、200),其中所述最佳运动策略π1-4在以下边界条件下被确定(160、250),即所述最佳运动策略分别统计地围绕使各自质量函数R1-4最大化的策略分布。
8.根据权利要求1至7中任一项所述的方法(100、200),其中所述外来对象(2-4)分别在其类型(2d-4d)方面被分类(115、215),并且其中各自质量函数R2-4或各自特征函数F2-4根据这种类型(2d-4d)被选择(141、241)。
9.一种用于在自我车辆(1)的环境中在具有运动的外来对象(2-4)的交通状况中控制所述自我车辆(1)的方法(300),所述方法具有以下步骤:
•利用根据权利要求1至8中任一项所述的方法(100、200)来确定(310)所述自我车辆(1)的与所述外来对象(2-4)的行为适配的轨迹(1a);
•适配的轨迹(1a)被传送(320)给所述自我车辆(1)的运动规划器(13);
•通过所述运动规划器(13)确定(330)用于所述自我车辆(1)的驱动系统(14)、转向系统(15)和/或制动系统(16)的操控程序(13a),其中所述操控程序(13a )被构造用于在系统极限的范围内使所述车辆(1)的实际行为尽可能好地与所述轨迹(la)一致;
•根据所述操控程序(13a)操控(340)所述驱动系统(14)、转向系统(15)和/或制动系统(16)。
10.一种包含机器可读指令的计算机程序,当在计算机上和/或在控制设备上执行所述机器可读指令时,所述机器可读指令促使所述计算机和/或所述控制设备执行根据权利要求1至9中任一项所述的方法(100、200、300)。
Applications Claiming Priority (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
DE102018210280.5 | 2018-06-25 | ||
DE102018210280.5A DE102018210280A1 (de) | 2018-06-25 | 2018-06-25 | Anpassung der Trajektorie eines Ego-Fahrzeugs an bewegte Fremdobjekte |
PCT/EP2019/063232 WO2020001867A1 (de) | 2018-06-25 | 2019-05-22 | Anpassung der trajektorie eines ego-fahrzeugs an bewegte fremdobjekte |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112292719A true CN112292719A (zh) | 2021-01-29 |
CN112292719B CN112292719B (zh) | 2023-01-31 |
Family
ID=66676497
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201980042562.3A Active CN112292719B (zh) | 2018-06-25 | 2019-05-22 | 使自我车辆的轨迹与运动的外来对象适配 |
Country Status (5)
Country | Link |
---|---|
US (1) | US11858506B2 (zh) |
EP (1) | EP3811351A1 (zh) |
CN (1) | CN112292719B (zh) |
DE (1) | DE102018210280A1 (zh) |
WO (1) | WO2020001867A1 (zh) |
Families Citing this family (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP3413082B1 (en) * | 2017-06-09 | 2020-01-01 | Veoneer Sweden AB | A vehicle system for detection of oncoming vehicles |
EP3866074B1 (en) | 2020-02-14 | 2022-11-30 | Robert Bosch GmbH | Method and device for controlling a robot |
US11458987B2 (en) | 2020-02-26 | 2022-10-04 | Honda Motor Co., Ltd. | Driver-centric risk assessment: risk object identification via causal inference with intent-aware driving models |
US11544935B2 (en) * | 2020-02-26 | 2023-01-03 | Honda Motor Co., Ltd. | System for risk object identification via causal inference and method thereof |
DE102020207897A1 (de) | 2020-06-25 | 2021-12-30 | Robert Bosch Gesellschaft mit beschränkter Haftung | Situationsangepasste Ansteuerung für Fahrassistenzsysteme und Systeme zum zumindest teilweise automatisierten Führen von Fahrzeugen |
DE102020208080A1 (de) | 2020-06-30 | 2021-12-30 | Robert Bosch Gesellschaft mit beschränkter Haftung | Erkennung von Objekten in Bildern unter Äquivarianz oder Invarianz gegenüber der Objektgröße |
US11958498B2 (en) | 2020-08-24 | 2024-04-16 | Toyota Research Institute, Inc. | Data-driven warm start selection for optimization-based trajectory planning |
DE102020215302A1 (de) | 2020-12-03 | 2022-06-09 | Robert Bosch Gesellschaft mit beschränkter Haftung | Dynamikabhängige Verhaltensplanung für zumindest teilweise automatisiert fahrende Fahrzeuge |
DE102020215324A1 (de) | 2020-12-03 | 2022-06-09 | Robert Bosch Gesellschaft mit beschränkter Haftung | Auswahl von Fahrmanövern für zumindest teilweise automatisiert fahrende Fahrzeuge |
CN113219962B (zh) * | 2021-02-26 | 2023-02-28 | 北京航空航天大学合肥创新研究院(北京航空航天大学合肥研究生院) | 一种面向混行队列跟驰安全的控制方法、系统及存储介质 |
DE102021206014A1 (de) | 2021-06-14 | 2022-12-15 | Robert Bosch Gesellschaft mit beschränkter Haftung | Bewegungsvorhersage für Verkehrsteilnehmer |
Citations (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1656524A (zh) * | 2002-03-22 | 2005-08-17 | 易卜拉欣·纳拉 | 车辆的导航、防撞、和控制系统 |
DE102008005305A1 (de) * | 2008-01-21 | 2009-07-23 | Bayerische Motoren Werke Aktiengesellschaft | Verfahren zur Beeinflussung der Bewegung eines Fahrzeugs |
DE102008005310A1 (de) * | 2008-01-21 | 2009-07-23 | Bayerische Motoren Werke Aktiengesellschaft | Verfahren zur Beeinflussung der Bewegung eines Fahrzeugs bei vorzeitigem Erkennen einer unvermeidbaren Kollision mit einem Hindernis |
DE102008062916A1 (de) * | 2008-12-23 | 2010-06-24 | Continental Safety Engineering International Gmbh | Verfahren zur Ermittlung einer Kollisionswahrscheinlichkeit eines Fahrzeuges mit einem Lebewesen |
US20100228419A1 (en) * | 2009-03-09 | 2010-09-09 | Gm Global Technology Operations, Inc. | method to assess risk associated with operating an autonomic vehicle control system |
US20110235864A1 (en) * | 2008-04-07 | 2011-09-29 | Toyota Jidosha Kabushiki Kaisha | Moving object trajectory estimating device |
GB201116961D0 (en) * | 2011-09-30 | 2011-11-16 | Bae Systems Plc | Fast calibration for lidars |
US8259994B1 (en) * | 2010-09-14 | 2012-09-04 | Google Inc. | Using image and laser constraints to obtain consistent and improved pose estimates in vehicle pose databases |
US20130179382A1 (en) * | 2012-01-11 | 2013-07-11 | Honda Research Institute Europe Gmbh | Vehicle with computing means for monitoring and predicting traffic participant objects |
EP2881829A2 (de) * | 2013-12-05 | 2015-06-10 | Fraunhofer-Gesellschaft zur Förderung der angewandten Forschung e.V. | Verfahren zum automatischen Steuern eines Fahrzeugs, Vorrichtung zum Erzeugen von Steuersignalen für ein Fahrzeug und Fahrzeug |
CN104802796A (zh) * | 2014-01-27 | 2015-07-29 | 罗伯特·博世有限公司 | 用于运行驾驶员辅助系统的方法以及驾驶员辅助系统 |
EP2950294A1 (en) * | 2014-05-30 | 2015-12-02 | Honda Research Institute Europe GmbH | Method and vehicle with an advanced driver assistance system for risk-based traffic scene analysis |
DE102015221626A1 (de) * | 2015-11-04 | 2017-05-04 | Bayerische Motoren Werke Aktiengesellschaft | Verfahren zur Ermittlung einer Fahrzeug-Trajektorie entlang einer Referenzkurve |
WO2017120336A2 (en) * | 2016-01-05 | 2017-07-13 | Mobileye Vision Technologies Ltd. | Trained navigational system with imposed constraints |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108701251B (zh) * | 2016-02-09 | 2022-08-12 | 谷歌有限责任公司 | 使用优势估计强化学习 |
WO2017197170A1 (en) | 2016-05-12 | 2017-11-16 | The Regents Of The University Of California | Safely controlling an autonomous entity in presence of intelligent agents |
WO2018220418A1 (en) * | 2017-06-02 | 2018-12-06 | Toyota Motor Europe | Driving assistance method and system |
US10935982B2 (en) * | 2017-10-04 | 2021-03-02 | Huawei Technologies Co., Ltd. | Method of selection of an action for an object using a neural network |
US11084504B2 (en) * | 2017-11-30 | 2021-08-10 | Nissan North America, Inc. | Autonomous vehicle operational management scenarios |
-
2018
- 2018-06-25 DE DE102018210280.5A patent/DE102018210280A1/de active Pending
-
2019
- 2019-05-22 US US15/734,415 patent/US11858506B2/en active Active
- 2019-05-22 EP EP19727327.9A patent/EP3811351A1/de active Pending
- 2019-05-22 WO PCT/EP2019/063232 patent/WO2020001867A1/de unknown
- 2019-05-22 CN CN201980042562.3A patent/CN112292719B/zh active Active
Patent Citations (15)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1656524A (zh) * | 2002-03-22 | 2005-08-17 | 易卜拉欣·纳拉 | 车辆的导航、防撞、和控制系统 |
DE102008005305A1 (de) * | 2008-01-21 | 2009-07-23 | Bayerische Motoren Werke Aktiengesellschaft | Verfahren zur Beeinflussung der Bewegung eines Fahrzeugs |
DE102008005310A1 (de) * | 2008-01-21 | 2009-07-23 | Bayerische Motoren Werke Aktiengesellschaft | Verfahren zur Beeinflussung der Bewegung eines Fahrzeugs bei vorzeitigem Erkennen einer unvermeidbaren Kollision mit einem Hindernis |
US20110235864A1 (en) * | 2008-04-07 | 2011-09-29 | Toyota Jidosha Kabushiki Kaisha | Moving object trajectory estimating device |
DE102008062916A1 (de) * | 2008-12-23 | 2010-06-24 | Continental Safety Engineering International Gmbh | Verfahren zur Ermittlung einer Kollisionswahrscheinlichkeit eines Fahrzeuges mit einem Lebewesen |
US20100228419A1 (en) * | 2009-03-09 | 2010-09-09 | Gm Global Technology Operations, Inc. | method to assess risk associated with operating an autonomic vehicle control system |
US8259994B1 (en) * | 2010-09-14 | 2012-09-04 | Google Inc. | Using image and laser constraints to obtain consistent and improved pose estimates in vehicle pose databases |
GB201116961D0 (en) * | 2011-09-30 | 2011-11-16 | Bae Systems Plc | Fast calibration for lidars |
US20130179382A1 (en) * | 2012-01-11 | 2013-07-11 | Honda Research Institute Europe Gmbh | Vehicle with computing means for monitoring and predicting traffic participant objects |
EP2881829A2 (de) * | 2013-12-05 | 2015-06-10 | Fraunhofer-Gesellschaft zur Förderung der angewandten Forschung e.V. | Verfahren zum automatischen Steuern eines Fahrzeugs, Vorrichtung zum Erzeugen von Steuersignalen für ein Fahrzeug und Fahrzeug |
CN104802796A (zh) * | 2014-01-27 | 2015-07-29 | 罗伯特·博世有限公司 | 用于运行驾驶员辅助系统的方法以及驾驶员辅助系统 |
EP2950294A1 (en) * | 2014-05-30 | 2015-12-02 | Honda Research Institute Europe GmbH | Method and vehicle with an advanced driver assistance system for risk-based traffic scene analysis |
DE102015221626A1 (de) * | 2015-11-04 | 2017-05-04 | Bayerische Motoren Werke Aktiengesellschaft | Verfahren zur Ermittlung einer Fahrzeug-Trajektorie entlang einer Referenzkurve |
WO2017120336A2 (en) * | 2016-01-05 | 2017-07-13 | Mobileye Vision Technologies Ltd. | Trained navigational system with imposed constraints |
US20180032082A1 (en) * | 2016-01-05 | 2018-02-01 | Mobileye Vision Technologies Ltd. | Machine learning navigational engine with imposed constraints |
Also Published As
Publication number | Publication date |
---|---|
CN112292719B (zh) | 2023-01-31 |
DE102018210280A1 (de) | 2020-01-02 |
US20210171061A1 (en) | 2021-06-10 |
WO2020001867A1 (de) | 2020-01-02 |
EP3811351A1 (de) | 2021-04-28 |
US11858506B2 (en) | 2024-01-02 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN112292719B (zh) | 使自我车辆的轨迹与运动的外来对象适配 | |
US20200269871A1 (en) | Method and system for determining a driving maneuver | |
US10173675B2 (en) | Method and apparatus in a motor vehicle for automated driving | |
CN111696373B (zh) | 车队协同感知方法、车队协同控制方法和系统 | |
US11256260B2 (en) | Generating trajectories for autonomous vehicles | |
US9280899B2 (en) | Dynamic safety shields for situation assessment and decision making in collision avoidance tasks | |
IL287819B (en) | Navigation based on vehicle activity | |
US20180056998A1 (en) | System and Method for Multi-Vehicle Path Planning Technical Field | |
US20230129316A1 (en) | Method and system for dynamically curating autonomous vehicle policies | |
RU2760046C1 (ru) | Способ помощи при вождении и устройство помощи при вождении | |
CN113954871A (zh) | 对于自主车辆测试预测 | |
US11351996B2 (en) | Trajectory prediction of surrounding vehicles using predefined routes | |
CN110930746A (zh) | 用于协作式操作协调的方法 | |
US20220306113A1 (en) | Customization of autonomous-driving lane changes of motor vehicles based on drivers' driving behaviours | |
US11945433B1 (en) | Risk mitigation in speed planning | |
KR20220121824A (ko) | 협력적 차량 헤드라이트 지향 | |
JP2022513929A (ja) | 自動車車両を制御する方法およびシステム | |
CN113228131B (zh) | 用于提供周围环境数据的方法和系统 | |
US20220392276A1 (en) | Vehicle behavior evaluation device, vehicle behavior evaluation method, and vehicle behavior evaluation program product | |
CN112955361A (zh) | 对预期行驶行为的预测 | |
CN115136081A (zh) | 用于训练用于机动车的控制器的至少一个算法的方法、用于优化区域中的交通流的方法、计算机程序产品以及机动车 | |
CN113642372A (zh) | 在自主驾驶车辆的操作中基于灰度图像识别对象的方法和系统 | |
CN113844446B (zh) | 融合长短程的车辆轨迹预测方法 | |
US20220379918A1 (en) | Vehicle behavior generation device, vehicle behavior generation method, and vehicle behavior generation program product | |
US20240025445A1 (en) | Safety enhanced planning system with anomaly detection for autonomous vehicles |
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 |