[go: up one dir, main page]

CN113665574B - Prediction of lane changing duration and anthropomorphic trajectory planning method for intelligent vehicles - Google Patents

Prediction of lane changing duration and anthropomorphic trajectory planning method for intelligent vehicles Download PDF

Info

Publication number
CN113665574B
CN113665574B CN202111237247.1A CN202111237247A CN113665574B CN 113665574 B CN113665574 B CN 113665574B CN 202111237247 A CN202111237247 A CN 202111237247A CN 113665574 B CN113665574 B CN 113665574B
Authority
CN
China
Prior art keywords
lane
changing
vehicle
lane change
influence
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
Application number
CN202111237247.1A
Other languages
Chinese (zh)
Other versions
CN113665574A (en
Inventor
刘巧斌
王涛
高铭
杨路
许庆
王建强
李克强
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.)
Tsinghua University
Original Assignee
Tsinghua University
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 Tsinghua University filed Critical Tsinghua University
Priority to CN202111237247.1A priority Critical patent/CN113665574B/en
Publication of CN113665574A publication Critical patent/CN113665574A/en
Application granted granted Critical
Publication of CN113665574B publication Critical patent/CN113665574B/en
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
    • B60W30/18Propelling the vehicle
    • B60W30/18009Propelling the vehicle related to particular drive situations
    • B60W30/18163Lane change; Overtaking manoeuvres
    • 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
    • B60W40/00Estimation 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/10Estimation 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/107Longitudinal acceleration
    • 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
    • B60W50/00Details 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
    • 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
    • B60W50/00Details 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
    • B60W2050/0001Details of the control system
    • B60W2050/0019Control system elements or transfer functions
    • B60W2050/0028Mathematical models, e.g. for simulation
    • 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
    • B60W50/00Details 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
    • B60W2050/0001Details of the control system
    • B60W2050/0043Signal treatments, identification of variables or parameters, parameter estimation or state estimation

Landscapes

  • Engineering & Computer Science (AREA)
  • Automation & Control Theory (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • Physics & Mathematics (AREA)
  • Mathematical Physics (AREA)
  • Human Computer Interaction (AREA)
  • Traffic Control Systems (AREA)

Abstract

本申请涉及智能汽车应用技术领域,特别涉及一种智能汽车换道时长预测及拟人化轨迹规划方法,包括:从自然驾驶数据中提取优秀驾驶员的换道轨迹,并提取多车影响下的换道时长;获取换道车辆的周车运动信息,将周车影响表征为周车运动学参数对换道车辆的平均纵向加速度的非线性映射,进而获得周车影响下的换道时长预测模型;智能汽车应用换道时长预测模型时,基于预期换道纵向位移、当前纵向速度和换道后目标车道预期车速,结合周车信息,利用预测模型进行换道时长的优选,进而实现拟人化的换道轨迹规划。由此,充分挖掘了自然驾驶数据中优秀驾驶员的操纵规律,为智能汽车科学合理的换道决策提供参考,是智能汽车拟人化决策理念在换道决策中的体现。

Figure 202111237247

The present application relates to the technical field of intelligent vehicle applications, and in particular to a method for predicting the lane-changing duration and anthropomorphic trajectory planning of an intelligent vehicle, including: extracting the lane-changing trajectory of an excellent driver from natural driving data, and extracting the lane-changing trajectory under the influence of multiple vehicles. Lane duration; obtain the information of the lane-changing vehicle's lap movement, characterize the influence of the lap as a nonlinear mapping of the kinematic parameters of the lap to the average longitudinal acceleration of the lane-changing vehicle, and then obtain the lane-changing duration prediction model under the influence of the lap; When applying the lane-changing duration prediction model to the smart car, based on the expected longitudinal displacement of the lane-changing, the current longitudinal speed and the expected speed of the target lane after the lane-changing, combined with the information of the surrounding vehicles, the prediction model is used to optimize the lane-changing duration, thereby realizing anthropomorphic changing. Road trajectory planning. As a result, the manipulation rules of excellent drivers in the natural driving data are fully excavated, which provides a reference for intelligent vehicles to make scientific and reasonable lane-changing decisions.

Figure 202111237247

Description

智能汽车换道时长预测及拟人化轨迹规划方法Prediction of lane-changing duration and anthropomorphic trajectory planning method for intelligent vehicles

技术领域technical field

本申请涉及智能汽车应用技术领域,特别涉及一种智能汽车换道时长预测及拟人化轨迹规划方法。The present application relates to the technical field of intelligent vehicle applications, and in particular, to a method for predicting the lane-changing duration and anthropomorphic trajectory planning of an intelligent vehicle.

背景技术Background technique

在人工驾驶和自动驾驶混行的混合交通环境下,自动驾驶汽车的换道行为受到周围交通车的影响,特别是人工驾驶车辆的不确定性影响,使得换道轨迹的纵向运动规律十分复杂。In a mixed traffic environment where manual driving and automatic driving are mixed, the lane-changing behavior of autonomous vehicles is affected by the surrounding traffic vehicles, especially the uncertainty of artificially-driven vehicles, which makes the longitudinal motion of the lane-changing trajectory very complex.

相关技术中,通常假定换道过程中,智能汽车纵向速度保持不变,在这种理想工况下规划获得的换道轨迹,换道轨迹规划对横向运动规律的考量较多,然而,该方式缺乏对换道过程中车辆纵向运动的分析,未能充分考虑周围车辆对自车换道过程中纵向驾驶行为的影响,使得规划的轨迹的预期性能不一定能够满足预期要求,可能导致频繁的加减速,造成换道舒适性的降低,甚至还存在换道时长不足导致车辆侧向加速度过大,诱发自车的侧滑和侧倾等失稳风险,以及与周围车辆的碰撞风险增加等安全问题,亟待解决。In the related art, it is usually assumed that the longitudinal speed of the smart car remains unchanged during the lane-changing process. The lane-changing trajectory obtained by planning the lane-changing trajectory under this ideal operating condition requires more consideration of the lateral motion law. However, this method The lack of analysis of the longitudinal motion of the vehicle during the lane-changing process, and the failure to fully consider the impact of surrounding vehicles on the longitudinal driving behavior of the own vehicle during the lane-changing process, makes the expected performance of the planned trajectory not necessarily able to meet the expected requirements, which may lead to frequent overloading. Deceleration will reduce the comfort of changing lanes, and there may even be safety problems such as excessive lateral acceleration of the vehicle due to insufficient lane-changing time, inducing the risk of instability such as sideslip and roll of the own vehicle, and increased risk of collision with surrounding vehicles. ,waiting to be solved.

发明内容SUMMARY OF THE INVENTION

本申请提供一种智能汽车换道时长预测及拟人化轨迹规划方法,以解决相关智能汽车技术中未能充分量化评估周围车辆对自车换道过程中纵向驾驶行为的影响,而导致的换道时长决策合理性不足、可解释性差和可能存在的安全风险的问题,充分挖掘自然驾驶数据中优秀驾驶员的驾驶操纵规律,为智能汽车科学合理的换道决策提供参考,是智能汽车“学习人、模拟人、超越人和服务人”的拟人化决策理念在换道决策中的体现。The present application provides a method for predicting the lane-changing duration of an intelligent vehicle and an anthropomorphic trajectory planning method, so as to solve the problem of lane-changing caused by insufficient quantitative assessment of the impact of surrounding vehicles on the longitudinal driving behavior during the lane-changing process of the vehicle in the relevant intelligent vehicle technology. Insufficient rationality, poor interpretability and possible safety risks in the decision-making of time duration, fully excavate the driving and maneuvering rules of excellent drivers in the natural driving data, and provide a reference for intelligent vehicles to make scientific and reasonable lane-changing decisions. The embodiment of the anthropomorphic decision-making concept of "simulating people, surpassing people and serving people" in lane changing decision-making.

本申请第一方面实施例提供一种智能汽车换道时长预测及拟人化轨迹规划方法,包括以下步骤:The embodiment of the first aspect of the present application provides a method for predicting the lane-changing duration and anthropomorphic trajectory planning of an intelligent vehicle, including the following steps:

从若干驾驶员的自然驾驶数据中提取优秀驾驶员的换道轨迹,并由所述优秀驾驶员的换道轨迹提取真实多车影响下的优秀驾驶员换道时长;Extracting the lane-changing trajectory of the excellent driver from the natural driving data of several drivers, and extracting the lane-changing duration of the excellent driver under the influence of real multi-vehicles from the lane-changing trajectory of the excellent driver;

获取换道车辆的周车运动信息,并根据所述周车运动信息建立多车影响下的车辆换道纵向运动学模型,以及将所述周车的影响表征为周车运动学参数对换道车辆的平均纵向加速度的非线性映射,进而获得训练好的多车影响下的换道时长预测模型和辨识获得的模型参数;Acquiring the information of the lane-changing vehicle's movement around the vehicle, and establishing a longitudinal kinematics model of the vehicle under the influence of multiple vehicles according to the vehicle's movement information, and characterizing the influence of the vehicle's movement as the effect of the vehicle's kinematics parameters on changing lanes. The nonlinear mapping of the average longitudinal acceleration of the vehicle, and then the trained lane-changing duration prediction model under the influence of multiple vehicles and the model parameters obtained by identification are obtained;

在网联多车环境下的智能汽车应用所述换道时长预测模型进行决策的情况下,当下达换道指令时,基于预期换道纵向位移、所述智能汽车的纵向速度和换道后目标车道预期车速,结合所述智能汽车的周车信息,利用所述换道时长预测模型对所述智能汽车的换道时长进行优选,并根据优选获得的所述智能汽车的换道时长进行拟人化的轨迹规划,以实现所述智能汽车换道意图的准确实施。In the case where the smart car in the network-connected multi-vehicle environment uses the lane-changing duration prediction model to make decisions, when a lane-changing command is issued, based on the expected longitudinal displacement of the lane-changing, the longitudinal speed of the smart car and the target after the lane-changing The expected speed of the lane, combined with the weekly vehicle information of the smart car, use the lane-changing duration prediction model to optimize the lane-changing duration of the smart car, and anthropomorphize the lane-changing duration of the smart car obtained by optimization. trajectory planning to realize the accurate implementation of the lane-changing intention of the intelligent vehicle.

在一些示例中,所述从若干驾驶员的自然驾驶数据中提取优秀驾驶员的换道轨迹,并由所述优秀驾驶员的换道轨迹提取真实多车影响下的优秀驾驶员换道时长,包括:In some examples, the lane-changing trajectory of the excellent driver is extracted from the natural driving data of several drivers, and the lane-changing duration of the excellent driver under the influence of a real multi-vehicle is extracted from the lane-changing trajectory of the excellent driver, include:

计算所述优秀驾驶员的换道轨迹的朝向角;calculating the heading angle of the lane-changing trajectory of the excellent driver;

基于所述朝向角从所述自然驾驶数据中确定峰值点,并且由所述峰值点向两边搜索,得到满足预设条件的时间点;Determine a peak point from the natural driving data based on the heading angle, and search both sides from the peak point to obtain a time point that satisfies a preset condition;

由所述时间点匹配对应的换道轨迹的初始区间;matching the initial interval of the corresponding lane-changing trajectory by the time point;

根据所述初始区间计算所述换道轨迹侧向加速度峰-峰值时间差,并基于所述时间差计算侧向加速度取得最大值和最小值时对应的时间点,得到所述换道轨迹在真实多车影响下的优秀驾驶员换道时长。Calculate the peak-to-peak time difference of the lateral acceleration of the lane-changing trajectory according to the initial interval, and calculate the corresponding time points when the lateral acceleration obtains the maximum value and the minimum value based on the time difference, and obtain the lane-changing trajectory in the real multi-vehicle. A good driver's lane-changing time under the influence.

在一些示例中,所述获得训练好的多车影响下的换道时长预测模型和辨识获得的模型参数,包括:In some examples, obtaining the trained lane-changing duration prediction model under the influence of multiple vehicles and identifying the obtained model parameters include:

对所述换道车辆的平均纵向加速度进行加速度修正,得到修正后的平均纵向加速度,将所述周车的影响表征为周车运动学参数对换道车辆的所述平均纵向加速度的非线性映射;Acceleration correction is performed on the average longitudinal acceleration of the lane-changing vehicle to obtain the corrected average longitudinal acceleration, and the influence of the surrounding car is characterized as a nonlinear mapping of the kinematic parameters of the surrounding vehicle to the average longitudinal acceleration of the lane-changing vehicle ;

根据所述多车影响下的车辆换道纵向运动学模型和所述周车的影响表征为周车运动学参数对换道车辆的所述平均纵向加速度的非线性映射,得到所述多车影响下的换道时长预测模型和辨识获得的模型参数。According to the vehicle lane-changing longitudinal kinematics model under the influence of the multi-vehicle and the influence of the circling vehicle, which is characterized as a nonlinear mapping of the kinematic parameters of the circling vehicle to the average longitudinal acceleration of the lane-changing vehicle, the multi-vehicle influence is obtained. The lane-changing duration prediction model and the model parameters obtained by identification.

在一些示例中,所述换道时长预测模型为:In some examples, the lane change duration prediction model is:

Figure 938260DEST_PATH_IMAGE001
Figure 938260DEST_PATH_IMAGE001
,

其中,

Figure 136023DEST_PATH_IMAGE002
为自车的换道时长,
Figure 949258DEST_PATH_IMAGE003
为所述自车预期换道纵向位移、
Figure 119339DEST_PATH_IMAGE004
为所述自车平均纵向加速度,
Figure 563090DEST_PATH_IMAGE005
为所述自车换道后在目标车道的预期车速。in,
Figure 136023DEST_PATH_IMAGE002
for the lane changing time of the vehicle,
Figure 949258DEST_PATH_IMAGE003
is the expected lane change longitudinal displacement of the ego vehicle,
Figure 119339DEST_PATH_IMAGE004
is the average longitudinal acceleration of the ego vehicle,
Figure 563090DEST_PATH_IMAGE005
The expected vehicle speed in the target lane after changing lanes for the ego vehicle.

在一些示例中,所述预期换道纵向位移是根据纵向位置、纵向速度和纵向加速度状态函数确定的。In some examples, the expected lane change longitudinal displacement is determined from a longitudinal position, longitudinal velocity, and longitudinal acceleration state function.

本申请第二方面实施例提供一种智能汽车换道时长预测及拟人化轨迹规划装置,包括:The embodiment of the second aspect of the present application provides an intelligent vehicle lane changing duration prediction and anthropomorphic trajectory planning device, including:

提取模块,用于从若干驾驶员的自然驾驶数据中提取优秀驾驶员的换道轨迹,并由所述优秀驾驶员的换道轨迹提取真实多车影响下的优秀驾驶员换道时长;The extraction module is used to extract the lane-changing trajectory of the excellent driver from the natural driving data of several drivers, and extract the lane-changing duration of the excellent driver under the influence of the real multi-vehicle from the lane-changing trajectory of the excellent driver;

生成模块,用于获取换道车辆的周车运动信息,并根据所述周车运动信息建立多车影响下的车辆换道纵向运动学模型,以及将所述周车的影响表征为周车运动学参数对换道车辆的平均纵向加速度的非线性映射,进而获得训练好的多车影响下的换道时长预测模型和辨识获得的模型参数;以及The generation module is used to obtain the information about the vehicle's movement around the vehicle, and according to the information about the vehicle's movement, establish a longitudinal kinematics model of the vehicle under the influence of multiple vehicles, and characterize the influence of the vehicle as the movement of the vehicle. The nonlinear mapping of the learning parameters to the average longitudinal acceleration of the lane-changing vehicle, and then the trained lane-changing duration prediction model under the influence of multiple vehicles and the model parameters obtained by identification are obtained; and

换道轨迹规划模块,用于在网联多车环境下的所述智能汽车应用所述换道时长预测模型进行决策的情况下,当下达换道指令时,基于预期换道纵向位移、所述智能汽车的纵向速度和换道后目标车道预期车速,结合所述智能汽车的周车信息,利用所述换道时长预测模型对所述智能汽车的换道时长进行优选,并根据优选获得的所述智能汽车的换道时长进行拟人化的轨迹规划,以实现所述智能汽车换道意图的准确实施。The lane-changing trajectory planning module is used for, in the case where the intelligent vehicle in the network-connected multi-vehicle environment uses the lane-changing duration prediction model to make decisions, when a lane-changing command is issued, based on the expected lane-changing longitudinal displacement, the The longitudinal speed of the smart car and the expected speed of the target lane after changing lanes, combined with the weekly traffic information of the smart car, the lane-changing duration prediction model is used to optimize the lane-changing duration of the smart car, and according to the obtained An anthropomorphic trajectory planning is carried out according to the lane-changing duration of the intelligent vehicle, so as to realize the accurate implementation of the lane-changing intention of the intelligent vehicle.

在一些示例中,所述提取模块,具体用于:In some examples, the extraction module is specifically used to:

计算所述优秀驾驶员的换道轨迹的朝向角;calculating the heading angle of the lane-changing trajectory of the excellent driver;

基于所述朝向角从所述自然驾驶数据中确定峰值点,并且由所述峰值点向两边搜索,得到满足预设条件的时间点;Determine a peak point from the natural driving data based on the heading angle, and search both sides from the peak point to obtain a time point that satisfies a preset condition;

由所述时间点匹配对应的换道轨迹的初始区间;matching the initial interval of the corresponding lane-changing trajectory by the time point;

根据所述初始区间计算所述换道轨迹侧向加速度峰-峰值时间差,并基于所述时间差计算侧向加速度取得最大值和最小值时对应的时间点,得到所述换道轨迹在真实多车影响下的优秀驾驶员换道时长。Calculate the peak-to-peak time difference of the lateral acceleration of the lane-changing trajectory according to the initial interval, and calculate the corresponding time points when the lateral acceleration obtains the maximum value and the minimum value based on the time difference, and obtain the lane-changing trajectory in the real multi-vehicle. A good driver's lane-changing time under the influence.

在一些示例中,所述生成模块,具体用于:In some examples, the generation module is specifically used to:

对所述换道车辆的平均纵向加速度进行加速度修正,得到修正后的平均纵向加速度,将所述周车的影响表征为周车运动学参数对换道车辆的所述平均纵向加速度的非线性映射;Acceleration correction is performed on the average longitudinal acceleration of the lane-changing vehicle to obtain the corrected average longitudinal acceleration, and the influence of the surrounding car is characterized as a nonlinear mapping of the kinematic parameters of the surrounding vehicle to the average longitudinal acceleration of the lane-changing vehicle ;

根据所述多车影响下的车辆换道纵向运动学模型和所述周车的影响表征为周车运动学参数对换道车辆的所述平均纵向加速度的非线性映射,得到所述多车影响下的换道时长预测模型和辨识获得的模型参数。According to the vehicle lane-changing longitudinal kinematics model under the influence of the multi-vehicle and the influence of the circling vehicle, which is characterized as a nonlinear mapping of the kinematic parameters of the circling vehicle to the average longitudinal acceleration of the lane-changing vehicle, the multi-vehicle influence is obtained. The lane-changing duration prediction model and the model parameters obtained by identification.

在一些示例中,所述换道时长预测模型为:In some examples, the lane change duration prediction model is:

Figure 716991DEST_PATH_IMAGE006
Figure 716991DEST_PATH_IMAGE006
,

其中,

Figure 333917DEST_PATH_IMAGE002
为自车的换道时长,
Figure 155243DEST_PATH_IMAGE003
为所述自车预期换道纵向位移、
Figure 566632DEST_PATH_IMAGE004
为所述自车平均纵向加速度,
Figure 676671DEST_PATH_IMAGE005
为所述自车换道后在目标车道的预期车速。in,
Figure 333917DEST_PATH_IMAGE002
for the lane changing time of the vehicle,
Figure 155243DEST_PATH_IMAGE003
is the expected lane change longitudinal displacement of the ego vehicle,
Figure 566632DEST_PATH_IMAGE004
is the average longitudinal acceleration of the ego vehicle,
Figure 676671DEST_PATH_IMAGE005
The expected vehicle speed in the target lane after changing lanes for the ego vehicle.

在一些示例中,所述预期换道纵向位移是根据纵向位置、纵向速度和纵向加速度状态函数确定的。In some examples, the expected lane change longitudinal displacement is determined from a longitudinal position, longitudinal velocity, and longitudinal acceleration state function.

本申请第三方面实施例提供一种智能汽车换道轨迹决策设备,包括:换道意图识别模块和换道轨迹规划模块,其中,上述第一方面实施例所述的智能汽车换道时长预测及拟人化轨迹规划方法服务于所述换道意图识别模块和换道轨迹规划模块。A third aspect of the present application provides a lane-changing trajectory decision device for an intelligent vehicle, including: a lane-changing intention recognition module and a lane-changing trajectory planning module, wherein the lane-changing duration prediction and The anthropomorphic trajectory planning method serves the lane-changing intention identification module and the lane-changing trajectory planning module.

本申请第四方面实施例提供一种换道轨迹跟踪模块,其上存储有计算机程序,该程序被处理器执行,以用于实现上述第一方面实施例所述的智能汽车换道时长预测及拟人化轨迹规划方法。A fourth aspect of the present application provides a lane-changing trajectory tracking module, on which a computer program is stored, and the program is executed by a processor to implement the lane-changing duration prediction and Anthropomorphic trajectory planning method.

本发明的实施例,可以从大量的驾驶员的自然驾驶数据中提取出优秀驾驶员的换道轨迹,并由优秀驾驶员的换道轨迹提取真实多车影响下的优秀驾驶员换道时长,然后,获取换道车辆的周车运动信息,并根据周车运动信息建立多车影响下的车辆换道纵向运动学模型,将周车的影响表征为周车运动学参数对换道车辆的平均纵向加速度的非线性映射,进而能够获得多车影响下的换道时长预测模型,这样,当该换道时长预测模型应用到网联多车环境下的智能汽车之后,该智能汽车便可以根据预期换道纵向位移、智能汽车的纵向速度和换道后目标车道预期车速等,结合智能汽车的周车信息,利用换道时长预测模型对智能汽车的换道时长进行优选,进而,可以根据优选获得的智能汽车的换道时长进行拟人化的轨迹规划,以实现所述智能汽车换道意图的准确实施。由此,解决了相关智能汽车技术中,未能充分量化评估周围车辆对自车换道过程中纵向驾驶行为的影响,而导致的换道时长决策合理性不足、可解释性差和可能存在的安全风险的问题,本发明的实施例,充分挖掘大量驾驶员的自然驾驶数据中优秀驾驶员的驾驶操纵规律,为智能汽车科学合理的换道决策提供参考,使智能汽车的换道过程更为合理,进而提升智能汽车的安全性和可靠性,是智能汽车“学习人、模拟人、超越人和服务人”的拟人化决策理念在换道决策中的体现。In the embodiment of the present invention, the lane-changing trajectory of the excellent driver can be extracted from a large number of natural driving data of the driver, and the lane-changing duration of the excellent driver under the influence of real multi-vehicles can be extracted from the lane-changing trajectory of the excellent driver, Then, obtain the information of the perimeter vehicle motion of the lane-changing vehicle, and establish a longitudinal kinematic model of the vehicle under the influence of multiple vehicles according to the perimeter vehicle motion information, and characterize the influence of the perimeter vehicle as the average of the kinematic parameters of the perimeter vehicle on the lane-changing vehicle. The nonlinear mapping of longitudinal acceleration can then obtain a lane-changing duration prediction model under the influence of multiple vehicles. In this way, when the lane-changing duration prediction model is applied to a smart car in a networked multi-vehicle environment, the smart car can Longitudinal displacement of lane change, longitudinal speed of smart car and expected speed of target lane after lane change, etc., combined with the traffic information of smart car, the lane-changing duration prediction model is used to optimize the lane-changing duration of smart car, and then, it can be obtained according to the optimization. An anthropomorphic trajectory planning is performed on the lane-changing duration of the intelligent vehicle, so as to realize the accurate implementation of the lane-changing intention of the intelligent vehicle. This solves the problem of insufficient quantification and evaluation of the influence of surrounding vehicles on the longitudinal driving behavior during the lane changing process of the relevant smart car technology, resulting in insufficient rationality, poor interpretability and possible safety of lane change decision-making. To solve the problem of risk, the embodiment of the present invention fully excavates the driving and maneuvering rules of excellent drivers in the natural driving data of a large number of drivers, provides a reference for intelligent vehicles to make scientific and reasonable lane-changing decisions, and makes the lane-changing process of intelligent vehicles more reasonable. , and then improve the safety and reliability of smart cars, which is the embodiment of the anthropomorphic decision-making concept of smart cars "learning, simulating, surpassing and serving people" in lane-changing decision-making.

本申请附加的方面和优点将在下面的描述中部分给出,部分将从下面的描述中变得明显,或通过本申请的实践了解到。Additional aspects and advantages of the present application will be set forth, in part, in the following description, and in part will be apparent from the following description, or learned by practice of the present application.

附图说明Description of drawings

本申请上述的和/或附加的方面和优点从下面结合附图对实施例的描述中将变得明显和容易理解,其中:The above and/or additional aspects and advantages of the present application will become apparent and readily understood from the following description of embodiments taken in conjunction with the accompanying drawings, wherein:

图1为根据本申请实施例提供的一种智能汽车换道时长预测及拟人化轨迹规划方法的流程图;1 is a flowchart of a method for predicting the lane-changing duration of an intelligent vehicle and an anthropomorphic trajectory planning method provided according to an embodiment of the present application;

图2为根据本申请一个实施例的自然驾驶轨迹集HighD中提取的向左的换道轨迹、侧向速度和侧向加速度的变化规律示意图;2 is a schematic diagram of the variation law of the leftward lane change trajectory, lateral speed and lateral acceleration extracted from the natural driving trajectory set HighD according to an embodiment of the present application;

图3为根据本申请一个实施例的自然驾驶轨迹集HighD中提取的向右的换道轨迹、侧向速度和侧向加速度的变化规律;Fig. 3 is the variation law of the right lane change trajectory, lateral speed and lateral acceleration extracted from the natural driving trajectory set HighD according to an embodiment of the present application;

图4为根据本申请一个实施例的周车对自车换道过程中平均等效纵向加速度的非线性映射关系示意图;FIG. 4 is a schematic diagram of a nonlinear mapping relationship of the average equivalent longitudinal acceleration in the process of changing lanes between the surrounding vehicles and the own vehicle according to an embodiment of the present application;

图5为根据本申请一个实施例的网联环境下周车运动参数识别说明示例图;FIG. 5 is an exemplary diagram illustrating the identification of the motion parameters of a weekly vehicle in a networked environment according to an embodiment of the present application;

图6为根据本申请一个实施例的实测自然驾驶数据集HighD换道轨迹的纵向驾驶行为统计分析结果的示例图;6 is an example diagram of a statistical analysis result of longitudinal driving behavior of the measured natural driving data set HighD lane change trajectory according to an embodiment of the present application;

图7为根据本申请一个实施例的预测获得的当前车辆的换道时长与换道轨迹对应的换道时长的对比的直方图和散点图的示意图;7 is a schematic diagram of a histogram and a scatter plot of the comparison between the lane-changing duration of the current vehicle and the lane-changing duration corresponding to the lane-changing trajectory obtained by prediction according to an embodiment of the present application;

图8为根据本申请一个实施例的智能汽车换道时长预测及拟人化轨迹规划方法的流程图;8 is a flowchart of a method for predicting the lane-changing duration and anthropomorphic trajectory planning of an intelligent vehicle according to an embodiment of the present application;

图9为根据本申请实施例的智能汽车换道时长预测及拟人化轨迹规划装置的方框示意图。FIG. 9 is a schematic block diagram of an apparatus for predicting the lane-changing duration and anthropomorphic trajectory planning of an intelligent vehicle according to an embodiment of the present application.

具体实施方式Detailed ways

下面详细描述本申请的实施例,所述实施例的示例在附图中示出,其中自始至终相同或类似的标号表示相同或类似的元件或具有相同或类似功能的元件。下面通过参考附图描述的实施例是示例性的,旨在用于解释本申请,而不能理解为对本申请的限制。The following describes in detail the embodiments of the present application, examples of which are illustrated in the accompanying drawings, wherein the same or similar reference numerals refer to the same or similar elements or elements having the same or similar functions throughout. The embodiments described below with reference to the accompanying drawings are exemplary, and are intended to be used to explain the present application, but should not be construed as a limitation to the present application.

下面参考附图描述本申请实施例的智能汽车换道时长预测及拟人化轨迹规划方法。The following describes the method for predicting the lane-changing duration and anthropomorphic trajectory planning of the smart car according to the embodiments of the present application with reference to the accompanying drawings.

在介绍本申请实施例的智能汽车换道时长预测及拟人化轨迹规划方法之前,先简单介绍下相关技术中换道轨迹提取方法。Before introducing the lane-changing duration prediction and anthropomorphic trajectory planning method of the smart car according to the embodiment of the present application, the method for extracting the lane-changing trajectory in the related art is briefly introduced.

相关技术中主要有两种方法:(1)采用驾驶模拟器采集换道数据进行分析;(2)直接从自然驾驶数据中提取换道轨迹进行分析。There are two main methods in related technologies: (1) using a driving simulator to collect lane-changing data for analysis; (2) directly extracting lane-changing trajectories from natural driving data for analysis.

具体地,驾驶模拟器数据能够直接结合驾驶员问卷调查,并采集同一驾驶员在不同场景下的不同驾驶换道数据,便于进行驾驶员风格的聚类分析,但驾驶模拟器存在样本量有限且与实际驾驶环境存在差异等弊端,因此现有换道研究越来越多的关注于从高精度的自然驾驶轨迹数据中直接提取并挖掘换道行为的规律。Specifically, the driving simulator data can be directly combined with the driver questionnaire, and the data of different driving lane changes of the same driver in different scenarios can be collected, which is convenient for cluster analysis of driver styles. However, the driving simulator has a limited sample size and There are disadvantages such as differences with the actual driving environment. Therefore, more and more existing lane-changing researches focus on directly extracting and mining the law of lane-changing behavior from high-precision natural driving trajectory data.

然而,从自然驾驶数据中准确的提取出换道轨迹仍面临较大的挑战,现有自然驾驶数据换道轨迹提取的技术方案通常给定一个阈值,在车辆偏离车道线中心距离大于阈值时认为换道开始,而在车辆偏离目标车道中心线小于阈值时认为换道结束,或者根据侧向速度由零值-峰值-零值的变化过程来提取换道轨迹,以上方法在车辆侧向位移和速度存在波动的情况下,容易造成所提取的换道轨迹不完整或者存在冗余,进而影响下一步的换道时长的建模精度。However, it is still a big challenge to accurately extract the lane-changing trajectory from the natural driving data. The existing technical solutions for lane-changing trajectory extraction from natural driving data usually give a threshold, and when the vehicle deviates from the center of the lane line, it is considered that the distance is greater than the threshold. The lane change starts, and the lane change is considered to end when the vehicle deviates from the center line of the target lane by less than the threshold, or the lane change trajectory is extracted according to the change process of the lateral speed from zero value to peak value to zero value. When the speed fluctuates, it is easy to cause the extracted lane change trajectory to be incomplete or redundant, which in turn affects the modeling accuracy of the next lane change duration.

正是基于上述问题,本申请提供了一种智能汽车换道时长预测及拟人化轨迹规划方法,在该方法中,可以从大量的驾驶员的自然驾驶数据中提取出优秀驾驶员的换道轨迹,并由优秀驾驶员的换道轨迹提取真实多车影响下的优秀驾驶员换道时长,然后,获取换道车辆的周车运动信息,并根据周车运动信息建立多车影响下的车辆换道纵向运动学模型,将周车的影响表征为周车运动学参数对换道车辆的平均纵向加速度的非线性映射,进而能够获得多车影响下的换道时长预测模型,这样,当该换道时长预测模型应用到网联多车环境下的智能汽车之后,该智能汽车便可以根据预期换道纵向位移、智能汽车的纵向速度和换道后目标车道预期车速等,结合智能汽车的周车信息,利用换道时长预测模型对智能汽车的换道时长进行优选,进而,可以根据优选获得的智能汽车的换道时长进行拟人化的轨迹规划,以实现所述智能汽车换道意图的准确实施。由此,解决了相关智能汽车技术中,未能充分量化评估周围车辆对自车换道过程中纵向驾驶行为的影响,而导致的换道时长决策合理性不足、可解释性差和可能存在的安全风险的问题,本发明的实施例,充分挖掘大量驾驶员的自然驾驶数据中优秀驾驶员的驾驶操纵规律,为智能汽车科学合理的换道决策提供参考,使智能汽车的换道过程更为合理,进而提升智能汽车的安全性和可靠性,是智能汽车“学习人、模拟人、超越人和服务人”的拟人化决策理念在换道决策中的体现。Based on the above problems, the present application provides a method for predicting the lane-changing duration and anthropomorphic trajectory planning of an intelligent vehicle. In this method, the lane-changing trajectory of an excellent driver can be extracted from a large number of drivers' natural driving data. , and extract the lane-changing duration of the excellent driver under the influence of the real multi-vehicle from the lane-changing trajectory of the excellent driver, and then obtain the weekly vehicle movement information of the lane-changing vehicle, and establish the vehicle change under the influence of multi-vehicle according to the weekly vehicle movement information. The lane longitudinal kinematics model is used to characterize the influence of the surrounding vehicles as the nonlinear mapping of the kinematic parameters of the surrounding vehicles to the average longitudinal acceleration of the lane-changing vehicles, and then the prediction model of the lane-changing duration under the influence of multiple vehicles can be obtained. After the lane duration prediction model is applied to a smart car in a networked multi-vehicle environment, the smart car can be based on the longitudinal displacement of the expected lane change, the longitudinal speed of the smart car and the expected speed of the target lane after the lane change, etc. information, using the lane-changing duration prediction model to optimize the lane-changing duration of the smart car, and further, anthropomorphic trajectory planning can be carried out according to the lane-changing duration of the smart car obtained by optimization, so as to realize the accurate implementation of the lane-changing intention of the smart car. . This solves the problem of insufficient quantification and evaluation of the influence of surrounding vehicles on the longitudinal driving behavior during the lane changing process of the relevant smart car technology, resulting in insufficient rationality, poor interpretability and possible safety of lane change decision-making. To solve the problem of risk, the embodiment of the present invention fully excavates the driving and maneuvering rules of excellent drivers in the natural driving data of a large number of drivers, provides a reference for intelligent vehicles to make scientific and reasonable lane-changing decisions, and makes the lane-changing process of intelligent vehicles more reasonable. , and then improve the safety and reliability of smart cars, which is the embodiment of the anthropomorphic decision-making concept of smart cars "learning, simulating, surpassing and serving people" in lane-changing decision-making.

具体而言,图1为本申请实施例所提供的一种智能汽车换道时长预测及拟人化轨迹规划方法的流程示意图。Specifically, FIG. 1 is a schematic flowchart of a method for predicting the lane changing duration and anthropomorphic trajectory planning of an intelligent vehicle according to an embodiment of the present application.

如图1所示,该智能汽车换道时长预测及拟人化轨迹规划方法包括以下步骤:As shown in Figure 1, the method for predicting the lane-changing duration and anthropomorphic trajectory planning of an intelligent vehicle includes the following steps:

在步骤S101中,从若干驾驶员的自然驾驶数据中提取优秀驾驶员的换道轨迹,并由所述优秀驾驶员的换道轨迹提取真实多车影响下的优秀驾驶员换道时长。即:从海量的驾驶员的自然驾驶数据中提取优秀驾驶员的换道轨迹,然后,提取出优秀驾驶员的换道轨迹对应的真实多车影响下的优秀驾驶员换道时长。In step S101, the lane-changing trajectory of the excellent driver is extracted from the natural driving data of several drivers, and the lane-changing duration of the excellent driver under the influence of real multiple vehicles is extracted from the lane-changing trajectory of the excellent driver. That is: extract the lane-changing trajectory of the excellent driver from the massive natural driving data of the driver, and then extract the lane-changing duration of the excellent driver under the influence of real multi-vehicles corresponding to the lane-changing trajectory of the excellent driver.

在具体示例中,从若干驾驶员的自然驾驶数据中提取优秀驾驶员的换道轨迹,并由所述优秀驾驶员的换道轨迹提取真实多车影响下的优秀驾驶员换道时长,包括:计算所述优秀驾驶员的换道轨迹的朝向角;基于所述朝向角从所述自然驾驶数据中确定峰值点,并且由所述峰值点向两边搜索,得到满足预设条件的时间点;由所述时间点匹配对应的换道轨迹的初始区间;根据所述初始区间计算所述换道轨迹侧向加速度峰-峰值时间差,并基于所述时间差计算侧向加速度取得最大值和最小值时对应的时间点,得到所述换道轨迹在真实多车影响下的优秀驾驶员换道时长。In a specific example, the lane-changing trajectory of the excellent driver is extracted from the natural driving data of several drivers, and the lane-changing duration of the excellent driver under the influence of real multi-vehicles is extracted from the lane-changing trajectory of the excellent driver, including: Calculate the heading angle of the lane-changing trajectory of the excellent driver; determine a peak point from the natural driving data based on the heading angle, and search from the peak point to both sides to obtain a time point that satisfies the preset condition; The time point matches the initial interval of the corresponding lane-changing trajectory; calculates the peak-to-peak time difference of the lateral acceleration of the lane-changing trajectory according to the initial interval, and calculates the lateral acceleration based on the time difference to obtain a maximum value and a minimum value corresponding to At the time point, the lane-changing duration of the excellent driver under the influence of the real multi-vehicle trajectory of the lane-changing trajectory is obtained.

具体而言,在从海量的驾驶员的自然驾驶数据中提取车辆的换道轨迹时,本申请实施例可以首先计算换道轨迹的朝向角

Figure 362867DEST_PATH_IMAGE007
,峰值点可以为朝向角
Figure 38699DEST_PATH_IMAGE007
大于预设朝向角阈值的点,假设朝向角阈值为2,则自然驾驶数据中朝向角
Figure 620990DEST_PATH_IMAGE008
的点均为峰值点,由峰值点向两边搜索,得到满足预设条件的时间点,其中,预设条件可以为
Figure 218325DEST_PATH_IMAGE009
,从而可以由时间点匹配对应的换道轨迹的初始区间
Figure 911474DEST_PATH_IMAGE010
。Specifically, when extracting the lane-changing trajectory of the vehicle from a large amount of natural driving data of drivers, the embodiment of the present application may first calculate the orientation angle of the lane-changing trajectory
Figure 362867DEST_PATH_IMAGE007
, the peak point can be the heading angle
Figure 38699DEST_PATH_IMAGE007
Points larger than the preset heading angle threshold, assuming the heading angle threshold is 2, then the heading angle in the natural driving data
Figure 620990DEST_PATH_IMAGE008
The points are all peak points, search from the peak point to both sides to obtain the time points that meet the preset conditions, where the preset conditions can be
Figure 218325DEST_PATH_IMAGE009
, so that the initial interval of the corresponding lane-changing trajectory can be matched by the time point
Figure 911474DEST_PATH_IMAGE010
.

由此,实现的对车辆的换道轨迹的初步提取,提取出的换道轨迹的初始区间由于车辆的侧向位移和速度波动,可能导致所提取的换道轨迹的初始区间存在冗余时间区间,因此,本申请实施例可以采用侧向加速度峰-峰值进行换道轨迹的精确提取。As a result, the preliminary extraction of the lane-changing trajectory of the vehicle is realized, and the initial interval of the extracted lane-changing trajectory may cause redundant time intervals in the initial interval of the extracted lane-changing trajectory due to the lateral displacement and speed fluctuation of the vehicle. , therefore, in this embodiment of the present application, the lateral acceleration peak-to-peak value can be used to accurately extract the lane change trajectory.

进一步地,换道轨迹侧向加速度峰-峰值时间差

Figure 972971DEST_PATH_IMAGE011
的计算公式如式(1)所示:Further, the peak-to-peak time difference of the lateral acceleration of the lane change trajectory
Figure 972971DEST_PATH_IMAGE011
The calculation formula of is shown in formula (1):

Figure 726164DEST_PATH_IMAGE012
(1)
Figure 726164DEST_PATH_IMAGE012
(1)

其中,

Figure 799075DEST_PATH_IMAGE013
为绝对值计算符号,
Figure 30337DEST_PATH_IMAGE014
为侧向加速度取得最大值时对应的时间点,
Figure 477498DEST_PATH_IMAGE015
为侧向加速度取得最小值时对应的时间点,
Figure 401592DEST_PATH_IMAGE016
为换道轨迹对应的换道时长。in,
Figure 799075DEST_PATH_IMAGE013
Calculate the sign for the absolute value,
Figure 30337DEST_PATH_IMAGE014
is the corresponding time point when the lateral acceleration reaches the maximum value,
Figure 477498DEST_PATH_IMAGE015
is the time point corresponding to the minimum value of lateral acceleration,
Figure 401592DEST_PATH_IMAGE016
It is the lane change duration corresponding to the lane change track.

由此可知,换道轨迹对应的换道时长

Figure 504677DEST_PATH_IMAGE016
是两倍的侧向加速度峰-峰值时间差
Figure 336367DEST_PATH_IMAGE011
,故换道时间起点
Figure 841298DEST_PATH_IMAGE017
和换道时间终点
Figure 670714DEST_PATH_IMAGE018
分别如式(2)和式(3)所示:It can be seen from this that the lane change duration corresponding to the lane change trajectory
Figure 504677DEST_PATH_IMAGE016
is twice the lateral acceleration peak-to-peak time difference
Figure 336367DEST_PATH_IMAGE011
, so the lane change time starts
Figure 841298DEST_PATH_IMAGE017
and end of lane change time
Figure 670714DEST_PATH_IMAGE018
As shown in formula (2) and formula (3) respectively:

Figure 526674DEST_PATH_IMAGE019
(2)
Figure 526674DEST_PATH_IMAGE019
(2)

Figure 896476DEST_PATH_IMAGE020
(3)
Figure 896476DEST_PATH_IMAGE020
(3)

其中,

Figure 521492DEST_PATH_IMAGE021
为取最小值符号,
Figure 521809DEST_PATH_IMAGE022
为取最大值符号。in,
Figure 521492DEST_PATH_IMAGE021
To take the minimum sign,
Figure 521809DEST_PATH_IMAGE022
for the maximum value sign.

举例来说,如图2和图3所示,图2中的(a)至(c)分别为自然驾驶轨迹集HighD中提取的向左的换道轨迹、侧向速度和侧向加速度的变化规律;图3中的(a)至(c)分别为自然驾驶轨迹集HighD中提取的向右的换道轨迹、侧向速度和侧向加速度的变化规律。在图2和图3中,换道起点和换道终点即对应于式(2)和式(3)中所提到的

Figure 396224DEST_PATH_IMAGE017
Figure 38558DEST_PATH_IMAGE023
,侧向加速度峰-峰值对应的时间点即为
Figure 721343DEST_PATH_IMAGE024
Figure 423720DEST_PATH_IMAGE025
。由图2和图3可知,该换道轨迹提取方法可以准确而完整的从自然驾驶数据集中提取出换道轨迹,为下一步的换道时长预测建模奠定了可靠的数据基础。For example, as shown in Fig. 2 and Fig. 3, (a) to (c) in Fig. 2 are the leftward lane changing trajectory, lateral speed and lateral acceleration extracted from the natural driving trajectory set HighD, respectively. (a) to (c) in Figure 3 are the changing laws of the right lane-changing trajectory, lateral speed and lateral acceleration extracted from the natural driving trajectory set HighD. In Figure 2 and Figure 3, the lane change start point and lane change end point correspond to the equations (2) and (3) mentioned in
Figure 396224DEST_PATH_IMAGE017
and
Figure 38558DEST_PATH_IMAGE023
, the time point corresponding to the peak-to-peak value of lateral acceleration is
Figure 721343DEST_PATH_IMAGE024
and
Figure 423720DEST_PATH_IMAGE025
. It can be seen from Figures 2 and 3 that the lane-changing trajectory extraction method can accurately and completely extract the lane-changing trajectory from the natural driving data set, which lays a reliable data foundation for the next lane-changing duration prediction modeling.

在步骤S102中,获取换道车辆的周车运动信息,并根据所述周车运动信息建立多车影响下的车辆换道纵向运动学模型,以及将所述周车的影响表征为周车运动学参数对换道车辆的平均纵向加速度的非线性映射,进而获得训练好的多车影响下的换道时长预测模型和辨识获得的模型参数。在具体应用中,可以采用无人机获得换道车辆周围车辆的运动信息,例如,获取德国自然驾驶数据集HighD中的数据;也可由路侧相机获得换道车辆周围车辆的运动信息,例如,获取美国自然驾驶数据集NGSIM中的数据。In step S102 , obtain the information of the cyclic vehicle movement of the lane-changing vehicle, establish a longitudinal kinematics model of the vehicle under the influence of multiple vehicles according to the information of the cyclic vehicle movement, and characterize the influence of the cyclic vehicle as the movement of the surrounding vehicles The nonlinear mapping of the learning parameters to the average longitudinal acceleration of the lane-changing vehicle is obtained, and then the trained lane-changing duration prediction model under the influence of multiple vehicles and the model parameters obtained by identification are obtained. In specific applications, the UAV can be used to obtain the motion information of vehicles around the lane-changing vehicle, for example, the data in the German natural driving data set HighD; the motion information of the vehicles around the lane-changing vehicle can also be obtained by the roadside camera, for example, Get data from the US Natural Driving Dataset NGSIM.

在一个具体示例中,获得训练好的多车影响下的换道时长预测模型和辨识获得的模型参数,包括:对所述换道车辆的平均纵向加速度进行加速度修正,得到修正后的平均纵向加速度,将所述周车的影响表征为周车运动学参数对换道车辆的所述平均纵向加速度的非线性映射;根据所述多车影响下的车辆换道纵向运动学模型和所述周车的影响表征为周车运动学参数对换道车辆的所述平均纵向加速度的非线性映射,得到所述多车影响下的换道时长预测模型和辨识获得的模型参数。In a specific example, obtaining the trained lane-changing duration prediction model under the influence of multiple vehicles and the model parameters obtained by identification includes: performing acceleration correction on the average longitudinal acceleration of the lane-changing vehicle to obtain the corrected average longitudinal acceleration , the influence of the lap car is represented as the nonlinear mapping of the kinematic parameters of the lap car to the average longitudinal acceleration of the lane-changing vehicle; The influence of is characterized by the nonlinear mapping of the kinematic parameters of the surrounding vehicles to the average longitudinal acceleration of the lane-changing vehicle, and the lane-changing duration prediction model under the influence of the multi-vehicle and the model parameters obtained by identification are obtained.

可以理解的是,在理想的驾驶员假设下,驾驶员换道是为了追求更高的行驶速度,因此在不考虑周车影响的换道过程中,驾驶员倾向于保持匀速或加速换道,以快速实现车道的变换和行驶效率的提升,而在复杂行车环境中,驾驶员的换道行为不得不考虑周车的影响,而周车对自车换道纵向驾驶行为的影响,需通过自车驾驶员的应激反应产生。因此,本申请实施例可以将车辆周边的预设范围内的其他车辆的影响等效为对自车平均纵向加速度

Figure 191956DEST_PATH_IMAGE026
的影响,等效系数
Figure 903560DEST_PATH_IMAGE027
(即影响值)与车辆周边的预设范围内的其他车辆状态之间的非线性映射关系,可用式(4)表述:It can be understood that under the ideal driver assumption, the driver changes lanes to pursue higher driving speeds, so in the process of changing lanes without considering the influence of the surrounding vehicles, the driver tends to keep a constant speed or accelerate to change lanes. In order to quickly realize lane change and improve driving efficiency, in a complex driving environment, the driver's lane-changing behavior has to consider the influence of the surrounding vehicles, and the influence of the surrounding vehicles on the longitudinal driving behavior of the own vehicle's lane-changing needs to be determined by self-driving. The driver's stress response is generated. Therefore, in the embodiment of the present application, the influence of other vehicles within a preset range around the vehicle may be equivalent to the average longitudinal acceleration of the own vehicle
Figure 191956DEST_PATH_IMAGE026
The effect of the equivalence factor
Figure 903560DEST_PATH_IMAGE027
(that is, the influence value) and the non-linear mapping relationship between other vehicle states within the preset range around the vehicle, which can be expressed by equation (4):

Figure 503169DEST_PATH_IMAGE028
(4)
Figure 503169DEST_PATH_IMAGE028
(4)

其中,式(4)的非线性映射的一种可行方案为式(5)和式(6)的回归模型方案。式(5)和式(6)中,

Figure 845288DEST_PATH_IMAGE029
Figure 897558DEST_PATH_IMAGE030
Figure 412853DEST_PATH_IMAGE031
均为回归系数,可根据实际换道轨迹(即步骤S101中提取到的换道轨迹)进行标定:Among them, a feasible scheme of the nonlinear mapping of formula (4) is the regression model scheme of formula (5) and formula (6). In formula (5) and formula (6),
Figure 845288DEST_PATH_IMAGE029
,
Figure 897558DEST_PATH_IMAGE030
and
Figure 412853DEST_PATH_IMAGE031
are regression coefficients, which can be calibrated according to the actual lane-changing trajectory (that is, the lane-changing trajectory extracted in step S101 ):

Figure 866968DEST_PATH_IMAGE032
(5)
Figure 866968DEST_PATH_IMAGE032
(5)

Figure 645568DEST_PATH_IMAGE033
(6)
Figure 645568DEST_PATH_IMAGE033
(6)

进一步地,本申请实施例根据周车的影响对自车平均纵向加速度进行加速度修正时,平均纵向加速度

Figure 388396DEST_PATH_IMAGE026
的获取方式可以如图4所示,平均纵向加速度
Figure 910644DEST_PATH_IMAGE026
可以使用如式(7)所示的数学公式进行量化的表达:Further, when the embodiment of the present application performs acceleration correction on the average longitudinal acceleration of the own vehicle according to the influence of the surrounding vehicles, the average longitudinal acceleration is
Figure 388396DEST_PATH_IMAGE026
The acquisition method can be shown in Figure 4, the average longitudinal acceleration
Figure 910644DEST_PATH_IMAGE026
It can be expressed quantitatively using the mathematical formula shown in equation (7):

Figure 219266DEST_PATH_IMAGE034
(7)
Figure 219266DEST_PATH_IMAGE034
(7)

式(7)中,

Figure 965505DEST_PATH_IMAGE035
为与车辆周边的预设范围内的其他车辆运动状态相关的等效系数,
Figure 726788DEST_PATH_IMAGE036
为理想条件下,只考虑换道效率收益的预期纵向加速度,
Figure 787148DEST_PATH_IMAGE036
的定义可以如式(8)所示:In formula (7),
Figure 965505DEST_PATH_IMAGE035
is the equivalent coefficient related to other vehicle motion states within the preset range around the vehicle,
Figure 726788DEST_PATH_IMAGE036
Under ideal conditions, only considering the expected longitudinal acceleration of lane change efficiency gains,
Figure 787148DEST_PATH_IMAGE036
The definition of can be shown in formula (8):

Figure 950276DEST_PATH_IMAGE037
(8)
Figure 950276DEST_PATH_IMAGE037
(8)

式(8)中,

Figure 867416DEST_PATH_IMAGE038
为目标车道的预期行驶速度,在理想驾驶员假设前提下,驾驶员换道是为了追求更高的行驶效率,因此,
Figure 115995DEST_PATH_IMAGE039
,车辆在换道过程应快速的实现纵向行驶速度的提升,而换道过程中,驾驶员又不得不考虑与周车的交互,在与周车的交互博弈过程中,采取的最终实际纵向加速度是与周车博弈的结果,周车的影响主要体现在式(7)所示的影响值
Figure 980046DEST_PATH_IMAGE040
中。In formula (8),
Figure 867416DEST_PATH_IMAGE038
is the expected driving speed of the target lane. Under the assumption of an ideal driver, the driver changes lanes to pursue higher driving efficiency. Therefore,
Figure 115995DEST_PATH_IMAGE039
, the vehicle should quickly increase the longitudinal driving speed during the lane change process, and during the lane change process, the driver has to consider the interaction with the car, and in the interactive game process with the car, the final actual longitudinal acceleration taken is the result of the game with Zhou Che, and the influence of Zhou Che is mainly reflected in the influence value shown in formula (7).
Figure 980046DEST_PATH_IMAGE040
middle.

由此,即可根据如式(9)所示的车辆换道纵向运动学模型等得到训练好的多车影响下的换道时长预测模型。In this way, the trained lane-changing duration prediction model under the influence of multiple vehicles can be obtained according to the vehicle lane-changing longitudinal kinematics model as shown in Equation (9).

Figure 794418DEST_PATH_IMAGE041
(9)
Figure 794418DEST_PATH_IMAGE041
(9)

可选地,在一些实施例中,通过求解式(9)所示的一元二次方程,并剔除负数解,即可得到换道时长预测模型为:Optionally, in some embodiments, by solving the one-dimensional quadratic equation shown in equation (9) and excluding negative solutions, the lane-changing duration prediction model can be obtained as:

Figure 351301DEST_PATH_IMAGE042
Figure 351301DEST_PATH_IMAGE042
,

其中,

Figure 821597DEST_PATH_IMAGE002
为自车的换道时长,
Figure 20497DEST_PATH_IMAGE043
为所述自车预期换道纵向位移、
Figure 158217DEST_PATH_IMAGE004
为所述自车平均纵向加速度,
Figure 886002DEST_PATH_IMAGE005
为所述自车换道后在目标车道的预期车速。in,
Figure 821597DEST_PATH_IMAGE002
for the lane changing time of the vehicle,
Figure 20497DEST_PATH_IMAGE043
is the expected lane change longitudinal displacement of the ego vehicle,
Figure 158217DEST_PATH_IMAGE004
is the average longitudinal acceleration of the ego vehicle,
Figure 886002DEST_PATH_IMAGE005
The expected vehicle speed in the target lane after changing lanes for the ego vehicle.

需要说明的是,式(10)在

Figure 578014DEST_PATH_IMAGE044
的数学极限条件下,可求得不考虑纵向加速度时的换道时长
Figure 846184DEST_PATH_IMAGE002
。显然,在
Figure 838411DEST_PATH_IMAGE044
时,式(10)为
Figure 205939DEST_PATH_IMAGE045
型数学极限问题,利用洛必达法则同时求得分子分母对
Figure 916406DEST_PATH_IMAGE004
的导数,如式(11)所示:It should be noted that formula (10) is in
Figure 578014DEST_PATH_IMAGE044
Under the mathematical limit of , the lane change time can be obtained without considering the longitudinal acceleration
Figure 846184DEST_PATH_IMAGE002
. Obviously, in
Figure 838411DEST_PATH_IMAGE044
When, formula (10) is
Figure 205939DEST_PATH_IMAGE045
type mathematical limit problem, using Lhobita's rule to simultaneously find the numerator and denominator pairs
Figure 916406DEST_PATH_IMAGE004
The derivative of , as shown in formula (11):

Figure 722688DEST_PATH_IMAGE046
(11)
Figure 722688DEST_PATH_IMAGE046
(11)

由式(11)可知,在换道时长

Figure 569421DEST_PATH_IMAGE002
的计算公式(10)中,自车平均纵向加速度
Figure 842270DEST_PATH_IMAGE004
趋向零时的解等于预期换道距离
Figure 774454DEST_PATH_IMAGE043
与换道后目标车道预期车速
Figure 587690DEST_PATH_IMAGE005
的比值,符合匀速运动运动学规律,说明传统的纵向匀速换道时长模型是本申请所提出的换道时长预测模型的特例。From Equation (11), it can be seen that when the lane change time
Figure 569421DEST_PATH_IMAGE002
In the calculation formula (10), the average longitudinal acceleration of the ego vehicle
Figure 842270DEST_PATH_IMAGE004
The solution towards zero is equal to the expected lane change distance
Figure 774454DEST_PATH_IMAGE043
and the expected speed of the target lane after the lane change
Figure 587690DEST_PATH_IMAGE005
The ratio of , conforms to the kinematics law of uniform motion, indicating that the traditional longitudinal uniform lane change duration model is a special case of the lane change duration prediction model proposed in this application.

需要说明的是,周车对自车平均纵向加速度的影响的非线性映射模型,不仅可用上述回归建模方法获得,在其他示例中,也可以由其他方式得到,例如:由神经网络模型、支持向量机模型、随机森林模型和深度学习模型等非参数化建模方法获得。It should be noted that the nonlinear mapping model of the influence of the surrounding car on the average longitudinal acceleration of the own vehicle can not only be obtained by the above regression modeling method, but also obtained by other methods in other examples, such as: neural network model, support Non-parametric modeling methods such as vector machine models, random forest models, and deep learning models are obtained.

在步骤S103中,在网联多车环境下的智能汽车应用所述换道时长预测模型进行决策的情况下,当下达换道指令时,基于预期换道纵向位移、所述智能汽车的纵向速度和换道后目标车道预期车速,结合所述智能汽车的周车信息,利用所述换道时长预测模型对所述智能汽车的换道时长进行优选,并根据优选获得的所述智能汽车的换道时长进行拟人化的轨迹规划,以实现所述智能汽车换道意图的准确实施。In step S103, in the case where the smart car in the network-connected multi-vehicle environment applies the lane-changing duration prediction model to make a decision, when a lane-changing command is issued, based on the expected longitudinal displacement of the lane-changing, the longitudinal speed of the smart car and the expected speed of the target lane after changing lanes, combined with the weekly traffic information of the smart car, using the lane-changing duration prediction model to optimize the lane-changing duration of the smart car, and based on the optimally obtained changes in the smart car. The anthropomorphic trajectory planning is carried out according to the lane duration, so as to realize the accurate implementation of the lane changing intention of the intelligent vehicle.

也就是说,当通过步骤S101和步骤S102得到换道时长预测模型之后,可以将该换道时长预测模型应用到智能车辆上进行自动且智能的换道控制。That is, after obtaining the lane-changing duration prediction model through steps S101 and S102, the lane-changing duration prediction model can be applied to the intelligent vehicle to perform automatic and intelligent lane-changing control.

应当理解的是,在网联多车环境下,智能汽车可以通过车载感知系统和V2X(Vehicle to X,车对外界的信息交换),其中,X可以为车、路和云,智能汽车才可通过感知系统的传感器(如激光雷达、毫米波雷达、相机、GPS和惯导等)和V2X通信设备获取周车运动信息,以便于对周围车辆运动产生的风险进行评估,从而为自车的换道决策提供准确的环境信息。It should be understood that in a networked multi-vehicle environment, a smart car can use the in-vehicle perception system and V2X (Vehicle to X, vehicle-to-external information exchange), where X can be a car, road, and cloud, and a smart car can Through the sensors of the perception system (such as lidar, millimeter-wave radar, camera, GPS and inertial navigation, etc.) and V2X communication equipment to obtain information on the movement of vehicles around, in order to assess the risks caused by the movement of surrounding vehicles, so as to provide the replacement for the vehicle. Road decisions provide accurate environmental information.

因此,在智能汽车的换道意图模块和换道决策模块下达换道指令时,基于预期换道纵向位移、自车平均纵向加速度和换道后目标车道预期车速,结合智能汽车感知系统和V2X设备获取的周车信息,利用所述换道时长预测模型对所述智能汽车的换道时长进行优选,并根据优选获得的所述智能汽车的换道时长进行拟人化的轨迹规划,以实现所述智能汽车换道意图的准确实施。Therefore, when the lane change intention module and the lane change decision module of the intelligent car issue a lane change command, based on the expected lane change longitudinal displacement, the average longitudinal acceleration of the ego vehicle and the expected speed of the target lane after the lane change, combined with the intelligent vehicle perception system and V2X equipment The obtained weekly vehicle information is used to optimize the lane-changing duration of the smart car by using the lane-changing duration prediction model, and anthropomorphic trajectory planning is performed according to the preferably obtained lane-changing duration of the smart car, so as to realize the described Accurate implementation of lane-changing intent in smart cars.

其中,所述预期换道纵向位移是根据纵向位置、纵向速度和纵向加速度状态函数确定的。Wherein, the expected lane change longitudinal displacement is determined according to the longitudinal position, longitudinal velocity and longitudinal acceleration state functions.

具体地,如图5所示,在换道过程中,本申请实施例可以考虑的周围车辆分别是来自当前车道的前后车和目标车道的前后车,图5中,1号车为当前车道前车,2号车为当前车道后车,3号车为目标车道后车,4号车为目标车道前车,

Figure 554509DEST_PATH_IMAGE047
为各车的纵向位置、纵向速度和纵向加速度状态函数。Specifically, as shown in FIG. 5 , in the process of changing lanes, the surrounding vehicles that can be considered in the embodiment of the present application are the front and rear vehicles from the current lane and the front and rear vehicles from the target lane, respectively. car, car No. 2 is the car behind the current lane, car No. 3 is the car behind the target lane, car No. 4 is the car in front of the target lane,
Figure 554509DEST_PATH_IMAGE047
It is the state function of longitudinal position, longitudinal velocity and longitudinal acceleration of each vehicle.

由此,解决了相关智能汽车技术中,未能充分量化评估周围车辆对自车换道过程中纵向驾驶行为的影响,而导致的换道时长决策合理性不足、可解释性差和可能存在的安全风险的问题,充分挖掘自然驾驶数据中优秀驾驶员的驾驶操纵规律,为智能汽车科学合理的换道决策提供参考,是智能汽车“学习人、模拟人、超越人和服务人”的拟人化决策理念在换道决策中的体现。This solves the problem of insufficient quantification and evaluation of the influence of surrounding vehicles on the longitudinal driving behavior during the lane changing process of the relevant smart car technology, resulting in insufficient rationality, poor interpretability and possible safety of lane change decision-making. The problem of risk, fully excavate the driving control laws of excellent drivers in the natural driving data, and provide a reference for intelligent vehicles to make scientific and reasonable lane changing decisions. The concept is reflected in the lane change decision.

为使得本领域技术人员进一步了解本申请实施例的智能汽车换道时长预测及拟人化轨迹规划方法,下面以自然驾驶数据集HighD为例进行详细说明。In order for those skilled in the art to further understand the lane changing duration prediction and anthropomorphic trajectory planning method of the smart car according to the embodiment of the present application, the following takes the natural driving data set HighD as an example for detailed description.

具体地,HighD数据集中的换道轨迹共5600多条,从中剔除多次变道的数据,并提取出换道过程中周车符合图5所示的环境的换道轨迹,从中随机选择1000条换道轨迹作为研究对象。Specifically, there are more than 5,600 lane-changing trajectories in the HighD data set, from which the data of multiple lane-changes are excluded, and the lane-changing trajectories that conform to the environment shown in Figure 5 during the lane-changing process are extracted, and 1,000 lane-changing trajectories are randomly selected. The lane change trajectory is used as the research object.

如图6所示,图6(a)至图6(c)分别是这些换道轨迹的纵向位移

Figure 326156DEST_PATH_IMAGE048
、纵向初始速度
Figure 11215DEST_PATH_IMAGE049
和平均等效纵向加速度
Figure 96982DEST_PATH_IMAGE050
的实测结果的统计分布图。由图6可知,纵向位移
Figure 918308DEST_PATH_IMAGE051
服从正态分布,换道过程纵向位移分布在
Figure 64119DEST_PATH_IMAGE052
的区间内。初始纵向速度
Figure 767632DEST_PATH_IMAGE049
呈双峰分布,且集中在
Figure 922670DEST_PATH_IMAGE053
的高速行驶区间内。由自车平均纵向加速度
Figure 332923DEST_PATH_IMAGE050
的分布特性可知,受到周车影响,换道过程可能产生平均加速度为负的场景,而在大部分场景下,驾驶员希望维持平均纵向加速度为零的工况,从而把更多的注意力放在顺利完成换道的横向驾驶行为上。As shown in Fig. 6, Fig. 6(a) to Fig. 6(c) are the longitudinal displacements of these lane changing trajectories respectively
Figure 326156DEST_PATH_IMAGE048
, longitudinal initial velocity
Figure 11215DEST_PATH_IMAGE049
and the mean equivalent longitudinal acceleration
Figure 96982DEST_PATH_IMAGE050
Statistical distribution of the measured results. It can be seen from Figure 6 that the longitudinal displacement
Figure 918308DEST_PATH_IMAGE051
It obeys a normal distribution, and the longitudinal displacement in the lane changing process is distributed in
Figure 64119DEST_PATH_IMAGE052
within the range. initial longitudinal velocity
Figure 767632DEST_PATH_IMAGE049
has a bimodal distribution and is concentrated in
Figure 922670DEST_PATH_IMAGE053
within the high-speed driving area. Average longitudinal acceleration by ego vehicle
Figure 332923DEST_PATH_IMAGE050
It can be seen from the distribution of On the lateral driving behavior that successfully completes the lane change.

进一步地,如图7所示,图7(a)和图7(b)分别为根据本申请预测获得的当前车辆的换道时长与初始实测换道轨迹对应的换道时长的对比的直方图和散点图,由统计直方图可知,换道时长服从对数正态分布,采用对数正态分布建立起预测换道时长的概率密度曲线与实测获得的换道时长的统计直方图具有高度的一致性,说明本申请预测得到的当前车辆的换道时长的精确性较高。由换道轨迹对应的换道时长与预测的当前车辆的换道时长的散点图对比可知,预测的换道时长均匀的分散在真实值两侧,说明建模的效果较好。Further, as shown in FIG. 7 , FIG. 7( a ) and FIG. 7( b ) are histograms of the comparison between the lane-changing duration of the current vehicle predicted according to the present application and the lane-changing duration corresponding to the initially measured lane-changing trajectory. and scatter plot, it can be seen from the statistical histogram that the lane-changing duration obeys the log-normal distribution, and the log-normal distribution is used to establish the probability density curve for predicting the lane-changing duration and the statistical histogram of the lane-changing duration obtained from the actual measurement. is consistent, indicating that the accuracy of the lane-changing duration of the current vehicle predicted by this application is relatively high. By comparing the scatter plot of the lane-changing duration corresponding to the lane-changing trajectory and the predicted lane-changing duration of the current vehicle, it can be seen that the predicted lane-changing duration is evenly dispersed on both sides of the actual value, indicating that the modeling effect is good.

综上,如图8所示,本申请首先从自然驾驶数据中提取完整的换道轨迹,并计算换道时长;其次是利用网联技术获取自车周围车辆的运动学参数,为周车影响下的量化评估提供数据;最后是换道时长建模,在给定换道纵向距离、纵向速度的前提下,结合周车影响下的纵向加速度,可直接由运动学模型求解出换道时长的预测值(利用换道时长预测模型得到的当前车辆的换道时长)。To sum up, as shown in Figure 8, the application first extracts the complete lane-changing trajectory from the natural driving data, and calculates the lane-changing duration; secondly, the kinematic parameters of the vehicles around the self-vehicle are obtained by using the network connection technology, which is the influence of the surrounding vehicles. Provide data for the quantitative evaluation under Predicted value (the lane-changing duration of the current vehicle obtained using the lane-changing duration prediction model).

根据本申请实施例提出的智能汽车换道时长预测及拟人化轨迹规划方法,可以从大量的驾驶员的自然驾驶数据中提取出优秀驾驶员的换道轨迹,并由优秀驾驶员的换道轨迹提取真实多车影响下的优秀驾驶员换道时长,然后,获取换道车辆的周车运动信息,并根据周车运动信息建立多车影响下的车辆换道纵向运动学模型,将周车的影响表征为周车运动学参数对换道车辆的平均纵向加速度的非线性映射,进而能够获得多车影响下的换道时长预测模型,这样,当该换道时长预测模型应用到网联多车环境下的智能汽车之后,该智能汽车便可以根据预期换道纵向位移、智能汽车的纵向速度和换道后目标车道预期车速等,结合智能汽车的周车信息,利用换道时长预测模型对智能汽车的换道时长进行优选,进而,可以根据优选获得的智能汽车的换道时长进行拟人化的轨迹规划,以实现所述智能汽车换道意图的准确实施。由此,解决了相关智能汽车技术中,未能充分量化评估周围车辆对自车换道过程中纵向驾驶行为的影响,而导致的换道时长决策合理性不足、可解释性差和可能存在的安全风险的问题,本发明的实施例,充分挖掘大量驾驶员的自然驾驶数据中优秀驾驶员的驾驶操纵规律,为智能汽车科学合理的换道决策提供参考,使智能汽车的换道过程更为合理,进而提升智能汽车的安全性和可靠性,是智能汽车“学习人、模拟人、超越人和服务人”的拟人化决策理念在换道决策中的体现。According to the method for predicting the lane-changing duration and anthropomorphic trajectory planning of a smart car proposed in the embodiment of the present application, the lane-changing trajectory of an excellent driver can be extracted from a large number of natural driving data of drivers, and the lane-changing trajectory of the excellent driver can be extracted from the lane-changing trajectory of the excellent driver. Extract the lane-changing duration of excellent drivers under the influence of real multi-vehicles, and then obtain the traffic information of the vehicles changing lanes. The influence is represented by the nonlinear mapping of the kinematic parameters of the surrounding vehicles to the average longitudinal acceleration of the lane-changing vehicles, and then the prediction model of the lane-changing duration under the influence of multiple vehicles can be obtained. After the smart car in the environment, the smart car can use the lane-changing duration prediction model to predict the intelligent car according to the expected longitudinal displacement of the lane change, the longitudinal speed of the smart car and the expected speed of the target lane after the lane change, etc. The lane-changing duration of the car is optimized, and further, anthropomorphic trajectory planning can be performed according to the lane-changing duration of the smart car obtained by optimization, so as to realize the accurate implementation of the lane-changing intention of the smart car. This solves the problem of insufficient quantification and evaluation of the influence of surrounding vehicles on the longitudinal driving behavior during the lane changing process of the relevant smart car technology, resulting in insufficient rationality, poor interpretability and possible safety of lane change decision-making. To solve the problem of risk, the embodiment of the present invention fully excavates the driving and maneuvering rules of excellent drivers in the natural driving data of a large number of drivers, provides a reference for intelligent vehicles to make scientific and reasonable lane-changing decisions, and makes the lane-changing process of intelligent vehicles more reasonable. , and then improve the safety and reliability of smart cars, which is the embodiment of the anthropomorphic decision-making concept of smart cars "learning, simulating, surpassing and serving people" in lane-changing decision-making.

其次参照附图描述根据本申请实施例提出的智能汽车换道时长预测及拟人化轨迹规划装置。Next, the device for predicting the lane changing duration and anthropomorphic trajectory planning of a smart car according to the embodiments of the present application will be described with reference to the accompanying drawings.

图9是本申请实施例的智能汽车换道时长预测及拟人化轨迹规划装置的方框示意图。FIG. 9 is a schematic block diagram of an apparatus for predicting the lane changing duration and anthropomorphic trajectory planning of an intelligent vehicle according to an embodiment of the present application.

如图9所示,该智能汽车换道时长预测及拟人化轨迹规划装置10包括:提取模块100、生成模块200和换道轨迹规划模块300。As shown in FIG. 9 , the intelligent vehicle lane change duration prediction and anthropomorphic trajectory planning device 10 includes an extraction module 100 , a generation module 200 and a lane change trajectory planning module 300 .

其中,提取模块100用于从若干驾驶员的自然驾驶数据中提取优秀驾驶员的换道轨迹,并由所述优秀驾驶员的换道轨迹提取真实多车影响下的优秀驾驶员换道时长;Wherein, the extraction module 100 is used for extracting the lane-changing trajectory of the excellent driver from the natural driving data of several drivers, and extracting the lane-changing duration of the excellent driver under the influence of the real multi-vehicle from the lane-changing trajectory of the excellent driver;

生成模块200用于获取换道车辆的周车运动信息,并根据所述周车运动信息建立多车影响下的车辆换道纵向运动学模型,以及将所述周车的影响表征为周车运动学参数对换道车辆的平均纵向加速度的非线性映射,进而获得训练好的多车影响下的换道时长预测模型和辨识获得的模型参数;以及The generation module 200 is used to obtain the information of the lane-changing vehicle's movement around the vehicle, establish a longitudinal kinematics model of the vehicle lane-changing under the influence of multiple vehicles according to the information on the movement of the vehicle around the vehicle, and characterize the influence of the vehicle as the movement of the vehicle. The nonlinear mapping of the learning parameters to the average longitudinal acceleration of the lane-changing vehicle, and then the trained lane-changing duration prediction model under the influence of multiple vehicles and the model parameters obtained by identification are obtained; and

换道轨迹规划模块300用于在网联多车环境下的所述智能汽车应用所述换道时长预测模型进行决策的情况下,当下达换道指令时,基于预期换道纵向位移、所述智能汽车的纵向速度和换道后目标车道预期车速,结合所述智能汽车的周车信息,利用所述换道时长预测模型对所述智能汽车的换道时长进行优选,并根据优选获得的所述智能汽车的换道时长进行拟人化的轨迹规划,以实现所述智能汽车换道意图的准确实施。The lane-changing trajectory planning module 300 is configured to, in the case where the smart car in the network-connected multi-vehicle environment applies the lane-changing duration prediction model to make a decision, when a lane-changing command is issued, based on the expected lane-changing longitudinal displacement, the The longitudinal speed of the smart car and the expected speed of the target lane after changing lanes, combined with the weekly traffic information of the smart car, the lane-changing duration prediction model is used to optimize the lane-changing duration of the smart car, and according to the obtained An anthropomorphic trajectory planning is carried out according to the lane-changing duration of the intelligent vehicle, so as to realize the accurate implementation of the lane-changing intention of the intelligent vehicle.

可选地,提取模块100具体用于:Optionally, the extraction module 100 is specifically used for:

计算所述优秀驾驶员的换道轨迹的朝向角;calculating the heading angle of the lane-changing trajectory of the excellent driver;

基于所述朝向角从所述自然驾驶数据中确定峰值点,并且由所述峰值点向两边搜索,得到满足预设条件的时间点;Determine a peak point from the natural driving data based on the heading angle, and search both sides from the peak point to obtain a time point that satisfies a preset condition;

由所述时间点匹配对应的换道轨迹的初始区间;matching the initial interval of the corresponding lane-changing trajectory by the time point;

根据所述初始区间计算所述换道轨迹侧向加速度峰-峰值时间差,并基于所述时间差计算侧向加速度取得最大值和最小值时对应的时间点,得到所述换道轨迹在真实多车影响下的优秀驾驶员换道时长。Calculate the peak-to-peak time difference of the lateral acceleration of the lane-changing trajectory according to the initial interval, and calculate the corresponding time points when the lateral acceleration obtains the maximum value and the minimum value based on the time difference, and obtain the lane-changing trajectory in the real multi-vehicle. A good driver's lane-changing time under the influence.

可选地,生成模块200具体用于:Optionally, the generating module 200 is specifically used for:

对所述换道车辆的平均纵向加速度进行加速度修正,得到修正后的平均纵向加速度,将所述周车的影响表征为周车运动学参数对换道车辆的所述平均纵向加速度的非线性映射;Acceleration correction is performed on the average longitudinal acceleration of the lane-changing vehicle to obtain the corrected average longitudinal acceleration, and the influence of the surrounding car is characterized as a nonlinear mapping of the kinematic parameters of the surrounding vehicle to the average longitudinal acceleration of the lane-changing vehicle ;

根据所述多车影响下的车辆换道纵向运动学模型和所述周车的影响表征为周车运动学参数对换道车辆的所述平均纵向加速度的非线性映射,得到所述多车影响下的换道时长预测模型和辨识获得的模型参数。According to the vehicle lane-changing longitudinal kinematics model under the influence of the multi-vehicle and the influence of the circling vehicle, which is characterized as a nonlinear mapping of the kinematic parameters of the circling vehicle to the average longitudinal acceleration of the lane-changing vehicle, the multi-vehicle influence is obtained. The lane-changing duration prediction model and the model parameters obtained by identification.

可选地,所述换道时长预测模型为:Optionally, the lane change duration prediction model is:

Figure 915214DEST_PATH_IMAGE042
Figure 915214DEST_PATH_IMAGE042
,

其中,

Figure 106024DEST_PATH_IMAGE002
为自车的换道时长,
Figure 799173DEST_PATH_IMAGE003
为所述自车预期换道纵向位移、
Figure 329512DEST_PATH_IMAGE004
为所述自车平均纵向加速度,
Figure 879442DEST_PATH_IMAGE005
为所述自车换道后在目标车道的预期车速。in,
Figure 106024DEST_PATH_IMAGE002
for the lane changing time of the vehicle,
Figure 799173DEST_PATH_IMAGE003
is the expected lane change longitudinal displacement of the ego vehicle,
Figure 329512DEST_PATH_IMAGE004
is the average longitudinal acceleration of the ego vehicle,
Figure 879442DEST_PATH_IMAGE005
The expected vehicle speed in the target lane after changing lanes for the ego vehicle.

可选地,所述预期换道纵向位移是根据纵向位置、纵向速度和纵向加速度状态函数确定的。Optionally, the expected lane change longitudinal displacement is determined from a longitudinal position, longitudinal velocity and longitudinal acceleration state function.

需要说明的是,前述对智能汽车换道时长预测及拟人化轨迹规划方法实施例的解释说明也适用于该实施例的智能汽车换道时长预测及拟人化轨迹规划装置,此处不再赘述。It should be noted that the foregoing explanations of the embodiment of the method for predicting the lane-changing duration and anthropomorphic trajectory planning of a smart car are also applicable to the device for predicting the lane-changing duration and anthropomorphic trajectory planning of a smart car in this embodiment, which will not be repeated here.

根据本申请实施例提出的智能汽车换道时长预测及拟人化轨迹规划装置,可以从大量的驾驶员的自然驾驶数据中提取出优秀驾驶员的换道轨迹,并由优秀驾驶员的换道轨迹提取真实多车影响下的优秀驾驶员换道时长,然后,获取换道车辆的周车运动信息,并根据周车运动信息建立多车影响下的车辆换道纵向运动学模型,将周车的影响表征为周车运动学参数对换道车辆的平均纵向加速度的非线性映射,进而能够获得多车影响下的换道时长预测模型,这样,当该换道时长预测模型应用到网联多车环境下的智能汽车之后,该智能汽车便可以根据预期换道纵向位移、智能汽车的纵向速度和换道后目标车道预期车速等,结合智能汽车的周车信息,利用换道时长预测模型对智能汽车的换道时长进行优选,进而,可以根据优选获得的智能汽车的换道时长进行拟人化的轨迹规划,以实现所述智能汽车换道意图的准确实施。由此,解决了相关智能汽车技术中,未能充分量化评估周围车辆对自车换道过程中纵向驾驶行为的影响,而导致的换道时长决策合理性不足、可解释性差和可能存在的安全风险的问题,本发明的实施例,充分挖掘大量驾驶员的自然驾驶数据中优秀驾驶员的驾驶操纵规律,为智能汽车科学合理的换道决策提供参考,使智能汽车的换道过程更为合理,进而提升智能汽车的安全性和可靠性,是智能汽车“学习人、模拟人、超越人和服务人”的拟人化决策理念在换道决策中的体现。According to the device for predicting the lane-changing duration and anthropomorphic trajectory planning of a smart car proposed in the embodiment of the present application, the lane-changing trajectory of an excellent driver can be extracted from a large number of natural driving data of drivers, and the lane-changing trajectory of the excellent driver can be extracted from the lane-changing trajectory of the excellent driver. Extract the lane-changing duration of excellent drivers under the influence of real multi-vehicles, and then obtain the traffic information of the vehicles changing lanes. The influence is represented by the nonlinear mapping of the kinematic parameters of the surrounding vehicles to the average longitudinal acceleration of the lane-changing vehicles, and then the prediction model of the lane-changing duration under the influence of multiple vehicles can be obtained. After the smart car in the environment, the smart car can use the lane-changing duration prediction model to predict the intelligent car according to the expected longitudinal displacement of the lane change, the longitudinal speed of the smart car and the expected speed of the target lane after the lane change, etc. The lane-changing duration of the car is optimized, and further, anthropomorphic trajectory planning can be performed according to the lane-changing duration of the smart car obtained by optimization, so as to realize the accurate implementation of the lane-changing intention of the smart car. This solves the problem of insufficient quantification and evaluation of the influence of surrounding vehicles on the longitudinal driving behavior during the lane changing process of the relevant smart car technology, resulting in insufficient rationality, poor interpretability and possible safety of lane change decision-making. To solve the problem of risk, the embodiment of the present invention fully excavates the driving and maneuvering rules of excellent drivers in the natural driving data of a large number of drivers, provides a reference for intelligent vehicles to make scientific and reasonable lane-changing decisions, and makes the lane-changing process of intelligent vehicles more reasonable. , and then improve the safety and reliability of smart cars, which is the embodiment of the anthropomorphic decision-making concept of smart cars "learning, simulating, surpassing and serving people" in lane-changing decision-making.

另外,本申请实施例提供一种智能汽车换道轨迹决策设备,包括:换道意图识别模块和换道轨迹规划模块,其中,如上述任意一个实施例所述的智能汽车换道时长预测及拟人化轨迹规划方法服务于所述换道意图识别模块和换道轨迹规划模块。In addition, an embodiment of the present application provides an intelligent vehicle lane-changing trajectory decision-making device, including: a lane-changing intention recognition module and a lane-changing trajectory planning module, wherein the lane-changing duration prediction and anthropomorphic method of the intelligent vehicle described in any one of the above embodiments The integrated trajectory planning method serves the lane change intention identification module and the lane change trajectory planning module.

此外,本申请第四方面实施例提供一种换道轨迹跟踪模块,其上存储有计算机程序,其特征在于,该程序被处理器执行,以用于实现上述的智能汽车换道时长预测及拟人化轨迹规划方法。In addition, an embodiment of the fourth aspect of the present application provides a lane-changing trajectory tracking module, on which a computer program is stored, characterized in that the program is executed by a processor, so as to realize the above-mentioned intelligent vehicle lane-changing duration prediction and anthropomorphism method for trajectory planning.

在本说明书的描述中,参考术语“一个实施例”、“一些实施例”、“示例”、“具体示例”、或“一些示例”等的描述意指结合该实施例或示例描述的具体特征、结构、材料或者特点包含于本申请的至少一个实施例或示例中。在本说明书中,对上述术语的示意性表述不必须针对的是相同的实施例或示例。而且,描述的具体特征、结构、材料或者特点可以在任一个或N个实施例或示例中以合适的方式结合。此外,在不相互矛盾的情况下,本领域的技术人员可以将本说明书中描述的不同实施例或示例以及不同实施例或示例的特征进行结合和组合。In the description of this specification, description with reference to the terms "one embodiment," "some embodiments," "example," "specific example," or "some examples", etc., mean specific features described in connection with the embodiment or example , structure, material or feature is included in at least one embodiment or example of the present application. In this specification, schematic representations of the above terms are not necessarily directed to the same embodiment or example. Furthermore, the particular features, structures, materials or characteristics described may be combined in any suitable manner in any one or N of the embodiments or examples. Furthermore, those skilled in the art may combine and combine the different embodiments or examples described in this specification, as well as the features of the different embodiments or examples, without conflicting each other.

此外,术语“第一”、“第二”仅用于描述目的,而不能理解为指示或暗示相对重要性或者隐含指明所指示的技术特征的数量。由此,限定有“第一”、“第二”的特征可以明示或者隐含地包括至少一个该特征。在本申请的描述中,“N个”的含义是至少两个,例如两个,三个等,除非另有明确具体的限定。In addition, the terms "first" and "second" are only used for descriptive purposes, and should not be construed as indicating or implying relative importance or implying the number of indicated technical features. Thus, a feature delimited with "first", "second" may expressly or implicitly include at least one of that feature. In the description of the present application, "N" means at least two, such as two, three, etc., unless otherwise expressly and specifically defined.

流程图中或在此以其他方式描述的任何过程或方法描述可以被理解为,表示包括一个或更N个用于实现定制逻辑功能或过程的步骤的可执行指令的代码的模块、片段或部分,并且本申请的优选实施方式的范围包括另外的实现,其中可以不按所示出或讨论的顺序,包括根据所涉及的功能按基本同时的方式或按相反的顺序,来执行功能,这应被本申请的实施例所属技术领域的技术人员所理解。Any process or method description in the flowchart or otherwise described herein may be understood to represent a module, segment or portion of code comprising one or N more executable instructions for implementing custom logical functions or steps of the process , and the scope of the preferred embodiments of the present application includes alternative implementations in which the functions may be performed out of the order shown or discussed, including performing the functions substantially concurrently or in the reverse order depending upon the functions involved, which should It is understood by those skilled in the art to which the embodiments of the present application belong.

在流程图中表示或在此以其他方式描述的逻辑和/或步骤,例如,可以被认为是用于实现逻辑功能的可执行指令的定序列表,可以具体实现在任何计算机可读介质中,以供指令执行系统、装置或设备(如基于计算机的系统、包括处理器的系统或其他可以从指令执行系统、装置或设备取指令并执行指令的系统)使用,或结合这些指令执行系统、装置或设备而使用。就本说明书而言,"计算机可读介质"可以是任何可以包含、存储、通信、传播或传输程序以供指令执行系统、装置或设备或结合这些指令执行系统、装置或设备而使用的装置。计算机可读介质的更具体的示例(非穷尽性列表)包括以下:具有一个或N个布线的电连接部(电子装置),便携式计算机盘盒(磁装置),随机存取存储器(RAM),只读存储器(ROM),可擦除可编辑只读存储器(EPROM或闪速存储器),光纤装置,以及便携式光盘只读存储器(CDROM)。另外,计算机可读介质甚至可以是可在其上打印所述程序的纸或其他合适的介质,因为可以例如通过对纸或其他介质进行光学扫描,接着进行编辑、解译或必要时以其他合适方式进行处理来以电子方式获得所述程序,然后将其存储在计算机存储器中。The logic and/or steps represented in flowcharts or otherwise described herein, for example, may be considered an ordered listing of executable instructions for implementing the logical functions, may be embodied in any computer-readable medium, For use with, or in conjunction with, an instruction execution system, apparatus, or device (such as a computer-based system, a system including a processor, or other system that can fetch instructions from and execute instructions from an instruction execution system, apparatus, or apparatus) or equipment. For the purposes of this specification, a "computer-readable medium" can be any device that can contain, store, communicate, propagate, or transport the program for use by or in connection with an instruction execution system, apparatus, or apparatus. More specific examples (non-exhaustive list) of computer readable media include the following: electrical connections (electronic devices) with one or N wires, portable computer disk cartridges (magnetic devices), random access memory (RAM), Read Only Memory (ROM), Erasable Editable Read Only Memory (EPROM or Flash Memory), Fiber Optic Devices, and Portable Compact Disc Read Only Memory (CDROM). In addition, the computer readable medium may even be paper or other suitable medium on which the program may be printed, as the paper or other medium may be optically scanned, for example, followed by editing, interpretation, or other suitable medium as necessary process to obtain the program electronically and then store it in computer memory.

应当理解,本申请的各部分可以用硬件、软件、固件或它们的组合来实现。在上述实施方式中,N个步骤或方法可以用存储在存储器中且由合适的指令执行系统执行的软件或固件来实现。如,如果用硬件来实现和在另一实施方式中一样,可用本领域公知的下列技术中的任一项或他们的组合来实现:具有用于对数据信号实现逻辑功能的逻辑门电路的离散逻辑电路,具有合适的组合逻辑门电路的专用集成电路,可编程门阵列(PGA),现场可编程门阵列(FPGA)等。It should be understood that various parts of this application may be implemented in hardware, software, firmware, or a combination thereof. In the above-described embodiments, the N steps or methods may be implemented in software or firmware stored in memory and executed by a suitable instruction execution system. For example, if implemented in hardware, as in another embodiment, it can be implemented by any one of the following techniques known in the art, or a combination thereof: discrete with logic gates for implementing logic functions on data signals Logic circuits, ASICs with suitable combinational logic gates, Programmable Gate Arrays (PGA), Field Programmable Gate Arrays (FPGA), etc.

本技术领域的普通技术人员可以理解实现上述实施例方法携带的全部或部分步骤是可以通过程序来指令相关的硬件完成,所述的程序可以存储于一种计算机可读存储介质中,该程序在执行时,包括方法实施例的步骤之一或其组合。Those of ordinary skill in the art can understand that all or part of the steps carried by the methods of the above embodiments can be completed by instructing the relevant hardware through a program, and the program can be stored in a computer-readable storage medium, and the program is stored in a computer-readable storage medium. When executed, one or a combination of the steps of the method embodiment is included.

此外,在本申请各个实施例中的各功能单元可以集成在一个处理模块中,也可以是各个单元单独物理存在,也可以两个或两个以上单元集成在一个模块中。上述集成的模块既可以采用硬件的形式实现,也可以采用软件功能模块的形式实现。所述集成的模块如果以软件功能模块的形式实现并作为独立的产品销售或使用时,也可以存储在一个计算机可读取存储介质中。In addition, each functional unit in each embodiment of the present application may be integrated into one processing module, or each unit may exist physically alone, or two or more units may be integrated into one module. The above-mentioned integrated modules can be implemented in the form of hardware, and can also be implemented in the form of software function modules. If the integrated modules are implemented in the form of software functional modules and sold or used as independent products, they may also be stored in a computer-readable storage medium.

上述提到的存储介质可以是只读存储器,磁盘或光盘等。尽管上面已经示出和描述了本申请的实施例,可以理解的是,上述实施例是示例性的,不能理解为对本申请的限制,本领域的普通技术人员在本申请的范围内可以对上述实施例进行变化、修改、替换和变型。The above-mentioned storage medium may be a read-only memory, a magnetic disk or an optical disk, and the like. Although the embodiments of the present application have been shown and described above, it should be understood that the above embodiments are exemplary and should not be construed as limitations to the present application. Embodiments are subject to variations, modifications, substitutions and variations.

Claims (9)

1. An intelligent automobile lane change duration prediction and anthropomorphic track planning method is characterized by comprising the following steps:
extracting a lane changing track of an excellent driver from natural driving data of a plurality of drivers, and extracting lane changing time length of the excellent driver under the influence of real multiple vehicles from the lane changing track of the excellent driver;
acquiring the vehicle-to-vehicle motion information of the lane-changing vehicle, establishing a vehicle lane-changing longitudinal kinematics model under the influence of multiple vehicles according to the vehicle-to-vehicle motion information, representing the influence of the vehicles as the nonlinear mapping of the vehicle-to-vehicle kinematics parameters to the average longitudinal acceleration of the lane-changing vehicle, and further acquiring the trained influence of the multiple vehiclesThe lane change duration prediction model and the model parameters obtained by identification are as follows:
Figure 822468DEST_PATH_IMAGE001
wherein
Figure 497163DEST_PATH_IMAGE002
in order to prolong the lane change time of the self vehicle,
Figure 20548DEST_PATH_IMAGE003
the lane change longitudinal displacement is expected for the self-vehicle,
Figure 450392DEST_PATH_IMAGE004
is the average longitudinal acceleration of the own vehicle,
Figure 629701DEST_PATH_IMAGE005
the expected speed of the vehicle in the target lane after the vehicle is changed;
under the condition that an intelligent automobile in a network multi-automobile environment uses the lane change duration prediction model to make a decision, when a lane change instruction is given, the lane change duration of the intelligent automobile is optimized by using the lane change duration prediction model based on the expected lane change longitudinal displacement, the longitudinal speed of the intelligent automobile and the expected speed of a target lane after lane change in combination with the week information of the intelligent automobile, and the lane change duration of the intelligent automobile is subjected to anthropomorphic track planning according to the lane change duration of the intelligent automobile obtained through optimization, so that the lane change intention of the intelligent automobile is accurately implemented.
2. The method according to claim 1, wherein the extracting of the lane change trajectory of the excellent driver from the natural driving data of several drivers and the extracting of the excellent driver lane change duration under the influence of real multi-vehicle from the excellent driver lane change trajectory comprises:
calculating an orientation angle of a lane change trajectory of the excellent driver;
determining a peak point from the natural driving data based on the orientation angle, and searching from the peak point to two sides to obtain a time point meeting a preset condition;
matching the initial interval of the corresponding lane changing track by the time point;
and calculating the peak-peak time difference of the lateral acceleration of the track changing track according to the initial interval, and calculating corresponding time points when the lateral acceleration obtains the maximum value and the minimum value based on the time difference to obtain the excellent track changing time of the driver under the influence of real multiple vehicles.
3. The method of claim 1, wherein the obtaining a trained lane change duration prediction model under the influence of multiple vehicles and identifying obtained model parameters comprises:
performing acceleration correction on the average longitudinal acceleration of the lane changing vehicle to obtain the corrected average longitudinal acceleration, and representing the influence of the week vehicle as nonlinear mapping of the kinetic parameters of the week vehicle on the average longitudinal acceleration of the lane changing vehicle;
and according to the longitudinal vehicle lane change kinematics model under the influence of the multiple vehicles and the influence characterization of the vehicles in the week, obtaining a lane change duration prediction model under the influence of the multiple vehicles and model parameters obtained by identification by nonlinear mapping of the vehicle lane change kinematics parameters to the average longitudinal acceleration of the lane change vehicle.
4. The method of claim 1, wherein the expected lane-change longitudinal displacement is determined as a function of longitudinal position, longitudinal velocity, and longitudinal acceleration state.
5. The utility model provides an intelligent automobile lane change duration prediction and anthropomorphic track planning device which characterized in that includes:
the extraction module is used for extracting a lane changing track of an excellent driver from natural driving data of a plurality of drivers and extracting the lane changing time length of the excellent driver under the influence of real multiple vehicles from the lane changing track of the excellent driver;
generatingThe module is used for acquiring the vehicle-to-vehicle motion information of a lane-changing vehicle, establishing a vehicle lane-changing longitudinal kinematic model under the influence of multiple vehicles according to the vehicle-to-vehicle motion information, representing the influence of the vehicles as the nonlinear mapping of the vehicle-to-vehicle kinematic parameters to the average longitudinal acceleration of the lane-changing vehicle, and further acquiring a trained lane-changing duration prediction model under the influence of the multiple vehicles and model parameters obtained by identification, wherein the lane-changing duration prediction model is as follows:
Figure 904824DEST_PATH_IMAGE001
wherein
Figure 984513DEST_PATH_IMAGE002
in order to prolong the lane change time of the self vehicle,
Figure 319680DEST_PATH_IMAGE003
the lane change longitudinal displacement is expected for the self-vehicle,
Figure 48601DEST_PATH_IMAGE004
is the average longitudinal acceleration of the own vehicle,
Figure 65099DEST_PATH_IMAGE005
the expected speed of the vehicle in the target lane after the vehicle is changed; and
and the lane change track planning module is used for optimizing the lane change time length of the intelligent automobile by using the lane change time length prediction model according to the lane change time length prediction model and the acquired lane change time length of the intelligent automobile according to the optimization when a lane change instruction is issued under the condition that the intelligent automobile applies the lane change time length prediction model to make a decision, and the lane change time length prediction model is combined with the week automobile information of the intelligent automobile, so that the accurate implementation of the lane change intention of the intelligent automobile is realized.
6. The apparatus according to claim 5, wherein the extraction module is specifically configured to:
calculating an orientation angle of a lane change trajectory of the excellent driver;
determining a peak point from the natural driving data based on the orientation angle, and searching from the peak point to two sides to obtain a time point meeting a preset condition;
matching the initial interval of the corresponding lane changing track by the time point;
and calculating the peak-peak time difference of the lateral acceleration of the track changing track according to the initial interval, and calculating corresponding time points when the lateral acceleration obtains the maximum value and the minimum value based on the time difference to obtain the excellent track changing time of the driver under the influence of real multiple vehicles.
7. The apparatus of claim 5, wherein the generating module is specifically configured to:
performing acceleration correction on the average longitudinal acceleration of the lane changing vehicle to obtain the corrected average longitudinal acceleration, and representing the influence of the week vehicle as nonlinear mapping of the kinetic parameters of the week vehicle on the average longitudinal acceleration of the lane changing vehicle;
and according to the longitudinal vehicle lane change kinematics model under the influence of the multiple vehicles and the influence characterization of the vehicles in the week, obtaining a lane change duration prediction model under the influence of the multiple vehicles and model parameters obtained by identification by nonlinear mapping of the vehicle lane change kinematics parameters to the average longitudinal acceleration of the lane change vehicle.
8. An intelligent automobile track change decision-making device is characterized by comprising: the lane change intention identification module and the lane change trajectory planning module, wherein the intelligent automobile lane change duration prediction and anthropomorphic trajectory planning method according to any one of claims 1-4 serves the lane change intention identification module and the lane change trajectory planning module.
9. A lane change trajectory tracking module, on which a computer program is stored, wherein the program is executed by a processor to implement the intelligent automobile lane change duration prediction and anthropomorphic trajectory planning method according to any one of claims 1-4.
CN202111237247.1A 2021-10-22 2021-10-22 Prediction of lane changing duration and anthropomorphic trajectory planning method for intelligent vehicles Active CN113665574B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202111237247.1A CN113665574B (en) 2021-10-22 2021-10-22 Prediction of lane changing duration and anthropomorphic trajectory planning method for intelligent vehicles

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202111237247.1A CN113665574B (en) 2021-10-22 2021-10-22 Prediction of lane changing duration and anthropomorphic trajectory planning method for intelligent vehicles

Publications (2)

Publication Number Publication Date
CN113665574A CN113665574A (en) 2021-11-19
CN113665574B true CN113665574B (en) 2022-01-11

Family

ID=78550986

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202111237247.1A Active CN113665574B (en) 2021-10-22 2021-10-22 Prediction of lane changing duration and anthropomorphic trajectory planning method for intelligent vehicles

Country Status (1)

Country Link
CN (1) CN113665574B (en)

Families Citing this family (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114169371B (en) * 2021-12-09 2024-05-14 合肥工业大学智能制造技术研究院 Driving style classification method considering risk potential field distribution under vehicle lane change working condition
CN114056332B (en) * 2022-01-14 2022-04-12 清华大学 Intelligent vehicle following decision and control method based on cognitive risk balance
CN114633750B (en) * 2022-03-29 2024-08-02 山东交通学院 A lane-changing process extraction and lane-changing characteristics analysis method based on unsupervised technology
CN114475607B (en) * 2022-04-13 2022-07-12 清华大学 Method and device for changing lanes for automatic driving vehicle, vehicle and storage medium
CN114475608B (en) * 2022-04-13 2022-07-12 清华大学 Humanized lane changing method, device, vehicle and storage medium for autonomous vehicle
CN115050183B (en) * 2022-06-09 2023-07-25 上海人工智能创新中心 Method for generating simulated traffic flow
CN115257741B (en) * 2022-06-29 2025-02-25 东风汽车集团股份有限公司 Self-learning lane-changing decision control system based on driver habits
CN115195748A (en) * 2022-08-15 2022-10-18 中汽研(天津)汽车工程研究院有限公司 Data-driven intelligent automobile personification decision planning system and method
CN115830886B (en) * 2023-02-09 2023-05-12 西南交通大学 Calculation method, device, equipment and medium for time series calculation of coordinated lane change of intelligent networked vehicles

Family Cites Families (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103754221B (en) * 2014-01-24 2017-05-24 清华大学 Vehicle adaptive cruise control system
JP6986239B2 (en) * 2016-08-25 2021-12-22 スズキ株式会社 Vehicle driving control device
JP2018030479A (en) * 2016-08-25 2018-03-01 スズキ株式会社 Travel control device of vehicle
CN109739218A (en) * 2018-12-24 2019-05-10 江苏大学 A method for establishing a lane-changing model based on GRU network for imitating excellent drivers
CN110576864A (en) * 2019-08-15 2019-12-17 中国第一汽车股份有限公司 driving mode control method and device, vehicle and storage medium
CN110936958B (en) * 2019-11-26 2021-01-19 交通运输部公路科学研究所 Lane change trajectory optimization method and system for autonomous driving
CN111009153B (en) * 2019-12-04 2021-10-15 珠海深圳清华大学研究院创新中心 Training method, device and equipment of trajectory prediction model
CN111260956B (en) * 2020-01-15 2021-03-16 清华大学 A vehicle automatic lane changing planning and control method based on model predictive control
CN112053589B (en) * 2020-08-18 2022-05-24 北京航空航天大学 A method for constructing an adaptive recognition model for target vehicle lane-changing behavior

Also Published As

Publication number Publication date
CN113665574A (en) 2021-11-19

Similar Documents

Publication Publication Date Title
CN113665574B (en) Prediction of lane changing duration and anthropomorphic trajectory planning method for intelligent vehicles
CN109213134B (en) Method and device for generating automatic driving strategy
CN110562258B (en) Method for vehicle automatic lane change decision, vehicle-mounted equipment and storage medium
CN113642633B (en) Method, device, equipment and medium for classifying driving scene data
WO2022052406A1 (en) Automatic driving training method, apparatus and device, and medium
US9053433B2 (en) Assisting vehicle guidance over terrain
CN109109863B (en) Intelligent device and control method and device thereof
CN113343461A (en) Simulation method and device for automatic driving vehicle, electronic equipment and storage medium
WO2022052856A1 (en) Vehicle-based data processing method and apparatus, computer, and storage medium
JP7220169B2 (en) Information processing method, device, storage medium, and program
CN104875740B (en) For managing the method for following space, main vehicle and following space management unit
US12027052B2 (en) Computer-implemented method for determining similarity values of traffic scenarios
CN114987498B (en) Anthropomorphic trajectory planning method and device for automatic driving vehicle, vehicle and medium
WO2022222647A1 (en) Method and apparatus for predicting vehicle intention, device, and storage medium
CN111845787A (en) A Lane Change Intention Prediction Method Based on LSTM
JP2020075561A (en) Travel range acquisition system, vehicle control system and travel range acquisition program
CN116541295A (en) Road dynamic scene simulation method and system
EP2405383A1 (en) Assisting with guiding a vehicle over terrain
CN113119999A (en) Method, apparatus, device, medium, and program product for determining automatic driving characteristics
CN116476861A (en) Automatic driving decision system based on multi-mode sensing and layering actions
CN113771884B (en) Intelligent automobile anthropomorphic track planning method based on lateral quantitative balance index
US20240043022A1 (en) Method, system, and computer program product for objective assessment of the performance of an adas/ads system
CN116902007A (en) Steering control method and device for automatic driving vehicle, vehicle and medium
CN111880521B (en) Vehicle control method and device, vehicle and electronic equipment
CN114120653A (en) Centralized vehicle group decision control method and device and electronic equipment

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