CN112292719A - 使自我车辆的轨迹与运动的外来对象适配 - Google Patents

使自我车辆的轨迹与运动的外来对象适配 Download PDF

Info

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
Application number
CN201980042562.3A
Other languages
English (en)
Other versions
CN112292719B (zh
Inventor
S·J·厄特萨米
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Robert Bosch GmbH
Original Assignee
Robert Bosch GmbH
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Robert Bosch GmbH filed Critical Robert Bosch GmbH
Publication of CN112292719A publication Critical patent/CN112292719A/zh
Application granted granted Critical
Publication of CN112292719B publication Critical patent/CN112292719B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Purposes 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/08Active safety systems predicting or avoiding probable or impending collision or attempting to minimise its consequences
    • B60W30/095Predicting travel path or likelihood of collision
    • B60W30/0956Predicting travel path or likelihood of collision the prediction being responsive to traffic or environmental parameters
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Drive control systems specially adapted for autonomous road vehicles
    • B60W60/001Planning or execution of driving tasks
    • B60W60/0011Planning or execution of driving tasks involving control alternatives for a single driving scenario, e.g. planning several paths to avoid obstacles
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06FELECTRIC DIGITAL DATA PROCESSING
    • G06F18/00Pattern recognition
    • G06F18/20Analysing
    • G06F18/24Classification techniques
    • G06F18/241Classification techniques relating to the classification model, e.g. parametric or non-parametric approaches
    • G06F18/2415Classification 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
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06NCOMPUTING ARRANGEMENTS BASED ON SPECIFIC COMPUTATIONAL MODELS
    • G06N3/00Computing arrangements based on biological models
    • G06N3/02Neural networks
    • G06N3/08Learning methods
    • G06N3/092Reinforcement learning
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06VIMAGE OR VIDEO RECOGNITION OR UNDERSTANDING
    • G06V20/00Scenes; Scene-specific elements
    • G06V20/50Context or environment of the image
    • G06V20/56Context or environment of the image exterior to a vehicle by using sensors mounted on the vehicle
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06VIMAGE OR VIDEO RECOGNITION OR UNDERSTANDING
    • G06V20/00Scenes; Scene-specific elements
    • G06V20/50Context or environment of the image
    • G06V20/56Context or environment of the image exterior to a vehicle by using sensors mounted on the vehicle
    • G06V20/58Recognition of moving objects or obstacles, e.g. vehicles or pedestrians; Recognition of traffic objects, e.g. traffic signs, traffic lights or roads
    • GPHYSICS
    • G08SIGNALLING
    • G08GTRAFFIC CONTROL SYSTEMS
    • G08G1/00Traffic control systems for road vehicles
    • G08G1/16Anti-collision systems
    • G08G1/166Anti-collision systems for active traffic, e.g. moving vehicles, pedestrians, bikes
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Input parameters relating to objects
    • B60W2554/40Dynamic objects, e.g. animals, windblown objects
    • B60W2554/404Characteristics
    • B60W2554/4049Relationship among other objects, e.g. converging dynamic objects
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Input parameters relating to data
    • B60W2556/20Data confidence level
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Input parameters relating to data
    • B60W2556/45External transmission of data to or from the vehicle
    • B60W2556/65Data 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*下可以具有形式:
Figure 100002_DEST_PATH_IMAGE001
其中
Figure 364666DEST_PATH_IMAGE002
是其他交通参与者的最佳运动策略,所述其他交通参与者的索引是不同于i的索引,以及
Figure 100002_DEST_PATH_IMAGE003
期望值E在概率性状态过渡以及其他交通参与者的策略上进行,所述其他交通参与者的索引是不同于i的索引。所述期望值通过
Figure 219490DEST_PATH_IMAGE004
给出。
在另一特别有利的构型中,在最佳运动策略π1-4在相同的来历Ht情况下彼此无关的前提条件下确定所述最佳运动策略π1-4
Figure DEST_PATH_IMAGE005
如果现在此外选择波尔兹曼-吉布斯(Boltzmann-Gibbs)分布作为状态变化x'的概率P(x')的分布,则交通参与者分别根据最大熵原理选择其运动策略:
Figure 936910DEST_PATH_IMAGE006
方程式(1)至(3)构成成一组M个耦合的方程式,其中M是所观察的交通参与者的数量。所述方程可以被联合为
Figure DEST_PATH_IMAGE007
在这里Ti是方程式(1)的右侧。方程式(4)具有刚好一个最佳解Qi*,其可以利用以下算法获得:
Figure 269802DEST_PATH_IMAGE008
Figure DEST_PATH_IMAGE009
如果时间范围是有限的,则问题轻微不同。第i个交通参与者的质量函数Q在完成优化的状态下在时间步
Figure 520393DEST_PATH_IMAGE010
时具有形式:
Figure DEST_PATH_IMAGE011
其具有边界条件:
Figure 280538DEST_PATH_IMAGE012
是在时间范围结束时处于最终优化状态下质量函数Ri的值。类似于有限时间范围的情况,期望值再次取决于其余交通参与者的策略,所述策略又有利地是波尔兹曼分布的:
Figure DEST_PATH_IMAGE013
因此,方程式(5)可以被写为:
Figure 485255DEST_PATH_IMAGE014
其中,Ui是方程式(5)的右侧。例如,可以利用以下算法获得最佳解:
Figure DEST_PATH_IMAGE015
Figure 621838DEST_PATH_IMAGE016
输出
Figure DEST_PATH_IMAGE017
在本发明的范围中,开发了用于预报自我车辆的环境中的外来对象的轨迹以及用于为自我车辆确定与之适配的自身未来轨迹的另一方法。该方法首先如先前描述的方法一样开始,即标识外来对象,并且不仅为自我车辆而且为外来对象确定运动的基本规则和近距目的地。
与先前描述的方法不同地,不仅为自我车辆而且为外来对象分别设置特征函数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中。
自我车辆和外来对象的运动策略π1-4被确定为那些在总状况x中导致自我车辆和外来对象的运动行动a1-4的最大因果熵
Figure 726935DEST_PATH_IMAGE018
的策略。从运动策略π1-4中确定所寻求的轨迹。
最终获得的结果具有与根据先前描述的方法获得的结果相同的优点。特别是该方法的优点是,与对于直接确定质量函数R1-4相比,对于确定参数组θ1-4需要关于各自交通参与者的更加少的信息。但是在参数组θ1-4的另一侧上可以考虑每个附加信息,不管来自何种源。在优化时根据运动策略π1-4确定自由的参数θ1-4
因果熵
Figure DEST_PATH_IMAGE019
可以被写为
Figure 923561DEST_PATH_IMAGE020
有利地,在以下边界条件下关于运动策略π1-4确定因果熵
Figure 146732DEST_PATH_IMAGE019
的最大值,即不仅对于自我车辆而且对于外来对象而言,各自特征函数F1-4在所有可能的总状况x和所有可能的紧接着的运动行动a1-4上的期望值与在迄今为止的轨迹中根据经验观测的特征函数F1-4的平均值相等。该平均值尤其是可以在迄今根据经验观测的所有状况x和运动a1-4上被构成:
Figure DEST_PATH_IMAGE021
Figure 821427DEST_PATH_IMAGE022
结合以下其他边界条件,即在相同的来历
Figure DEST_PATH_IMAGE023
情况下最佳运动策略π1-4彼此无关,并且所述最佳运动策略分别以统计方式围绕使各自质量函数R1-4最大化的策略分布,在使用
Figure 781031DEST_PATH_IMAGE024
的情况下可以说明方程式(7)的递归解:
Figure DEST_PATH_IMAGE025
Figure 882979DEST_PATH_IMAGE026
在这里是
Figure DEST_PATH_IMAGE027
边界条件对于所有交通参与者是
Figure 327867DEST_PATH_IMAGE028
递归解类似于根据方程式(5)的完成优化的质量度量Q。
Figure DEST_PATH_IMAGE029
起质量度量Qi的作用,并且质量函数Ri作为线性组合由特征函数Fi组成。
因此,最终从自我车辆的角度来看,可以促进“逆向强化学习(inversereinforcement learning)”,即在知道自我车辆的质量函数R1的情况下,可以单独地从其余交通参与者的观测中推断其质量函数R2-4。这例如可以利用以下算法发生:
算法3:用于自主车辆的MMCE-IRL
Figure 743936DEST_PATH_IMAGE030
在另一特别有利的构型中,外来对象分别在其类型方面被分类,并且各自质量函数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,所述质量度量除了值
Figure DEST_PATH_IMAGE001
之外还将状态变化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)和所述外来对象(2-4)的运动策略π1-4确定(250)为那些在所述总状况x中导致所述自我车辆(1)和所述外来对象(2-4)的运动行动a1-4的最大因果熵
Figure 28347DEST_PATH_IMAGE002
的策略;
•从所述运动策略π1-4中确定(260)所寻求的轨迹(la-4a)。
5.根据权利要求4所述的方法(200),其中关于所述运动策略π1-4的因果熵
Figure DEST_PATH_IMAGE003
的最大值在以下边界条件下被确定(251),即不仅对于所述自主车辆(1)而且对于所述外来对象(2-4)而言,各自特征函数F1-4在所有可能的总状况x和所有可能的紧接着的运动行动a1-4上的期望值与在迄今为止的轨迹中根据经验观测的特征函数F1-4的平均值相等。
6.根据权利要求1至5中任一项所述的方法(100、200),其中所述最佳运动策略π1-4在以下边界条件下被确定(160、250),即所述最佳运动策略在相同的来历
Figure 617592DEST_PATH_IMAGE004
情况下彼此无关。
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)。
CN201980042562.3A 2018-06-25 2019-05-22 使自我车辆的轨迹与运动的外来对象适配 Active CN112292719B (zh)

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)

* Cited by examiner, † Cited by third party
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)

* Cited by examiner, † Cited by third party
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)

* Cited by examiner, † Cited by third party
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

Patent Citations (15)

* Cited by examiner, † Cited by third party
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