CN114901535A - 用于预测车辆的轨迹的系统和方法 - Google Patents
用于预测车辆的轨迹的系统和方法 Download PDFInfo
- Publication number
- CN114901535A CN114901535A CN202080089838.6A CN202080089838A CN114901535A CN 114901535 A CN114901535 A CN 114901535A CN 202080089838 A CN202080089838 A CN 202080089838A CN 114901535 A CN114901535 A CN 114901535A
- Authority
- CN
- China
- Prior art keywords
- vehicle
- vehicles
- host vehicle
- lane
- host
- 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.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 24
- 230000008859 change Effects 0.000 claims abstract description 32
- 230000000272 proprioceptive effect Effects 0.000 claims description 12
- 238000005094 computer simulation Methods 0.000 claims description 11
- 230000001419 dependent effect Effects 0.000 claims description 2
- 230000008447 perception Effects 0.000 description 7
- 230000006870 function Effects 0.000 description 4
- 230000001133 acceleration Effects 0.000 description 2
- 238000007500 overflow downdraw method Methods 0.000 description 2
- 230000008569 process Effects 0.000 description 2
- 230000003044 adaptive effect Effects 0.000 description 1
- 238000004422 calculation algorithm Methods 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 238000004590 computer program Methods 0.000 description 1
- 238000011156 evaluation Methods 0.000 description 1
- 230000000644 propagated effect Effects 0.000 description 1
- 230000004044 response Effects 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W60/00—Drive control systems specially adapted for autonomous road vehicles
- B60W60/001—Planning or execution of driving tasks
- B60W60/0027—Planning or execution of driving tasks using trajectory prediction for other traffic participants
-
- 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
- B60W30/10—Path keeping
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- 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
- B60W30/18—Propelling the vehicle
- B60W30/18009—Propelling the vehicle related to particular drive situations
- B60W30/18163—Lane change; Overtaking manoeuvres
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W40/00—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
- B60W40/10—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to vehicle motion
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W40/00—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
- B60W40/10—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to vehicle motion
- B60W40/105—Speed
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W50/00—Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
- B60W50/0097—Predicting future conditions
-
- 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
- B60W2520/00—Input parameters relating to overall vehicle dynamics
- B60W2520/04—Vehicle stop
-
- 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
- B60W2520/00—Input parameters relating to overall vehicle dynamics
- B60W2520/10—Longitudinal speed
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2554/00—Input parameters relating to objects
- B60W2554/40—Dynamic objects, e.g. animals, windblown objects
- B60W2554/404—Characteristics
- B60W2554/4041—Position
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2554/00—Input parameters relating to objects
- B60W2554/40—Dynamic objects, e.g. animals, windblown objects
- B60W2554/404—Characteristics
- B60W2554/4042—Longitudinal speed
-
- 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/4046—Behavior, e.g. aggressive or erratic
-
- 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/50—External transmission of data to or from the vehicle of positioning data, e.g. GPS [Global Positioning System] data
Landscapes
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Human Computer Interaction (AREA)
- Physics & Mathematics (AREA)
- Mathematical Physics (AREA)
- Traffic Control Systems (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
Abstract
一种用于预测在主车道上行驶的本车辆的轨迹的方法(50),其中,根据对在该相邻车道上行驶的车辆组的动态行为的估计来确定本车辆从该主车道到该相邻车道的变道,该车辆组包括位于本车辆附近的至少一辆主车辆和位于本车辆后方的副车辆。
Description
本发明涉及用于预测机动车辆的路径和/或轨迹的设备和方法、以及旨在实施这种方法的计算机程序的领域。
更特别地,本发明涉及机动车辆的驾驶员辅助、以及特别是用于辅助驾驶员激活或不激活驾驶员辅助系统的领域。
目前,机动车辆配备有越来越高效的高级驾驶员辅助系统(ADAS)。高级驾驶员辅助系统的目的是允许机动车辆自主驾驶(即,没有驾驶员干预或与车辆驾驶员共享驾驶),以使车辆保持在其行车道中和/或降低其速度。特别地,高级驾驶员辅助系统可以用于预测机动车辆的路径和/或轨迹。在本申请中,车辆的路径将被认为是与车辆在出发点与到达点之间的行进相对应的几何形状。车辆的轨迹将被认为是车辆的行进位置在出发点与到达点之间的时间演化。
被称为“自主”车辆或部分辅助驾驶车辆的车辆需要充分的车辆环境模型,以允许算法做出决策。这能够凭借如加速度计、陀螺仪等各种本体感受性传感器和如相机、雷达、LIDAR、超声波传感器等各种外感受性传感器以及被配置为处理接收到的信息并计算车辆和周围物体的状态(位置、速度、加速度、偏航等)的数据融合方法来实现。
因此,在这种车辆中,有必要预测本车辆以及其他移动物体的移动,这些移动物体存在于所述车辆的紧邻环境中并且很可能在本车辆的轨迹与物体的轨迹有冲突时成为障碍物。
例如,已知允许车辆在其车道中自动重新定位的车道保持辅助(LKA)系统,或者甚至已知允许车辆变道的变道辅助(LCA)系统。
还已知驾驶员辅助的其他示例,诸如能够检测任何障碍物并且能够执行紧急转向的自动紧急转向(AES)辅助系统,预测移动物体的轨迹允许分析潜在的碰撞风险,或者甚至已知能够控制速度并且能够自动与前方车辆保持安全距离的自适应巡航控制(ACC)辅助系统。
从文献EP 3056405-A1已知一种用于根据与本车辆相邻的两辆车辆之间的第一距离作为所述本车辆变道的目标来控制本车辆的变道的方法。
这些驾驶员辅助系统的主要缺点在于其响应反应缺乏流畅性。实际上,预测位于与本车辆相邻的车道中的车辆的行为是特别困难的,因此这些辅助系统的决策时间特别长。
因此,存在对优化本车辆从主车道到相邻车道的变道的需求。
鉴于以上内容,本发明的目的是允许预测机动车辆的轨迹,同时克服上述缺点。
本发明的目的是一种用于预测本车辆在主车道上行驶的轨迹的方法,其中,根据对在相邻车道上行驶的车辆组的动态行为的估计来确定本车辆从主车道到相邻车道的变道。所述车辆组包括位于本车辆附近的至少一辆主车辆和位于所述本车辆后方的副车辆。
因此,预测在与本车辆所在车道相邻的车道中的车辆的动态行为相对应的车流移动,以便做出变道决策。
对本车辆的轨迹的预测是根据在与本车辆所在行车道相邻的车道上存在的车辆组的行为来确定的。
有利地,收集本车辆和该车辆组中的车辆的位置、取向和速度信息,并根据收集到的信息建立在相邻车道上行驶的每对相继车辆的动态模型。这允许根据同一行车道中邻近的车辆的数据来获取相邻车辆中的每辆车辆的精确动态模型。
每对相继车辆的动态模型通过以下方式来获取:使用自回归外生(ARX)计算模型获取一对相继车辆的动态数据,以确定与本车辆相对于该对所考虑的相继车辆的行为相对应的二阶传递函数。本车辆的行为取决于其纵向模型和纵向控制器。
车辆的位置、取向和速度特别是通过本车辆的感知系统的各种本体感受性传感器和外感受性传感器来获得。
例如,通过将该自回归外生计算模型的误差与取决于每辆车辆在某一时刻的实际速度以及所述车辆在前一时刻的速度的阈值进行比较来确认所建立的动态模型。
根据后续步骤,根据所确认的动态模型和所述车辆的初始位置预测这些相邻车辆的移动,根据这些相邻车辆的移动和源自本车辆的本体感受性传感器的信息来预测本车辆的移动,并且根据对该车辆和这些相邻车辆的移动的所述预测、本车辆的总体轨迹、以及例如源自本车辆正在其上行驶的道路的地图的信息来确定本车辆的变道。
确定本车辆的变道的步骤允许评估允许本车辆安全变道的合适时间窗口。
然后,将用于本车辆的变道指令发送到用于执行本车辆的变道的模块。
在本车辆无法变道的情况下,通知本车辆需要修改诸如特别是其速度等参数。
有利地,重复该方法的步骤直到发现能够变道。
根据第二方面,本发明涉及一种用于预测在主车道上行驶的本车辆的轨迹的系统,该系统被配置为根据对在该相邻车道上行驶的车辆组的动态行为的估计来确定本车辆从该主车道到该相邻车道的变道,所述车辆组包括位于本车辆附近的至少一辆主车辆和位于所述本车辆后方的副车辆。
有利地,该系统包括:
-用于收集或取得本车辆和该车辆组中的车辆的位置、取向和速度信息的模块;
-用于根据收集到的信息估计在该相邻车道上行驶的每对相继车辆的动态模型的模块。这允许根据同一行车道中邻近的车辆的数据来获得相邻车辆中的每辆车辆的精确动态模型。
每对相继车辆的动态模型例如通过以下方式来获取:使用自回归外生(ARX)计算模型获取一对相继车辆的动态数据,以确定与本车辆相比于该对所考虑的相继车辆的行为相对应的二阶传递函数。本车辆的行为取决于其纵向模型和纵向控制器。
车辆的位置、取向和速度特别是通过本车辆的感知系统的各种本体感受性传感器和外感受性传感器来获取。
有利地,该系统包括:
-用于通过将该自回归外生计算模型的误差与取决于每辆车辆在某一时刻的实际速度以及所述本车辆在前一时刻的速度的阈值进行比较来确认所建立的动态模型模块;
-用于根据所确认的动态模型和所述车辆的初始位置来预测这些相邻车辆的移动的模块;
-用于根据对这些相邻车辆的移动的预测和源自本车辆的本体感受性传感器的信息来预测本车辆的移动的模块;以及
-用于根据对本车辆和相邻车辆的移动的所述预测、本车辆的总体轨迹、以及例如源自本车辆正在其上行驶的道路的地图的信息来确定本车辆的变道的模块。
根据另一方面,本发明涉及一种本机动车辆,该本机动车辆包括用于感知的系统以及如前所述的用于预测本车辆的轨迹的系统。
通过阅读仅借助非限制性示例所提供并且参考附图所做出的以下描述,本发明的进一步的目的、特征以及优点将变得明显,在附图中:
[图1]是两个相邻车道的示意图,本机动车辆和多辆相邻车辆正在这些车道中行驶,本车辆包括根据本发明的实施例的轨迹预测系统;
[图2]示意性地示出了根据图1的实施例的用于预测本车辆的轨迹的系统;以及
[图3]示出了由图1的系统实施的根据本发明的实施例的用于预测本车辆的轨迹的方法的流程图。
图1高度示意性地示出了两个相邻行车道1、2,在这些行车道中,机动车辆正在以同一行驶方向行驶。
如图所示,本机动车辆10在第一行车道1上行驶,并且四辆车辆3、4、5、6在与第一车道相邻的相邻车道2上行驶。
车辆3、4、5、6形成在与本车辆10的行车道1相邻的相邻车道2上行驶的车辆组7。
本机动车辆10包括用于感知所述车辆的环境的系统11,该系统被配置为检测在相邻车道2上行驶的车辆组7。
通常,在相邻车道2上行驶的车辆组7包括位于本车辆10紧邻附近的至少一辆主车辆和位于本车辆10后方的至少一辆副车辆。
感知系统11允许检测位于相邻车道2中在本车辆10紧邻附近的主车辆6。
感知系统11包括如加速度计、陀螺仪等各种本体感受性传感器和如相机、雷达、LIDAR、超声波传感器等各种外感受性传感器以及被配置为处理接收到的信息并计算本车辆10和周围物体7的状态(位置、速度、加速度、偏航等)的数据融合方法。
检测主车辆6的车辆的行为允许确定对在车辆行驶方向上位于主车辆6后方的副车辆3、4、5的位置的预测。
主车辆的速度波动传播到副车辆,使得副车辆的数量越多,预测用于本车辆10的变道的时间窗口的能力就越强。
预测允许根据在与本车辆10相邻的车道上行驶的所有车辆来创建用于本车辆10的变道的时间窗口。
本车辆包括用于预测所述本车辆的轨迹的系统12,该系统被配置为根据对在相邻车道2中行驶的车辆的行为的估计来发送用于本车辆的变道指令。
如图2中详细示出的,用于预测本车辆10的轨迹的系统12包括用于确定在与本车辆10相邻的相邻车道2上行驶的车辆3、4、5、6的状态的模块13。
为此,模块13包括用于确定在与本车辆10相邻的相邻车道2上行驶的车辆3、4、5、6的位置P和取向O的模块13a,以及用于确定在与本车辆10相邻的相邻车道2上行驶的车辆3、4、5、6的速度V的模块13b。相邻车辆的位置P、取向O和速度V特别是通过本车辆10的感知系统11的各种本体感受性传感器和外感受性传感器来获得。
用于预测本车辆10的轨迹的系统12进一步包括用于估计在相邻车道2上行驶的车辆的动态模型的模块14。模块14被配置建立在相邻车道2上行驶的每对相继车辆的动态模型。这允许根据同一行车道中邻近的车辆的数据来获取相邻车辆中的每辆车辆的精确动态模型。
用于估计车辆的动态模型的模块14被配置为确定与车辆相对于相邻车辆的行为相对应的二阶传递函数。本车辆的行为取决于其纵向模型和纵向控制器。
模型14使用自回归外生(ARX)计算模型来获取一对相继车辆的动态数据。
自回归外生计算模型根据以下等式来表达:
A(z).y(t)=B(z).u(t-nk)+e(t)。
其中:
z是时间偏移;
nk是延迟;
u(t)是输入数据,在这种情况下是前述副车辆的速度;
y(t)是输出数据,在这种情况下是主车辆的速度;
e(t)是误差值;并且
A(z)和B(z)是二阶多项式。
多项式A(z)和B(z)根据以下等式来表达:
A(z)=1+a1.z-1+a2.z-2
B(z)=b1+b2.z-1+b3.z-2。
然后,在用于确认动态模型的模块16中确认估计的动态模型,该模块被配置为根据时刻t的实际速度V(t)和前一时刻t-1的前一速度V(t-1)来确认动态模型。
用于预测本车辆10的轨迹的系统12进一步包括用于根据所确认的动态模型和相邻车辆的初始位置来预测这些相邻车辆的移动的模块18、以及用于根据模块18提供的移动预测和源自本车辆10的本体感受性传感器C的信息来预测本车辆10的移动的模块20。
用于预测本车辆10的轨迹的系统12进一步包括用于根据对本车辆和相邻车辆的移动的预测、本车辆10的总体轨迹T、以及非限制性地源自本车辆正在其上行驶的道路的地图Cart的信息来确定本车辆10的变道的模块22。
用于确定由本车辆10的变道的模块22被配置为评估允许本车辆安全变道的合适时间窗口。
将用于本车辆10的变道指令发送到用于执行变道的模块24。
在本车辆无法变道的情况下,用于确定变道的模块22可以被配置为通知用于预测本车辆10的轨迹、特别是目的在于修改诸如特别是其速度等参数的模块20。
如图3所示,用于预测本车辆10的轨迹的方法50包括用于确定在与本车辆10相邻的相邻车道2上行驶的车辆3、4、5、6的状态的步骤51。
确定步骤51允许收集或取得本车辆10和在与本车辆10相邻的相邻车道2上行驶的车辆3、4、5、6的位置P、取向O和速度信息。相邻车辆的位置P、取向O和速度V特别是通过本车辆10的感知系统11的各种本体感受性传感器和外感受性传感器来获取。
用于预测本车辆10的轨迹的方法50进一步包括估计在相邻车道2上行驶的车辆的动态模型的步骤52。在该步骤52期间,建立在相邻车道2上行驶的每对相继车辆的动态模型。这允许根据同一行车道中邻近的车辆的数据来获取相邻车辆中的每辆车辆的精确动态模型。
每对相继车辆的动态模型通过以下方式来获取:使用自回归外生(ARX)计算模型获取一对相继车辆的动态数据,以确定与车辆相对于相邻车辆的行为相对应的二阶传递函数。本车辆的行为取决于其纵向模型和纵向控制器。参考上述等式,即数学公式1至数学公式3解释自回归外生计算模型。
然后,在确认动态模型的步骤53中确认估计的动态模型,该步骤被配置为根据车辆在时刻t的实际速度V(t)和车辆在前一时刻t-1的前一速度V(t-1)来确认动态模型。例如,为了确认动态模型,将ARX计算模型的误差与阈值进行比较。如果误差低于所述阈值,则确认动态模型。
用于预测本车辆10的轨迹的方法50进一步包括根据在步骤53中所确认的动态模型及相邻车辆的初始位置来预测这些相邻车辆的移动的步骤54。
用于预测本车辆10的轨迹的方法50进一步包括用于根据在步骤53中提供的移动预测和源自本车辆10的本体感受性传感器C的信息来预测本车辆10的移动的步骤55。
在步骤56中,随后根据对本车辆和相邻车辆的移动的预测、本车辆10的总体轨迹T、以及源自本车辆正在其上行驶的道路地图Cart的信息确定本车辆10的变道。
确定本车辆的变道的步骤56允许评估允许本车辆10安全变道的合适时间窗口。
在步骤57中,将用于本车辆10的变道指令发送到用于执行本车辆10的变道的模块24。
在本车辆无法变道的情况下,通知本车辆10需要修改诸如特别是其速度等参数。
重复用于预测本车辆的轨迹的方法50,直到发现可以变道。
凭借本发明,能实时可靠地预测在与本车辆所在行车道相邻的车道中的车流移动,并允许预测本车辆在从主车道变道至相邻车道后的位置。
此外,本发明允许考虑本车辆正在其上行驶的道路的约束。
这种用于预测本车辆轨迹的系统和方法允许车流更顺畅地流动,而不会危害本车辆和周围车辆的安全。
Claims (9)
1.一种用于预测在主车道(1)上行驶的本车辆(10)的轨迹的方法(50),其中,根据对在该相邻车道(2)上行驶的车辆组的动态行为的估计来确定该本车辆从该主车道(1)到该相邻车道(2)的变道,所述车辆组(7)包括位于该本车辆附近的至少一辆主车辆和位于所述本车辆后方的副车辆。
2.如权利要求1所述的方法(50),其中,收集本车辆(10)和车辆组(7)中的车辆(3,4,5,6)的位置(P)、取向(O)和速度(V)信息,并根据收集到的信息建立在该相邻车道(2)上行驶的每对相继车辆的动态模型。
3.如权利要求2所述的方法(50),其中,每对相继车辆的动态模型通过以下方式来获取:使用自回归外生计算模型确定与该本车辆相对于每对所考虑的相继车辆的行为相对应的二阶传递函数,其中,该本车辆的行为取决于其纵向模型和纵向控制器。
4.如权利要求3所述的方法(50),其中,通过将该自回归外生计算模型的误差(e(t))与取决于每辆车辆在时刻(t)的实际速度(V(t))以及所述车辆在前一时刻(t-1)的速度(V(t-1))的阈值进行比较来确认所建立的动态模型。
5.如权利要求4所述的方法(50),其中,根据所确认的动态模型和所述车辆的初始位置预测这些相邻车辆的移动,根据对这些相邻车辆的移动的预测和源自该本车辆(10)的本体感受性传感器(C)的信息来预测该本车辆(10)的移动,并且根据对该本车辆和这些相邻车辆的移动的所述预测、该本车辆(10)的总体轨迹(T)来确定该本车辆(10)的变道。
6.如前述权利要求中任一项所述的方法(50),其中,重复该方法(50)的步骤直到发现能够变道。
7.一种用于预测在主车道(1)上行驶的本车辆(10)的轨迹的系统(12),该系统被配置为根据对在该相邻车道(2)上行驶的车辆组的动态行为的估计来确定该本车辆从该主车道(1)到该相邻车道(2)的变道,所述车辆组(7)包括位于本车辆附近的至少一辆主车辆和位于所述本车辆后方的副车辆。
8.如权利要求7所述的系统(12),包括:
-用于收集该本车辆(10)和该车辆组(7)中的车辆(3,4,5,6)的位置(P)、取向(O)和速度(V)信息的模块(13);
-用于根据收集到的信息估计在该相邻车道(2)上行驶的每对相继车辆的动态模型的模块(14);
-用于通过将该自回归外生计算模型的误差(e(t))与取决于每辆车辆在时刻(t)的实际速度(V(t))以及在前一时刻(t-1)的前一速度(V(t-1))的阈值进行比较来确认所建立的动态模型模块(16);
-用于根据所确认的动态模型和所述车辆的初始位置来预测这些相邻车辆的移动的模块(18);
-用于根据对这些相邻车辆的移动的预测和源自本车辆(10)的本体感受性传感器(C)的信息来预测该本车辆(10)的移动的模块(20);以及
-用于根据对该(本)车辆和这些相邻车辆的移动的所述预测以及该本车辆(10)的总体轨迹(T)来确定该本车辆(10)的变道的模块。
9.一种本机动车辆(10),该本机动车辆包括用于感知的系统(11)和如权利要求7或8中任一项所述的用于预测本车辆的轨迹的系统(12)。
Applications Claiming Priority (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
FRFR1914342 | 2019-12-13 | ||
FR1914342A FR3104518B1 (fr) | 2019-12-13 | 2019-12-13 | Système et procédé de prédiction de la trajectoire d’un véhicule |
PCT/EP2020/085633 WO2021116345A1 (fr) | 2019-12-13 | 2020-12-10 | Système et procédé de prédiction de la trajectoire d'un véhicule |
Publications (1)
Publication Number | Publication Date |
---|---|
CN114901535A true CN114901535A (zh) | 2022-08-12 |
Family
ID=69903432
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202080089838.6A Pending CN114901535A (zh) | 2019-12-13 | 2020-12-10 | 用于预测车辆的轨迹的系统和方法 |
Country Status (7)
Country | Link |
---|---|
US (1) | US20230015485A1 (zh) |
EP (1) | EP4072917A1 (zh) |
JP (1) | JP2023505700A (zh) |
KR (1) | KR20220108823A (zh) |
CN (1) | CN114901535A (zh) |
FR (1) | FR3104518B1 (zh) |
WO (1) | WO2021116345A1 (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116653963B (zh) * | 2023-07-31 | 2023-10-20 | 福思(杭州)智能科技有限公司 | 车辆变道控制方法、系统和智能驾驶域控制器 |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
RU2624392C1 (ru) | 2013-10-11 | 2017-07-03 | Ниссан Мотор Ко., Лтд. | Устройство управления движением и способ управления движением |
DE102015208007A1 (de) * | 2015-04-30 | 2016-11-03 | Conti Temic Microelectronic Gmbh | Verfahren zur Durchführung eines Fahrspurwechsels bei einem Kraftfahrzeug |
EP3758998A4 (en) * | 2018-04-05 | 2021-12-01 | TuSimple, Inc. | SYSTEM AND METHOD FOR AUTOMATIC LANE CHANGE CONTROL FOR AUTONOMOUS VEHICLES |
-
2019
- 2019-12-13 FR FR1914342A patent/FR3104518B1/fr active Active
-
2020
- 2020-10-12 US US17/784,531 patent/US20230015485A1/en active Pending
- 2020-12-10 WO PCT/EP2020/085633 patent/WO2021116345A1/fr unknown
- 2020-12-10 JP JP2022535570A patent/JP2023505700A/ja active Pending
- 2020-12-10 CN CN202080089838.6A patent/CN114901535A/zh active Pending
- 2020-12-10 KR KR1020227024170A patent/KR20220108823A/ko unknown
- 2020-12-10 EP EP20820225.9A patent/EP4072917A1/fr active Pending
Also Published As
Publication number | Publication date |
---|---|
FR3104518B1 (fr) | 2022-06-24 |
FR3104518A1 (fr) | 2021-06-18 |
US20230015485A1 (en) | 2023-01-19 |
EP4072917A1 (fr) | 2022-10-19 |
KR20220108823A (ko) | 2022-08-03 |
WO2021116345A1 (fr) | 2021-06-17 |
JP2023505700A (ja) | 2023-02-10 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107103784B (zh) | 估计车道变更操作的车辆间隔和时间场合的方法和系统 | |
CN108986540B (zh) | 车辆控制系统和方法、以及行驶辅助服务器 | |
US9566981B2 (en) | Method and system for post-collision manoeuvre planning and vehicle equipped with such system | |
CN105539434B (zh) | 用于躲避转向操作的路径规划方法 | |
CN107731003B (zh) | 用于沿路径引导机动车辆并且避免碰撞的控制系统和方法 | |
CN103935361B (zh) | 用于自主的车道变换、经过和超越行为的有效数据流算法 | |
CN105539586B (zh) | 用于自主驾驶的车辆躲避移动障碍物的统一的运动规划 | |
CN106335509B (zh) | 车辆的驾驶辅助装置 | |
US10741079B2 (en) | Route prediction system | |
US9081387B2 (en) | Method and device for the prediction and adaptation of movement trajectories of motor vehicles | |
KR101351919B1 (ko) | 차선 유지 보조 시스템 및 방법 | |
EP3048023B1 (en) | Method for assisting a driver in driving an ego vehicle and corresponding driver assistance system | |
EP2942250B1 (en) | Method for determining an evasive path for a host vehicle | |
CN113165648A (zh) | 用于基于采样对机动车辆的可能轨迹进行规划的控制系统和控制方法 | |
JP7193656B2 (ja) | 割り込んでくる又は抜け出て行く車両を認識する制御ユニット及び方法 | |
KR20190045308A (ko) | 차량 판정 방법, 주행 경로 보정 방법, 차량 판정 장치, 및 주행 경로 보정 장치 | |
Chae et al. | Design and vehicle implementation of autonomous lane change algorithm based on probabilistic prediction | |
JP5359289B2 (ja) | 車両用運転支援装置 | |
JP6291737B2 (ja) | 車両用走行制御装置及び隊列走行制御方法 | |
EP3626570B1 (en) | Driving assistance method and driving assistance apparatus | |
CN111483459A (zh) | 车辆控制装置 | |
CN114901535A (zh) | 用于预测车辆的轨迹的系统和方法 | |
JP5282590B2 (ja) | 車両用運転支援装置および車両用運転支援方法 | |
JP6796679B2 (ja) | 車両制御システム及び方法、並びに走行支援サーバ | |
JP6898645B2 (ja) | 自動操舵システム |
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 |