CN115099009B - 一种基于推理图的混合交通流运动行为建模方法 - Google Patents
一种基于推理图的混合交通流运动行为建模方法 Download PDFInfo
- Publication number
- CN115099009B CN115099009B CN202210615496.8A CN202210615496A CN115099009B CN 115099009 B CN115099009 B CN 115099009B CN 202210615496 A CN202210615496 A CN 202210615496A CN 115099009 B CN115099009 B CN 115099009B
- Authority
- CN
- China
- Prior art keywords
- interaction
- scene
- traffic
- graph
- vehicle
- 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 71
- 230000003993 interaction Effects 0.000 claims abstract description 170
- 238000010276 construction Methods 0.000 claims abstract description 14
- 230000002452 interceptive effect Effects 0.000 claims description 46
- 230000001133 acceleration Effects 0.000 claims description 39
- 230000006399 behavior Effects 0.000 claims description 34
- 230000008569 process Effects 0.000 claims description 32
- 238000010586 diagram Methods 0.000 claims description 16
- 238000011144 upstream manufacturing Methods 0.000 claims description 16
- 230000008859 change Effects 0.000 claims description 7
- 238000003066 decision tree Methods 0.000 claims description 6
- 230000006870 function Effects 0.000 claims description 6
- 238000004364 calculation method Methods 0.000 claims description 5
- 230000010399 physical interaction Effects 0.000 claims description 5
- 230000002457 bidirectional effect Effects 0.000 claims 1
- 238000004088 simulation Methods 0.000 description 9
- 230000000694 effects Effects 0.000 description 8
- 238000004458 analytical method Methods 0.000 description 7
- 238000005516 engineering process Methods 0.000 description 2
- 230000007246 mechanism Effects 0.000 description 2
- 238000012360 testing method Methods 0.000 description 2
- 230000002159 abnormal effect Effects 0.000 description 1
- 230000019771 cognition Effects 0.000 description 1
- 230000001351 cycling effect Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000002474 experimental method Methods 0.000 description 1
- 230000006742 locomotor activity Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012827 research and development Methods 0.000 description 1
- 238000012549 training Methods 0.000 description 1
- 230000028838 turning behavior Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F30/00—Computer-aided design [CAD]
- G06F30/20—Design optimisation, verification or simulation
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F30/00—Computer-aided design [CAD]
- G06F30/20—Design optimisation, verification or simulation
- G06F30/27—Design optimisation, verification or simulation using machine learning, e.g. artificial intelligence, neural networks, support vector machines [SVM] or training a model
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F17/00—Digital computing or data processing equipment or methods, specially adapted for specific functions
- G06F17/10—Complex mathematical operations
- G06F17/15—Correlation function computation including computation of convolution operations
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F2111/00—Details relating to CAD techniques
- G06F2111/10—Numerical modelling
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T10/00—Road transport of goods or passengers
- Y02T10/10—Internal combustion engine [ICE] based vehicles
- Y02T10/40—Engine management systems
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Theoretical Computer Science (AREA)
- General Physics & Mathematics (AREA)
- Evolutionary Computation (AREA)
- General Engineering & Computer Science (AREA)
- Software Systems (AREA)
- Geometry (AREA)
- Computer Hardware Design (AREA)
- Medical Informatics (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Artificial Intelligence (AREA)
- Mathematical Analysis (AREA)
- Mathematical Physics (AREA)
- Data Mining & Analysis (AREA)
- Pure & Applied Mathematics (AREA)
- Mathematical Optimization (AREA)
- Computational Mathematics (AREA)
- Databases & Information Systems (AREA)
- Algebra (AREA)
- Computing Systems (AREA)
- Traffic Control Systems (AREA)
Abstract
本发明涉及一种基于推理图的混合交通流运动行为建模方法,包括:获取场景信息,将场景中的所有交通参与者表示为顶点,并用有向边表示各个交通参与者之间的交互关系,从而得到交互图;根据交互图,获取所有可能的交互情景;基于每一可能的交互情景,估计该交互情景中各个交通参与者的轨迹,并判断该轨迹是否符合预设的经过实证的决策准则,从而判断交互情景的合理性;依次判断交互情景构建步骤中获取的所有可能的交互情景的合理性,直至发现满足合理性的交互情景,将该交互情景对应的各个交通参与者的轨迹作为最终的执行轨迹。与现有技术相比,本发明可高逼真、高可信地生成智能汽车虚拟测试所需背景交通流。
Description
技术领域
本发明涉及交通流微观仿真领域,尤其是涉及基于推理图的混合交通流运动行为建模方法。
背景技术
近年来,智能网联汽车技术(Intelligent and Connected Vehicles,ICV)快速发展,但是所有车辆全部实现自动驾驶仍需要很长时间。在现阶段,ICV将与人类驾驶的机动车、非机动车和行人进行交互。对混合交通流的运动行为建模将有助于为ICV的规划决策行为建模提供参考。一方面行为模型源自对人类驾驶行为的学习和交互机理的充分认知,能够为ICV赋予拟人化驾驶能力。另一方面,行为模型可直接应用于交通仿真,而交通仿真作为测试和验证自动驾驶技术的重要手段,可通过逼真地再现真实道路交通环境,有效地为自动驾驶的研发测试环节提供反馈。
但是,目前的微观交通行为建模思路为基于车道的思路,即将交通参与者的行驶空间为预先设定的车道,其行为被离散为沿着车道方向的跟驰行为和垂直于车道方向的换道行为,在面临车辆交互时采用间隙选择模型确定交互双方的优先顺序。现有交通仿真均以车道为基本单元对路网进行结构化建模,即使在交叉口等无车道划分的共享空间也以虚拟车道的形式构建路网。同时,在车道之间的交叉处设置大量的优先权规则,低优先权的交通流根据间隙选择模型穿越高优先权交通流。上述做法在本质上与混合交通流交叉口场景下多主体在连续平面上同时交互、非严格遵守优先权、以及交互决策机制复杂等特征不相符合,难以满足高精度高可信度建模和仿真的需求,更无法为智能汽车提供高逼真的虚拟测试交通流环境。
发明内容
本发明的目的就是为了克服上述现有技术存在的缺陷而提供一种基于推理图的混合交通流运动行为建模方法,以图的方式构建了多交互场景形式化表达和解析方法。在场景解析过程中,通过构建推理过程合理地产生多对象间的上下游关系组合,构成可能出现的情景,然后结合跟驰模型和决策、规划模型构建求解过程,得出合理的规划决策结果。
本发明的目的可以通过以下技术方案来实现:
一种基于推理图的混合交通流运动行为建模方法,包括以下步骤:
交互图构建步骤:获取场景信息,将场景中的所有交通参与者表示为顶点,并用有向边表示各个交通参与者之间的交互关系,从而得到交互图;
交互情景构建步骤:根据所述交互图,获取所有可能的交互情景;
合理性判断步骤:从所述交互情景构建步骤中获取一交互情景,估计该交互情景中各个交通参与者的轨迹,并判断该轨迹是否符合预设的经过实证的决策准则,从而判断交互情景的合理性;
循环执行步骤:循环执行所述合理性判断步骤,依次判断所述交互情景构建步骤中获取的所有可能的交互情景的合理性,直至发现满足合理性的交互情景,将该交互情景对应的各个交通参与者的轨迹作为最终的执行轨迹。
进一步地,所述交互图构建步骤中交互关系的表示具体为:
定义在未来行驶轨迹上具有线性重叠特征的两个个体被称为存在物理交互关系,采用单向实线连接,箭头方向代表上下游关系;
定义在未来行驶轨迹上具有交点的两个个体被称为存在逻辑交互关系,由于上下游关系尚未确定,采用双向虚线连接。
进一步地,所述交互情景构建步骤具体为:
将转向车辆视为核心交互对象,
当场景中仅存在一个核心交互对象时,确定各个交通流中的间隙,从核心交互对象的角度出发采用从下游间隙到上游间隙的深度优先策略,确定可能的交互情景;
当场景中存在两个或两个以上的核心交互对象时,首先将一个核心交互对象放入交互图中,确定可能的交互情景,然后将其他核心交互对象依次添加到已经确定的交互情景中,进一步确定可能的交互情景;
如果后续加入的核心交互对象影响了之前核心交互对象的下游交通参与者,则将被影响的核心交互对象剔出交互图,重新确定交互关系,然后将被剔出的核心交互对象加入交互图中,得到最终的交互情景。
进一步地,根据交通参与者的类型,确定不同的交通流。
进一步地,合理性判断步骤中,各个交通参与者的轨迹估计过程具体为:
采用四阶贝塞尔曲线表征交通参与者运动的路径;
采用智能驾驶人模型作为速度规划模型确定交通参与者的速度。
进一步地,所述四阶贝塞尔曲线采用五个控制点确定曲线的形状,所述曲线的形状的计算表达式为:
式中,B(u)为参数u在区间[0,1]上变化时曲线的点,是包含所有点的x坐标与y坐标的二维矩阵,即B(u)=[Bx(u),By(u)];B(0)和B(1)为曲线的两端;Bi=(Xi,Yi)为贝塞尔曲线的控制点;bi,n(u)为伯恩斯坦基多项式。
进一步地,所述路径的规划选择曲率变化的二次幂和作为目标函数,并设置约束以保证曲线端点连续性,所述目标函数的计算表达式为:
所述约束的计算表达式为:
式中,(xs,ys)为起点坐标;(xe,ye)为终点坐标;θs为起点处方向角;ks为起点处曲率;ks为终点处曲率。
进一步地,所述交通参与者的速度的确定过程具体为:
若当前对象的下游无其他对象,则认为当前对象按照期望加速度行驶;
若当前对象的下游有其它对象,则采用IDM模型作为跟驰模型,基于前方对象确定当前对象的速度,根据IDM模型确定的当前对象的加速度的计算表达式为:
式中,aIDM(s,v,Δv)为根据IDM模型确定的当前对象的加速度,amax为最大加速度,add为期望减速度;vd为期望速度;δ为自由加速指数,s*(v,Δv)为有效最小间隙;s0为由最小停车距离;T为期望时间间距;add为期望减速度,v为本车速度,Δv为前车与本车速度差。
进一步地,合理性判断步骤中,所述决策准则包括:从当前交通参与者的角度,选取等待时间和延误进行交互决策;从其它交互对象的角度,选取合作加速度和延迟进行交互决策。
进一步地,所述合作加速度和延迟的计算表达式为:
式中,ac为交互对象合作加速度,D为交互对象让行本车引起的延误,vI为交互对象当前速度;dI为交互对象至冲突点的距离;tE为本车到达冲突点的时间;dE为本车至冲突点的距离;ada为车辆的期望加速度;
利用决策树方法建立从经验数据中学习交互双方行为的决策准则。
与现有技术相比,本发明具有以下优点:
(1)本发明提出的基于推理图的混合交通流行为建模方法,将各交通参与对象潜在的交互策略的组合作为情景,从情景的角度出发,推理各交通参与对象潜在的情景并逐一甄别,极大地提高了交通仿真模拟的真实度和可靠度;
(2)本发明学习了真实驾驶员的决策标准,将其作为判断各情景中交互策略合理性的标准,使执行的情景更符合人类驾驶员的驾驶习惯,进一步提高了模型的真实度和可信度;
(3)本发明提出的基于轨迹的运动行为模型,可适应智能汽车虚拟测试对于混合交通流二维平面多交互环境的构建及模拟需求,满足了智能汽车虚拟测试对于高逼真的背景交通流仿真模型的需求,对实现高等级智能驾驶具有重要的推动作用和实际价值。
附图说明
图1为本发明实施例中提供的一种基于推理图的混合交通流运动行为建模方法的场景图示和构建的交互图;
图2为本发明实施例中提供的一种基于推理图的混合交通流运动行为建模方法的推理图框架图;
图3为本发明实施例中提供的一种基于推理图的混合交通流运动行为建模方法的交互关系问题转换成的间隙选择问题图;
图4为本发明实施例中提供的一种基于推理图的混合交通流运动行为建模方法的间隙选择问题的可选方案图;
图5为本发明实施例中提供的一种基于推理图的混合交通流运动行为建模方法的多转向车共存时的推理步骤示意图;
图6为本发明实施例中提供的一种基于推理图的混合交通流运动行为建模方法的行为建模后执行效果图;
图7为本发明实施例中提供的一种基于推理图的混合交通流运动行为建模方法的场景图示和构建的交互图的流程示意图。
具体实施方式
为使本发明实施例的目的、技术方案和优点更加清楚,下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例是本发明一部分实施例,而不是全部的实施例。通常在此处附图中描述和示出的本发明实施例的组件可以以各种不同的配置来布置和设计。
因此,以下对在附图中提供的本发明的实施例的详细描述并非旨在限制要求保护的本发明的范围,而是仅仅表示本发明的选定实施例。基于本发明中的实施例,本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
应注意到:相似的标号和字母在下面的附图中表示类似项,因此,一旦某一项在一个附图中被定义,则在随后的附图中不需要对其进行进一步定义和解释。
本方案以图的方式构建了多交互场景形式化表达和解析方法。在场景解析过程中,通过构建推理过程合理地产生多对象间的上下游关系组合,构成可能出现的情景,然后结合跟驰模型和决策、规划模型构建求解过程,得出合理的规划决策结果。
具体步骤如下:
S1:提出了基于图论的交互图来表示多交互对象场景。
S11:场景中所有的交通参与者都被表示为顶点。多交互对象场景中的交互图G由n个交通参与者A={A1,A2,…,An},包括i个机动车辆M={M1,M2,…,Mi},j非机动车辆N={N1,N2,…,Nj}和k个行人P={P1,P2,…,Pk}组成。同时,用有向边表示从下游交通参与者指向上游交通参与者的关系。其中在未来行驶轨迹上具有线性重叠特征的两个个体被称为存在物理交互关系EP(Ai,Aj),由下游个体Ai指向上游个体Aj。在未来行驶轨迹上具有交点(点重叠特征)的两个个体被称为存在逻辑交互关系EI(Ai,Aj),由于逻辑交互关系尚未确定,采用双向边连接。物理交互关系能够通过交通参与者运动过程直接识别出来,而逻辑交互关系需要通过推理过程,通过选择合理的上下游关系(即交通情景)来确定。
S2:构建了推理图框架用以解析交互关系确定交互情景。
逻辑交互关系常见于合流和穿越场景中,其中一个交通参与者与多个交互对象相关,这形成了各种交通情景。但是,在这些可能的交通情景中,只有少数符合当地的驾驶习惯的场景应该被仿真选择并呈现出来,因此建立一种推理方法,从可能的情况中选择最合理的交通情景,即推理图框架。
S21:推理图模型中有两个过程,推理过程和求解过程。推理过程负责产生当前交通场景所有可能出现的交通情景。这些交通情景往往是站在核心交互对象的角度产生。核心交互对象是指在交互图中的一组逻辑交互关系{EI,1(E,M1),EI,2(M1,E),…,EI,2i-1(E,Mi),EI,2i(Mi,E)}中所包含的共同顶点E。站在核心交互对象角度分析的交互情况能够更全面的解析当前交互问题。然后,将这些交通情景按照核心交互对象的通行效率最高到最低排序。
S22:基于推理过程生成的可能的情景,求解过程对每个情景的可行性进行分析。求解过程由针对逻辑前车的预测模块,针对核心交互对象的规划模块和针对逻辑后车的决策模块组成。最终针对逻辑后车优先权判断的结果将作为当前交互情景是否可行的最终结果。
S3:推理过程
S31:当场景中仅存在一个核心交互对象时,确定交互上下游关系的可以转化为一个间隙选择问题进行求解,采用从下游间隙到上游间隙的深度优先搜索策略,一旦一个通路被求解过程认可,其余路线就会被自然剪枝。
S32:场景中存在两个或更多个核心交互对象时,本方案提出一种“出图入图+”的推理方法以实现多核心交互对象下的快速推理。
首先将一个核心交互对象纳入推理图模型,确定该对象与其他交互对象的最佳交互情景。
然后,将其他的被逐个添加到已经确定的情景中。如果后续加入的核心交互对象影响之前核心交互对象的下游交通参与者,则应该将被影响的核心交互对象剔出交互图,重新考虑受影响的关系。
剔出交互对象原因在于改变的图结构对下游个体的运动产生影响,这可能进一步影响上游交互对象的决策和规划。当确定所有逻辑交互关系时,终止推理过程,此情景认为是不存在内部逻辑冲突的情景并输出。
S4:在给定了各种推理得到的情景之后,情景求解过程确定各情景下各个交通参与者的运动轨迹。该过程主要有两个模块:轨迹规划和决策。轨迹规划模块一是确定了位于核心交互对象下游中不受核心交互对象影响的其他交通对象的轨迹;二是为核心交互对象设计行驶轨迹,该轨迹需要在让行多个下游交互对象的同时按照驾驶人习惯的舒适高效。决策模块根据交互决策规则来估计所规划的轨迹,以再现拟人的决策行为。如果当前交通情景的解决方案能成立,则根据预测模块的方法为位于核心交互对象上游的其他交互对象规划轨迹。反之,对下一个交互情景采用同样的过程进行求解。
S41:轨迹规划分解为路径预测和速度预测两步。
S411:路径规划
路径规划为每个交通参与者设计一条最优曲线,采用四阶贝塞尔曲线,用五个控制点确定曲线的形状,如下式所示:
式中,B(u)为参数u在区间[0,1]上变化时曲线的点,是包含所有点的x坐标与y坐标的二维矩阵,即B(u)=[Bx(u),By(u)];B(0)和B(1)为曲线的两端;Bi=(Xi,Yi)为贝塞尔曲线的控制点;bi,n(u)为伯恩斯坦基多项式。
同时,路径规划选择曲率变化的二次幂和作为目标函数,即:
设置约束以保证曲线端点连续性,包括:
式中,(xs,ys)为起点坐标;(xe,ye)为终点坐标;θs为起点处方向角;ks为起点处曲率;ks为终点处曲率。
S412:车辆行驶状态通常有以下两种情况:①该对象下游无其他对象;②该对象下游有其他对象,需要跟随其行驶。对于情况①,本发明认为交互前车按照期望加速运动行驶。对于情况②,采用IDM作为跟驰模型确定车辆的速度。
根据IDM模型,后车的加速度由下式给出:
式中,amax为最大加速度,add为期望减速度;vd为期望速度;δ为自由加速指数,表现了加速度随速度的减小规律;s*(v,Δv)为有效最小间隙;s0为由最小停车距离;T为期望时间间距;add为期望减速度,v为本车速度,Δv为前车与本车速度差。
S42:情景合理性判断
首先基于实证分析探究真实人类驾驶员决策(即先行还是让行交互对象)的准则。站在本车驾驶人角度来看,选择等待时间TE及其延误DE作为影响变量的一部分,其分别代表驾驶人的耐心及其效率损失。站在其他交互对象的角度,预期的合作加速度ac和它们的延迟D选择作为交互决策行为的影响因素。
在不同初始状态下,协作加速度和延误的变化规律和求解公式不同,可以分三种情况讨论,分别为交互车辆需要停车让行本车、交互车辆需要减速让行本车和交互车辆可以加速让行本车。三种情况下的合作加速度和延迟如下公式求得:
式中,vI为交互对象当前速度;dI为交互对象至冲突点的距离;tE为本车到达冲突点的时间;dE为本车至冲突点的距离;ada为车辆的期望加速度。
利用决策树方法建立从经验数据中学习交互双方行为决策准则,结果如下:
式中,Y为交互双方的决策结果,当Y为1时,交互车让行,本车先行,当Y为0时,交互车先行,本车让行。
若某一交互关系不符合,则认为此情景不符合真实驾驶员的决策标准,应予以舍弃,应分析下一个潜在情景,直到找到所有交互关系符合人类驾驶员决策准则的情景。
S5:情景执行
在步骤S3推理得到某一情景,并通过步骤S41为该情景的各参与对象规划轨迹,并应用S42的决策方法判断情景的合理性,循环此过程直至发现某一情景合理,则停止推理与求解,此情景为最优情景,且基于此情景求解的轨迹作为最终的执行轨迹。
实施例1
针对两相位无左转保护相位的交叉口,以本车E左转通过交叉口为例(如附图1所示)说明实施推理图,解析交互关系,做出合理的决策。
(1)应用交互图表示两相位交叉口场景
交互图如附图1所示。本车E具有左转意图,而机动车辆M1,M2和非机动车辆群N1、N2直行通过交叉口。非机动车和行人首先需要通过聚类处理,将纵向距离小于机动车宽度并且横向距离小于机动车长度的非机动车和行人作为群组处理,如附图1所示的场景中非机动车群N2被当作群组处理。对于本车E而言,场景中的直行机动车和非机动车都与本车的行驶方向存在潜在冲突点,因此这些交通参与者均为交互对象。同时,直行机动车M2正在跟驰M1行驶,直行非机动车群N2正在跟驰N1行驶,在交互图中,通过图中的实线有向边(M1,M2)和(N1,N2)表示以上两个物理交互关系。此外,本车和其他直行交通参与者的交互关系尚未确定,所有可能的情况通过虚线有向边表示。
(2)构建了推理图框架用以解析交互关系确定交互情景。针对附图1所示场景,构建推理图框架如附图2。
一个交通场景可能有若干种情景运行。推理过程负责产生当前交通场景所有可能出现的交通情景。以附图2中所示的转向车辆通过交叉口为例,交通参与者可能按照情景1通行,即左转车E优先于直行机动车和非机动车通过交叉口,也可能按照情景2通行,即左转车E优先于M1通过,然后让行于N1,并在N2之前通过。以此类推直至所有情景。
在附图2中,一个转向车辆可能会对应多个直行交通参与者,而一个直行交通参与者只对应一个转向车辆。因此,转向车辆视为核心交互对象。然后,将这些交通情景按照核心交互对象的通行效率最高到最低排序,如附图2中的情景1核心交互对象E受到直行交通流的影响最小,而情景n中E需让行所有交互对象,其效率最低。
(3)基于构建的推理图执行推理过程
当场景中仅存在一个核心交互对象时,确定交互上下游关系的可以转化为一个间隙选择问题进行求解。同样以附图1中所示的一个具有一个左转车辆的简单场景为例,该交互关系确定问题被转换为间隙选择问题。请见附图3。
图3中核心交互对象为左转车E,左转车选择与直行车的交互关系等价于选择直行车流中的间隙,例如当左转车期望提前于直行机动车M1时,等价于选择g1通行。因此,核心交互对象通过交叉口的所有可能交互情景可以通过遍历间隙选择情况得到。
将交互场景转化为间隙选择网络,如附图3右图所示。图中的O点即为核心交互对象的位置,D点为核心交互对象期望驶出交叉口的位置,O点到D点的通路即为通过交叉口的一种交通情景。网络中的节点为可选择的间隙,在同一股交通流的间隙中,例如g1、g2、g3,只能选择一个通过,此外这些间隙从上到下按照核心交互与其相遇的先后顺序排列。通过深度优先遍历过程,附图4中所示的间隙网络所产生的所有通路如下所示,分别对应了9种交互情景。
当在附图1中所示的场景中存在两个或更多个核心交互对象时。如附图5所示,场景中的核心交互对象除了之前的左转车E还有右转车M3。本发明设计的推理方案为,首先将一个核心交互对象纳入推理图模型,确定该对象与其他交互对象的最佳交互情景。然后,将其他的被逐个添加到已经确定的情景中。如果后续加入的核心交互对象影响之前核心交互对象的下游交通参与者,则应该将被影响的核心交互对象剔出交互图,重新考虑受影响的关系。剔出交互对象原因在于改变的图结构对下游个体的运动产生影响,这可能进一步影响上游交互对象的决策和规划。例如附图5中,M3的加入影响了E的下游N1,根据推理规则,需要将E剔出交互图,重新将E加入带有M3的交互图中,L重新加入的过程中,考虑了M3对N1的影响,制定了更加合理的决策和规划结果,从而避免异常驾驶行为的发生。当确定所有逻辑交互关系时,终止推理过程。
(4)求解过程
(4.1.1)路径规划
路径规划为每个交通参与者设计一条最优曲线。贝塞尔曲线具有形式简单性和曲率连续性,通过平衡约束的数量和复杂性,选择四阶贝塞尔曲线,用五个控制点确定曲线的形状。
式中,B(u)为参数u在区间[0,1]上变化时曲线的点;B(0)和B(1)为曲线的两端;Bi=(Xi,Yi)为贝塞尔曲线的控制点;bi,n(u)为伯恩斯坦基多项式
同时,选择曲率变化的二次幂和作为目标函数,即
设置约束以保证曲线端点连续性,包括:
式中,(xs,ys)为起点坐标;(xe,ye)为终点坐标;θs为起点处方向角;ks为起点处曲率;ks为终点处曲率。
(4.1.2)车辆行驶状态通常有以下两种情况:①该对象下游无其他对象;②该对象下游有其他对象,需要跟随其行驶。对于情况①,本研究认为交互前车按照期望加速运动行驶。对于情况②,下游交互对象的速度预测需要充分考虑跟驰作用的影响。这里采用IDM作为跟驰模型确定车辆的速度。
根据IDM模型,后车的加速度由下式给出:
式中,amax为最大加速度,add为期望减速度;vd为期望速度;δ为自由加速指数,表现了加速度随速度的减小规律;s*(v,Δv)为有效最小间隙;s0为由最小停车距离;T为期望时间间距;add为期望减速度。
(4.2)决策方法
选择预期的合作加速度ac和它们的延迟D选择作为交互决策行为的影响因素。
在不同初始状态下,协作加速度和延误的变化规律和求解公式不同,可以分三种情况讨论,情况1为交互车辆需要停车让行本车,情况2为交互车辆需要减速让行本车,情况3为交互车辆可以加速让行本车,不同情况下的协作加速度与延误求解方法如下:
式中,vI为交互对象当前速度;dI为交互对象至冲突点的距离;tE为本车到达冲突点的时间;dE为本车至冲突点的距离;ada为车辆的期望加速度。
利用决策树方法建立从经验数据中学习交互双方行为决策规律。基于实际收集的仙霞路剑河路交叉口处的车辆轨迹数据,训练此决策树模型,得出的决策结果为下:①当直行车协作加速度大于-0.152m/s2时,样本中89.6%的样本最终结果为优先通过交叉点。②当直行车需采取的协作作加速度大于0.152而且直行车延误小于3.4s时,也就是说,左转行为对直行车的安全有一定影响,但是对直行车效率的影响较小时,有60.6%的样本选择穿越。③当直行车的协作加速度绝对值大于0.152而且直行车延误大于3.4s时,也就是说,左转行为对直行车的安全和效率均有严重影响时,98.5%的样本选择让行。
具体决策树模型结果如下:
式中,Y——交互双方的决策结果,当Y为1时,交互车让行,本车先行,当Y为0时,交互车先行,本车让行。
(5)情景执行
在步骤(3)推理得到某一情景,并通过步骤(4.1)为该情景的各参与对象规划轨迹,并应用(4.2)的决策方法判断情景的合理性,循环此过程直至发现某一情景合理,则停止推理与求解,此情景为最优情景,且基于此情景求解的轨迹作为最终的轨迹进行执行。执行效果见附图6。
以上详细描述了本发明的较佳具体实施例。应当理解,本领域的普通技术人员无需创造性劳动就可以根据本发明的构思做出诸多修改和变化。因此,凡本技术领域中技术人员依本发明的构思在现有技术的基础上通过逻辑分析、推理或者有限的实验可以得到的技术方案,皆应在由权利要求书所确定的保护范围内。
Claims (6)
1.一种基于推理图的混合交通流运动行为建模方法,其特征在于,包括以下步骤:
交互图构建步骤:获取场景信息,将场景中的所有交通参与者表示为顶点,并用有向边表示各个交通参与者之间的交互关系,从而得到交互图;
交互情景构建步骤:根据所述交互图,获取所有可能的交互情景;
合理性判断步骤:从所述交互情景构建步骤中获取一交互情景,估计该交互情景中各个交通参与者的轨迹,并判断该轨迹是否符合预设的经过实证的决策准则,从而判断交互情景的合理性;
循环执行步骤:循环执行所述合理性判断步骤,依次判断所述交互情景构建步骤中获取的所有可能的交互情景的合理性,直至发现满足合理性的交互情景,将该交互情景对应的各个交通参与者的轨迹作为最终的执行轨迹;
所述交互图构建步骤中交互关系的表示具体为:
定义在未来行驶轨迹上具有线性重叠特征的两个个体被称为存在物理交互关系,采用单向实线连接,箭头方向代表上下游关系;
定义在未来行驶轨迹上具有交点的两个个体被称为存在逻辑交互关系,由于上下游关系尚未确定,采用双向虚线连接;
所述交互情景构建步骤具体为:
将转向车辆视为核心交互对象,
当场景中仅存在一个核心交互对象时,确定各个交通流中的间隙,从核心交互对象的角度出发采用从下游间隙到上游间隙的深度优先策略,确定可能的交互情景;
当场景中存在两个或两个以上的核心交互对象时,首先将一个核心交互对象放入交互图中,确定可能的交互情景,然后将其他核心交互对象依次添加到已经确定的交互情景中,进一步确定可能的交互情景;
如果后续加入的核心交互对象影响了之前核心交互对象的下游交通参与者,则将被影响的核心交互对象剔出交互图,重新确定交互关系,然后将被剔出的核心交互对象加入交互图中,得到最终的交互情景;
合理性判断步骤中,各个交通参与者的轨迹估计过程具体为:
采用四阶贝塞尔曲线表征交通参与者运动的路径;
采用应用智能驾驶人模型作为速度规划模型确定交通参与者的速度;
合理性判断步骤中,所述决策准则包括:从当前交通参与者的角度,选取等待时间和延误进行交互决策;从其它交互对象的角度,选取合作加速度和延迟进行交互决策。
2.根据权利要求1所述的一种基于推理图的混合交通流运动行为建模方法,其特征在于,根据交通参与者的类型,确定不同的交通流。
3.根据权利要求1所述的一种基于推理图的混合交通流运动行为建模方法,其特征在于,所述四阶贝塞尔曲线采用五个控制点确定曲线的形状,所述曲线的形状的计算表达式为:
式中,B(u)为参数u在区间[0,1]上变化时曲线的点,是包含所有点的x坐标与y坐标的二维矩阵,即B(u)=[Bx(u),By(u)];B(0)和B(1)为曲线的两端;Bi=(Xi,Yi)为贝塞尔曲线的控制点;bi,n(u)为伯恩斯坦基多项式。
4.根据权利要求3所述的一种基于推理图的混合交通流运动行为建模方法,其特征在于,所述路径的规划选择曲率变化的二次幂和作为目标函数,并设置约束以保证曲线端点连续性,所述目标函数的计算表达式为:
minF=∫0 1Bx″′(u)2+By″′(u)2du
所述约束的计算表达式为:
式中,(xs,ys)为起点坐标;(xe,ye)为终点坐标;θs为起点处方向角;js为起点处曲率;ks为终点处曲率。
5.根据权利要求1所述的一种基于推理图的混合交通流运动行为建模方法,其特征在于,所述交通参与者的速度的确定过程具体为:
若当前对象的下游无其他对象,则认为当前对象按照期望加速度行驶;
若当前对象的下游有其它对象,则采用智能驾驶人模型作为跟驰模型,基于前方对象确定当前对象的速度,根据IDM模型确定的当前对象的加速度的计算表达式为:
式中,aIDM(s,v,Δv)为根据IDM模型确定的当前对象的加速度,amax为最大加速度,add为期望减速度;vd为期望速度;δ为自由加速指数,s*(v,Δv)为有效最小间隙;s0为由最小停车距离;T为期望时间间距;add为期望减速度,v为本车速度,Δv为前车与本车的速度差。
6.根据权利要求1所述的一种基于推理图的混合交通流运动行为建模方法,其特征在于,所述合作加速度和延迟的计算表达式为:
式中,ac为合作加速度,D为延误,vI为交互对象当前速度;dI为交互对象至冲突点的距离;tE为本车到达冲突点的时间;dE为本车至冲突点的距离;ada为车辆的期望加速度;
利用决策树方法建立从经验数据中学习交互双方行为的决策准则。
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210615496.8A CN115099009B (zh) | 2022-05-31 | 2022-05-31 | 一种基于推理图的混合交通流运动行为建模方法 |
US18/326,003 US12026442B2 (en) | 2022-05-31 | 2023-05-31 | Hybrid traffic flow motion behavior modeling method based on inference graph |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210615496.8A CN115099009B (zh) | 2022-05-31 | 2022-05-31 | 一种基于推理图的混合交通流运动行为建模方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN115099009A CN115099009A (zh) | 2022-09-23 |
CN115099009B true CN115099009B (zh) | 2023-08-29 |
Family
ID=83288926
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210615496.8A Active CN115099009B (zh) | 2022-05-31 | 2022-05-31 | 一种基于推理图的混合交通流运动行为建模方法 |
Country Status (2)
Country | Link |
---|---|
US (1) | US12026442B2 (zh) |
CN (1) | CN115099009B (zh) |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108229078A (zh) * | 2018-03-19 | 2018-06-29 | 北京工业大学 | 一种城市交通场景中基于规则的群体运动模拟方法 |
CN110298122A (zh) * | 2019-07-03 | 2019-10-01 | 北京理工大学 | 基于冲突消解的无人驾驶车辆城市交叉口左转决策方法 |
CN111553539A (zh) * | 2020-05-09 | 2020-08-18 | 上海大学 | 一种基于概率模型检验的行驶路径规划方法 |
CN112668100A (zh) * | 2020-11-19 | 2021-04-16 | 同济大学 | 基于自然驾驶实验的智能汽车交通场景事件链重构方法 |
CN113010967A (zh) * | 2021-04-22 | 2021-06-22 | 吉林大学 | 一种基于混合交通流模型的智能汽车在环仿真测试方法 |
CN113361866A (zh) * | 2021-05-17 | 2021-09-07 | 同济大学 | 一种非机动车微观交通流二维仿真方法 |
Family Cites Families (51)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8478642B2 (en) * | 2008-10-20 | 2013-07-02 | Carnegie Mellon University | System, method and device for predicting navigational decision-making behavior |
US8543320B2 (en) * | 2011-05-19 | 2013-09-24 | Microsoft Corporation | Inferring a behavioral state of a vehicle |
JP2016513805A (ja) * | 2013-03-15 | 2016-05-16 | キャリパー コーポレイション | 車両ルート指定および交通管理のための車線レベル車両ナビゲーション |
EP2950294B1 (en) * | 2014-05-30 | 2019-05-08 | Honda Research Institute Europe GmbH | Method and vehicle with an advanced driver assistance system for risk-based traffic scene analysis |
CN110418743B (zh) * | 2017-02-10 | 2022-10-04 | 日产北美公司 | 自主车辆运行管理阻碍监测 |
RU2733015C1 (ru) * | 2017-02-10 | 2020-09-28 | Ниссан Норт Америка, Инк. | Оперативное управление автономным транспортным средством |
US11276012B2 (en) * | 2017-04-12 | 2022-03-15 | International Business Machines Corporation | Route prediction based on adaptive hybrid model |
US11537134B1 (en) * | 2017-05-25 | 2022-12-27 | Apple Inc. | Generating environmental input encoding for training neural networks |
US11625036B2 (en) * | 2018-04-09 | 2023-04-11 | SafeAl, Inc. | User interface for presenting decisions |
US11561541B2 (en) * | 2018-04-09 | 2023-01-24 | SafeAI, Inc. | Dynamically controlling sensor behavior |
US10860023B2 (en) * | 2018-06-25 | 2020-12-08 | Mitsubishi Electric Research Laboratories, Inc. | Systems and methods for safe decision making of autonomous vehicles |
US10909866B2 (en) * | 2018-07-20 | 2021-02-02 | Cybernet Systems Corp. | Autonomous transportation system and methods |
US11861458B2 (en) * | 2018-08-21 | 2024-01-02 | Lyft, Inc. | Systems and methods for detecting and recording anomalous vehicle events |
US11169531B2 (en) * | 2018-10-04 | 2021-11-09 | Zoox, Inc. | Trajectory prediction on top-down scenes |
DE102019209736A1 (de) * | 2019-07-03 | 2021-01-07 | Robert Bosch Gmbh | Verfahren zur Bewertung möglicher Trajektorien |
US11428534B2 (en) * | 2019-08-08 | 2022-08-30 | HERE Global, B.V. | Method, apparatus, and computer program product for map matching location data to a map |
US11345342B2 (en) * | 2019-09-27 | 2022-05-31 | Intel Corporation | Potential collision warning system based on road user intent prediction |
US20200026289A1 (en) * | 2019-09-28 | 2020-01-23 | Ignacio J. Alvarez | Distributed traffic safety consensus |
US11276179B2 (en) * | 2019-12-18 | 2022-03-15 | Zoox, Inc. | Prediction on top-down scenes based on object motion |
US11755014B2 (en) * | 2019-12-31 | 2023-09-12 | Uatc, Llc | Jointly learnable behavior and trajectory planning for autonomous vehicles |
US11577746B2 (en) * | 2020-01-31 | 2023-02-14 | Nissan North America, Inc. | Explainability of autonomous vehicle decision making |
US11650590B2 (en) * | 2020-03-26 | 2023-05-16 | Mitsubishi Electric Research Laboratories, Inc. | Adaptive optimization of decision making for vehicle control |
US20200324794A1 (en) * | 2020-06-25 | 2020-10-15 | Intel Corporation | Technology to apply driving norms for automated vehicle behavior prediction |
US11605232B2 (en) * | 2020-08-27 | 2023-03-14 | Robert Bosch Gmbh | System and method for road sign ground truth construction with a knowledge graph and machine learning |
US11873006B2 (en) * | 2020-09-21 | 2024-01-16 | GM Global Technology Operations LLC | Virtual lane estimation using a recursive self-organizing map |
EP4439525A2 (en) * | 2020-10-30 | 2024-10-02 | Five AI Limited | Tools for performance testing and/or training autonomous vehicle planners |
US11845464B2 (en) * | 2020-11-12 | 2023-12-19 | Honda Motor Co., Ltd. | Driver behavior risk assessment and pedestrian awareness |
US12037025B2 (en) * | 2020-11-17 | 2024-07-16 | Uatc, Llc | Systems and methods for motion forecasting and planning for autonomous vehicles |
DE102020215545A1 (de) * | 2020-12-09 | 2022-06-09 | Robert Bosch Gesellschaft mit beschränkter Haftung | Verfahren zur Ansteuerung eines Fahrzeugs |
US11912301B1 (en) * | 2020-12-10 | 2024-02-27 | Zoox, Inc. | Top-down scenario exposure modeling |
US11606265B2 (en) * | 2021-01-29 | 2023-03-14 | World Wide Technology Holding Co., LLC | Network control in artificial intelligence-defined networking |
US20220245441A1 (en) * | 2021-01-29 | 2022-08-04 | World Wide Technology Holding Co., LLC | Reinforcement-learning modeling interfaces |
US20220245462A1 (en) * | 2021-01-29 | 2022-08-04 | World Wide Technology Holding Co., LLC | Training a digital twin in artificial intelligence-defined networking |
US20220274625A1 (en) * | 2021-02-26 | 2022-09-01 | Zoox, Inc. | Graph neural networks with vectorized object representations in autonomous vehicle systems |
EP4286972A4 (en) * | 2021-02-26 | 2024-03-27 | Huawei Technologies Co., Ltd. | METHOD AND DEVICE FOR PREDICTING THE DRIVING INTENTION OF A VEHICLE, TERMINAL AND STORAGE MEDIUM |
CA3160224A1 (en) * | 2021-05-21 | 2022-11-21 | Royal Bank Of Canada | System and method for conditional marginal distributions at flexible evaluation horizons |
US20220410938A1 (en) * | 2021-06-29 | 2022-12-29 | Toyota Research Institute, Inc. | Systems and methods for predicting the trajectory of a moving object |
US11884282B1 (en) * | 2021-08-04 | 2024-01-30 | Zoox, Inc. | Machine-learned model variance compensation |
US20230071810A1 (en) * | 2021-09-02 | 2023-03-09 | Honda Motor Co., Ltd. | System and method for providing spatiotemporal costmap inference for model predictive control |
US20230159027A1 (en) * | 2021-11-24 | 2023-05-25 | Zoox, Inc. | Boundary aware top-down prediction |
US12080044B2 (en) * | 2021-11-24 | 2024-09-03 | Zoox, Inc. | Prediction sampling techniques |
US12065171B2 (en) * | 2021-11-24 | 2024-08-20 | Zoox, Inc. | Encoding relative object information into node edge features |
US12084087B2 (en) * | 2021-11-24 | 2024-09-10 | Zoox, Inc. | Focusing prediction distribution output for efficient sampling |
US12054178B2 (en) * | 2021-12-14 | 2024-08-06 | Zoox, Inc. | Identifying relevant objects within an environment |
US20230230484A1 (en) * | 2022-01-18 | 2023-07-20 | The Regents Of The University Of California | Methods for spatio-temporal scene-graph embedding for autonomous vehicle applications |
WO2023220848A1 (en) * | 2022-05-16 | 2023-11-23 | Nvidia Corporation | Detecting robustness of a neural network |
US20230391374A1 (en) * | 2022-06-01 | 2023-12-07 | Nvidia Corporation | Neural network trajectory prediction |
US20240017745A1 (en) * | 2022-07-14 | 2024-01-18 | Nvidia Corporation | Trajectory generation |
US20240092398A1 (en) * | 2022-08-31 | 2024-03-21 | Zoox, Inc. | Trajectory prediction based on a decision tree |
US20240104335A1 (en) * | 2022-09-15 | 2024-03-28 | Waabi Innovation Inc. | Motion forecasting for autonomous systems |
EP4346177A1 (en) * | 2022-09-29 | 2024-04-03 | Nokia Technologies Oy | Ai/ml operation in single and multi-vendor scenarios |
-
2022
- 2022-05-31 CN CN202210615496.8A patent/CN115099009B/zh active Active
-
2023
- 2023-05-31 US US18/326,003 patent/US12026442B2/en active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108229078A (zh) * | 2018-03-19 | 2018-06-29 | 北京工业大学 | 一种城市交通场景中基于规则的群体运动模拟方法 |
CN110298122A (zh) * | 2019-07-03 | 2019-10-01 | 北京理工大学 | 基于冲突消解的无人驾驶车辆城市交叉口左转决策方法 |
CN111553539A (zh) * | 2020-05-09 | 2020-08-18 | 上海大学 | 一种基于概率模型检验的行驶路径规划方法 |
CN112668100A (zh) * | 2020-11-19 | 2021-04-16 | 同济大学 | 基于自然驾驶实验的智能汽车交通场景事件链重构方法 |
CN113010967A (zh) * | 2021-04-22 | 2021-06-22 | 吉林大学 | 一种基于混合交通流模型的智能汽车在环仿真测试方法 |
CN113361866A (zh) * | 2021-05-17 | 2021-09-07 | 同济大学 | 一种非机动车微观交通流二维仿真方法 |
Non-Patent Citations (1)
Title |
---|
混合交通流交叉口共享空间交互行为建模及仿真;李逸昕 等;《https://kns.cnki.net/kcms/detail/11.4520.U.20220114.1746.027.html》;第1-14页 * |
Also Published As
Publication number | Publication date |
---|---|
US12026442B2 (en) | 2024-07-02 |
CN115099009A (zh) | 2022-09-23 |
US20230385487A1 (en) | 2023-11-30 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Bai et al. | Hybrid reinforcement learning-based eco-driving strategy for connected and automated vehicles at signalized intersections | |
Lenz et al. | Tactical cooperative planning for autonomous highway driving using Monte-Carlo Tree Search | |
De Beaucorps et al. | Decision-making for automated vehicles at intersections adapting human-like behavior | |
US11555706B1 (en) | Processing graph representations of tactical maps using neural networks | |
Naumann et al. | Analyzing the suitability of cost functions for explaining and imitating human driving behavior based on inverse reinforcement learning | |
Cai et al. | DQ-GAT: Towards safe and efficient autonomous driving with deep Q-learning and graph attention networks | |
Zhang et al. | A systematic solution of human driving behavior modeling and simulation for automated vehicle studies | |
Sun et al. | Vehicle turning behavior modeling at conflicting areas of mixed-flow intersections based on deep learning | |
Hou et al. | Large-scale vehicle platooning: Advances and challenges in scheduling and planning techniques | |
Wang et al. | High-level decision making for automated highway driving via behavior cloning | |
Nakka et al. | A multi-agent deep reinforcement learning coordination framework for connected and automated vehicles at merging roadways | |
Tang et al. | Systematic testing of autonomous driving systems using map topology-based scenario classification | |
Sun et al. | Microscopic simulation and optimization of signal timing based on multi-agent: A case study of the intersection in Tianjin | |
Jiang et al. | Integrated decision and control at multi-lane intersections with mixed traffic flow | |
Deshpande et al. | Navigation in urban environments amongst pedestrians using multi-objective deep reinforcement learning | |
Shi et al. | Efficient Lane-changing Behavior Planning via Reinforcement Learning with Imitation Learning Initialization | |
Lu et al. | A game-theoretic approach on conflict resolution of autonomous vehicles at unsignalized intersections | |
Jia et al. | Interactive decision-making with switchable game modes for automated vehicles at intersections | |
Lin et al. | Generating believable mixed-traffic animation | |
CN115099009B (zh) | 一种基于推理图的混合交通流运动行为建模方法 | |
Arbabi et al. | Planning for autonomous driving via interaction-aware probabilistic action policies | |
Wen et al. | TrafficMCTS: A Closed-Loop Traffic Flow Generation Framework with Group-Based Monte Carlo Tree Search | |
Chen et al. | Motion Planning using Feasible and Smooth Tree for Autonomous Driving | |
CN114360290A (zh) | 一种基于强化学习的交叉口前车辆群体车道选择方法 | |
Speidel et al. | Graph-based motion planning for automated vehicles using multi-model branching and admissible heuristics |
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 |