CN109727490A - An adaptive correction prediction method for surrounding vehicle behavior based on driving prediction field - Google Patents

An adaptive correction prediction method for surrounding vehicle behavior based on driving prediction field Download PDF

Info

Publication number
CN109727490A
CN109727490A CN201910071784.XA CN201910071784A CN109727490A CN 109727490 A CN109727490 A CN 109727490A CN 201910071784 A CN201910071784 A CN 201910071784A CN 109727490 A CN109727490 A CN 109727490A
Authority
CN
China
Prior art keywords
prediction
vehicle
behavior
driving
surrounding
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CN201910071784.XA
Other languages
Chinese (zh)
Other versions
CN109727490B (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.)
Jiangsu University
Original Assignee
Jiangsu 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 Jiangsu University filed Critical Jiangsu University
Priority to CN201910071784.XA priority Critical patent/CN109727490B/en
Publication of CN109727490A publication Critical patent/CN109727490A/en
Application granted granted Critical
Publication of CN109727490B publication Critical patent/CN109727490B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Landscapes

  • Traffic Control Systems (AREA)

Abstract

本发明公开了一种基于行车预测场的周边车辆行为自适应矫正预测方法,步骤1:周边车辆行为离散化与数据集预处理:将周边车辆行为根据横向与纵向划分为N个典型行为;步骤2:获取交通环境参与车时序数据:每辆交通环境参与车使用定位系统实时获取每个时刻自车的位置、速度、加速度;步骤3:建立行车预测场:建立基于安全性、效率性、驾驶舒适性三要素的行车预测场EP,EP=ES+EE+EC;步骤4:基于最大似然估计方法建立周边车辆行为预测模型;步骤5:周边车辆行为实时预测与模型自适应矫正。本发明综合考虑影响驾驶者行为的安全性、效率性与驾驶舒适性,在目标车辆的行驶区域建立行车预测场并定性与定量分析,为周边车辆行为预测提出了新思路。

The invention discloses an adaptive correction prediction method for surrounding vehicle behaviors based on a driving prediction field. Step 1: discretization of surrounding vehicle behaviors and data set preprocessing: dividing surrounding vehicle behaviors into N typical behaviors according to the horizontal and vertical directions; step 2: Obtain the time series data of the participating vehicles in the traffic environment: Each vehicle participating in the traffic environment uses the positioning system to obtain the position, speed, and acceleration of the vehicle at each moment in real time; Step 3: Establish a driving prediction field: establish a vehicle based on safety, efficiency, driving The driving prediction field E P of the three elements of comfort, E P =E S +E E +E C ; Step 4: Establish a surrounding vehicle behavior prediction model based on the maximum likelihood estimation method; Step 5: Real-time prediction of surrounding vehicle behavior and model automatic Adapt to correction. The invention comprehensively considers the safety, efficiency and driving comfort affecting the driver's behavior, establishes a driving prediction field in the driving area of the target vehicle and analyzes it qualitatively and quantitatively, and proposes a new idea for the behavior prediction of surrounding vehicles.

Description

一种基于行车预测场的周边车辆行为自适应矫正预测方法An adaptive correction prediction method for surrounding vehicle behavior based on driving prediction field

技术领域technical field

本发明属于智能驾驶技术领域,具体涉及一种基于行车预测场的周边车辆行为自适应矫正预测方法。The invention belongs to the technical field of intelligent driving, and in particular relates to an adaptive correction prediction method for surrounding vehicle behavior based on a driving prediction field.

背景技术Background technique

现如今无论是先进的驾驶员辅助系统,还是完全自动驾驶车辆都引发了各领域学者广泛的研究兴趣,毫无疑问,汽车智能化已经成为汽车产业发展最重要的潮流和趋势之一。究其原因,智能车辆不仅在运输系统中具有更为高效、更为安全和更为清洁的性能,同时它还能够释放人类在驾驶过程对车辆的操纵。而真实的交通环境往往是复杂和高度不确定的,在这种环境下人类其实是非常优秀的驾驶员,因为人可以通过不断学习具备推断周围交通参与者行为意图和预测它们运动态势的能力。因此,智能车辆“驾驶脑”也只有像人类一样达到对日益交通环境感知的升华,才能做到真正的“智能”驾驶。即从技术层面上讲,车辆应该能够预测周围复杂交通环境中多目标的未来运动行为态势,以提高其理解交通环境的能力,这对制定合理高效的轨迹规划和决策控制具有重大的意义。近年来,随着视觉感知技术和通信技术的发展,激光雷达、毫米波雷达、摄像头多传感器融合系统使智能车辆能够实时监测周围交通环境,车联网、车对车(V2V)、智能手机等通信设备也可以帮助车辆准确地获取周围额外的信息,这给周边目标车辆的行为预测提供了便利。Nowadays, both advanced driver assistance systems and fully autonomous vehicles have aroused extensive research interests of scholars in various fields. There is no doubt that automotive intelligence has become one of the most important trends and trends in the development of the automotive industry. The reason for this is that smart vehicles not only provide more efficient, safer and cleaner performance in transportation systems, but also free up human manipulation of the vehicle during driving. The real traffic environment is often complex and highly uncertain. In this environment, human beings are actually very good drivers, because they can continuously learn and have the ability to infer the behavioral intentions of surrounding traffic participants and predict their movement. Therefore, the "driving brain" of intelligent vehicles can achieve true "smart" driving only if it achieves the sublimation of the perception of the increasingly traffic environment like human beings. That is, from a technical point of view, the vehicle should be able to predict the future motion behavior of multiple targets in the surrounding complex traffic environment to improve its ability to understand the traffic environment, which is of great significance for formulating reasonable and efficient trajectory planning and decision control. In recent years, with the development of visual perception technology and communication technology, lidar, millimeter-wave radar, and camera multi-sensor fusion systems enable intelligent vehicles to monitor the surrounding traffic environment in real time. The device can also help the vehicle to accurately obtain additional information around it, which facilitates the behavior prediction of surrounding target vehicles.

目前来看,国内外学者对于本车驾驶员的驾驶行为或驾驶意图的识别与预测开展了大量的研究工作,并取得了卓越的成果。他们在进行预测模型特征输入量数据处理时,往往是通过获取本车的车辆运行参数(转向盘转角、纵向加速度和自车与车道中心线距离等)或者驾驶员参数(左后视镜平均注视次数、单次平均扫视时间、单次平均头部水平转角等)来实现的,但若从周围车辆内部及其驾驶者本身的详细数据入手,无疑增大了对车载通讯设备或远程通信平台传输效率的要求,还危及信息安全的问题,因此这种方法并不适用于周边车辆的行为预测。另一种可行的方案,是通过周边目标车辆的原型轨迹来对行为直接进行预测,可获得较高的计算效率,但此类方法在进行运动预测时将被预测目标车作为一个独立的个体来进行研究,而忽略了周围交通环境参与者如其它车辆(包括主车在内)对其行为态势所产生的影响,是很难在交通环境下进行稳定准确的长期运动行为预测,这是因为无论是人驾驶的交通车还是具备自动驾驶能力的交通车,都是一个会对周围环境的激励做出相应反应的智能体。At present, scholars at home and abroad have carried out a lot of research work on the identification and prediction of the driver's driving behavior or driving intention, and have achieved excellent results. When they process the feature input data of the prediction model, they often obtain the vehicle operating parameters of the vehicle (steering wheel angle, longitudinal acceleration, and the distance between the vehicle and the center line of the lane, etc.) or driver parameters (average gaze in the left rearview mirror). However, if we start from the detailed data of the surrounding vehicles and their drivers, it will undoubtedly increase the transmission of in-vehicle communication equipment or remote communication platforms. The requirements of efficiency also endanger the problem of information security, so this method is not suitable for the behavior prediction of surrounding vehicles. Another feasible solution is to directly predict the behavior through the prototype trajectories of the surrounding target vehicles, which can achieve higher computational efficiency, but such methods use the predicted target vehicle as an independent individual when performing motion prediction. It is difficult to carry out stable and accurate long-term motion behavior prediction in the traffic environment by conducting research without ignoring the influence of the surrounding traffic environment participants such as other vehicles (including the host vehicle) on their behavior. Whether it is a human-driven vehicle or a vehicle with autonomous driving capabilities, it is an agent that responds to the stimuli of the surrounding environment.

因此,对周边车辆行为进行预测时,需要挖掘车辆行为态势的长期影响因素。本发明提出一种基于行车预测场的周边车辆行为自适应预测方法,提出了考量安全性、效率性、驾驶舒适性决策影响三要素的行车预测场,并基于此建立了周边车辆行为预测模型,并结合被预测的车辆的行为识别结果自适应矫正提高预测精度。Therefore, when predicting the behavior of surrounding vehicles, it is necessary to excavate the long-term influencing factors of vehicle behavior. The invention proposes an adaptive prediction method for surrounding vehicle behavior based on a driving prediction field, and proposes a driving prediction field considering three factors of safety, efficiency, and driving comfort in decision-making, and based on this, a surrounding vehicle behavior prediction model is established. And combined with the behavior recognition results of the predicted vehicle, adaptive correction is used to improve the prediction accuracy.

发明内容SUMMARY OF THE INVENTION

针对周边车辆行为预测长期稳定性与可靠性的要求,本发明提出了一种基于驾驶操纵者行为决策要素影响的行车预测场,并基于此提出了一种周边车辆行为自适应预测方法,能够实时准确地对周边目标车辆的行为作出合理预测,为智能车辆自身的决策规划提供参考依据。本发明的目的可以通过以下技术方案来实现。一种基于行车预测场的周边车辆行为自适应预测方法,具体包括:Aiming at the requirements of long-term stability and reliability of the surrounding vehicle behavior prediction, the present invention proposes a driving prediction field based on the influence of the driver's behavioral decision-making elements, and based on this, an adaptive prediction method for surrounding vehicle behavior is proposed, which can real-time It can accurately predict the behavior of surrounding target vehicles and provide a reference for the intelligent vehicle's own decision-making planning. The object of the present invention can be achieved through the following technical solutions. An adaptive prediction method for surrounding vehicle behavior based on a driving prediction field, which specifically includes:

Step1:周边车辆行为离散化与数据集预处理;Step1: Discretization of surrounding vehicle behavior and data set preprocessing;

将周边车辆行为根据横向与纵向两个方面组合划分,离散化划分为N个典型行为bi。对NGSIM交通数据集进行去噪处理并提取出有效数据集,根据车辆行为离散化划分方法标注各数据标定对应行为类型。The surrounding vehicle behaviors are divided according to the combination of lateral and vertical aspects, and the discretization is divided into N typical behaviors b i . The NGSIM traffic data set is denoised and an effective data set is extracted. According to the discretization method of vehicle behavior, each data is marked to calibrate the corresponding behavior type.

Step2:获取交通环境参与车时序数据;Step2: Obtain the time series data of the participating vehicles in the traffic environment;

每辆交通环境参与车使用车载的GPS与IMU联合定位系统实时获取每个时刻自车的位置(x,y)、速度(Vx,Vy)、加速度(ax,ay)。主车使用V2V通信技术中LTE模块的D2D(Device-To-Device)邻近通信服务(ProSe)实时获取所处交通环境周边车辆的状态时序信息。针对需进行车辆行为预测的周边目标车辆,取其当前车道的前后方车辆与相邻车道的前后方车辆作为其行为发生的影响者。Each vehicle participating in the traffic environment uses the on-board GPS and IMU joint positioning system to obtain the position (x, y), velocity (V x , V y ) and acceleration (a x , a y ) of the vehicle at each moment in real time. The host vehicle uses the D2D (Device-To-Device) proximity communication service (ProSe) of the LTE module in the V2V communication technology to obtain the status and timing information of the surrounding vehicles in the traffic environment in real time. For the surrounding target vehicles that need to predict the vehicle behavior, the vehicles in front and rear of the current lane and the vehicles in the adjacent lanes are taken as the influencers of the behavior.

Step3:建立行车预测场;Step3: Establish a driving prediction field;

针对驾驶操纵者是对周围环境的激励做出相应“趋利避害”反应的智能体,建立基于安全性、效率性、驾驶舒适性决策影响三要素的行车预测场EP,EP=ES+EE+EC,其中安全预测场ES、效率预测场EE、驾驶舒适预测场EC。设预测周期时间为ΔT。Aiming at the fact that the driver is an agent that responds to the incentives of the surrounding environment by "seeking benefits and avoiding disadvantages", a driving prediction field EP based on the three factors of safety, efficiency, and driving comfort decision-making is established, where EP = E S +E E +E C , wherein the safety prediction field E S , the efficiency prediction field E E , and the driving comfort prediction field E C . Let the forecast cycle time be ΔT.

(1)建立安全预测场(1) Establish a safety prediction field

目标车辆行车区域内任意一点位置受到周围第j辆车影响所具有的单位安全势值The unit safety potential value of any point in the driving area of the target vehicle affected by the surrounding jth vehicle

其中,(X,Y)为目标车辆行车区域内任意一点位置;GS为行车安全预测场待定常数;δj周围第j辆车的车辆类型系数;Mj为周围第j辆车的等效质量比,是第j辆车的长宽高乘积的倒数;(x[j],y[j])为目标车辆周围第j辆车当前时刻的位置向量;为目标车辆周围第j辆车当前时刻的速度向量;为目标车辆周围第j辆车当前时刻的加速度向量;ΔT为周边目标车辆行为预测周期时间;|| ||2为向量的2-范数符号。Among them, (X, Y) is the position of any point in the driving area of the target vehicle; G S is the undetermined constant of the driving safety prediction field; δ j is the vehicle type coefficient of the j-th vehicle around; M j is the equivalent of the j-th vehicle around The mass ratio is the reciprocal of the product of the length, width and height of the jth vehicle; (x [j] , y [j] ) is the current position vector of the jth vehicle around the target vehicle; is the velocity vector of the jth vehicle around the target vehicle at the current moment; is the acceleration vector of the jth vehicle around the target vehicle at the current moment; ΔT is the behavior prediction cycle time of the surrounding target vehicle; || ||2 is the 2-norm sign of the vector.

则目标车辆行车区域内任意一点位置所具有的单位安全势值Then the unit safety potential value of any point in the driving area of the target vehicle

(2)建立效率预测场(2) Establish an efficiency prediction field

目标车辆行车区域内任意一点位置所具有的单位效率势值The unit efficiency potential value of any point in the target vehicle's driving area

Y为目标车辆行车区域内任意一点纵向位置;GE为行车效率预测场待定常数;M0为目标车辆的等效质量比,是目标车辆的长宽高乘积的倒数;y[0]为目标车辆当前时刻的纵向位置;Y is the longitudinal position of any point in the driving area of the target vehicle; G E is the undetermined constant of the driving efficiency prediction field; M 0 is the equivalent mass ratio of the target vehicle, which is the reciprocal of the product of the length, width and height of the target vehicle; y [0] is the target vehicle The longitudinal position of the vehicle at the current moment;

(3)建立驾驶舒适预测场(3) Establish a driving comfort prediction field

目标车辆行车区域内任意一点位置所具有的单位驾驶舒适势值The unit driving comfort potential value at any point in the target vehicle's driving area

(X,Y)为目标车辆行车区域内任意一点位置;GC为行车驾驶舒适预测场待定常数;(x[0],y[0])为目标车辆当前时刻的位置向量;为目标车辆当前时刻的速度向量;ΔT为周边目标车辆行为预测周期时间;|| ||2为向量的2-范数符号。(X, Y) is the position of any point in the driving area of the target vehicle; G C is the undetermined constant of the driving comfort prediction field; (x [0] , y [0] ) is the position vector of the target vehicle at the current moment; is the velocity vector of the target vehicle at the current moment; ΔT is the behavior prediction cycle time of the surrounding target vehicle; || ||2 is the 2-norm sign of the vector.

Step4:建立周边车辆行为预测模型;Step4: Establish a behavior prediction model of surrounding vehicles;

拟合每个车辆行为bi对应的相似性轨迹,设目标车辆依照相似性轨迹行驶过的区域为计算周边目标车辆每个行为的行车预测场场强和Fit the similarity trajectory corresponding to each vehicle behavior b i , and set the area where the target vehicle travels according to the similarity trajectory as Calculate the predicted driving field strength and sum of each behavior of the surrounding target vehicle

其中,KS为安全预测场场强和的权重系数;KE为效率预测场场强和的权重系数;KS为驾驶舒适预测场场强和的权重系数;Among them, K S is the weight coefficient of the field strength sum for safety prediction; KE is the weight coefficient of the efficiency prediction field strength sum; K S is the weight coefficient of the driving comfort prediction field strength sum;

将场强和归一化处理为每个车辆行为对应的概率Process field strength and normalization into probabilities for each vehicle behavior

写出似然函数L(θ)=ΠP_predict(bi),其中θ={KS,KE,KC}。Write the likelihood function L(θ) = ΠP_predict ( bi ), where θ = {K S , K E , K C }.

基于Step1中预处理好的NGSIM数据集使用成熟的共轭梯度法计算出最大似然估计量即初始权重系数KS_0,KE_0,KC_0Based on the preprocessed NGSIM data set in Step1, the maximum likelihood estimator is calculated using the mature conjugate gradient method That is, the initial weight coefficients K S_0 , K E_0 , K C_0 .

则得出周边车辆行为预测模型函数Then get the surrounding vehicle behavior prediction model function

Step5:周边车辆行为实时预测与模型自适应矫正Step5: Real-time prediction of surrounding vehicle behavior and model adaptive correction

主车位于真实的交通环境中首先依据Step2实时获取交通环境参与车时序数据,根据Step4建立的预测模型实时预测周边目标车辆在预测周期时间ΔT内的车辆行为概率,并将概率最大对应的行为作为周边车辆行为的预测结果。为进一步提高预测精度,本发明还提出一种权重系数回归矫正方法。取周边目标车辆的横、纵向位移、速度、加速度为观测变量,基于HMM模型对周边目标车辆行为进行在线识别,得出各行为在预测周期时间内的识别概率Precognize(bi)。The main vehicle is located in the real traffic environment. Firstly, according to Step 2, the time series data of the participating vehicles in the traffic environment are obtained in real time. According to the prediction model established in Step 4, the vehicle behavior probability of the surrounding target vehicles within the prediction cycle time ΔT is predicted in real time, and the behavior corresponding to the maximum probability is used as Prediction of surrounding vehicle behavior. In order to further improve the prediction accuracy, the present invention also proposes a weight coefficient regression correction method. Taking the lateral and longitudinal displacement, velocity, and acceleration of surrounding target vehicles as observation variables, online recognition of surrounding target vehicle behaviors is carried out based on the HMM model, and the recognition probability P recognize (b i ) of each behavior within the prediction cycle time is obtained.

将行为预测模型概率函数写为Write the behavior prediction model probability function as

Ppredict_k(bi)=fk(KS_k,KE_k,KC_k)P predict_k (bi )=f k ( K S_k ,K E_k ,K C_k )

即Ppredict_k(bi)关于KS_k,KE_k,KC_k的函数,其中KS_k为第k个预测周期时间安全场场强和的权重系数;KE_k为第k个预测周期时间效率场场强和的权重系数;KC_k为第k个预测周期时间驾驶场场强和的权重系数。That is, P predict_k (b i ) is a function of K S_k , K E_k , K C_k , where K S_k is the weight coefficient of the sum of the time safety field strengths of the kth prediction cycle; K E_k is the time efficiency field field of the kth prediction cycle The weight coefficient of the strong sum; K C_k is the weight coefficient of the driving field field strength sum at the kth prediction cycle time.

构造预测值与识别值之间的代价函数Construct a cost function between predicted and identified values

其中N为周边车辆行为类型数,N=9。Among them, N is the number of surrounding vehicle behavior types, and N=9.

构造矫正函数其中为α矫正速率系数。Construct Correction Function where is the α correction rate coefficient.

通过矫正函数逐个预测周期时间ΔT在线矫正权重系数,实现自适应预测,进一步提高周边车辆行为识别预测的准确率。The weight coefficients are corrected online by the correction function to predict the cycle time ΔT one by one to realize adaptive prediction and further improve the accuracy of the behavior recognition and prediction of surrounding vehicles.

本发明的有益效果:Beneficial effects of the present invention:

(1)从周围交通参与车对目标车辆行为的影响入手,缓解了只将被预测目标车作为单一独立个体的缺陷,能够实现周边车辆行为识别的长期稳定预测。(1) Starting from the influence of the surrounding traffic participating vehicles on the behavior of the target vehicle, the defect that only the predicted target vehicle is regarded as a single independent individual is alleviated, and the long-term stable prediction of the behavior recognition of surrounding vehicles can be realized.

(2)综合考虑影响驾驶操纵者行为的安全性、效率性与驾驶舒适性,在目标车辆的行驶区域建立了行车预测场并进行了定性与定量分析,为周边车辆行为预测提出了新思路。(2) Comprehensively considering the safety, efficiency and driving comfort that affect the behavior of the driver, a driving prediction field is established in the driving area of the target vehicle, and qualitative and quantitative analysis are carried out, which proposes a new idea for the prediction of surrounding vehicle behavior.

(3)提出一种基于行车预测场的周边车辆行为预测模型,有较好的预测准确率与较少的预测时间。(3) A prediction model of surrounding vehicle behavior based on driving prediction field is proposed, which has better prediction accuracy and less prediction time.

(4)提出一种周边车辆行为预测回归矫正方法,通过HMM模型识别在预测周期时间的车辆行为结果不断自适应矫正预测模型的权重系数向量,进一步提高了周边车辆行为的预测精度。(4) A regression correction method for the prediction of surrounding vehicle behavior is proposed. The HMM model identifies the vehicle behavior results in the prediction cycle time and continuously adapts the weight coefficient vector of the prediction model to further improve the prediction accuracy of surrounding vehicle behavior.

附图说明Description of drawings

图1基于行车预测场的周边车辆行为自适应矫正预测方法框图;Fig. 1 is a block diagram of the adaptive correction prediction method of surrounding vehicle behavior based on the driving prediction field;

图2周边车辆行为的离散化划分;Figure 2. Discretization of surrounding vehicle behavior;

图3目标车辆的交通环境参考车;Fig. 3 Traffic environment reference vehicle of the target vehicle;

(a).目标车辆处于中间车道;(b).目标车辆处于右侧车道;(c).目标车辆处于左侧车道);(a). The target vehicle is in the middle lane; (b). The target vehicle is in the right lane; (c). The target vehicle is in the left lane);

图4周边目标车辆某一行为bi驶过的区域;Figure 4. The area where a certain behavior bi of the surrounding target vehicle passes;

图5某一典型交通环境H;Figure 5 A typical traffic environment H;

图6在H交通环境下安全预测场场强分布;Fig. 6 Safely predicted field strength distribution in H traffic environment;

图7在H交通环境下效率预测场场强分布;Fig. 7 Efficient prediction field strength distribution in H traffic environment;

图8在H交通环境下驾驶舒适性预测场场强分布;Figure 8. Field strength distribution for driving comfort prediction in H traffic environment;

具体实施方式Detailed ways

下面结合附图对本发明作进一步说明。The present invention will be further described below in conjunction with the accompanying drawings.

如图1所示,本发明的实施包括如下步骤:As shown in Figure 1, the implementation of the present invention includes the following steps:

Step1:周边车辆行为离散化与数据集预处理Step1: Discretization of surrounding vehicle behavior and data set preprocessing

根据周边目标车辆行为不确定因素多、复杂难分的特点,将可能行为分为横向行为与纵向行为两个方向去进行组合划分。由横向行为中的左换道(Lane Change to Left)、保持车道(Lane Keep)、右换道(Lane Change to Right),纵向行为中的加速(SpeedIncrease)、维持速度(Speed Keep)、减速(Speed Decrease)将周边车辆行为离散化划分为N个典型行为bi,N=9,分别为左换道减速(LCL-SD),左换道匀速(LCL-SK),左换道加速(LCL-SI),维持车道减速(LK-SD),维持车道匀速(LK-SK),维持车道加速(LK-SI),右换道减速(LCR-SD),右换道减速(LCR-SK),右换道减速(LCR-SI)。如图2所示每条轨迹对应于每个行为bi,其中1≤i≤9。利用Python的Pandas数据分析包开发计算机程序,对NGSIM交通数据集进行去噪处理并提取出有效数据集,根据车辆行为离散化划分方法标注各数据标定对应行为类型。According to the characteristics of many uncertain factors and complex and difficult to distinguish the behavior of surrounding target vehicles, the possible behaviors are divided into two directions: horizontal behavior and vertical behavior for combined division. From Lane Change to Left, Lane Keep, Lane Change to Right in the lateral behavior, SpeedIncrease, Speed Keep, Deceleration ( Speed Decrease) discretizes the behavior of surrounding vehicles into N typical behaviors b i , N=9, which are left lane change deceleration (LCL-SD), left lane change uniform speed (LCL-SK), left lane change acceleration (LCL -SI), maintain lane deceleration (LK-SD), maintain lane constant speed (LK-SK), maintain lane acceleration (LK-SI), right lane change deceleration (LCR-SD), right lane change deceleration (LCR-SK) , right lane change deceleration (LCR-SI). As shown in Fig. 2, each trajectory corresponds to each behavior bi, where 1≤i≤9 . Using Python's Pandas data analysis package to develop a computer program, denoise the NGSIM traffic data set and extract an effective data set, and label each data to calibrate the corresponding behavior type according to the discretization method of vehicle behavior.

Step2:获取交通环境参与车时序数据Step2: Obtain the time series data of the participating vehicles in the traffic environment

每辆交通环境参与车具有一个独立的ID,使用车载的GPS与IMU联合定位系统实时获取每个时刻自车的位置(x,y)、速度(Vx,Vy)、加速度(ax,ay)。考虑到后续步骤中数据传输的实时性与鲁棒性,数据采集频率为50Hz,即0.02s为采取前后两次数据间隔的时长。主车通过PC5接口接入V2V通信网络,使用以LTE模块中的D2D(Device-To-Device,设备间)邻近通信服务(ProSe)实时获取所处交通环境周边车辆的状态时序信息。所述的V2V通信技术英文全称为Vehicle-To-Vehicle Technology,因其能够克服高速移动引发的多普勒效应与复杂的通信环境在智能汽车领域受到广泛应用,其D2D模块无需通过基站即可建立邻近车辆终端之间的相互通信。主车锁定周边某一车辆作为行为预测目标车辆,根据上述步骤中获取的实时状态时序数据架构目标运动车辆的交通环境。在真实的交通环境中,人类驾驶员可以通过前向可视区域、后视镜与后视摄像仪获取周围的交通信息,而智能驾驶系统也可通过摄像头、激光雷达与毫米波雷达等视觉感知模块达到同样的目的,因此交通信息对目标车的影响是邻近前后交替传播的。在构建目标车辆的周围交通环境时,取目标车辆当前车道的前后方车辆与相邻车道的前后方车辆作为其行为发生的影响者,设周围影响车辆数目为h。图3分别为三路单行车道上目标车辆处于不同车道取周围影响车辆的方式,a为目标车辆处于中间车道,此时h为6;b为目标车辆处于左侧车道,此时h为4;c为目标车辆处于右侧车道,此时h为4。Each vehicle participating in the traffic environment has an independent ID, and uses the on-board GPS and IMU joint positioning system to obtain the position (x, y), speed (V x , V y ), acceleration (a x , a y ). Considering the real-time and robustness of data transmission in the subsequent steps, the data collection frequency is 50Hz, that is, 0.02s is the duration of the two data intervals before and after the acquisition. The host vehicle connects to the V2V communication network through the PC5 interface, and uses the D2D (Device-To-Device, inter-device) proximity communication service (ProSe) in the LTE module to obtain real-time status and timing information of the surrounding vehicles in the traffic environment. The full name of the V2V communication technology in English is Vehicle-To-Vehicle Technology. Because it can overcome the Doppler effect caused by high-speed movement and the complex communication environment, it is widely used in the field of smart cars, and its D2D module can be established without going through a base station. Intercommunication between adjacent vehicle terminals. The host vehicle locks a surrounding vehicle as the target vehicle for behavior prediction, and constructs the traffic environment of the target moving vehicle according to the real-time state time series data obtained in the above steps. In the real traffic environment, human drivers can obtain surrounding traffic information through the forward viewing area, rear-view mirrors and rear-view cameras, and the intelligent driving system can also perceive visual perception through cameras, lidar and millimeter-wave radar. The module achieves the same purpose, so the influence of traffic information on the target car is propagated alternately before and after the neighbors. When constructing the surrounding traffic environment of the target vehicle, take the front and rear vehicles in the current lane of the target vehicle and the front and rear vehicles in the adjacent lane as the influencers of its behavior, and set the number of surrounding affected vehicles as h. Figure 3 shows the ways in which the target vehicle is in different lanes and the surrounding vehicles on the three-way one-way lane, a is the target vehicle is in the middle lane, and h is 6 at this time; b is the target vehicle is in the left lane, and h is 4 at this time; c means that the target vehicle is in the right lane, and h is 4 at this time.

Step3:建立行车预测场Step3: Establish a driving prediction field

无论是是人驾驶的交通车还是具备自动驾驶能力的交通车,都是一个会对周围车路协同交通环境的激励做出相应“趋利避害”反应的智能体,并且周边车辆驾驶行为具有很大的不确定性、可变性,且分别受到自车各种期望收益的制衡影响。因此,下面在周边目标车辆行驶区域内建立一种基于决策影响因素的行车预测场EP,来量化周边车辆行为产生的影响因素。根据影响驾驶操纵者行为三要素(安全性、效率性、驾驶舒适性),行车预测场分为三个子预测场,分别为安全预测场ES、效率预测场EE、驾驶舒适预测场EC。其中,EP=ES+EE+EC。为方便说明,取图5所示某一典型交通环境H。Whether it is a human-driven traffic vehicle or a traffic vehicle with automatic driving ability, it is an intelligent body that responds to the incentives of the surrounding vehicle-road collaborative traffic environment, and the driving behavior of surrounding vehicles has the It has great uncertainty and variability, and is affected by the checks and balances of various expected benefits of the self-vehicle. Therefore, a driving prediction field EP based on decision influencing factors is established below in the surrounding target vehicle driving area to quantify the influencing factors generated by surrounding vehicle behaviors. According to the three factors (safety, efficiency, and driving comfort) that affect the driver's behavior, the driving prediction field is divided into three sub-forecasting fields, namely, the safety prediction field ES, the efficiency prediction field E E , and the driving comfort prediction field E C . where E P =E S +E E +E C . For the convenience of description, a typical traffic environment H shown in FIG. 5 is taken.

(1)建立安全预测场(1) Establish a safety prediction field

安全预测场表征安全性对周边目标车辆驾驶操纵者的影响。以目标车辆的前后向h辆周边交通车辆为产生安全场势的“电荷”,将前后向h辆周边交通车辆的位置、速度与加速度作为影响安全势值的主要变量。The safety prediction field characterizes the effect of safety on the driver and operator of the surrounding target vehicle. Taking h traffic vehicles in the front and rear of the target vehicle as the "charges" to generate the safety potential, and taking the position, speed and acceleration of the h traffic vehicles in the front and rear as the main variables that affect the safety potential value.

写出目标车辆行车区域内任意一点位置受到周围第j辆车影响所具有的单位安全势值Write out the unit safety potential value of any point in the driving area of the target vehicle affected by the surrounding jth vehicle

其中,(X,Y)为目标车辆行车区域内任意一点位置;GS为行车安全预测场待定常数;δj周围第j辆车的车辆类型系数;Mj为周围第j辆车的等效质量比,是第j辆车的长宽高乘积的倒数;(x[j],y[j])为目标车辆周围第j辆车当前时刻的位置向量;为目标车辆周围第j辆车当前时刻的速度向量;为目标车辆周围第j辆车当前时刻的加速度向量;ΔT为周边目标车辆行为预测周期时间;|| ||2为向量的2-范数符号。Among them, (X, Y) is the position of any point in the driving area of the target vehicle; G S is the undetermined constant of the driving safety prediction field; δ j is the vehicle type coefficient of the j-th vehicle around; M j is the equivalent of the j-th vehicle around The mass ratio is the reciprocal of the product of the length, width and height of the jth vehicle; (x [j] , y [j] ) is the current position vector of the jth vehicle around the target vehicle; is the velocity vector of the jth vehicle around the target vehicle at the current moment; is the acceleration vector of the jth vehicle around the target vehicle at the current moment; ΔT is the behavior prediction cycle time of the surrounding target vehicle; || || 2 is the 2-norm sign of the vector.

则目标车辆行车区域内任意一点位置所具有的单位安全势值Then the unit safety potential value of any point in the driving area of the target vehicle

如图6,仿真得到H交通环境下安全预测场场强分布。As shown in Fig. 6, the simulation obtains the field strength distribution of the safety prediction field in the H traffic environment.

(2)建立效率预测场(2) Establish an efficiency prediction field

效率预测场表征安全性对周边目标车辆驾驶操纵者的影响。以目标车辆为产生效率场势的“电荷”,将目标车辆的纵向位置作为影响效率势值的主要变量。The Efficiency Prediction Field characterizes the impact of safety on surrounding target vehicle drivers. Taking the target vehicle as the "charge" that generates the efficiency field potential, the longitudinal position of the target vehicle is the main variable that affects the efficiency potential value.

写出目标车辆行车区域内任意一点位置所具有的单位效率势值Write the unit efficiency potential value at any point in the target vehicle's driving area

Y为目标车辆行车区域内任意一点纵向位置;GE为行车效率预测场待定常数;M0为目标车辆的等效质量比,是目标车辆的长宽高乘积的倒数;y[0]为目标车辆当前时刻的纵向位置;Y is the longitudinal position of any point in the driving area of the target vehicle; G E is the undetermined constant of the driving efficiency prediction field; M 0 is the equivalent mass ratio of the target vehicle, which is the reciprocal of the product of the length, width and height of the target vehicle; y [0] is the target vehicle The longitudinal position of the vehicle at the current moment;

如图7,仿真得到H交通环境下效率预测场场强分布。As shown in Figure 7, the simulation obtains the field strength distribution of the efficiency prediction in the H traffic environment.

(3)建立驾驶舒适预测场(3) Establish a driving comfort prediction field

驾驶舒适预测场表征驾驶舒适性对周边目标车辆驾驶操纵者的影响。以目标车辆为产生驾驶舒适场势的“电荷”,将目标车辆前往行驶区域某一位置的横纵向加速度作为影响驾驶舒适势值的主要变量。The driving comfort prediction field characterizes the influence of driving comfort on the surrounding target vehicle driver. Taking the target vehicle as the "charge" that generates the driving comfort field potential, the lateral and longitudinal acceleration of the target vehicle going to a certain position in the driving area is taken as the main variable that affects the driving comfort potential value.

写出目标车辆行车区域内任意一点位置所具有的单位驾驶舒适势值Write the unit driving comfort potential value at any point in the driving area of the target vehicle

(X,Y)为目标车辆行车区域内任意一点位置;GC为行车驾驶舒适预测场待定常数;(x[0],y[0])为目标车辆当前时刻的位置向量;为目标车辆当前时刻的速度向量;ΔT为周边目标车辆行为预测周期时间;|| ||2为向量的2-范数符号。(X, Y) is the position of any point in the driving area of the target vehicle; G C is the undetermined constant of the driving comfort prediction field; (x [0] , y [0] ) is the position vector of the target vehicle at the current moment; is the velocity vector of the target vehicle at the current moment; ΔT is the behavior prediction cycle time of the surrounding target vehicle; || || 2 is the 2-norm sign of the vector.

如图8,仿真得到H交通环境下驾驶舒适预测场场强分布。As shown in Figure 8, the field strength distribution for driving comfort prediction in H traffic environment is obtained by simulation.

Step4:建立周边车辆行为预测模型Step4: Establish a prediction model of surrounding vehicle behavior

以目标车辆处于中间车道为例,将可行驶区域内安全区域依据行为类型划分为9个行为热区。模拟周边目标车辆的决策层产生和执行某一车辆行为bi会模糊估计各行车子预测场场强和的制衡影响,根据相似性原理,取各行为热区的中心点作为各行为类型结束时刻的目标车辆的位置。拟合每个车辆行为bi对应的相似性轨迹,取车辆在该轨迹下扫过的面积为积分区域 Taking the target vehicle in the middle lane as an example, the safe area in the drivable area is divided into 9 behavior hot areas according to the behavior type. The decision-making layer simulating the surrounding target vehicles to generate and execute a certain vehicle behavior b i will fuzzy estimate the balance effect of the predicted field strength and field strength of each vehicle. The location of the target vehicle. Fit the similarity trajectory corresponding to each vehicle behavior b i , and take the area swept by the vehicle under the trajectory as the integral area

将行车预测场场强和进行归一化处理,即将每个车辆行为的行车预测场场强和转为该车辆行为对应的预测概率,Normalize the predicted driving field strength sum, that is, convert the predicted driving field strength sum of each vehicle behavior into the predicted probability corresponding to the vehicle behavior,

写出似然函数L(θ)=ΠPpredict(bi),其中θ={KS,KE,KC}。Write the likelihood function L(θ) = ΠP predict ( bi ), where θ = {K S , K E , K C }.

以Step1中预处理好的NGSIM数据集为样本集使用成熟的共轭梯度法计算出最大似然估计量即初始权重系数KS,0,KE,0,KC,0Using the preprocessed NGSIM data set in Step1 as the sample set, use the mature conjugate gradient method to calculate the maximum likelihood estimator That is, the initial weight coefficients K S,0 , K E,0 , K C,0 .

则得出周边车辆行为预测模型函数Then get the surrounding vehicle behavior prediction model function

Step5:周边车辆行为实时预测与模型自适应矫正Step5: Real-time prediction of surrounding vehicle behavior and model adaptive correction

操作周边车辆的人类驾驶者或智能驾驶系统在周边交通环境还受到自身决策机制的影响,对安全性、效率性、驾驶舒适性的期望追求具有鲜明的个性,且期望追求在驾驶行为长期预测的时域内是稳定的。主车位于真实的交通环境中,首先依据Step2实时获取交通环境参与车时序数据,根据Step4建立的预测模型实时预测周边目标车辆在预测周期时间ΔT内的车辆典型行为概率Ppredict(bi),输出最大行为概率对应的车辆行为类型为预测结果。Human drivers or intelligent driving systems operating surrounding vehicles are also affected by their own decision-making mechanisms in the surrounding traffic environment, and their expectations for safety, efficiency, and driving comfort have distinct personalities, and they are expected to pursue long-term driving behavior predictions. is stable in the time domain. The main vehicle is located in the real traffic environment. First, the time series data of the participating vehicles in the traffic environment are obtained in real time according to Step 2, and the typical behavior probability P predict (b i ) of the surrounding target vehicles within the prediction cycle time ΔT is predicted in real time according to the prediction model established in Step 4, The vehicle behavior type corresponding to the output maximum behavior probability is the prediction result.

为进一步提高预测精度,本发明还提出一种权重系数回归矫正方法,以减小真实场景中权重系数偏差给行为预测结果带来的错误率。当一个预测时间周期ΔT终了时,利用隐马尔可夫模型(HMM)识别预测周期时间的ΔT内的周边车辆典型行为类型。In order to further improve the prediction accuracy, the present invention also proposes a weight coefficient regression correction method, so as to reduce the error rate caused by the weight coefficient deviation in the real scene to the behavior prediction result. When a prediction time period ΔT expires, a Hidden Markov Model (HMM) is used to identify the typical behavior types of surrounding vehicles within the prediction period time ΔT.

设隐马尔可夫模型为一个五元组(Q,V,A,B,π)。可观察状态表示为V={V1,V2,…,VM},M为观察状态的数目;隐藏状态表示为Q={Q1,Q2,…,QN},N为隐藏状态的数目。I是长度为T的状态序列,O是对应的观测序列,I={I1,I2,…,IT},O={O1,O2,…,OT}。Let the hidden Markov model be a quintuple (Q, V, A, B, π). The observable state is expressed as V={V 1 , V 2 ,...,VM }, where M is the number of observed states; the hidden state is expressed as Q={Q 1 , Q 2 ,...,Q N }, where N is the hidden state Number of. I is a state sequence of length T, O is a corresponding observation sequence, I={I 1 ,I 2 ,...,I T }, O={O 1 ,O 2 ,...,O T }.

A=[aij]N×N为隐藏状态转移概率矩阵,其元素表示HMM模型中各个隐藏状态之间的转移概率。其中,A=[a ij ] N×N is the hidden state transition probability matrix, and its elements represent the transition probability between each hidden state in the HMM model. in,

aij=P(It+1=Qj∣It=Qi),i=1,2…,N;j=1,2…,Na ij =P(I t+1 =Q j ∣I t =Q i ),i=1,2...,N; j=1,2...,N

是在t时刻,隐藏状态为Qi的条件下,在t+1时刻隐藏状态是Qj的概率。is the probability that the hidden state is Q j at time t+1 under the condition that the hidden state is Q i at time t.

B=[bj(k)]N×M为混淆矩阵,其元素表示HMM模型中各个隐藏状态和观察状态之间的转移概率。其中,B=[b j (k)] N×M is a confusion matrix, and its elements represent the transition probability between each hidden state and observed state in the HMM model. in,

bj(k)=P(Ot=Vk∣It=Qj),k=1,2…,M;j=1,2…,Nb j (k)=P(O t =V k ∣I t =Q j ),k=1,2...,M; j=1,2...,N

表示在t时刻,隐藏状态Qj是条件下,观察状态为Ot的概率。Indicates that at time t, the hidden state Q j is the probability that the observed state is O t under the condition.

π=(πi)为初始状态概率矩阵,其中πi=P(I1=Qi),i=1,2,…,N是初始时刻t=1各个隐含状态Qi的概率。π=(π i ) is the initial state probability matrix, wherein π i =P(I 1 =Q i ), i =1,2,...,N is the probability of each hidden state Qi at the initial time t=1.

用HMM模型进行周边车辆行为识别可分为两个阶段:The behavior recognition of surrounding vehicles with HMM model can be divided into two stages:

a.模型训练学习:对每一个车辆行为识别模型初始化,获得初始参数N,M,A,B,π;提取Step1处理好的NGSIM交通数据集中ΔT内每一个采集时间点的特征数据Ot(横向位移、速度、加速度与纵向位移、速度、加速度),每个时间点特征数据Ot组成的观测序列O=O1O2O3……O△T。将观测序列作为HMM参数学习的输入,依据模型初始化后的初始参数,采用Baum-Welch迭代算法调整模型λ=(A,B,π)的参数,使概率函数最大化,逐步更新模型参数,最终获取各个行为类型的最优HMM模型;a. Model training and learning: Initialize each vehicle behavior recognition model to obtain initial parameters N, M, A, B, π; extract the feature data O t ( Lateral displacement, velocity, acceleration and longitudinal displacement, velocity, acceleration), the observation sequence O=O 1 O 2 O 3 ... O ΔT composed of characteristic data O t at each time point. The observation sequence is used as the input of HMM parameter learning. According to the initial parameters after model initialization, the Baum-Welch iterative algorithm is used to adjust the parameters of the model λ=(A, B, π) to maximize the probability function, and gradually update the model parameters. Obtain the optimal HMM model for each behavior type;

b.在线测试识别:然后利用训练好的车辆行为HMM识别模型,将待识别的周边目标车辆经特征提取、编码后形成观测序列作为模型输入,利用前向算法计算观测序列在各个HMM模型下的概率Precognize_k(bi)。b. Online test identification: Then use the trained vehicle behavior HMM identification model to extract and encode the surrounding target vehicles to be identified to form the observation sequence as the model input, and use the forward algorithm to calculate the observation sequence under each HMM model. The probability P recognize_k (b i ).

将行为预测模型概率函数写为Write the behavior prediction model probability function as

Ppredict_k(bi)=fk(KS_k,KE_k,KC_k)P predict_k (bi )=f k ( K S_k ,K E_k ,K C_k )

即Ppredict_k(bi)关于KS_k,KE_k,KC_k的函数,k表示第k个预测周期时间ΔT。That is, P predict_k (b i ) is a function of K S_k , K E_k , K C_k , where k represents the kth prediction cycle time ΔT.

写出预测概率值与识别概率值的残差平方和函数,即代价函数Write the residual sum of squares function of the predicted probability value and the recognition probability value, that is, the cost function

构造矫正函数其中为α矫正速率系数。Construct Correction Function where is the α correction rate coefficient.

然后将KS_k+1,KE_k+1,KC_k+1代入更新预测模型参数,来预测下一个通过预测周期时间ΔT内目标车辆行为。通过矫正函数逐个预测周期时间对权重系数在线矫正,以实现自适应预测,进一步提高周边车辆行为识别预测的准确率。Then, K S_k+1 , K E_k+1 , K C_k+1 are substituted into the parameters of the updated prediction model to predict the behavior of the target vehicle within the next passing prediction cycle time ΔT. The weight coefficients are corrected online by the correction function to predict the cycle time one by one, so as to realize the adaptive prediction and further improve the accuracy of the behavior recognition and prediction of surrounding vehicles.

上文所列出的一系列的详细说明仅仅是针对本发明的可行性实施方式的具体说明,它们并非用以限制本发明的保护范围,凡未脱离本发明技艺精神所作的等效实施方式或变更均应包含在本发明的保护范围之内。The series of detailed descriptions listed above are only specific descriptions for the feasible embodiments of the present invention, and they are not used to limit the protection scope of the present invention. Changes should all be included within the protection scope of the present invention.

Claims (8)

1.一种基于行车预测场的周边车辆行为自适应矫正预测方法,其特征在于,包括如下步骤:1. a surrounding vehicle behavior adaptive correction prediction method based on driving prediction field, is characterized in that, comprises the steps: 步骤1:周边车辆行为离散化与数据集预处理;Step 1: Discretization of surrounding vehicle behavior and data set preprocessing; 步骤2:获取交通环境参与车时序数据;Step 2: Obtain the time series data of the participating vehicles in the traffic environment; 步骤3:建立行车预测场,包括安全预测场、效率预测场、驾驶舒适预测场;Step 3: Establish a driving prediction field, including a safety prediction field, an efficiency prediction field, and a driving comfort prediction field; 步骤4:建立周边车辆行为预测模型Step 4: Establish a model for predicting the behavior of surrounding vehicles 步骤5:周边车辆行为实时预测与模型自适应矫正。Step 5: Real-time prediction of surrounding vehicle behavior and model adaptive correction. 2.根据权利要求1所述的一种基于行车预测场的周边车辆行为自适应矫正预测方法,其特征在于,所述步骤1的具体过程包括:2. a kind of surrounding vehicle behavior adaptive correction prediction method based on driving prediction field according to claim 1, is characterized in that, the concrete process of described step 1 comprises: 将周边车辆行为根据横向与纵向两个方面组合划分,离散化划分为N个典型行为bi,对NGSIM交通数据集进行去噪处理并提取出有效数据集,根据车辆行为离散化划分方法标注各数据标定对应行为类型。The surrounding vehicle behavior is divided according to the combination of horizontal and vertical aspects, and the discretization is divided into N typical behaviors b i . The NGSIM traffic data set is denoised and an effective data set is extracted. The data calibration corresponds to the behavior type. 3.根据权利要求2所述的一种基于行车预测场的周边车辆行为自适应矫正预测方法,其特征在于,所述N个典型行为具体为:3. a kind of surrounding vehicle behavior adaptive correction prediction method based on driving prediction field according to claim 2, is characterized in that, described N typical behaviors are specifically: 左换道减速、左换道匀速、左换道加速、维持车道减速、维持车道匀速、维持车道加速、右换道减速、右换道减速、右换道减速。Left lane change deceleration, left lane change uniform speed, left lane change acceleration, maintain lane deceleration, maintain lane uniform speed, maintain lane acceleration, right lane deceleration, right lane deceleration, right lane deceleration. 4.根据权利要求2所述的一种基于行车预测场的周边车辆行为自适应矫正预测方法,其特征在于,所述步骤2的具体实现包括:4. a kind of surrounding vehicle behavior adaptive correction prediction method based on driving prediction field according to claim 2, is characterized in that, the concrete realization of described step 2 comprises: 每辆交通环境参与车使用车载GPS与IMU联合定位系统实时获取每个时刻自车的位置(x,y)、速度(Vx,Vy)、加速度(ax,ay);主车使用V2V通信技术中LTE模块的D2D邻近通信服务实时获取所处交通环境周边车辆的状态时序信息。Each vehicle participating in the traffic environment uses the on-board GPS and IMU joint positioning system to obtain the position (x, y), speed (V x , V y ) and acceleration (a x , a y ) of the vehicle at each moment in real time; the main vehicle uses The D2D proximity communication service of the LTE module in the V2V communication technology obtains the status and timing information of the surrounding vehicles in the traffic environment in real time. 5.根据权利要求1所述的一种基于行车预测场的周边车辆行为自适应矫正预测方法,其特征在于,所述步骤3的具体实现包括:5. a kind of surrounding vehicle behavior adaptive correction prediction method based on driving prediction field according to claim 1, is characterized in that, the concrete realization of described step 3 comprises: 所述安全预测场的建立方法:The establishment method of the safety prediction field: 以目标车辆的前后向h辆周边交通车辆为产生安全场势的“电荷”,将前后向h辆周边交通车辆的位置、速度与加速度作为影响安全势值的主要变量;Taking the front and rear of h surrounding traffic vehicles of the target vehicle as the "charges" to generate the safety field potential, and taking the position, speed and acceleration of the front and rear h surrounding traffic vehicles as the main variables affecting the safety potential value; 写出目标车辆行车区域内任意一点位置受到周围第j辆车影响所具有的单位安全势值Write out the unit safety potential value of any point in the driving area of the target vehicle affected by the surrounding jth vehicle 其中,(X,Y)为目标车辆行车区域内任意一点位置;Gs为行车安全预测场待定常数;δj周围第j辆车的车辆类型系数;Mj为周围第j辆车的等效质量比,是第j辆车的长宽高乘积的倒数;(x[j],y[j])为目标车辆周围第j辆车当前时刻的位置向量;为目标车辆周围第j辆车当前时刻的速度向量;为目标车辆周围第j辆车当前时刻的加速度向量;ΔT为周边目标车辆行为预测周期时间;||||2为向量的2-范数符号;Among them, (X, Y) is the position of any point in the driving area of the target vehicle; G s is the undetermined constant of the driving safety prediction field; δ j is the vehicle type coefficient of the jth vehicle around; M j is the equivalent of the jth vehicle around The mass ratio is the reciprocal of the product of the length, width and height of the jth vehicle; (x [j] , y [j] ) is the current position vector of the jth vehicle around the target vehicle; is the velocity vector of the jth vehicle around the target vehicle at the current moment; is the acceleration vector of the jth vehicle around the target vehicle at the current moment; ΔT is the behavior prediction cycle time of the surrounding target vehicle; |||| 2 is the 2-norm symbol of the vector; 则目标车辆行车区域内任意一点位置所具有的单位安全势值Then the unit safety potential value of any point in the driving area of the target vehicle 所述效率预测场的建立方法:The establishment method of the efficiency prediction field: 以目标车辆为产生效率场势的“电荷”,将目标车辆的纵向位置作为影响效率势值的主要变量;Taking the target vehicle as the "charge" that generates the efficiency field potential, and taking the longitudinal position of the target vehicle as the main variable affecting the efficiency potential value; 写出目标车辆行车区域内任意一点位置所具有的单位效率势值Write the unit efficiency potential value at any point in the target vehicle's driving area Y为目标车辆行车区域内任意一点纵向位置;GE为行车效率预测场待定常数;M0为目标车辆的等效质量比,是目标车辆的长宽高乘积的倒数;y[0]为目标车辆当前时刻的纵向位置;Y is the longitudinal position of any point in the driving area of the target vehicle; G E is the undetermined constant of the driving efficiency prediction field; M 0 is the equivalent mass ratio of the target vehicle, which is the reciprocal of the product of the length, width and height of the target vehicle; y [0] is the target vehicle The longitudinal position of the vehicle at the current moment; 所述驾驶舒适预测场的建立方法:The establishment method of the driving comfort prediction field: 以目标车辆为产生驾驶舒适场势的“电荷”,将目标车辆前往行驶区域某一位置的横纵向加速度作为影响驾驶舒适势值的主要变量;Taking the target vehicle as the "charge" that generates the driving comfort field potential, the lateral and longitudinal acceleration of the target vehicle going to a certain position in the driving area is taken as the main variable affecting the driving comfort potential value; 写出目标车辆行车区域内任意一点位置所具有的单位驾驶舒适势值Write the unit driving comfort potential value at any point in the driving area of the target vehicle (X,Y)为目标车辆行车区域内任意一点位置;GC为行车驾驶舒适预测场待定常数;(x[0],y[0])为目标车辆当前时刻的位置向量;为目标车辆当前时刻的速度向量;ΔT为周边目标车辆行为预测周期时间;||||2为向量的2-范数符号。(X, Y) is the position of any point in the driving area of the target vehicle; G C is the undetermined constant of the driving comfort prediction field; (x [0] , y [0] ) is the position vector of the target vehicle at the current moment; is the velocity vector of the target vehicle at the current moment; ΔT is the behavior prediction cycle time of the surrounding target vehicle; |||| 2 is the 2-norm sign of the vector. 6.根据权利要求1所述的一种基于行车预测场的周边车辆行为自适应矫正预测方法,其特征在于,所述步骤4的具体实现包括:6. a kind of surrounding vehicle behavior adaptive correction prediction method based on driving prediction field according to claim 1, is characterized in that, the concrete realization of described step 4 comprises: 以目标车辆处于中间车道为例,将可行驶区域内安全区域依据行为类型划分为9个行为热区;模拟周边目标车辆的决策层产生和执行某一车辆行为bi会模糊估计各行车子预测场场强和的制衡影响,根据相似性原理,取各行为热区的中心点作为各行为类型结束时刻的目标车辆的位置;拟合每个车辆行为bi对应的相似性轨迹,取车辆在该轨迹下扫过的面积为积分区域 Taking the target vehicle in the middle lane as an example, the safe area in the drivable area is divided into 9 behavioral hotspots according to the type of behavior; the decision-making layer simulating the surrounding target vehicle to generate and execute a certain vehicle behavior will fuzzy estimate the prediction field of each driving sub-prediction field. According to the principle of similarity, the center point of each behavior hot zone is taken as the position of the target vehicle at the end of each behavior type; the similarity trajectory corresponding to each vehicle behavior bi is fitted, and the The area swept under the trajectory is the integration area 其中,KS为安全预测场场强和的权重系数;KE为效率预测场场强和的权重系数;KS为驾驶舒适预测场场强和的权重系数;Among them, K S is the weight coefficient of the field strength sum for safety prediction; KE is the weight coefficient of the efficiency prediction field strength sum; K S is the weight coefficient of the driving comfort prediction field strength sum; 将行车预测场场强和进行归一化处理,即将每个车辆行为的行车预测场场强和转为该车联行为对应的预测概率,Normalize the sum of the predicted driving field strength, that is, convert the predicted field strength of each vehicle behavior into the predicted probability corresponding to the connected vehicle behavior, 写出似然函数L(θ)=ΠPpredict(bi),其中θ={KS,KE,KC};Write out the likelihood function L(θ)=ΠP predict (b i ), where θ={K S , K E , K C }; 以步骤1中预处理好的NGSIM数据集为样本集使用成熟的共轭梯度法计算出最大似然估计量即初始权重系数KS,0,KE,0,KC,0Using the preprocessed NGSIM data set in step 1 as the sample set, use the mature conjugate gradient method to calculate the maximum likelihood estimator That is, the initial weight coefficients K S,0 , K E,0 , K C,0 . 得出周边车辆行为预测模型函数Obtain the surrounding vehicle behavior prediction model function 7.根据权利要求1所述的一种基于行车预测场的周边车辆行为自适应矫正预测方法,其特征在于,所述步骤5的具体实现包括:7. a kind of surrounding vehicle behavior adaptive correction prediction method based on driving prediction field according to claim 1, is characterized in that, the concrete realization of described step 5 comprises: 首先依据步骤2实时获取交通环境参与车时序数据,根据步骤4建立的预测模型实时预测周边目标车辆在预测周期时间ΔT内的车辆典型行为概率Ppredict(bi),输出最大行为概率对应的车辆行为类型为预测结果。First, obtain the time series data of the participating vehicles in the traffic environment in real time according to step 2, predict the typical behavior probability P predict (b i ) of the surrounding target vehicles in the prediction cycle time ΔT in real time according to the prediction model established in step 4, and output the vehicle corresponding to the maximum behavior probability. The behavior type is predicted outcome. 8.根据权利要求7所述的一种基于行车预测场的周边车辆行为自适应矫正预测方法,其特征在于,还包括:针对预测结果采用一种权重系数回归矫正方法,所述矫正方法具体为:8 . The method for adaptively correcting and predicting the behavior of surrounding vehicles based on the driving prediction field according to claim 7 , further comprising: adopting a weight coefficient regression correction method for the prediction result, and the correction method is specifically: 9 . : 当一个预测时间周期ΔT结束时,利用隐马尔可夫模型识别预测周期时间的ΔT内的周边车辆典型行为类型;When a prediction time period ΔT ends, use the Hidden Markov Model to identify the typical behavior types of surrounding vehicles within the prediction period time ΔT; 设隐马尔可夫模型为一个五元组(Q,V,A,B,π),观察状态表示为V={V1,V2,...,VM},M为观察状态的数目;隐藏状态表示为Q={Q1,Q2,…,QN},N为隐藏状态的数目,I是长度为T的状态序列,O是对应的观测序列,I={I1,I2,...,IT},O={O1,O2,...,OT};Let the hidden Markov model be a quintuple (Q, V, A, B, π), and the observed states are represented as V={V 1 , V 2 , ..., V M }, where M is the number of observed states ; Hidden state is expressed as Q={Q 1 , Q 2 ,...,Q N }, N is the number of hidden states, I is the state sequence of length T, O is the corresponding observation sequence, I={I 1 , I 2 , ..., I T }, O = {O 1 , O 2 , ..., O T }; A=[aij]N×N为隐藏状态转移概率矩阵,其元素表示HMM模型中各个隐藏状态之间的转移概率;其中,A=[a ij ] N×N is the hidden state transition probability matrix, and its elements represent the transition probability between each hidden state in the HMM model; wherein, aij=P(It+1=Qj|It=Qi),i=1,2…,N;j=1,2…,Na ij =P(I t+1 =Q j |I t =Q i ), i=1, 2...,N; j=1, 2...,N 是在t时刻,隐藏状态为Qi的条件下,在t+1时刻隐藏状态是Qj的概率;is the probability that the hidden state is Q j at time t+1 under the condition that the hidden state is Qi i at time t; B=[bj(k)]N×M为混淆矩阵,其元素表示HMM模型中各个隐藏状态和观察状态之间的转移概率;其中,B=[b j (k)] N×M is a confusion matrix, and its elements represent the transition probability between each hidden state and observed state in the HMM model; among them, bj(k)=P(Ot=Vk|It=Qj),k=1,2…,M;j=1,2…,Nb j (k)=P(O t =V k |I t =Q j ), k=1,2...,M; j=1,2...,N 表示在t时刻,隐藏状态Qj是条件下,观察状态为Ot的概率;Indicates that at time t, the hidden state Q j is the probability that the observed state is O t ; π=(πi)为初始状态概率矩阵,其中πi=P(I1=Qi),i=1,2,…,N是初始时刻t=1各个隐含状态Qi的概率;π=(π i ) is the initial state probability matrix, wherein π i =P(I 1 =Q i ), i =1,2,...,N is the probability of each hidden state Qi at the initial time t=1; 用HMM模型进行周边车辆行为识别分为两个阶段:The behavior recognition of surrounding vehicles with HMM model is divided into two stages: a.模型训练学习:对每一个车辆行为预测模型初始化,获得初始参数N,M,A,B,π;提取步骤1处理好的NGSIM交通数据集中ΔT内每一个采集时间点的特征数据Ot,即横向位移、速度、加速度与纵向位移、速度、加速度,每个时间点特征数据Ot组成的观测序列O=O1O2O3......OΔT;将观测序列作为HMM参数学习的输入,依据模型初始化后的初始参数,采用Baum-Welch迭代算法调整模型λ=(A,B,π)的参数,使概率函数最大化,逐步更新模型参数,最终获取各个行为类型的最优HMM模型;a. Model training and learning: Initialize each vehicle behavior prediction model to obtain initial parameters N, M, A, B, π; extract the feature data O t at each collection time point in the NGSIM traffic data set processed in step 1 , namely the observation sequence O=O 1 O 2 O 3 ......O ΔT composed of the lateral displacement, velocity, acceleration and longitudinal displacement, velocity, acceleration, characteristic data O t at each time point; take the observation sequence as HMM The input of parameter learning is based on the initial parameters after the model is initialized, and the Baum-Welch iterative algorithm is used to adjust the parameters of the model λ=(A, B, π) to maximize the probability function, gradually update the model parameters, and finally obtain the parameters of each behavior type. Optimal HMM model; b.在线测试识别:利用训练好的车辆行为HMM模型,将待识别的周边目标车辆经特征提取、编码后形成观测序列作为模型输入,利用前向算法计算观测序列在各个HMM模型下的概率Precognize_k(bi);b. Online test identification: Using the trained vehicle behavior HMM model, the surrounding target vehicles to be identified are extracted and encoded to form the observation sequence as the model input, and the forward algorithm is used to calculate the probability P of the observation sequence under each HMM model. recognize_k (bi); 将行为预测模型概率函数写为Write the behavior prediction model probability function as Ppredict_k(bi)=fk(KS_k,KE_k,KC_k)P predict_k (bi )=f k (K S_k , K E_k , K C_k ) 即Ppredict_k(bi)关于KS_k,KE_k,KC_k的函数,k表示第k个预测周期时间ΔT;That is, P predict_k (b i ) is a function of K S_k , K E_k , K C_k , and k represents the kth prediction cycle time ΔT; 写出预测概率值与识别概率值的残差平方和函数,即代价函数Write the residual sum of squares function of the predicted probability value and the recognition probability value, that is, the cost function 构造矫正函数其中为α矫正速率系数;Construct Correction Function where is the α correction rate coefficient; 然后将KS_k+1,KE_k+1,KC_k+1代入更新预测模型参数,来预测下一个通过预测周期时间ΔT内目标车辆行为,通过矫正函数逐个预测周期时间对权重系数在线矫正,实现自适应预测,提高周边车辆行为识别预测的准确率。Then substitute K S_k+1 , K E_k+1 , and K C_k+1 into the parameters of the updated prediction model to predict the next target vehicle behavior within the prediction cycle time ΔT, and use the correction function to predict the cycle time one by one to correct the weight coefficients online to achieve Adaptive prediction improves the accuracy of surrounding vehicle behavior recognition and prediction.
CN201910071784.XA 2019-01-25 2019-01-25 Peripheral vehicle behavior self-adaptive correction prediction method based on driving prediction field Active CN109727490B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201910071784.XA CN109727490B (en) 2019-01-25 2019-01-25 Peripheral vehicle behavior self-adaptive correction prediction method based on driving prediction field

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201910071784.XA CN109727490B (en) 2019-01-25 2019-01-25 Peripheral vehicle behavior self-adaptive correction prediction method based on driving prediction field

Publications (2)

Publication Number Publication Date
CN109727490A true CN109727490A (en) 2019-05-07
CN109727490B CN109727490B (en) 2021-10-12

Family

ID=66300095

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201910071784.XA Active CN109727490B (en) 2019-01-25 2019-01-25 Peripheral vehicle behavior self-adaptive correction prediction method based on driving prediction field

Country Status (1)

Country Link
CN (1) CN109727490B (en)

Cited By (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110288835A (en) * 2019-06-28 2019-09-27 江苏大学 A Real-time Recognition Method of Surrounding Vehicle Behavior Based on Kinematics Prediction and Compensation Mechanism
CN110851948A (en) * 2019-08-27 2020-02-28 清华大学 Driving environment situation assessment method and assessment device under unstructured road conditions
CN110920631A (en) * 2019-11-27 2020-03-27 北京三快在线科技有限公司 Method and device for controlling vehicle, electronic equipment and readable storage medium
CN111338335A (en) * 2019-12-31 2020-06-26 清华大学 A vehicle local trajectory planning method in structured road scene
CN113177508A (en) * 2021-05-18 2021-07-27 中移(上海)信息通信科技有限公司 Method, device and equipment for processing driving information
WO2021196879A1 (en) * 2020-03-31 2021-10-07 华为技术有限公司 Method and device for recognizing driving behavior of vehicle
CN113561996A (en) * 2021-09-23 2021-10-29 国汽智控(北京)科技有限公司 Trajectory planning method and device
CN114852099A (en) * 2021-02-03 2022-08-05 郑州宇通客车股份有限公司 Method for predicting lane changing behavior of motor vehicle
CN117922576A (en) * 2024-03-22 2024-04-26 山东科技大学 Automatic driving vehicle lane change decision method based on data and knowledge double driving

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20090140882A1 (en) * 2007-12-03 2009-06-04 Robert Thomas Arenburg Dynamic speed limit system
CN101529486A (en) * 2006-11-01 2009-09-09 丰田自动车株式会社 Cruise control plan evaluation device and method
CN106408981A (en) * 2016-10-21 2017-02-15 江苏大学 Unmanned vehicle information optimization system and method based on vehicle information sharing
CN106950956A (en) * 2017-03-22 2017-07-14 合肥工业大学 The wheelpath forecasting system of fusional movement model and behavior cognitive model
CN107967486A (en) * 2017-11-17 2018-04-27 江苏大学 A kind of nearby vehicle Activity recognition method based on V2V communications with HMM-GBDT mixed models
CN108387242A (en) * 2018-02-07 2018-08-10 西南交通大学 Automatic Pilot lane-change prepares and executes integrated method for planning track
CN108470460A (en) * 2018-04-11 2018-08-31 江苏大学 A kind of nearby vehicle Activity recognition method based on smart mobile phone and RNN

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101529486A (en) * 2006-11-01 2009-09-09 丰田自动车株式会社 Cruise control plan evaluation device and method
US20090140882A1 (en) * 2007-12-03 2009-06-04 Robert Thomas Arenburg Dynamic speed limit system
CN106408981A (en) * 2016-10-21 2017-02-15 江苏大学 Unmanned vehicle information optimization system and method based on vehicle information sharing
CN106950956A (en) * 2017-03-22 2017-07-14 合肥工业大学 The wheelpath forecasting system of fusional movement model and behavior cognitive model
CN107967486A (en) * 2017-11-17 2018-04-27 江苏大学 A kind of nearby vehicle Activity recognition method based on V2V communications with HMM-GBDT mixed models
CN108387242A (en) * 2018-02-07 2018-08-10 西南交通大学 Automatic Pilot lane-change prepares and executes integrated method for planning track
CN108470460A (en) * 2018-04-11 2018-08-31 江苏大学 A kind of nearby vehicle Activity recognition method based on smart mobile phone and RNN

Cited By (18)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110288835A (en) * 2019-06-28 2019-09-27 江苏大学 A Real-time Recognition Method of Surrounding Vehicle Behavior Based on Kinematics Prediction and Compensation Mechanism
CN110288835B (en) * 2019-06-28 2021-08-17 江苏大学 A Real-time Recognition Method of Surrounding Vehicle Behavior Based on Kinematic Prediction and Compensation Mechanism
CN110851948A (en) * 2019-08-27 2020-02-28 清华大学 Driving environment situation assessment method and assessment device under unstructured road conditions
CN110920631B (en) * 2019-11-27 2021-02-12 北京三快在线科技有限公司 Method and device for controlling vehicle, electronic equipment and readable storage medium
WO2021103841A1 (en) * 2019-11-27 2021-06-03 北京三快在线科技有限公司 Control vehicle
CN110920631A (en) * 2019-11-27 2020-03-27 北京三快在线科技有限公司 Method and device for controlling vehicle, electronic equipment and readable storage medium
US12221117B2 (en) 2019-11-27 2025-02-11 Beijing Sankuai Online Technology Co., Ltd Vehicle control
CN111338335B (en) * 2019-12-31 2021-02-26 清华大学 Vehicle local track planning method under structured road scene
CN111338335A (en) * 2019-12-31 2020-06-26 清华大学 A vehicle local trajectory planning method in structured road scene
WO2021196879A1 (en) * 2020-03-31 2021-10-07 华为技术有限公司 Method and device for recognizing driving behavior of vehicle
CN114852099A (en) * 2021-02-03 2022-08-05 郑州宇通客车股份有限公司 Method for predicting lane changing behavior of motor vehicle
CN114852099B (en) * 2021-02-03 2024-08-02 宇通客车股份有限公司 Method for predicting lane changing behavior of motor vehicle
CN113177508A (en) * 2021-05-18 2021-07-27 中移(上海)信息通信科技有限公司 Method, device and equipment for processing driving information
CN113177508B (en) * 2021-05-18 2022-04-08 中移(上海)信息通信科技有限公司 A method, device and device for processing traffic information
CN113561996B (en) * 2021-09-23 2021-12-21 国汽智控(北京)科技有限公司 Trajectory planning method and device
CN113561996A (en) * 2021-09-23 2021-10-29 国汽智控(北京)科技有限公司 Trajectory planning method and device
CN117922576A (en) * 2024-03-22 2024-04-26 山东科技大学 Automatic driving vehicle lane change decision method based on data and knowledge double driving
CN117922576B (en) * 2024-03-22 2024-05-17 山东科技大学 A lane-changing decision method for autonomous driving vehicles based on dual drive of data and knowledge

Also Published As

Publication number Publication date
CN109727490B (en) 2021-10-12

Similar Documents

Publication Publication Date Title
CN109727490B (en) Peripheral vehicle behavior self-adaptive correction prediction method based on driving prediction field
Duan et al. Hierarchical reinforcement learning for self‐driving decision‐making without reliance on labelled driving data
US11762391B2 (en) Systems and methods for training predictive models for autonomous devices
Zhang et al. Human-like autonomous vehicle speed control by deep reinforcement learning with double Q-learning
US20230359202A1 (en) Jointly Learnable Behavior and Trajectory Planning for Autonomous Vehicles
US11783232B2 (en) System and method for multi-agent reinforcement learning in a multi-agent environment
EP3835908B1 (en) Automatic driving method, training method and related apparatuses
Streubel et al. Prediction of driver intended path at intersections
US11891087B2 (en) Systems and methods for generating behavioral predictions in reaction to autonomous vehicle movement
CN110288835B (en) A Real-time Recognition Method of Surrounding Vehicle Behavior Based on Kinematic Prediction and Compensation Mechanism
CN113485380A (en) AGV path planning method and system based on reinforcement learning
WO2021134172A1 (en) Trajectory prediction method and related device
CN111079590A (en) Peripheral vehicle behavior pre-judging method of unmanned vehicle
JP2024543943A (en) Method and system for feasibility-based operation of autonomous agents - Patents.com
CN111907517A (en) Automatic parking control method and system, vehicle and field end edge cloud system
US11794780B2 (en) Reward function for vehicles
CN115303297A (en) Method and device for controlling end-to-end automatic driving under urban market scene based on attention mechanism and graph model reinforcement learning
US12091042B2 (en) Method and system for training an autonomous vehicle motion planning model
US20210387652A1 (en) Systems and methods for long-term prediction of lane change maneuver
Meghjani et al. Context and intention aware planning for urban driving
CN115761431A (en) System and method for providing spatiotemporal cost map inferences for model predictive control
Lee et al. Probabilistic inference of traffic participants' lane change intention for enhancing adaptive cruise control
John et al. Estimation of steering angle and collision avoidance for automated driving using deep mixture of experts
Gutiérrez-Moreno et al. Hybrid decision making for autonomous driving in complex urban scenarios
Liao et al. Lateral Motion Control for Obstacle Avoidance in Autonomous Driving Based on Deep Reinforcement Learning

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