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 PDFInfo
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 67
- 230000001133 acceleration Effects 0.000 claims abstract description 90
- 238000013507 mapping Methods 0.000 claims abstract description 27
- 238000006073 displacement reaction Methods 0.000 claims abstract description 26
- 230000008859 change Effects 0.000 claims description 114
- 238000000605 extraction Methods 0.000 claims description 10
- 238000012937 correction Methods 0.000 claims description 7
- 238000005457 optimization Methods 0.000 claims description 7
- 238000004590 computer program Methods 0.000 claims description 3
- 238000012512 characterization method Methods 0.000 claims 2
- 230000008569 process Effects 0.000 description 25
- 230000006399 behavior Effects 0.000 description 13
- 230000006870 function Effects 0.000 description 13
- 239000000284 extract Substances 0.000 description 10
- 238000005516 engineering process Methods 0.000 description 8
- 230000003442 weekly effect Effects 0.000 description 8
- 238000010586 diagram Methods 0.000 description 7
- 238000011156 evaluation Methods 0.000 description 5
- 238000011002 quantification Methods 0.000 description 5
- NAWXUBYGYWOOIX-SFHVURJKSA-N (2s)-2-[[4-[2-(2,4-diaminoquinazolin-6-yl)ethyl]benzoyl]amino]-4-methylidenepentanedioic acid Chemical compound C1=CC2=NC(N)=NC(N)=C2C=C1CCC1=CC=C(C(=O)N[C@@H](CC(=C)C(O)=O)C(O)=O)C=C1 NAWXUBYGYWOOIX-SFHVURJKSA-N 0.000 description 3
- 238000004458 analytical method Methods 0.000 description 3
- 125000004122 cyclic group Chemical group 0.000 description 3
- 230000000694 effects Effects 0.000 description 3
- 230000008447 perception Effects 0.000 description 3
- 238000003491 array Methods 0.000 description 2
- 238000004364 calculation method Methods 0.000 description 2
- 239000000463 material Substances 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 230000002902 bimodal effect Effects 0.000 description 1
- 238000007621 cluster analysis Methods 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 238000013136 deep learning model Methods 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 239000000835 fiber Substances 0.000 description 1
- 230000001939 inductive effect Effects 0.000 description 1
- 230000003993 interaction Effects 0.000 description 1
- 230000002452 interceptive effect Effects 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 238000005065 mining Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000003062 neural network model Methods 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 238000011158 quantitative evaluation Methods 0.000 description 1
- 238000007637 random forest analysis Methods 0.000 description 1
- 230000003938 response to stress Effects 0.000 description 1
- 238000007619 statistical method Methods 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W30/00—Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
- B60W30/18—Propelling the vehicle
- B60W30/18009—Propelling the vehicle related to particular drive situations
- B60W30/18163—Lane change; Overtaking manoeuvres
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W40/00—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
- B60W40/10—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to vehicle motion
- B60W40/107—Longitudinal acceleration
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W50/00—Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W50/00—Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
- B60W2050/0001—Details of the control system
- B60W2050/0019—Control system elements or transfer functions
- B60W2050/0028—Mathematical models, e.g. for simulation
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W50/00—Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
- B60W2050/0001—Details of the control system
- B60W2050/0043—Signal 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
本申请涉及智能汽车应用技术领域,特别涉及一种智能汽车换道时长预测及拟人化轨迹规划方法,包括:从自然驾驶数据中提取优秀驾驶员的换道轨迹,并提取多车影响下的换道时长;获取换道车辆的周车运动信息,将周车影响表征为周车运动学参数对换道车辆的平均纵向加速度的非线性映射,进而获得周车影响下的换道时长预测模型;智能汽车应用换道时长预测模型时,基于预期换道纵向位移、当前纵向速度和换道后目标车道预期车速,结合周车信息,利用预测模型进行换道时长的优选,进而实现拟人化的换道轨迹规划。由此,充分挖掘了自然驾驶数据中优秀驾驶员的操纵规律,为智能汽车科学合理的换道决策提供参考,是智能汽车拟人化决策理念在换道决策中的体现。
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.
Description
技术领域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:
, ,
其中,为自车的换道时长,为所述自车预期换道纵向位移、为所述自车平均纵向加速度,为所述自车换道后在目标车道的预期车速。in, for the lane changing time of the vehicle, is the expected lane change longitudinal displacement of the ego vehicle, is the average longitudinal acceleration of the ego vehicle, 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:
, ,
其中,为自车的换道时长,为所述自车预期换道纵向位移、为所述自车平均纵向加速度,为所述自车换道后在目标车道的预期车速。in, for the lane changing time of the vehicle, is the expected lane change longitudinal displacement of the ego vehicle, is the average longitudinal acceleration of the ego vehicle, 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.
具体而言,在从海量的驾驶员的自然驾驶数据中提取车辆的换道轨迹时,本申请实施例可以首先计算换道轨迹的朝向角,峰值点可以为朝向角大于预设朝向角阈值的点,假设朝向角阈值为2,则自然驾驶数据中朝向角的点均为峰值点,由峰值点向两边搜索,得到满足预设条件的时间点,其中,预设条件可以为,从而可以由时间点匹配对应的换道轨迹的初始区间。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 , the peak point can be the heading angle Points larger than the preset heading angle threshold, assuming the heading angle threshold is 2, then the heading angle in the natural driving data 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 , so that the initial interval of the corresponding lane-changing trajectory can be matched by the time point .
由此,实现的对车辆的换道轨迹的初步提取,提取出的换道轨迹的初始区间由于车辆的侧向位移和速度波动,可能导致所提取的换道轨迹的初始区间存在冗余时间区间,因此,本申请实施例可以采用侧向加速度峰-峰值进行换道轨迹的精确提取。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.
进一步地,换道轨迹侧向加速度峰-峰值时间差的计算公式如式(1)所示:Further, the peak-to-peak time difference of the lateral acceleration of the lane change trajectory The calculation formula of is shown in formula (1):
(1) (1)
其中,为绝对值计算符号,为侧向加速度取得最大值时对应的时间点,为侧向加速度取得最小值时对应的时间点,为换道轨迹对应的换道时长。in, Calculate the sign for the absolute value, is the corresponding time point when the lateral acceleration reaches the maximum value, is the time point corresponding to the minimum value of lateral acceleration, It is the lane change duration corresponding to the lane change track.
由此可知,换道轨迹对应的换道时长是两倍的侧向加速度峰-峰值时间差,故换道时间起点和换道时间终点分别如式(2)和式(3)所示:It can be seen from this that the lane change duration corresponding to the lane change trajectory is twice the lateral acceleration peak-to-peak time difference , so the lane change time starts and end of lane change time As shown in formula (2) and formula (3) respectively:
(2) (2)
(3) (3)
其中,为取最小值符号,为取最大值符号。in, To take the minimum sign, for the maximum value sign.
举例来说,如图2和图3所示,图2中的(a)至(c)分别为自然驾驶轨迹集HighD中提取的向左的换道轨迹、侧向速度和侧向加速度的变化规律;图3中的(a)至(c)分别为自然驾驶轨迹集HighD中提取的向右的换道轨迹、侧向速度和侧向加速度的变化规律。在图2和图3中,换道起点和换道终点即对应于式(2)和式(3)中所提到的和,侧向加速度峰-峰值对应的时间点即为和。由图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 and , the time point corresponding to the peak-to-peak value of lateral acceleration is and . 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.
可以理解的是,在理想的驾驶员假设下,驾驶员换道是为了追求更高的行驶速度,因此在不考虑周车影响的换道过程中,驾驶员倾向于保持匀速或加速换道,以快速实现车道的变换和行驶效率的提升,而在复杂行车环境中,驾驶员的换道行为不得不考虑周车的影响,而周车对自车换道纵向驾驶行为的影响,需通过自车驾驶员的应激反应产生。因此,本申请实施例可以将车辆周边的预设范围内的其他车辆的影响等效为对自车平均纵向加速度的影响,等效系数(即影响值)与车辆周边的预设范围内的其他车辆状态之间的非线性映射关系,可用式(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 The effect of the equivalence factor (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):
(4) (4)
其中,式(4)的非线性映射的一种可行方案为式(5)和式(6)的回归模型方案。式(5)和式(6)中,、和均为回归系数,可根据实际换道轨迹(即步骤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), , and are regression coefficients, which can be calibrated according to the actual lane-changing trajectory (that is, the lane-changing trajectory extracted in step S101 ):
(5) (5)
(6) (6)
进一步地,本申请实施例根据周车的影响对自车平均纵向加速度进行加速度修正时,平均纵向加速度的获取方式可以如图4所示,平均纵向加速度可以使用如式(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 The acquisition method can be shown in Figure 4, the average longitudinal acceleration It can be expressed quantitatively using the mathematical formula shown in equation (7):
(7) (7)
式(7)中,为与车辆周边的预设范围内的其他车辆运动状态相关的等效系数,为理想条件下,只考虑换道效率收益的预期纵向加速度,的定义可以如式(8)所示:In formula (7), is the equivalent coefficient related to other vehicle motion states within the preset range around the vehicle, Under ideal conditions, only considering the expected longitudinal acceleration of lane change efficiency gains, The definition of can be shown in formula (8):
(8) (8)
式(8)中,为目标车道的预期行驶速度,在理想驾驶员假设前提下,驾驶员换道是为了追求更高的行驶效率,因此,,车辆在换道过程应快速的实现纵向行驶速度的提升,而换道过程中,驾驶员又不得不考虑与周车的交互,在与周车的交互博弈过程中,采取的最终实际纵向加速度是与周车博弈的结果,周车的影响主要体现在式(7)所示的影响值中。In formula (8), 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, , 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). 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).
(9) (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:
, ,
其中,为自车的换道时长,为所述自车预期换道纵向位移、为所述自车平均纵向加速度,为所述自车换道后在目标车道的预期车速。in, for the lane changing time of the vehicle, is the expected lane change longitudinal displacement of the ego vehicle, is the average longitudinal acceleration of the ego vehicle, The expected vehicle speed in the target lane after changing lanes for the ego vehicle.
需要说明的是,式(10)在的数学极限条件下,可求得不考虑纵向加速度时的换道时长。显然,在时,式(10)为型数学极限问题,利用洛必达法则同时求得分子分母对的导数,如式(11)所示:It should be noted that formula (10) is in Under the mathematical limit of , the lane change time can be obtained without considering the longitudinal acceleration . Obviously, in When, formula (10) is type mathematical limit problem, using Lhobita's rule to simultaneously find the numerator and denominator pairs The derivative of , as shown in formula (11):
(11) (11)
由式(11)可知,在换道时长的计算公式(10)中,自车平均纵向加速度趋向零时的解等于预期换道距离与换道后目标车道预期车速的比值,符合匀速运动运动学规律,说明传统的纵向匀速换道时长模型是本申请所提出的换道时长预测模型的特例。From Equation (11), it can be seen that when the lane change time In the calculation formula (10), the average longitudinal acceleration of the ego vehicle The solution towards zero is equal to the expected lane change distance and the expected speed of the target lane after the lane change 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号车为目标车道前车,为各车的纵向位置、纵向速度和纵向加速度状态函数。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, 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)分别是这些换道轨迹的纵向位移、纵向初始速度和平均等效纵向加速度的实测结果的统计分布图。由图6可知,纵向位移服从正态分布,换道过程纵向位移分布在的区间内。初始纵向速度呈双峰分布,且集中在的高速行驶区间内。由自车平均纵向加速度的分布特性可知,受到周车影响,换道过程可能产生平均加速度为负的场景,而在大部分场景下,驾驶员希望维持平均纵向加速度为零的工况,从而把更多的注意力放在顺利完成换道的横向驾驶行为上。As shown in Fig. 6, Fig. 6(a) to Fig. 6(c) are the longitudinal displacements of these lane changing trajectories respectively , longitudinal initial velocity and the mean equivalent longitudinal acceleration Statistical distribution of the measured results. It can be seen from Figure 6 that the longitudinal displacement It obeys a normal distribution, and the longitudinal displacement in the lane changing process is distributed in within the range. initial longitudinal velocity has a bimodal distribution and is concentrated in within the high-speed driving area. Average longitudinal acceleration by ego vehicle 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
其中,提取模块100用于从若干驾驶员的自然驾驶数据中提取优秀驾驶员的换道轨迹,并由所述优秀驾驶员的换道轨迹提取真实多车影响下的优秀驾驶员换道时长;Wherein, the
生成模块200用于获取换道车辆的周车运动信息,并根据所述周车运动信息建立多车影响下的车辆换道纵向运动学模型,以及将所述周车的影响表征为周车运动学参数对换道车辆的平均纵向加速度的非线性映射,进而获得训练好的多车影响下的换道时长预测模型和辨识获得的模型参数;以及The
换道轨迹规划模块300用于在网联多车环境下的所述智能汽车应用所述换道时长预测模型进行决策的情况下,当下达换道指令时,基于预期换道纵向位移、所述智能汽车的纵向速度和换道后目标车道预期车速,结合所述智能汽车的周车信息,利用所述换道时长预测模型对所述智能汽车的换道时长进行优选,并根据优选获得的所述智能汽车的换道时长进行拟人化的轨迹规划,以实现所述智能汽车换道意图的准确实施。The lane-changing
可选地,提取模块100具体用于:Optionally, the
计算所述优秀驾驶员的换道轨迹的朝向角;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
对所述换道车辆的平均纵向加速度进行加速度修正,得到修正后的平均纵向加速度,将所述周车的影响表征为周车运动学参数对换道车辆的所述平均纵向加速度的非线性映射;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:
, ,
其中,为自车的换道时长,为所述自车预期换道纵向位移、为所述自车平均纵向加速度,为所述自车换道后在目标车道的预期车速。in, for the lane changing time of the vehicle, is the expected lane change longitudinal displacement of the ego vehicle, is the average longitudinal acceleration of the ego vehicle, 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)
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)
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)
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 |
-
2021
- 2021-10-22 CN CN202111237247.1A patent/CN113665574B/en active Active
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 |