A cooperative lane-changing control method for intelligent connected vehicles
Through the intelligent connected vehicle collaborative lane change controller, combining the vehicle dynamic model and time-varying expected state vector, the cooperative lane change strategy is optimized, which solves the problem of insufficient vertical planning in the existing technology and achieves efficient and accurate vehicle collaborative lane change , reducing traffic oscillations and collision risks.
Patent Information
- Application Number
- CN202210758250.6
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2022-06-29
- Publication Date
- 2024-11-22
- Estimated Expiration
- 2042-06-29
AI Technical Summary
The prior art only conducts vertical planning in the cooperative lane change of intelligent connected vehicles, ignoring lateral movement, resulting in poor lane change mobility, low traffic flow efficiency and traffic oscillation, and failures are prone to occur during cooperative lane change.
By building an intelligent connected vehicle collaborative lane change controller, combining vehicle dynamics model and time-varying expected state vector, the cooperative lane change control strategy is optimized, and longitudinal and lateral coupled motion is considered to ensure that the vehicle avoids collision and velocity oscillation during lane change. Improve lane change efficiency.
It improves the efficiency and accuracy of cooperative lane change, reduces traffic oscillations, enhances the stability and safety of lane change process, and reduces the risk of collision with human-driving vehicles.
Smart Images

Figure CN115123239B_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the technical field of vehicle automatic driving, and in particular to a method for controlling cooperative lane changing of intelligent networked vehicles. Background Art
[0002] Cruising, following, and lane changing are three major driving behaviors on highways. Among these behaviors, lane changing has specific characteristics—longitudinal and lateral coupling. Compared with longitudinal behaviors, lane changing maneuvers may have a more significant impact on the safety, mobility, and continuity of traffic operation. Past studies have shown that 60% of traffic accidents on highways can be attributed to lane changes. In addition, lane changing behaviors also cause speed oscillations, which lead to loss of traffic mobility, more fuel consumption, and emissions.
[0003] Connected vehicle (CAV) technology may solve the above problems. By equipping autonomous vehicles (AVs) with communication equipment, CAVs achieve cooperation between vehicles. Therefore, a CAV-based cooperative lane-changing scheme is proposed to improve the operational maneuverability of CAVs and eliminate the negative impact of lane changing on traffic flow. Traditional cooperative lane-changing planning methods only perform longitudinal planning, aiming to adjust the speeds of the leading vehicle (LV) and the trailing vehicle (RV) on the target lane to leave space for the target vehicle (SV) to change lanes. These studies focus on longitudinal automation, while the lateral lane-changing motion of the SV must be completed by a human driver or another lane-changing auxiliary controller. Only longitudinal control can guarantee application in situations with a low level of automation, however, its limitations cannot be ignored. In order to ensure the safety of the lane-changing maneuver, the cooperative lane-changing process must be divided into a gap opening phase and a lane-changing phase. Only when the lane-changing gap is large enough can the SV perform a lane change. Therefore, the time wasted in the gap opening process greatly reduces the efficiency of the cooperative lane-changing. In addition, it may also lead to cooperative lane-changing failures because slow-moving vehicles may hinder the cooperative lane-changing process. Summary of the invention
[0004] The purpose of the present invention is to overcome the defects of the above-mentioned prior art and provide a method for cooperative lane changing control of intelligent connected vehicles with high efficiency, high accuracy and small traffic oscillation.
[0005] The purpose of the present invention can be achieved by the following technical solutions:
[0006] A method for controlling a cooperative lane change of an intelligent connected vehicle, comprising:
[0007] According to the vehicle dynamics characteristics of the intelligent connected vehicles, the controlled intelligent connected vehicles are controlled to cooperate in lane changing through the constructed intelligent connected vehicle cooperative lane changing controller and vehicle dynamics model;
[0008] The controlled intelligent networked vehicles include a lane-changing target vehicle SV, a leading vehicle LV at the lane-changing target position, and a trailing vehicle RV at the lane-changing target position;
[0009] The cost function expression of the intelligent connected vehicle cooperative lane changing controller is:
[0010]
[0011]
[0012]
[0013]
[0014] Among them, Q and R are both diagonal matrices of non-negative weighting factors, ε i is the state vector of the cooperative lane-changing system at time step i, ε des,i is the time-varying expected state vector at time step i, u i is the cooperative lane-changing system control vector at time step i, ε N is the state vector of the cooperative lane-changing system at the final time step, ε des,N is the control vector of the cooperative lane-changing system at the final time step, is the weighting factor for the LV velocity error, is the weighting factor of the RV speed error, is the weighting factor of SV velocity error, is the weighting factor of the SV and LV interval error, is the weighting factor of the SV and RV interval error, is the weighting factor of LV acceleration cost, is the weighting coefficient of RV acceleration cost, is the weighting coefficient of SV acceleration cost, is the weighting factor of SV heading error, is the weighting factor of SV lateral position error, is the weighted coefficient of SV steering cost, u is the control vector, a L 、a S and a R are the accelerations of LV, SV and RV, respectively, S is the front steering angle of SV.
[0015] Furthermore, the expression of the state vector of the cooperative lane changing system is:
[0016]
[0017] g LS =x L -x S
[0018] g SR =x S -x R
[0019] Where ε is the state vector of the cooperative lane-changing system, v L 、v S and v R are the velocities of LV, SV and RV, respectively, g LS is the gap between LV and SV, g SR is the distance between SV and RV, is the heading angle of SV in the frenet coordinate system, y s is the lateral position of SV, x L 、x S 、x R The longitudinal positions of LV, SV and RV, respectively.
[0020] Furthermore, the expression of the time-varying expected state vector is:
[0021]
[0022]
[0023]
[0024] if but
[0025]
[0026]
[0027] if but
[0028] Among them, ε des is the time-varying expected state vector, v des The ideal cruising speed for intelligent connected vehicles. is the required lane-changing distance between LV and SV, is the required lane-changing distance between SV and RV, The response time of the intelligent connected vehicle. is the brake control delay, a min is the minimum acceleration, is the desired lateral position of the SV, is the lateral position of the initial lane centerline of the SV, is the safe lateral position range on the target lane during the cooperative lane change process, y taris the lateral position of the target lane centerline, Δy min is the minimum lateral distance between cruising intelligent connected vehicles, y L is the lateral position of the lead vehicle LV, y R It is the lateral position of the rear vehicle RV. When changing to the left lane, LC is 1, and when changing to the right lane, LC is -1.
[0029] Furthermore, the vehicle dynamics model is expressed as:
[0030] ε i+1 =A i ε i +B i u i +C i
[0031]
[0032]
[0033]
[0034] Where Δt is the control step length, A i , B i , C i They represent the state vector, coefficient matrix and constant matrix of the i-th step respectively.
[0035] Furthermore, the constraints of the intelligent connected vehicle cooperative lane changing controller include vehicle collision constraints, driving boundary constraints, acceleration constraints and steering constraints.
[0036] Furthermore, the vehicle collision constraint is expressed as:
[0037]
[0038]
[0039] in, is the longitudinal position of the lead vehicle OPV on the original lane at step i, is the longitudinal position of the previous vehicle TPV in the target lane at step i.
[0040] Furthermore, the OPV and TPV are human-driven vehicles.
[0041] Furthermore, the expression of the driving boundary constraint is:
[0042] y min ≤y≤y max
[0043] Where y is the lateral position of the intelligent connected vehicle, y min and max It is the geometric boundary position of the road.
[0044] Furthermore, the expression of the acceleration constraint is:
[0045] a min ≤a≤a max
[0046] Where a is the acceleration of the intelligent connected vehicle, a min and a max are the lower and upper limits of acceleration respectively.
[0047] Furthermore, the expression of the steering constraint is:
[0048] δ min ≤δ≤δ max
[0049] Among them, δ is the front wheel angle of the intelligent connected vehicle, δ min and δ max are the lower and upper limits of the vehicle's front wheel angle respectively.
[0050] Compared with the prior art, the present invention has the following beneficial effects:
[0051] (1) The intelligent networked vehicle cooperative lane change control method of the present invention is based on the motion planning step of optimal control, proposes a time-varying expected state vector, considers the influence of vehicle dynamics and background traffic flow, plans the coordinated transformation of operation space and lane, and can simultaneously generate lane change space and plan lane change path, thereby solving the shortcomings of low solution efficiency and instability caused by solving two stages separately in traditional cooperative lane change planning. The intelligent networked vehicle cooperative lane change controller considers vehicle dynamics in longitudinal and lateral coupled motion planning to ensure the executableness of motion instructions for controlled vehicles. The intelligent networked vehicle cooperative lane change controller considers the influence of background traffic flow and the uncertainty caused by the fact that human-driven vehicles will not communicate with networked autonomous driving vehicles, thereby improving the accuracy of cooperative lane change planning and reducing the negative impact of lane change actions on traffic flow.
[0052] (2) In the present invention, SV, LV and RV are under the control of the intelligent connected vehicle cooperative lane changing controller. The set cooperative lane changing strategy is implemented through the intelligent connected vehicle cooperative lane changing controller to control LV and RV to leave space for SV to go sideways. When the space gradually becomes wider, the SV is controlled to change lanes. In the intelligent connected vehicle lane changing planning, the deceleration behavior of OPV and TPV is considered to ensure the success of the cooperative lane changing motion planning. The lateral goal of SV is to change lanes as quickly as possible to avoid collision with LV and RV. The longitudinal movement of LV and RV has the following control goals: to leave space for SV's lane change; to maintain operational flexibility, reduce the speed oscillation of RV, avoid collision with OPV or TPV, improve the efficiency of cooperative lane changing, and reduce traffic oscillation. BRIEF DESCRIPTION OF THE DRAWINGS
[0053] Figure 1 A flowchart for building a cooperative lane-changing controller for intelligent connected vehicles;
[0054] Figure 2 A scene diagram of cooperative lane changing for intelligent connected vehicles. DETAILED DESCRIPTION
[0055] The present invention is described in detail below in conjunction with the accompanying drawings and specific embodiments. This embodiment is implemented based on the technical solution of the present invention, and provides a detailed implementation method and specific operation process, but the protection scope of the present invention is not limited to the following embodiments.
[0056] A method for controlling a cooperative lane change of an intelligent connected vehicle, comprising:
[0057] According to the characteristics of intelligent connected vehicles, upstream and downstream background vehicles, and vehicle dynamics, the controlled intelligent connected vehicles are controlled through the constructed intelligent connected vehicle cooperative lane change controller;
[0058] Among them, the upstream and downstream background vehicles (Background vehicle) include the lead vehicle (OPV) on the original lane, the previous vehicle (TPV) on the target lane, and the next vehicle (TFV) on the target lane. The upstream and downstream background vehicles are human-driven vehicles and will not communicate with the intelligent connected vehicles.
[0059] The controlled intelligent connected vehicles include the lane-changing target vehicle (SV), the leading vehicle (LV) at the lane-changing target position, and the trailing vehicle (RV) at the lane-changing target position;
[0060] The scene of intelligent connected vehicles cooperating in lane changing is shown in the figure below. Figure 2 As shown in the figure, the cooperative zone is the system lane changing space, Maneuver is the vehicle trajectory, SV, LV and RV are under the control of the intelligent connected vehicle cooperative lane changing controller, and the cooperative lane changing strategy of the intelligent connected vehicle cooperative lane changing controller is as follows:
[0061] Control LV and RV to leave space for SV sidewalk, and when the space gradually becomes wider, control SV to change lanes; in the lane change planning of intelligent connected vehicles, in order to ensure the success of collaborative lane change motion planning, the deceleration behavior of OPV and TPV must be considered; the lateral goal of SV is to change lanes as quickly as possible to avoid collision with LV and RV; the longitudinal movement of LV and RV has the following control objectives: leave space for SV's lane change; maintain operational flexibility; reduce the speed oscillation of RV to avoid collision with OPV or TPV.
[0062] like Figure 1 ,The construction process of the intelligent connected vehicle cooperative lane changing controller includes the following steps:
[0063] 1) Define the system state vector and control vector;
[0064] 2) Establish the controller system dynamics model;
[0065] 3) Establishing the cost function of the longitudinal and lateral coupled cooperative lane changing (CLC) controller;
[0066] 4) Establish the cooperative lane changing (CLC) controller constraints considering background vehicles.
[0067] Step 1) includes:
[0068] 1-1) Define the state vector ε and control vector u of the cooperative lane changing system:
[0069]
[0070] g LS =x L -x S
[0071] g SR =x S -x R
[0072]
[0073] Among them, v L 、v S and v R are the velocities of LV, SV and RV, respectively, g LS is the gap between LV and SV, g SR is the distance between SV and RV, is the heading angle of SV in the frenet coordinate system, y S is the lateral position of SV, x L 、x S 、x Rare the longitudinal positions of LV, SV and RV respectively, u is the control vector, a L 、a S and a R are the accelerations of LV, SV and RV, respectively, S is the front steering angle of SV;
[0074] 1-2) Define the time-varying expected state vector ε des :
[0075]
[0076]
[0077]
[0078] if
[0079]
[0080]
[0081] if
[0082]
[0083] where ε des is the expected state, v des It is the ideal cruising speed for intelligent connected vehicles. is the required lane-changing distance between LV and SV, is the required lane-changing distance between SV and RV, is the reaction time of the intelligent connected vehicle, is the brake control delay, a min is the minimum acceleration, is the desired lateral position of the SV, is the lateral position of the SV initial lane centerline, is the safe lateral position range on the target lane during the cooperative lane change process, y tar is the lateral position of the target lane centerline, Δy min is the minimum lateral distance between cruising intelligent connected vehicles, y L is the lateral position of the lead vehicle LV, y R It is the lateral position of the rear vehicle RV. In the case of left lane change, LC is 1, and in the right turn lane, LC is -1.
[0084] Step 2) includes:
[0085] ε i+1 =A i εi +B i u i +C i
[0086]
[0087]
[0088]
[0089] Where Δt is the control step length, A i , B i , C i They represent the state vector, coefficient matrix and constant matrix of the i-th step respectively.
[0090] Step 3) includes:
[0091] Define the cost function of the quadratic cooperative lane changing controller:
[0092]
[0093]
[0094]
[0095] Among them, Q and R are both diagonal matrices of non-negative weighting factors, is the weighting factor for the LV velocity error, is the weighting factor for the RV velocity error, is the weighting factor of the SV velocity error, is the weighting factor for the SV and LV interval errors, is the weighting factor of the SV and RV interval error, is the weighting factor for the LV acceleration cost, is the weighting coefficient of RV acceleration cost, is the weighting coefficient of SV acceleration cost, is the weighting factor of the SV heading error, is the weighting factor of the SV lateral position error, is the weighting coefficient of SV steering cost.
[0096] In step 4), the cooperative lane changing controller constraints include:
[0097] In a traffic environment, the longitudinal motion of the LV is constrained by the preceding vehicle on the origin lane (OPV) and the preceding vehicle on the target lane (TPV) (to avoid collision):
[0098]
[0099]
[0100] in, is the longitudinal position of the OPV at step i; is the longitudinal position of the TPV at step i;
[0101] Vehicles should travel within the road geometry boundaries:
[0102] y min ≤y≤y max
[0103] Vehicle acceleration should be within the limits of vehicle performance and comfort:
[0104] a min ≤a≤a max
[0105] The vehicle's front wheel angle should be within its steering range:
[0106] δ min ≤δ≤δ max
[0107] Research shows that compared with the traditional two-stage cooperative lane changing controller, the cooperative lane changing controller proposed in this embodiment can improve the cooperative lane changing efficiency by 15.67% and reduce traffic oscillation by 47.9%.
[0108] The present embodiment proposes a method for cooperative lane changing control of intelligent connected vehicles, which can simultaneously generate lane changing space and plan lane changing paths, thereby overcoming the shortcomings of low solution efficiency and instability caused by solving the two stages separately in traditional cooperative lane changing planning. The cooperative lane changing controller considers vehicle dynamics in longitudinal and lateral coupled motion planning to ensure the executability of motion instructions for controlled vehicles. The cooperative lane changing controller considers the influence of background traffic flow and the uncertainty caused by the fact that human-driven vehicles cannot communicate with connected autonomous driving vehicles, thereby improving the accuracy of cooperative lane changing planning and reducing the negative impact of lane changing actions on traffic flow.
[0109] The preferred specific embodiments of the present invention are described in detail above. It should be understood that a person skilled in the art can make many modifications and changes based on the concept of the present invention without creative work. Therefore, any technical solution that can be obtained by a person skilled in the art through logical analysis, reasoning or limited experiments based on the concept of the present invention on the basis of the prior art should be within the scope of protection determined by the claims.
Claims
1. A method for controlling cooperative lane change of intelligent connected vehicles, characterized in that: include: According to the vehicle dynamics characteristics of the intelligent connected vehicles, the controlled intelligent connected vehicles are controlled to cooperate in lane changing through the constructed intelligent connected vehicle cooperative lane changing controller and vehicle dynamics model; The controlled intelligent networked vehicles include a lane-changing target vehicle SV, a leading vehicle LV at the lane-changing target position, and a trailing vehicle RV at the lane-changing target position; The cost function expression of the intelligent connected vehicle cooperative lane changing controller is: Among them, Q and R are both diagonal matrices of non-negative weighting factors, ε i is the state vector of the cooperative lane-changing system at time step i, ε des,i is the time-varying expected state vector at time step i, u i is the cooperative lane-changing system control vector at time step i, ε N is the state vector of the cooperative lane-changing system at the final time step, ε des,N is the control vector of the cooperative lane-changing system at the final time step, is the weighting factor for LV velocity error, is the weighting factor of the RV speed error, is the weighting factor of SV velocity error, is the weighting factor of the SV and LV interval error, is the weighting factor of the SV and RV interval error, is the weighting factor of LV acceleration cost, is the weighting coefficient of RV acceleration cost, is the weighting coefficient of SV acceleration cost, is the weighting factor of SV heading error, is the weighting factor of SV lateral position error, is the weighted coefficient of SV steering cost, u is the control vector, a L 、a S and a R are the accelerations of LV, SV and RV, respectively, S is the front steering angle of SV; The expression of the state vector of the cooperative lane changing system is: g LS =x L -x S g SR =x S -x R Where ε is the state vector of the cooperative lane-changing system, v L 、v S and v R are the velocities of LV, SV and RV, respectively, g LS is the gap between LV and SV, g SR is the distance between SV and RV, is the heading angle of SV in the frenet coordinate system, y S is the lateral position of SV, x L 、x S 、x R are the longitudinal positions of LV, SV, and RV, respectively; The expression of the time-varying expected state vector is: if but if but Among them, ε des is the time-varying expected state vector, v des The ideal cruising speed for intelligent connected vehicles. is the required lane-changing distance between LV and SV, is the required lane-changing distance between SV and RV, The reaction time of the intelligent connected vehicle. is the brake control delay, a min is the minimum acceleration, is the desired lateral position of the SV, is the lateral position of the initial lane centerline of the SV, is the safe lateral position range on the target lane during the cooperative lane change process, y tar is the lateral position of the target lane centerline, Δy min is the minimum lateral distance between cruising intelligent connected vehicles, y L is the lateral position of the lead vehicle LV, y R It is the lateral position of the rear vehicle RV. When changing to the left lane, LC is 1, and when changing to the right lane, LC is -1.
2. The intelligent connected vehicle cooperative lane changing control method according to claim 1, characterized in that: The vehicle dynamics model is expressed as: e i+1 =A i e i +B i you i +C i Where Δt is the control step length, A i , B i , C i They represent the state vector, coefficient matrix and constant matrix of the i-th step respectively.
3. The intelligent connected vehicle cooperative lane changing control method according to claim 1, characterized in that: The constraints of the intelligent connected vehicle cooperative lane changing controller include vehicle collision constraints, driving boundary constraints, acceleration constraints and steering constraints.
4. The intelligent connected vehicle cooperative lane changing control method according to claim 3, characterized in that: The expression of the vehicle collision constraint is: in, is the longitudinal position of the lead vehicle OPV on the original lane at step i, is the longitudinal position of the previous vehicle TPV in the target lane at step i.
5. The intelligent connected vehicle cooperative lane changing control method according to claim 4, characterized in that: The OPV and TPV described are human driven vehicles.
6. The intelligent connected vehicle cooperative lane changing control method according to claim 4, characterized in that: The expression of the driving boundary constraint is: and min ≤y≤y max Where y is the lateral position of the intelligent connected vehicle, y min and max It is the geometric boundary position of the road.
7. The intelligent connected vehicle cooperative lane changing control method according to claim 4, characterized in that: The expression of the acceleration constraint is: a min ≤a≤a max Where a is the acceleration of the intelligent connected vehicle, a min and a max are the lower and upper limits of acceleration respectively.
8. The intelligent connected vehicle cooperative lane changing control method according to claim 4, characterized in that: The expression of the steering constraint is: d min ≤δ≤δ max Among them, δ is the front wheel angle of the intelligent connected vehicle, δ min and δ max are the lower and upper limits of the vehicle's front wheel angle respectively.
