The invention relates to the field of intelligent vehicle, in particular to a reconstruction method of intelligent vehicle safety driving envelope combining spatial and dynamic characteristics.
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 prediction results of forward vehicle driving behavior, the safety driving envelope (safety environment envelope and stable control envelope) is reconstructed by combining spatial and dynamic characteristics, so as to provide a basis for intelligent vehicle planning and decision-making from the perspective of safety and stability.
Therefore, the invention proposes a safty driving envelope reconstruction method for intelligent vehicles that integrates spatial and dynamic characteristics. It senses the traffic environment said forward vehicle of intelligent vehicle through camera and lidar and predicts forward vehicle driving behavior. Based on the prediction results of forward vehicle driving behavior, the lateral and longitudinal spacing between intelligent vehicles and forward vehicles are modified to reconstruct the safely environment envelope of intelligent vehicles. At the same time, according to the reconstructed safety environment envelope, combined with the intelligent vehicle dynamics model, the stability control envelope of the intelligent vehicle is reconstructed, and the potential collision risk in the driving area of the intelligent vehicle is estimated to improve the safety and stability of the intelligent vehicle. By consulting the data, the reconstruction method of safe driving envelope of intelligent vehicle by combining spatial and dynamic characteristics has not been reported yet.
The aim of the invention is to provide a reconstruction method of intelligent vehicle safety driving envelope combining spatial and dynamic characteristics. Starting from simulating the real driver's 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. The safety driving envelope (safely environment envelope and stable control envelope) is reconstructed by combining spatial and dynamic characteristics, so as to improve the safety and stability of intelligent vehicle. Firstly, based on the prediction results of forward vehicle driving behavior, the lateral and longitudinal distances between the intelligent vehicle and the front vehicle are corrected, to realize the envelop reconstruction of the safety environment of the intelligent vehicle and to improve the safety of intelligent vehicle. Then, on the basis of the reconstructed safety environment envelope and a dynamical model of the intelligent vehicle, the stable control envelope of the intelligent vehicle is reconstructed, so as to improve the stability of the intelligent vehicle.
The technical scheme of the invention: A reconstruction method of intelligent vehicle safety driving envelope combining spatial and dynamic characteristics is composed of safety environment envelope reconstruction algorithm and the stable control envelope reconstruction algorithm. Based on the prediction results of forward vehicle driving behavior from the driving behavior prediction model, the safety environment envelope reconstruction algorithm is responsible for modifying the lateral and longitudinal safe distances between the intelligent vehicle and forward vehicle, to realize the pre-estimation to the potential collision risk in the driving area of the intelligent vehicle, and improves the safety of the intelligent vehicle. To improve the stability of the intelligent vehicle, stable control envelope reconstruction algorithm is responsible for the reconstruction of stable region of the yaw rate based on the results of the environment envelope reconstruction and the dynamic characteristics of the intelligent vehicle.
Reconstruction algorithm for safety environment envelope described in the invention is as follows:
The secure diving 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 described 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 longitudinal 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 forward vehicle.
The distance between intelligent vehicle and forward vehicle can be obtained by transformation, as shown in equation (2):
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 value 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 decrease 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 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.
Reconstruction algorithm for the stable control envelope described in the invention is as follows:
Based on the two-degree-of-freedom bicycle model, considering the tire saturation characteristics and road surface error, the invention establishes an autonomous vehicle dynamics model as shown in equation (4):
Where the state variables β and γ are the sideslip angle and yaw rate; δf is the front wheel steering angle; Cf and Cr stand for the cornering stiffness of the front and rear wheels respectively; kaf and kar stand for the cornering stiffness adjusting coefficient of the front and rear wheels respectively; vx is longitudinal velocity; lf and lr are the distances from the center of gravity(CG) to the front and the rear axles respectively, m and Iz are the mass of the intelligent vehicle and the moment about the vertical axis, respectively.
Considering the tire saturation characteristics, to ensure the vehicle lateral control stability, the vehicle yaw rate and the sideslip angle must be limited to a certain range, the invention is defined as a stable control envelope. According to the dynamic characteristics of intelligent vehicles, the stable control envelope should be defined as:
Where μ is road adhesion coefficient; g is the acceleration of gravity; ay,max is maximum lateral acceleration.
Here, the stability control envelope is mainly based on road adhesion coefficient, tire lateral adhesion and other factors, without considering the constraints of the safety environment envelope, that is, the stability control envelope of the yaw rate and the sideslip angle can be contained so long as. However, when environmental envelope constraints are taken into account, the vehicle yaw rate should fill in the requirement of the intelligent vehicle driving in lateral security environment envelope range, generating the reconstruction of the stable control envelope by integrating the spatial and dynamic characteristics. The reconstruction method is as fellows:
According to the results of safety environment envelope reconstruction, the lateral safe distance between intelligent vehicle and forward vehicle is C′y,j(t); the current lateral velocity of the intelligent vehicle is vy; The lateral acceleration is ay; After passing by time Δt, the lateral displacement of the intelligent vehicle is:
l(t)=vyΔt+½ay2 (7)
When l(t)<C′y,j(t), the maximum yaw rate is still
at that time.
When l(t)≥C′y,j(t), it is necessary to restrict ay to ensure that the intelligent vehicle and the forward vehicle will not collide laterally after passing by time Δt, where ay(t)=√{square root over (2(C′y,j(t)−vyΔt)}.
At that time, the maximum yaw rate is
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, to estimate the potential collision risk in forward driving area of intelligent vehicles. The safety environment envelope of intelligent vehicle is reconstructed based on the prediction results of forward vehicle driving behavior. The stable control envelope of intelligent vehicle is reconstructed based on the reconstructed safety environment envelope. Reconstructed safe driving envelope of intelligent vehicle combines the spatial and dynamic characteristics, thus improving the safety and stability 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.
Where, figure (a) shows the lateral displacement distance of the intelligent vehicle is also constrainted within the lateral safety distance in the safety environment envelope, figure (b) shows the lateral displacement distance of the intelligent vehicle has exceeded the constraint of the lateral safe distance in the safe environment envelope 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 longitudinal distance reconstructed after considering driving behavior of forward vehicle; Cy,j(t): the lateral distance between intelligent vehicle and forward vehicle: C′y,j(t): the lateral distance reconstructed after considering driving behavior of forward vehicle; l(t): lateral displacement of intelligent vehicle at the next moment.
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
Reconstruction of safety environment envelope:
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
Reconstruction of stable control envelope:
Considering the tire saturation characteristics, to ensure the vehicle lateral control stability, the vehicle sideslip angle and yaw rate must be limited to a certain range, the invention is defined as a stable control envelope. According to the dynamic characteristics of intelligent vehicles, the stable control envelope should be defined as:
The stable control envelope is shown in
The stability control envelope is mainly based on road adhesion coefficient, tire lateral adhesion and other factors, without considering the constraints of the safety environment envelope, that is, the sideslip angle and yaw rate can satisfy the constraints as long as they are within the stable control envelope. However, when safety environment envelope constraints are taken into account, the vehicle yaw rate should meet the the constraints of safely environment envelope of intelligent vehicle. Therefore, it is necessary to reconstruct the stable control envelope by combining the spatial and dynamic characteristics. The reconstruction method is as follows:
Taking the left-turning driving behavior of forward vehicle as an example below, the yaw rate reconstruction of the invention is explained:
According to the results of safety environment envelope reconstruction, the lateral safe distance between intelligent vehicle and forward vehicle is C′y,j(t), the current lateral velocity of the intelligent vehicle is vy, and the lateral acceleration is ay. After passing by time Δt, the lateral displacement of the intelligent vehicle is:
l(t)=vyΔt+½ay2
As shown in
at this point.
As shown in
at this point.
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 |
---|---|---|---|
201610910181.0 | Oct 2016 | CN | national |
Filing Document | Filing Date | Country | Kind |
---|---|---|---|
PCT/CN2017/078515 | 3/29/2017 | WO | 00 |