SMOOTH COOPERATIVE LANE CHANGE CONTROL METHOD FOR MULTI-CONNECTED AND AUTONOMOUS VEHICLE (CAV
20230182741 · 2023-06-15
Inventors
- Siyuan GONG (Xi'an, CN)
- Kang Sun (Xi'an, CN)
- Xiangmo Zhao (Xi'an, CN)
- Xia Wu (Xi'an, CN)
- Licheng Zhang (Xi'an, CN)
- Wenjing Wang (Xi'an, CN)
- Yukun Ding (Xi'an, CN)
- Congli Zhang (Xi'an, CN)
- Yihan Sun (Xi'an, CN)
- Hongda Chang (Xi'an, CN)
- Ze Li (Xi'an, CN)
- Lu Zeng (Xi'an, CN)
- Xinxin Wang (Xi'an, CN)
- Jiakai Yin (Xi'an, CN)
- Yuqian Ma (Xi'an, CN)
- Guohui Zheng (Xi'an, CN)
Cpc classification
B60W2050/0031
PERFORMING OPERATIONS; TRANSPORTING
B60W60/0013
PERFORMING OPERATIONS; TRANSPORTING
B60W60/0027
PERFORMING OPERATIONS; TRANSPORTING
B60W50/0097
PERFORMING OPERATIONS; TRANSPORTING
International classification
B60W60/00
PERFORMING OPERATIONS; TRANSPORTING
Abstract
A smooth cooperative lane change control method for multi-connected and autonomous vehicles (CAVs), including: acquiring vehicle information of a lane-changing vehicle M and four surrounding vehicles A, B, C and D; constructing uncontrolled-vehicle and controlled-vehicle motion state prediction models; according to the motion state prediction models, predicting motion states of the lane-changing vehicle M, and the vehicles A, B, C and D; constructing an upper-layer optimization model to calculate an optimal control value and an optimized motion state of the lane-changing vehicle M and an optimal control value of the vehicle A; constructing a lower-layer optimization model to calculate an optimal control value of the vehicle D; and controlling the lane-changing vehicle M, the vehicle A and the vehicle D to run according to a corresponding optimal control value.
Claims
1. A smooth cooperative lane change control method for a multi-connected and autonomous vehicle (CAV), comprising: (a) acquiring vehicle information of a lane-changing vehicle M and four surrounding vehicles thereof, wherein the four surrounding vehicles are vehicle A, vehicle B, vehicle C and vehicle D, respectively; a lane where the lane-changing vehicle M is currently located is defined as a main lane, and the vehicle C and the vehicle D are located in the main lane; the vehicle C is located in front of the lane-changing vehicle M, and the vehicle D is located behind the lane-changing vehicle M; the vehicle A and the vehicle B are located in a target lane; the vehicle B is located in front of the lane-changing vehicle M, and the vehicle A is located behind the lane-changing vehicle M; the vehicle D and the vehicle A are configured as cooperative lane-changing vehicles of the lane-changing vehicle M; the vehicle D and the vehicle A are controlled to behave cooperatively with the lane-changing vehicle M during a lane changing process, and the vehicle B and the vehicle C are uncontrolled; the lane-changing vehicle M, the vehicle D and the vehicle A are each a connected and autonomous vehicle; and the vehicle B and the vehicle C are each a human-driven vehicle (HDV); (b) according to vehicle information and parameters of the vehicle B and the vehicle C, constructing an uncontrolled-vehicle motion state prediction model; and according to vehicle information and parameters of the lane-changing vehicle M, the vehicle A and the vehicle D, constructing a controlled-vehicle motion state prediction model; and according to the uncontrolled-vehicle motion state prediction model, predicting a motion state of the vehicle B and a motion state of the vehicle C; and according to the controlled-vehicle motion state prediction model, predicting a motion state of the lane-changing vehicle M, a motion state of the vehicle A, and a motion state of the vehicle D; wherein the uncontrolled-vehicle motion state prediction model comprises a long short-term memory (LSTM)-based neural network model; and the controlled-vehicle motion state prediction model comprises a vehicle kinematic model, and the vehicle kinematic model comprises a steering kinematic model and a longitudinal kinematic model; the LSTM-based neural network model is configured to predict the motion state of the vehicle B and the motion state of the vehicle C, so as to obtain a predicted motion state of the vehicle B and a predicted motion state of the vehicle C, wherein the predicted motion state of the vehicle B and the predicted motion state of the vehicle C each comprise longitudinal position, longitudinal acceleration and longitudinal speed; the steering kinematic model is configured to predict the motion state of the lane-changing vehicle M, wherein a predicted motion state of the lane-changing vehicle M comprises longitudinal position increment {dot over (y)}.sub.M, transverse position increment {dot over (x)}.sub.M, yaw angle increment {dot over (φ)}.sub.M and axial speed increment {dot over (v)}.sub.M; and the longitudinal kinematic model is configured to predict the motion state of the vehicle A and the motion state of the vehicle D, wherein the motion state of the vehicle A and the motion state of the vehicle D each comprise longitudinal position increment {dot over (x)}.sub.i and longitudinal speed increment {dot over (v)}.sub.i, wherein x.sub.i is a longitudinal position of the vehicle A and the vehicle D, and v.sub.i is a longitudinal speed of the vehicle A and the vehicle D; (c) based on vehicle information and predicted motion states of the lane-changing vehicle M, the vehicle A, the vehicle B and the vehicle C, constructing an upper-layer optimization model; and calculating an optimal control value and an optimized motion state of the lane-changing vehicle M and an optimal control value of the vehicle A according to the upper-layer optimization model; and (d) based on vehicle information of the lane-changing vehicle M, the vehicle C and the vehicle D, the optimized motion state of the lane-changing vehicle M and predicted motion states of the vehicle C and the vehicle D, constructing a lower-layer optimization model; calculating an optimal control value of the vehicle D according to the lower-layer optimization model; and controlling the lane-changing vehicle M, the vehicle A and vehicle D to run according to a corresponding optimal control value.
2. The smooth cooperative lane change control method of claim 1, wherein the motion state of the vehicle B and the motion state of the vehicle C are predicted by using the LSTM-based neural network model through steps of: acquiring a motion state of the vehicle B in previous m steps and a motion state of the vehicle C in previous m steps, wherein a sampling step interval is dt; and inputting the motion state of the vehicle B in previous m steps and the motion state of the vehicle C in previous m steps into the LSTM-based neural network model which has been trained according to HDV motion state, to obtain a motion state of the vehicle B in next N steps and a motion state of the vehicle C in next N steps.
3. The smooth cooperative lane change control method of claim 1, wherein the steering kinematic model is expressed as:
4. The smooth cooperative lane change control method of claim 1, wherein the longitudinal kinematic model is expressed as:
5. The smooth cooperative lane change control method of claim 3, wherein a differential form of the steering kinematic model is expressed as:
6. The smooth cooperative lane change control method of claim 4, wherein a differential form of the longitudinal kinematic model is expressed as:
7. The smooth cooperative lane change control method of claim 1, wherein an objective function of the upper-layer optimization model corresponds to a minimum of a sum of costs of comfort, tracking and traffic efficiency of the lane-changing vehicle M, the vehicle A, the vehicle B and the vehicle C; and an objective function of the lower-layer optimization model corresponds to a minimum of a sum of costs of comfort, tracking and traffic efficiency of the lane-changing vehicle M, the vehicle C and the vehicle D.
8. A smooth cooperative lane change control device for a CAV, comprising: an acquisition unit; a construction unit; an upper-layer controller; and a lower-layer controller; wherein the acquisition unit is configured to acquire vehicle information of a lane-changing vehicle M and four surrounding vehicles thereof, wherein the four surrounding vehicles are respectively vehicle A, vehicle B, vehicle C and vehicle D; a lane where the lane-changing vehicle M is currently located is defined as a main lane, and the vehicle C and vehicle D are located in the main lane; the vehicle C is located in front of the lane-changing vehicle M, and the vehicle D is located behind the lane-changing vehicle M; the vehicle A and the vehicle B are located in a target lane; the vehicle B is located in front of the lane-changing vehicle M, and the vehicle A is located behind the lane-changing vehicle M; the vehicle D and the vehicle A are configured as cooperative lane-changing vehicles of the lane-changing vehicle M; the vehicle D and the vehicle A are controlled to behave cooperatively with the lane-changing vehicle M during a lane changing process, and the vehicle B and the vehicle C are uncontrolled; the construction unit is configured to construct an uncontrolled-vehicle motion state prediction model according to vehicle information and parameters of the vehicle B and the vehicle C to predict a motion state of the vehicle B and a motion state of the vehicle C, and construct a controlled-vehicle motion state prediction model according to vehicle information and parameters of the lane-changing vehicle M, the vehicle A and the vehicle D to predict a motion state of the lane-changing vehicle M, a motion state of the vehicle A and a motion state of the vehicle D; the upper-layer controller is configured to construct an upper-layer optimization model based on vehicle information and predicted motion states of the lane-changing vehicle M, the vehicle A, the vehicle B and the vehicle C, and calculate an optimal control value of the lane-changing vehicle M, an optimized motion state of the lane-changing vehicle M and an optimal control value of the vehicle A according to the upper-layer optimization model, so as to control the lane-changing vehicle M and the vehicle A; and the lower-layer controller is configured to construct a lower-layer optimization model based on vehicle information of the lane-changing vehicle M, the vehicle C, and the vehicle D, the optimized motion state of the lane-changing vehicle M, and predicted motion states of the vehicle C and the vehicle D, and to calculate an optimal control value of the vehicle D according to the lower-layer optimization model to control the vehicle D.
9. A terminal, comprising: a memory; and a processor; wherein the memory is configured to store a computer program; and the processor is configured to execute the computer program to implement the smooth cooperative lane change control method of claim 1.
10. A non-transitory computer-readable storage medium, wherein the non-transitory computer-readable storage medium is configured to store a computer program; and the computer program is configured to be executed by a processor to implement the smooth cooperative lane change control method of claim 1.
Description
BRIEF DESCRIPTION OF THE DRAWINGS
[0049] In order to illustrate the technical solutions of the present disclosure or the prior art more clearly, the accompany drawings needed to be used in the description of the embodiments or the prior art will be briefly described below. Obviously, presented in the accompany drawings are merely some embodiments of the present disclosure, and other drawings can be obtained by those skilled in the art based on the drawings provided herein without paying creative effort.
[0050]
[0051]
[0052]
[0053]
[0054]
[0055] In the drawings: 100, acquisition unit; 200, construction unit; 300, upper-layer controller; and 400, lower-layer controller.
DETAILED DESCRIPTION OF EMBODIMENTS
[0056] The disclosure will be described completely and clearly below with reference to the accompanying drawings and embodiments to make the technical solutions of the present disclosure clearer. Obviously, provided below are merely some embodiments of the disclosure, which are not intended to limit the disclosure. Based on the embodiments provided herein, all other embodiments obtained by those skilled in the art without paying any creative effort shall fall within the scope of the present disclosure.
[0057] The flow chart is illustrative only, and does not necessarily include all elements and operations/steps, nor does it have to be performed in the order described. For example, some operations/steps can also be split, combined, or partially combined, so the actual order may accordingly change.
[0058] It should be understood that the terms are used for describing particular embodiments only and are not intended to limit the disclosure. Unless otherwise specified, the singular forms “a”, “an” and “the” are intended to include the plural.
[0059] The embodiments of this application will be described in detail below with reference to the accompanying drawings.
[0060] Referring to
[0061] (S10) Vehicle information of a lane-changing vehicle M and four surrounding vehicles thereof are acquired, where the four surrounding vehicles are vehicle A, vehicle B, vehicle C and vehicle D, respectively. A lane where the lane-changing vehicle M is currently located is defined as a main lane, and the vehicle C and the vehicle D are located in the main lane; the vehicle C is located in front of the lane-changing vehicle M, and the vehicle D is located behind the lane-changing vehicle M. The vehicle A and the vehicle B are located in a target lane. The vehicle B is located in front of the lane-changing vehicle M, and the vehicle A is located behind the lane-changing vehicle M. The vehicle D and the vehicle A are configured as cooperative lane-changing vehicles of the lane-changing vehicle M. The vehicle D and the vehicle A are controlled to behave cooperatively with the lane-changing vehicle M during a lane changing process, and the vehicle B and the vehicle C are uncontrolled; the lane-changing vehicle M, the vehicle D and the vehicle A are each a connected and autonomous vehicle; and the vehicle B and the vehicle C are each a human-driven vehicle (HDV).
[0062] The lane change occurs at an expressway in which HDV and CAV are in mixed traffic.
[0063] (S20) According to vehicle information and parameters of the lane-changing vehicle M and the vehicle C, an uncontrolled-vehicle motion state prediction model is constructed. According to vehicle information and parameters of the lane-changing vehicle M, the vehicle A and the vehicle D, a controlled-vehicle motion state prediction model is constructed.
[0064] According to the uncontrolled-vehicle motion state prediction model, a motion state of the vehicle B and a motion state of the vehicle C are predicted. According to the controlled-vehicle motion state prediction model, a motion state of the lane-changing vehicle M, a motion state of the vehicle A, and a motion state of the vehicle D are predicted.
[0065] The uncontrolled-vehicle motion state prediction model includes a long short-term memory (LSTM)-based neural network model. The controlled-vehicle motion state prediction model includes a vehicle kinematic model. The vehicle kinematic model includes a steering kinematic model and a longitudinal kinematic model.
[0066] The LSTM-based neural network model is configured to predict the motion state of the vehicle B and the motion state of the vehicle C, so as to obtain a predicted motion state of the vehicle B and a predicted motion state of the vehicle C, where the predicted motion state of the vehicle B and the predicted motion state of the vehicle C each include longitudinal position, longitudinal acceleration and longitudinal speed.
[0067] The motion state of the vehicle B and the motion state of the vehicle C are predicted by using the LSTM-based neural network model through the following steps.
[0068] A motion state of the vehicle B in previous m steps and a motion state of the vehicle C in previous m steps are acquired, in which a sampling step interval is dt. The motion state of the vehicle B in previous m steps and the motion state of the vehicle C in previous m steps are input into the LSTM-based neural network model which has been trained according to HDV motion state, to obtain a motion state of the vehicle B in next N steps and a motion state of the vehicle C in next N steps.
[0069] The steering kinematic model is configured to predict the motion state of the lane-changing vehicle M, so as to obtain a predicted motion state of the lane-changing vehicle M. The predicted motion state of the lane-changing vehicle M includes longitudinal position increment {dot over (y)}.sub.M, transverse position increment {dot over (x)}.sub.M, yaw angle increment {dot over (φ)}.sub.M and axial speed increment {dot over (v)}.sub.M. x.sub.M is a transverse position of the lane-changing vehicle M; y.sub.M is a longitudinal position of the lane-changing vehicle M; φ.sub.M is a yaw angle of the lane-changing vehicle M; and v.sub.M is an axial speed of the lane-changing vehicle M.
[0070] The steering kinematic model is expressed as follows:
[0071] where x.sub.M is a transverse position of the lane-changing vehicle M; y.sub.M is a longitudinal position of the lane-changing vehicle M; φ.sub.M is a yaw angle of the lane-changing vehicle M; v.sub.M is an axial speed of the lane-changing vehicle M; δ.sub.M is a front-wheel steering angle of the lane-changing vehicle M; a.sub.M is acceleration of the lane-changing vehicle M; and L is a wheelbase of the lane-changing vehicle M (distance between front and rear axles); {dot over (x)}.sub.M represents longitudinal position increment of the lane-changing vehicle M; {dot over (y)}.sub.M represents transverse position increment of the lane-changing vehicle M; {dot over (φ)}.sub.M represents yaw angle increment of the lane-changing vehicle M; and {dot over (v)}.sub.M represents axial speed increment of the lane-changing vehicle M (namely, acceleration).
[0072] The longitudinal kinematic model is configured to predict the motion state of the vehicle A and the motion state of the vehicle D, where the motion state of the vehicle A and the motion state of the vehicle D each include longitudinal position increment {dot over (x)}.sub.i and longitudinal speed increment {dot over (v)}.sub.i, where x.sub.i is a longitudinal position of the vehicle A and the vehicle D, and v.sub.i is a longitudinal speed of the vehicle A and the vehicle D.
[0073] The controlled-vehicle motion state prediction model is a longitudinal kinematic model, which is expressed as follows.
[0074] where x.sub.i (i=A, D) is the longitudinal position of the vehicle A and the vehicle D; v.sub.i (i=A, D) is the longitudinal speed of the vehicle A and the vehicle D; and a.sub.i (i=A, D) is an acceleration of the vehicle A and the vehicle D.
[0075] Since the motion state prediction model of the lane-chaining vehicle M is a nonlinear model, it needs to be discretized during a single-step prediction. However, the discretization will cause model accuracy loss, therefore the original continuous model is differentiated. Considering the consistency of the motion state prediction of the controlled vehicle, the motion state prediction models of vehicle M and vehicles A and D are differentiated.
[0076] A differential form of the steering kinematic model is expressed as:
[0077] A differential form of the longitudinal kinematic model is expressed as:
[0078] where dt is a sampling step interval; and N is a length of a predictive horizon.
[0079] (S30) Based on vehicle information and predicted motion states of the lane-changing vehicle M, the vehicle A, the vehicle B and the vehicle C, an upper-layer optimization model is constructed.
[0080] An optimal control value and an optimized motion state of the lane-changing vehicle M and an optimal control value of the vehicle A are calculated according to the upper-layer optimization model, so as to control the lane-changing vehicle M and the vehicle A.
[0081] Regarding the upper-layer optimization model, the lane-changing vehicle M and the vehicle A are taken as optimization objects, and the motion states of the vehicle B and the vehicle C are taken as inputs. The lane-changing vehicle M and vehicle A are actively controlled to realize the active cooperative driving of the vehicle A, so as to provide a safe lane change gap for the lane-changing vehicle M and ensure that the lane-changing vehicle M can safely and smoothly enter to the target lane. After the lane-changing vehicle M enters the target lane, the vehicle A and the vehicle B quickly enter the stable following behavior, so as to reduce the negative impact on the upstream traffic of the target.
[0082] An objective function of the upper-layer optimization model is as follows:
[0083] where J.sub.1(s) represents a sum of costs of comfort, tracking and traffic efficiency in the objective function of the upper-layer optimization model; a discrete time interval is dt. N represents a time domain of prediction; ω.sub.e.sub. ω.sub.e.sub.
[0084] In the first summation term in the objective function of the upper-layer optimization model, the first two terms represent the penalty on a transverse tracking error of the lane-changing vehicle M, the middle two terms represent the penalty on the longitudinal tracking error of the lane-changing vehicle M considering the front vehicle change, and the last two terms represent the penalty on the longitudinal tracking error of the vehicle A. In the second summation term, the first three terms respectively represent penalties on a desired control front wheel steering angle, acceleration and transverse acceleration of the lane-changing vehicle M, and the last term represents a penalty on a desired acceleration of the vehicle A. In the third summation term, the first two terms represent penalties on the front wheel steering angle and change rate of acceleration of the lane-changing vehicle M, and the last term represents a penalty on the change rate of acceleration of the vehicle A.
[0085] Regarding the first summation term in the objective function of the upper-layer optimization model, e.sub.y(s+k) represents a transverse tracking error of vehicle, which is expressed as follows:
e.sub.y(s+k)=y.sub.M(s+k)−w;
[0086] where y.sub.M(s+k) represents a transverse position of lane-changing vehicle M; and w is a lane width. According to this expression, in order to complete the transverse movement as soon as possible, the difference between the current transverse position of the lane-changing vehicle M and a total distance of the target transverse movement w should be reduced as soon as possible.
[0087] Regarding the first summation term in the objective function of the upper-layer optimization model, e.sub.y.sub.
e.sub.y.sub.
[0088] where a, b and c are relevant control parameters. The purpose of this expression is to constrain the lane-changing vehicle M to continue its transverse movement and prevent the lane-changing vehicle M from deviation from the target lane centerline after reaching the target lane centerline, so as to effectively ensure safety. When the transverse position y.sub.M(s+k) is less than the total transverse distance w, the function value is minimum, and when the transverse position y.sub.M(s+k) is greater than the total transverse distance w, the function value increases sharply.
[0089] Regarding the first summation term in the objective function of the upper-layer optimization model, (s+k) represents a longitudinal spacing tracking error considering the front vehicle change of the lane-changing vehicle M, which is expressed as follows:
(s+k)=[1−S(s+k)]e.sub.x1(s+k)+S(s+k)e.sub.x2(s+k);
[0090] where e.sub.x1(s+k) represents a longitudinal spacing tracking error of the lane-changing vehicle M with respect to a front vehicle, that is vehicle C, on the original lane, and e.sub.x1(s+k)=[x.sub.C(s+k)−x.sub.M(s+k)]−d.sub.exp_M(s+k); e.sub.x2(s+k) represents a longitudinal spacing tracking error of the lane-changing vehicle M with respect to a front vehicle, that is vehicle B, on the target lane, and e.sub.x2(s+k)=[x.sub.B(s+k)−x.sub.M(s+k)]−d.sub.exp_M(s+k); x.sub.C(s+k) is a longitudinal position of the vehicle C, x.sub.M(s+k) is a longitudinal position of the lane-changing vehicle M, and x.sub.B(s+k) a longitudinal position of the vehicle B; d.sub.exp_M(s+k) is a desired longitudinal spacing of the lane-changing vehicle M from a front vehicle being tracked of it. d.sub.exp_M(s+k) is the desired longitudinal spacing of the lane-changing vehicle M from a front vehicle, which follows the principle of constant headway, and is expressed as follows:
d.sub.exp_M(s+k)=v.sub.Mx(s+k)*t.sub.hd+d.sub.0;
[0091] where v.sub.Mx(k) represents the longitudinal speed of the lane-changing vehicle M; v.sub.Mx(s+k)=v.sub.M(s+k)cos(φ.sub.m(s+k); t.sub.hd represents desired headway time distance; and d.sub.0 represents a fixed minimum safety distance.
[0092] The S(s+k) is an S-type switching function, which smooths the variation of longitudinal tracking gap during front vehicle change of the lane-changing vehicle M. When the transverse position y.sub.M(s+k) is greater than w/2, a scale factor is greater than 0.5 and will grow at a faster trend to close to 1. When the transverse position y.sub.M(s+k) is less than w/2, the scale factor is less than 0.5. When the transverse position y.sub.M(s+k) starts at zero for a period of time, the scale factor remains at zero, and when the y.sub.M(s+k) gradually reaches to w/2, the scale factor is close to 0.5.
[0093] The purpose of optimizing the longitudinal spacing tracking error of the lane-changing vehicle M is to ensure that a desired longitudinal spacing between the lane-changing vehicle M and the front vehicle being tracked is tracked as fast as possible, while the vehicle in front is changed smoothly from the vehicle C at the original lane to the vehicle B at the target lane.
[0094] Regarding the first summation term in the objective function of the upper-layer optimization model, (s+k) is a longitudinal speed tracking error considering the front vehicle change of the lane-changing vehicle M, which is expressed as follows:
(s+k)=[1−S(s+k)]e.sub.v1(s+k)+S(s+k)e.sub.v2(s+k);
[0095] where e.sub.v1(s+k) represents a longitudinal speed tracking error of the lane-changing vehicle M to the front vehicle thereof, that is vehicle C, at the original lane; e.sub.v1(s+k)=v.sub.Mx(s+k)−v.sub.c(s+k); e.sub.x2(s+k) represents a longitudinal speed tracking error for the lane-changing vehicle M to the front vehicle thereof, that is vehicle B, at the target lane; e.sub.v2(s+k)=v.sub.Mx(s+k)−v.sub.B(s+k); v.sub.C(s+k) is a longitudinal speed of the vehicle C; v.sub.B(s+k) is a longitudinal speed of the vehicle B; S(s+k) is the same as the S-type switching function used in the longitudinal spacing tracking error.
[0096] The purpose of optimizing the longitudinal speed tracking error of the lane-changing vehicle M is to ensure that a longitudinal speed of the front vehicle being tracked is tracked as fast as possible by the lane-changing vehicle M while the front vehicle being tracked is changed smoothly from the vehicle C at the original lane to the vehicle B at the target lane.
[0097] Regarding the first summation term in the objective function of the upper-layer optimization model, e.sub.x3(s+k) represents longitudinal spacing tracking error of the vehicle A, which is expressed as follows:
e.sub.x3(s+k)=[x.sub.A(s+k)−x.sub.M(s+k)]−d.sub.exp_A(s+k);
[0098] where x.sub.A(s+k) represents a longitudinal position of the vehicle A; d.sub.exp_M(s+k) represents desired longitudinal spacing between the lane-changing vehicle M and a front vehicle being tracked; d.sub.exp_A(s+k)=v.sub.A(s+k)*t.sub.hd+d.sub.0; v.sub.A(s+k) represents a longitudinal speed of the vehicle A. Since the vehicle A is configure to actively provide space for the lane-changing vehicle M to change, the lane-changing vehicle M is regarded as the front vehicle being tracked of the vehicle A. The purpose of optimizing the longitudinal spacing tracking error of the vehicle A is to make the vehicle A to reach the desired longitudinal spacing from the lane-changing vehicle M as quickly as possible.
[0099] Regarding the first summation term in the objective function of the upper-layer optimization model, e.sub.v3(s+k) represents longitudinal speed tracking error of the vehicle A, which is expressed as follows:
e.sub.v3(s+k)=v.sub.A(s+k)−v.sub.Mx(s+k).
[0100] The purpose of optimizing the longitudinal speed tracking error of the vehicle A is to make the vehicle A to reach the longitudinal speed of the lane-changing vehicle M as fast as possible.
[0101] Regarding the second summation term in the objective function of the upper-layer optimization model, a.sub.My(s+k) represents the transverse acceleration of the lane-changing vehicle M, which is expressed as follows:
a.sub.My(s+k)=[v.sub.My(s+k+1)−v.sub.My(s+k)]/dt;
[0102] where v.sub.My(s+k) represents a transverse speed of the lane-changing vehicle M; and v.sub.My(s+k)=v.sub.M(s+k)sin(φ.sub.M(s+k)).
[0103] Regarding the third summation term in the objective function of the upper-layer optimization model, j.sub.δ.sub.
j.sub.δ.sub.
j.sub.a.sub.
j.sub.a.sub.
[0104] The purpose of optimizing the front wheel steering angle and the acceleration of the lane-changing vehicle M and the acceleration of the vehicle A, as well as the change rate of the lane-changing vehicle M and the change rate of the vehicle A is to ensure that the control inputs to the lane-changing vehicle M and the vehicle A are as small as possible, and that the amplitude and frequency of change are as small as possible to ensure driving comfort.
[0105] The constraints of the upper-layer optimization model are as follows:
[0106] Regarding the constraints of the upper-layer optimization model, the first six constraints are motion state prediction model constraints for the lane-changing vehicle M and the vehicle A. The seventh constraint represents that a distance between two vehicles should not be less than the minimum safe distance. S.sub.M.sub.
[0107] Since the objective function of the upper-layer optimization model is a multi-objective cooperative optimal control problem, a rolling horizon optimization algorithm is used to solve the problem. With the advance of the sampling time, the deviation of each discrete sampling time is optimized repeatedly in the rolling finite time interval to obtain the desired input of the lane-changing vehicle M and the vehicle A, such that the active cooperation between the lane-changing vehicle and the target lane vehicle is realized. Within the device prediction domain, the optimal control problem is solved stepwise and dynamically by using the rolling horizon optimization algorithm. Since the optimization model is constructed in differential form, the traditional solver based on the state is no longer applicable, such that the Python optimization modeling object (Pyomo) package is used to obtain the optimal control input of the lane-changing vehicle M and the vehicle A.
[0108] The first element of the optimized predicted motion state of the lane-changing vehicle M and the vehicle A are acquired, and then input into a vehicle model to obtain the desired optimum throttle opening and the optimum brake pedal pressure of the lane-changing vehicle M and the vehicle A, so as to achieve the optimal control of the driving and braking of the lane-changing vehicle M and the vehicle A.
[0109] (S40) Based on vehicle information of the lane-changing vehicle M, the vehicle C and the vehicle D, the optimized motion state of the lane-changing vehicle M and predicted motion states of the vehicle C and the vehicle D, a lower-layer optimization model is constructed.
[0110] An optimal control value of the vehicle D is calculated according to the lower-layer optimization model to control the vehicle D.
[0111] The lane-changing vehicle M, the vehicle A and vehicle D is controlled to run according to a corresponding optimal control value.
[0112] Specifically, the first term of a control sequence input by the upper-layer optimization model and the first term of a control sequence input by the lower-layer optimization model are selected as the optimal control value. The optimized predicted motion state can be determined according to these control sequences.
[0113] Regarding the lower-layer optimization model, the vehicle D is taken as an object to be optimized, and the optimized predicted motion state of the lane-changing vehicle M and a motion state of the vehicle C are taken as input. A control goal of the lower-layer optimization model is to allow the lane-changing vehicle M to smoothly track the front vehicle in the process of the lane-changing vehicle M gradually moving from the original lane to the target lane by actively controlling vehicle D, so as to reduce the negative impact on the upstream traffic.
[0114] An objective function of the lower-layer optimization model is expressed as follows:
min J.sub.2(s)=Σ.sub.k=1.sup.N(∥
(s+k)∥.sup.2+ω
∥
(s+k)∥.sup.2)+Σ.sub.k=1.sup.N−1(ω.sub.a2∥a.sub.D(s+k)μ.sup.2)+Σ.sub.k=1.sup.N−2(
∥j.sub.a.sub.
[0115] where J.sub.2(s) represents a sum of costs of comfort, tracking and traffic efficiency in the objective function of the lower-layer optimization model; ω.sub.a2 and ω.sub.ã2 are weighting factors of corresponding term; *(s+k) represents a predicted state at moment s+k; and s is the current moment.
[0116] The first summation term in the objective function of the lower-layer optimization model represents a penalty on a longitudinal tracking error of the vehicle D considering the front vehicle change. The second summation term in the objective function represents a penalty on the desired acceleration of the vehicle D. The third summation term in the objective function represents a penalty on change rate of acceleration of the vehicle D.
[0117] Regarding the first summation term in the objective function of the lower-layer optimization model, (s+k) represents longitudinal spacing tracking error considering the front vehicle change of the vehicle D, which is expressed as follows:
(s+k)=[1−S(s+k)]e.sub.x4(s+k)+S(s+k)e.sub.x5(s+k);
[0118] where e.sub.x4(s+k) represents a longitudinal spacing tracking error of the vehicle D to the original front vehicle in front of the vehicle D, that is lane-changing vehicle M, in the original lane of the vehicle D; e.sub.x4(s+k)=[x.sub.M(s+k)−x.sub.D(s+k)]−d.sub.exp_D(s+k); e.sub.x5(s+k) represents a longitudinal spacing tracking error of the vehicle D to the new front vehicle in front of the vehicle D, that is the vehicle C, in the original lane of the vehicle D; e.sub.x5(s+k)=[x.sub.C(s+k)−x.sub.D(s+k)]−d.sub.exp_M(s+k); x.sub.D(s+k) represents the longitudinal position of the vehicle D; d.sub.exp_D(s+k) is the desired longitudinal spacing between the vehicle D and a vehicle in front tracked by the vehicle D; d.sub.exp_D(s+k)=v.sub.D(s+k)*t.sub.hd+d.sub.0; the expression and function of the S-type switching function used in the longitudinal spacing and speed tracking error between the vehicle A and the lane-changing vehicle M are the same.
[0119] The purpose of optimizing the longitudinal spacing tracking error of the vehicle D is to ensure that the desired longitudinal spacing between the vehicle D and the vehicle in front is achieved as quickly as possible while smoothly switching the vehicle in front from the lane-changing vehicle M to the vehicle C on the original lane.
[0120] Regarding the first summation term in the objective function of the lower-layer optimization model, (s+k) represents longitudinal speed tracking error considering front vehicle change of the vehicle D, which is expressed as follows:
(s+k)=[1−S(s+k)]e.sub.v4(s+k)+S(s+k)e.sub.v5(s+k);
[0121] where e.sub.v4(s+k) represents a longitudinal speed tracking error of the vehicle D to the original front vehicle thereof, that is the lane-changing vehicle M, at the original lane; e.sub.v4(s+k)=v.sub.D(s+k)−v.sub.Mx(s+k); e.sub.x5(s+k) represents a longitudinal speed tracking error of the vehicle D to the new front vehicle thereof, that is the vehicle C, at the original lane; e.sub.v5(s+k)=v.sub.D(s+k)−v.sub.C(s+k); and S(s+k) is the same as the S-type switching function used in the longitudinal spacing tracking error.
[0122] The purpose of optimizing the longitudinal speed tracking error of the vehicle D is to ensure that a longitudinal speed of the front vehicle being tracked is tracked as fast as possible by the vehicle D while the front vehicle being tracked is changed smoothly from the lane-changing vehicle M at the original lane to the vehicle C at the original lane.
[0123] Regarding the third summation term in the objective function of the lower-layer optimization model, j.sub.a.sub.
j.sub.a.sub.
[0124] The purpose of optimizing the acceleration and change rate thereof of the vehicle D is to ensure that the control input of the vehicle D and the amplitude and frequency of variation are as small as possible to ensure driving comfort.
[0125] The constraints of the lower-layer optimization model are as follows:
[0126] Regarding the constraints of the lower-layer optimization model, the first two constraints are motion state prediction model constraints for the vehicle D. The third constraint represents that a distance between two vehicles should not be less than the minimum safe distance. S.sub.D.sub.
[0127] The objective functions of the upper-layer optimization model and the lower-layer optimization model are respectively solved dynamically step by step through the rolling time domain optimization algorithm for the optimal control problem. In the rolling finite time interval, the deviation of each moment is optimized repeatedly, and the desired control input of each controlled vehicle is obtained.
[0128] The solution method of the lower-layer optimization model refers to the rolling time domain optimization in the upper-layer optimization model. By solving the optimal control input of the vehicle D, extracting the first element of the optimal control input and inputting the first element into a vehicle model, the optimal throttle opening and the optimal brake pedal pressure desired by the vehicle D are obtained, and the optimal control of the driving and braking of the cooperative vehicle D is realized.
[0129] Specifically, by controlling motion state prediction model according to a vehicle, the transverse and longitudinal desired control parameters of that lane-changing vehicle M and longitudinal desired control parameters of the cooperative vehicle A and vehicle D are obtained. By controlling the engine throttle opening, brake pedal and automatic transmission of each vehicle, the control strategy of multi-vehicle cooperative lane change is realized.
[0130] The lane change occurs at an expressway in which HDV and CAV are in mixed traffic. By acquiring motion state information of the surrounding vehicles in real time and constructing a lane-changing model with a hierarchical controller architecture, in which the lane-changing model considers the safety, comfort, traffic efficiency and other constraints of lane change, the CAV can perform cooperative lane change safely. (1) The cooperative lane change control method provided herein based on model predictive control integrates the longitudinal and transverse motions during lane change. Compared with the framework analyzing the longitudinal and transverse independently, the acceleration and front wheel steering angle are integrated into a unified control management, which is more practical. (2) The following vehicles in the target lane and the original lane are regarded as cooperative vehicles, and their active cooperative driving can effectively reduce the negative impact of lane change on the two lanes. (3) The S-type function is designed to solve the problem of front vehicle changing and tracking, which provides a smooth front vehicle changing method for the controlled vehicle in the lane changing process, and can effectively avoid the speed oscillation caused by the sudden change of the front vehicle.
[0131] It should be understood that the above-described order is merely exemplary, and is not intended to limit the disclosure. Unless otherwise specified, such processes can be performed in another order. Moreover, some steps may include multiple sub-steps or stages, and these sub-steps or stages are not necessarily executed at the same time, and are not necessarily executed sequentially. Optionally, such sub-steps or stages may be executed in turn or alternately with at least part of sub-steps or stages in other steps.
[0132] Referring to an embodiment illustrated in
[0133] The acquisition unit 100 is configured to acquire vehicle information of a lane-changing vehicle M and four surrounding vehicles thereof, where the four surrounding vehicles are respectively vehicle A, vehicle B, vehicle C and vehicle D. A lane where the lane-changing vehicle M is currently located is defined as a main lane, and the vehicle C and vehicle D are located in the main lane; the vehicle C is located in front of the lane-changing vehicle M, and the vehicle D is located behind the lane-changing vehicle M. The vehicle A and the vehicle B are located in a target lane. The vehicle B is located in front of the lane-changing vehicle M, and the vehicle A is located behind the lane-changing vehicle M. The vehicle D and the vehicle A are configured as cooperative lane-changing vehicles of the lane-changing vehicle M. The vehicle D and the vehicle A are controlled to behave cooperatively with the lane-changing vehicle M during a lane changing process, and the vehicle B and the vehicle C are uncontrolled. The vehicle B and the vehicle C are HDV.
[0134] The construction unit 200 is configured to construct an uncontrolled-vehicle motion state prediction model according to vehicle information and parameters of the vehicle B and the vehicle C to predict a motion state of the vehicle B and a motion state of the vehicle C, and construct a controlled-vehicle motion state prediction model according to vehicle information and parameters of the lane-changing vehicle M, the vehicle A and the vehicle D to predict a motion state of the lane-changing vehicle M, a motion state of the vehicle A and a motion state of the vehicle D.
[0135] The upper-layer controller 300 is configured to construct an upper-layer optimization model based on vehicle information and predicted motion states of the lane-changing vehicle M, the vehicle A, the vehicle B and the vehicle C, and calculate an optimal control value of the lane-changing vehicle M, an optimized motion state of the lane-changing vehicle M and an optimal control value of the vehicle A according to the upper-layer optimization model, so as to control the lane-changing vehicle M and the vehicle A. The upper-layer controller takes the lane-changing vehicle M as a central controller.
[0136] The lower-layer controller 400 is configured to construct a lower-layer optimization model based on vehicle information of the lane-changing vehicle M, the vehicle C, and the vehicle D, the optimized motion state of the lane-changing vehicle M, and predicted motion states of the vehicle C and the vehicle D, and to calculate an optimal control value of the vehicle D according to the lower-layer optimization model to control the vehicle D. The lower-layer controller is located in the vehicle D.
[0137] Referring to
[0138] The memory is configured to store a computer program, and the processor is configured to execute the computer program to implement the smooth cooperative lane change control method.
[0139] The communication bus can be peripheral component interconnect (PCI) bus or extended industry standard architecture (EISA) bus. The communication bus can be divided into an address bus, a data bus, a control bus and the like. It should be understood that although the communication bus is represented by a single thick line in the drawings, it does not indicate that there is only one bus or one type of bus.
[0140] The communication interface is configured to allow the terminal to communicate with other devices.
[0141] The memory includes random access memory (RAM) and non-volatile memory, for example, at least one disk storage. In an embodiment, the memory is at least one storage device located remotely from the processor.
[0142] The processor is central processing unit (CPU), network processor (NP), digital signal processing (DSP), application specific integrated circuit (ASIC) or field-programmable gate array (FPGA), or other programmable logic devices, discrete gate or transistor logic devices, discrete hardware components.
[0143] The terminal includes a user device and a network device. The user device includes computer, smart phone and pad. The network device includes a single network server, a server group consisting of multiple network servers and a cloud consisting of a large number of computers or network servers based on cloud computing. The cloud computing is a kind of distributed computing, which is a super virtual computer consisting of a group of loosely coupled computer sets. The disclosure can be implemented by the terminal independently, or accessing to the network and interacting with other terminals. The network includes internet, wide area network, metropolitan area network, local area network and virtual private network.
[0144] It should also be understood that when the term “and/or” indicates any combination and all possible combinations of one or more of the associated listed items, and including these combinations.
[0145] This application also provides a non-transitory computer-readable storage medium. The non-transitory computer-readable storage medium is configured to store a computer program. The computer program is configured to be executed to implement the smooth cooperative lane change control method.
[0146] It can be understood by those skilled in the art that the method of the above embodiments can be implemented by a computer program instructing related hardware, the computer program can be stored in a nonvolatile computer-readable storage medium, and when being executed, the computer program can include the processes of the above embodiment. Any reference to memory, storage, databases, or other media used in the embodiments provided herein may include at least one of non-volatile and volatile memory.
[0147] It should be understood that unless otherwise specified, the singular form “a/an” also includes the plural form. The term ““and/or” should be considered to include all possible combinations of the listed items. The serial numbers of the embodiments are descriptive only, and are not intended to imply which embodiment is better.
[0148] It should be noted that described above are merely illustrative of the disclosure, and are not intended to limit the disclosure. The features of various embodiments may be combined to form other embodiments based on the technical concept disclosed herein. It should be understood that any changes, replacements and improvements made by those skilled in the art based on the content disclosed herein without paying creative effort shall fall within the scope of the present disclosure defined by the appended claims.