The invention relates to the field of intelligent vehicle, in particular to a reconstruction method of intelligent vehicle sat environment envelope based on forward vehicle driving behavior.
With the rapid development of automobile industry and the continuous improvement of people's living standards, the car ownership continues to climb, followed by a series of urgent problems such as increasing traffic pressure, road congestion, frequent traffic accidents and so on. As an effective way to solve the above problems, intelligent transportation system has attracted wide attention from all walks of life. As a new technology in intelligent transportation system, intelligent vehicle has become a research hotspot at home and abroad. The first problem to be solved in intelligent vehicles is environmental perception, which is to perceive the traffic environment around vehicles and the motion parameters of intelligent vehicles through visual sensors, radar sensors vehicle sensors and so on. It can be found that domestic and foreign scholars have only perceived the current motion parameters of surrounding vehicles of intelligent vehicle, and carry out path planning and tracking control nowadays. However, the random change of driving behavior of surrounding vehicles, especially forward vehicles, makes it difficult for intelligent vehicles to predict the potential collision risk, thus affecting the accuracy of path planning and tracking control. Therefore, in order to simulate the behavior of predicting potential collision risk during human driving, the forward vehicle driving behavior prediction is introduced into the safety environment envelope. According to the forward vehicle driving behavior, the safety environment envelope is reconstructed, and the potential collision risk is predicted, so as to improve the safety of intelligent vehicles.
Therefore, the invention proposes a reconstruction method of intelligent vehicle safety environment envelope based on forward vehicle driving behavior, which senses the traffic environment and forward vehicle of intelligent vehicle through camera and lidar, establishes a prediction model of forward vehicle driving behavior, and predicts forward vehicle driving behavior. According to the forecasting results of driving behavior of forward vehicles, the lateral and longitudinal spacing between intelligent vehicles and forward vehicles are modified to reconstruct the safety environment envelope of intelligent vehicles, and then the potential collision risk is estimated to improve the safety of intelligent vehicles. By consulting the data, the application of introducing forward driving behavior into safety environment envelope of intelligent vehicles has not been reported yet.
The aim of the invention is to provide a reconstruction method of intelligent vehicle safety environment envelope based on forward vehicle driving behavior. Starting from simulating the real drivers behavior of predicting the potential collision risk in the forward driving area, the prediction of forward driving behavior is introduced into the environmental perception of intelligent vehicles. Based on the prediction results of forward driving behavior, the safety environment envelope of intelligent vehicles is reconstructed. The method takes the signals of forward vehicle trajectory point sequence, forward vehicle steeling lights, intelligent vehicle speed, longitudinal relative speed of intelligent vehicle and forward vehicle as observation values, predicts driving behavior of forward vehicle by Hidden Markov Model (HMM). According to the forecasting results of driving behavior of forward vehicles, the lateral and longitudinal spacing between intelligent vehicles and forward vehicles are modified to reconstruct the safety environment envelope of intelligent vehicles, and then the potential collision risk is estimated which improve the safety of intelligent vehicles.
The technical scheme of the invention: A reconstruction method of intelligent vehicle safety environment envelope based on forward vehicle driving behavior is composed of forward vehicle driving behavior prediction model and intelligent vehicle safety environment envelope reconstruction algorithm. Forward vehicle driving behavior prediction model is responsible for the prediction of forward vehicle driving behavior, and intelligent vehicle safety environment envelope reconstruction algorithm is responsible for the reconstruction of safety environment envelope based on the prediction results.
The forward vehicle driving behavior prediction model described in the invention is as follows:
Based on HMM theory, HMM prediction model λ=(N, M, π, A, B) for forward vehicle driving behavior is established, which including:
The driving behavior states of forward vehicle is S: S=(S1, S2, . . . SN), the state at a given time t is qt, and qt∈S; status number of the invention N=4 , where S1 is represent for uniform driving behavior; S2 is the emergency braking driving behavior; is the driving behavior an steering left; S4 is the driving behavior on steering right.
The observation sequence is V: V=(v1, v2, . . . vM); observing events Ot is at a given time t. The observations number of the invention: M=7; where v1 is the observation value of polar diameter changing of adjacent trajectory point sequences of forward vehicle; v2 is the observation value of the pole angle changing of the sequence of adjacent trajectory point sequences of forward vehicle; v3 is intelligent vehicle speed; v4 is the longitudinal relative speed of the intelligent vehicle and the forward vehicle; v5 is the turn signal to the left of the forward vehicle; v6 is the turn signal to the right of the forward vehicle; v7 is the brake signal of the forward vehicle.
π is the probability vector of initial state of forward vehicle driving behavior; π=(π1, π2, . . . πN), where πi=P(q1=Si).
A is the state transition matrix, that is, state transition matrix of forward vehicle driving behavior; A={aij}N×N, where aij=P(qt+1=Sj|qt=Si), 1≤i, j≤N.
B is the probability distribution matrix of observed events; namely, probability of generating observation vk at state Sj: B={bjk}N×M where bjk=P[Ot=vk|qt=Sj], 1≤j≤N, 1≤k≤M.
Intelligent vehicle safety environment envelope reconstruction algorithm:
The secure driving area in front of the intelligent vehicle is determined based on the lateral and longitudinal distance between the forward vehicle and the intelligent vehicle, that is, the safety environment envelope is descried in this invention. According to the sensor and dynamic model, the relative position information of the intelligent vehicle and the forward vehicle is established, as shown in formula (1):
Where px,j(t) is the longitudinal coordinates of the jth forward vehicle; px,sub(t) is the longtudinal coordinates of the intelligent vehicle; eΨ(t) is the position error between vehicle and road surface; py,j(t) is the lateral coordinates of the jth forward vehicle; py,sub(t) is the lateral coordinates of the intelligent vehicle; Δpx,j(t) is the longitudinal relative distance between the smart vehicle and the jth forward vehicle; Δpy,j(t) is the lateral relative distance between the smart vehicle and the jth for and vehicle.
The distance between intelligent vehicle and forward vehicle can be obtained by transformation, as shown in equation (2):
Where: Lv length of the forward vehicle; Wv is the width of the forward vehicle; Cx,j(t) is longitudinal distance between intelligent vehicle and forward vehicle; Cy,j(t) is the lateral distance between intelligent vehicle and forward vehicle.
The longitudinal and lateral distance between the intelligent vehicle and the forward vehicle expressed in equation (2) is calculated based on the current position of the forward vehicle, which is regarded as the reference of the safety environment envelope of the intelligent vehicle at a given next time, and the randomicity of driving behavior changes of the forward vehicle is not considered. The lateral distance between the intelligent vehicle and forward vehicle will increase or decease at the next moment, when the forward vehicle has left-turn driving behavior or right-turn driving behavior. The longitudinal distance between the intelligent vehicle and forward vehicle will decrease, when the intelligent vehicle has emergency braking driving behavior at the next moment. Therefore, to estimate the potential collision risk of driving area, this invention will propose that driving behavior prediction of forward vehicle is introduced into the reconstruction links for safety environment envelope of intelligent vehicle. Based on the predicted results, the longitudinal and lateral distance between the intelligent vehicle and the forward vehicle are modified to realize the reconstruction for safety environment envelope of intelligent vehicle. Modifier formulas (3) are shown as below:
Where parameter ωx is the longitudinal correction factor, and represents the variations in scale of longitudinal distance, the value range of ωx is between 0 and 1 on account of the longitudinal prediction result of forward vehicle based on uniform driving behavior or emergency braking driving behavior. Parameter ωy is the lateral correction factor and represents the variations in scale of lateral distance. Considering the lateral relative position of the intelligent vehicle and the forward vehicle, the value range of ωy is between 0 and 1 on account of the lateral prediction result of forward vehicle based on left-turn or right-turn driving behavior when the lateral spacing gets smaller. While the lateral distance gets larger, the value of it is greater than 1. To improve the accuracy of envelope reconstruction for secure environment of intelligent vehicle, the probability value of the result predicted by HMM model is applied to determine the value of ωx and ωy.
Starting from simulating an actual driver's estimation of potential collision risks in the forward driving area, the forward vehicle driving behavior prediction is introduced to the environment perception link of the intelligent vehicle and sudden braking or sudden steering behavior of forward vehicle during driving is predicted. The safety environment envelope is reconstructed according to the driving behavior of forward vehicle, and the potential collision risk in the driving area is estimated, thus improving the safety of intelligent vehicles.
Where, figure (a) shows the current lateral distance between the intelligent vehicle and the forward vehicle, and figure (b) shows the lateral distance between the intelligent vehicle and the forward vehicle when the forward vehicle has left-turn driving behavior.
Where, figure (a) shows the current longitudinal distance between intelligent the vehicle and the forward vehicle, figure (b) shows the longitudinal distance between the intelligent vehicle and the forward vehicle when the forward vehicle has emergency braking driving behavior.
Parameters in the figures: {circle around (1)}: intelligent vehicle; {circle around (2)}: the forward vehicle; Cx,j(t): the longitudinal distance between intelligent vehicle and forward vehicle; C′x,j(t): the reconstructed longitudinal distance between intelligent vehicle and forward vehicle considering driving behavior of forward vehicle; Cy,j(t): the lateral distance between intelligent vehicle and forward vehicle: C′y,j(t): the reconstructed lateral distance between intelligent vehicle and forward vehicle considering driving behavior of forward vehicle.
Following is a clear and complete description of the concept and specific working process of the invention with reference to the drawings and examples. Obviously, the described embodiments are only part of the embodiments of the present invention, not all of them. Based on the embodiments of the present invention, other embodiments acquired by skilled personnel in the field without any creative effort belong to the scope of protection of the present invention.
As shown in
Establishment of forward vehicle driving behavior prediction model: The driving behavior prediction model established for forward vehicle including: Uniform driving behavior prediction model (US_HMM), Emergency brake driving behavior prediction model (EB_HMM), Left-turn driving behavior prediction model (LT_HMM) and Right turn driving behavior prediction model (RT_HMM).
Off-line training of forward vehicle driving behavior prediction model: As shown in
(1) Model parameter initialization, mainly initialize parameters of HMM model, such as π, A, and B.
(2) The forward-backward algorithm is selected to calculate the forward frequency αt(i) and backward probability βt(j) with the current sample.
(3) Baum-Welch algorithm was applied to calculate the estimated value {circumflex over (λ)}=(π, A, B) of the current new model.
(4) Calculate the likelihood probability P=(O/{circumflex over (λ)}).
(5) If P=(O/{circumflex over (λ)}) is increasing continually the next time, the new estimated value calculated by step (3) will be re-estimated for the sample, and returned to step (2), it is iterated step by step until P=(O/{circumflex over (λ)})is no longer significantly increased, i.e., converges. At this time, the model {circumflex over (λ)} is the model in requirement.
The training process of the present invention is illustrated by an example of a left-turn driving behavior prediction model (LT_HMM).
For left-turn driving behavior prediction model, the invention will consider observed sequence including seven parameters: the observed value of the pole diameter changes of the forward vehicle adjacent trajectory points sequence, the pole angle changes of the forward vehicle adjacent trajectory points sequence, intelligent vehicle speed, longitudinal relative velocity between intelligent vehicle and the forward vehicle, left turn signal, right turn signal, and brake lamp of the forward vehicle respectively. The observation sequence is described as a vector, as shown in equation (4).
O(f)={v1 v2 v3 v4 v5 v6 v7} (4)
Where v1 is the observed value of the pole diameter changes of the forward vehicle adjacent trajectory points sequence, v2 is the observed value of pole angle changes of the forward vehicle adjacent trajectory points sequence; v3 is the observed value of intelligent vehicle speed; v4 is the observed valve of longitudinal relative velocity between intelligent vehicle and the forward vehicle; v5, v6, v7 is left turn signal, right turn signal, and brake lamp of the forward vehicle respectively. Note: The number of samples is 100.
The invention adopts the mean value method to obtain initial value of π, and A:
The invention determines the initial probability distribution of the output probability matrix B based an the prior characteristics of different trajectory patterns:
According, to the off-line training process shown in
The prediction process is shown in
The prediction result is considered on left-turning driving behavior of forward vehicle as an example to illustrate the lateral safe distance reconstruction method of the invention:
As shown in
The prediction result is considered on emergency braking driving behavior of forward vehicle as an example to illustrate the longitudinal safe distance reconstruction method of the invention:
As shown in
The series of detailed explanations listed above are only specific explanations of the feasible embodiments of the invention, and they are not intended to limit the scope of protection of the invention. Any equivalent implementation or modification without departing from the spirit of the present invention shall be included in the scope of protection of the present invention.
Number | Date | Country | Kind |
---|---|---|---|
201610910341.1 | Oct 2016 | CN | national |
Filing Document | Filing Date | Country | Kind |
---|---|---|---|
PCT/CN2017/078516 | 3/29/2017 | WO | 00 |