Study on Lane-Change Replanning and Trajectory Tracking for Intelligent Vehicles Based on Model Predictive Control

: When an intelligent vehicle changes lanes, the state of other vehicles may change, which increases the risk of collision. Therefore, real-time local path replanning is needed at this time. Based on model predictive control (MPC), a lane-change trajectory replanning strategy was proposed, which was divided into a lane-change trajectory correction strategy, a lane-change switchback strategy and forward active collision avoidance strategy according to collision risk. Based on the collision risk function of the rectangular safety neighborhood, the objective functions were designed according to the speciﬁc requirements of different strategies. The vehicle lateral controller based on MPC and the vehicle longitudinal motion controller were established. The longitudinal velocity was taken as the joint point to establish the lateral and longitudinal integrated controller. The trajectory planning module, trajectory replanning module and trajectory tracking module were integrated in layers, and the three trajectory replanning strategies of lane-change trajectory correction, lane-change switchback and forward active collision avoidance were respectively simulated and veriﬁed. The simulation re-sults showed the trajectory replanning strategy achieves collision avoidance under different scenarios and ensures the vehicle’s driving stability. The trajectory tracking layer achieves accurate tracking of the conventional lane-change trajectory and has good driving stability and comfort.


Introduction
Vehicle driving behavior on structured roads mainly includes lane keeping and vehicle lane changes. Compared with lane keeping, the vehicle lane-change process is more prone to traffic accidents and has greater impact on traffic efficiency. For the safe lane-change of intelligent vehicles, lane-change trajectory planning and lane-change trajectory tracking play an important role.
Lane-change trajectory planning requires intelligent vehicles to plan a safe collisionfree path from the starting point of the lane change to the target point of the lane change according to the surrounding traffic environment and the motion state of the vehicle, and to take into account lane-change efficiency and comfort [1]. Model predictive control (MPC) is used to realize static and dynamic lane-change trajectory planning [2]. In the literature [3], path tracking control using optimal preview and model predictive control are compared and MPC shows better control performances. The authors of [4] describe a dynamic trajectory planning method for lane-changing maneuvering of connected and automated vehicles. The authors of [5] propose a vehicle lane-changing control strategy based on a neural networkenhanced non-singular fast terminal sliding mode control method, and the collision-free path planning problem in conditions with large road curvatures is investigated with the consideration of environmental safety constraints, drivers' comfort, vehicle actuator constraints, etc. [6]. A personalized motion planning and tracking control framework is proposed to prevent autonomous vehicles from colliding with obstacles ahead [7].
Trajectory tracking control requires intelligent vehicles to control, steer, drive or brake under the premise that the scene environment and reference trajectory are known, so as to ter path tracking controller is proposed, and the optimal pred trol time domain under different working conditions are obt prehensive evaluation index of the path tracking performanc as to improve the path tracking accuracy under the premise o At present, most of the research on vehicle lane changi state of other vehicles is unchanged during the lane-change sistent with actual situations. During the lane-change process vehicles changes, the risk of collision with the vehicle will in trajectory should be replanned according to the collision r avoidance [13]. Aiming at the multi-vehicle traffic environme changing state of other vehicles, this paper proposes a lane-c and trajectory tracking control strategy based on model pred vehicle collision avoidance in different scenarios and ensure vehicle.

Intelligent Vehicle Lane-Change Trajectory Planning
Under structured road conditions, a vehicle lane-chan gram is shown in Figure 1 The model is appropriately simplified, assuming that v always traveling along the centerline of the lane where they a eling along the centerline of the lane before the start of the la of the lane change; during the lane change, the change of v small, and the change of vehicle lateral velocity will not lead velocity. In accordance with the relevant regulatory require vehicle R0 behind this lane needs to actively maintain a longi this vehicle, and R0 is not considered in the lane-change safet Define the lane-change safety factor UL1 of vehicle M and where the numerator is the initial longitudinal distance S1(t and the denominator is the minimum lane-change safety dist  (1), where the numerator is the initial longitudinal distance S 1 (t s ) between the two vehicles and the denominator is the minimum lane-change safety distance S safe1 between M and F 0 .
Define the lane-change collision safety factor U L2 between vehicle M and F 1 as shown in Equation (2), where the numerator is the longitudinal distance S 2 (t s ) between the two vehicles at the initial moment of lane change minus the safe following distance S s used to avoid rear-end accidents after the lane change is completed, and the denominator is the minimum longitudinal safety distance S safe2 between M and F 1 .
Define the lane-change collision safety factor U L3 for vehicle M and R 1 as shown in Equation (3), where the numerator is the longitudinal distance S 3 (t s ) between the two vehicles at the initial moment of lane change minus the safe following distance S s , and the denominator is the minimum longitudinal safe distance S safe3 between M and R 1 .
The safety factor U L of lane change for the current road environment is shown in Equation (4). If U L < 1, it means that the lane change is not feasible and the lane change needs to be abandoned; U L > 1 means that the lane-change feasibility is satisfied and the lane-change operation can be performed.
Based on the quintuple polynomial for lane-change trajectory planning, considering lane-change safety, lane-change efficiency and comfort, the optimization problem based on a quintuple polynomial lane-change trajectory was constructed, as shown in Equation (5).
where ω 1  The optimal lane-change time is solved by Equation (5), and the optimal vehicle lanechange trajectory is obtained by substituting it into the vehicle lane-change trajectory based on the quintuple polynomial.

Lane-Change Replanning Strategy
The above lane-change trajectory planning algorithm is based on ideal conditions where the running state of surrounding traffic vehicles does not change during a period of time from the beginning of the lane change to the end of the lane change. In the actual lane-change process, there is the possibility of emergency braking of other vehicles, which leads to the risk of collision in the planned path. Therefore, the driving state of surrounding vehicles needs to be monitored during the lane-change process. When other vehicles change their driving state so that this may lead to collision, lane-change replanning is required to ensure vehicle driving safety as follows.
(1) F 0 is braking and the state of F 1 is unchanged.
If F 0 still meets the safety conditions of the original planning trajectory after braking and decelerating, the original planning trajectory is still used. If the safety conditions of the original planning trajectory are not satisfied, driving according to the original planning trajectory may lead to a collision between this car and F 0 . At this time, the driving status of F 1 in the target lane is not changed, and there is still enough longitudinal space in the target lane for this car to drive into, so it is necessary to replan the lateral movement of this car to complete the lane change safely, as shown in Figure 2.
where the running state of surrounding traffic vehicles does not change during a period of time from the beginning of the lane change to the end of the lane change. In the actual lane-change process, there is the possibility of emergency braking of other vehicles, which leads to the risk of collision in the planned path. Therefore, the driving state of surrounding vehicles needs to be monitored during the lane-change process. When other vehicles change their driving state so that this may lead to collision, lane-change replanning is required to ensure vehicle driving safety as follows.
(1) F0 is braking and the state of F1 is unchanged.
If F0 still meets the safety conditions of the original planning trajectory after braking and decelerating, the original planning trajectory is still used. If the safety conditions of the original planning trajectory are not satisfied, driving according to the original planning trajectory may lead to a collision between this car and F0. At this time, the driving status of F1 in the target lane is not changed, and there is still enough longitudinal space in the target lane for this car to drive into, so it is necessary to replan the lateral movement of this car to complete the lane change safely, as shown in Figure 2.  (2) The state of F0 is unchanged and F1 is braking.
If the safety condition of the original planning trajectory is still satisfied after F1 braking and deceleration, the original planning trajectory is still used. If the safety conditions of the original planning trajectory are not satisfied, the driving state of the vehicle in front of the original lane is unchanged at this time, and the uncertainty of the driving state of the vehicle in the original lane is less than that of the target lane. If the original lane meets the safety conditions required for turning back at this time, turning back to the original lane is a safer choice, as shown in Figure 3.  (2) The state of F 0 is unchanged and F 1 is braking.
If the safety condition of the original planning trajectory is still satisfied after F 1 braking and deceleration, the original planning trajectory is still used. If the safety conditions of the original planning trajectory are not satisfied, the driving state of the vehicle in front of the original lane is unchanged at this time, and the uncertainty of the driving state of the vehicle in the original lane is less than that of the target lane. If the original lane meets the safety conditions required for turning back at this time, turning back to the original lane is a safer choice, as shown in Figure 3.
of time from the beginning of the lane change to the end of the lane change. In the actual lane-change process, there is the possibility of emergency braking of other vehicles, which leads to the risk of collision in the planned path. Therefore, the driving state of surrounding vehicles needs to be monitored during the lane-change process. When other vehicles change their driving state so that this may lead to collision, lane-change replanning is required to ensure vehicle driving safety as follows.
(1) F0 is braking and the state of F1 is unchanged.
If F0 still meets the safety conditions of the original planning trajectory after braking and decelerating, the original planning trajectory is still used. If the safety conditions of the original planning trajectory are not satisfied, driving according to the original planning trajectory may lead to a collision between this car and F0. At this time, the driving status of F1 in the target lane is not changed, and there is still enough longitudinal space in the target lane for this car to drive into, so it is necessary to replan the lateral movement of this car to complete the lane change safely, as shown in Figure 2.     Because the lane-change trajectory planning will reserve the vehicle and the target lane ahead of the following safety distance, the turnback safety distance condition may not be met. At this time, the vehicle moving into the target lane will be braked with the same braking deceleration as the front vehicle; therefore, collision with the front vehicle can be avoided, as shown in Figure 4.
Because the lane-change trajectory planning will reserve the vehicle and the target lane ahead of the following safety distance, the turnback safety distance condition may not be met. At this time, the vehicle moving into the target lane will be braked with the same braking deceleration as the front vehicle; therefore, collision with the front vehicle can be avoided, as shown in Figure 4.  Thus, the lane-change replanning strategy for intelligent vehicles is shown in Figure  5.   Figure 5. Lane-change replanning strategy. Thus, the lane-change replanning strategy for intelligent vehicles is shown in Figure 5. Because the lane-change trajectory planning will reserve the vehicle and the target lane ahead of the following safety distance, the turnback safety distance condition may not be met. At this time, the vehicle moving into the target lane will be braked with the same braking deceleration as the front vehicle; therefore, collision with the front vehicle can be avoided, as shown in Figure 4.  Thus, the lane-change replanning strategy for intelligent vehicles is shown in Figure  5.  As the lane-change replanning needs to plan a safe lane-change trajectory when the driving state of other vehicles changes, the traffic environment presents strong uncertainty. When the trajectory planning based on the quintuple polynomial fails, it needs to plan a safe lane-change trajectory dynamically online according to the time-varying obstacle vehicle state information and the state information of this vehicle. Model predictive control can predict the vehicle state in the future period, has strong multi-constraint processing capability, and can dynamically solve the multi-objective optimization problem at each control moment. Therefore, the lane-change replanning strategy is implemented in the following based on model predictive control.

Lane-Change Trajectory Correction Based on MPC
In the process of vehicles changing lanes, when the vehicle in front of the original lane carries out braking, leading to a sharp decrease in the longitudinal distance between vehicles, this means the original lane does not meet the original lane-change safety conditions, and while the target lane still has sufficient space for a lane change, the original lane-change trajectory needs to be amended to replan the safe trajectory to complete the lane change in order to avoid collision accidents.
For the trajectory planning stage, the vehicle point mass model can be used to simplify the vehicle into mass points to improve the real-time performance of the system. Based on the vehicle point mass model and the transformation relationship between the earth coordinate system and the body coordinate system, it can be calculated: x sin ϕ + . y cos ϕ (6) From this, a nonlinear state space model can be established as shown in Equation (7), T and control variable u is the declination angle of the front wheels of the vehicle, .
x is the vehicle velocity in the x directions, .
y is the vehicle velocity in the x directions, ϕ is the vehicle yaw angle, X is the abscissa in the body coordinate system and Y is the ordinate in the body coordinate system. .
Define the sampling period at the current moment k, the sampling period at trajectory replanning as T s , with the prediction time domain denoted as N p , and the control time domain denoted as N c . Using the forward Euler method to discretize this, we calculate: Define the system output as η = [Y, ϕ] T , then: According to the relationship between the system state variable and output variable, the discrete output variable of the system can be derived as shown in Equation (10).
The left and right contour lines of the vehicle outer envelope rectangle and their extensions are translated outward by a certain transverse distance, so that the obstacle in the space beyond the two straight lines after translation has little risk of collision with this vehicle. Define this lateral distance as the lateral safety distance, noted as S y . Then, define the area in front of the vehicle and between the two straight lines as the collision risk zone [14]. Only the point of the obstacle in the collision risk zone has a collision risk with this vehicle. The value of the lateral safety distance S y is related to the velocity of this vehicle, as shown in Equation (11), where S y is the lateral safety distance in m; v M is the velocity of this vehicle in km/h.
Suppose there are N obstacle points in the collision risk zone: define the obstacle point with the smallest longitudinal distance between the N obstacle points and the center of mass of this vehicle as the maximum collision risk obstacle point, and the longitudinal distance between this point and the center of mass of this vehicle can be expressed as: As a result, the proposed collision risk function is shown below: where J ob denotes the collision risk function; ω ob denotes the collision risk coefficient; and ζ is a very small positive number, which serves to prevent the denominator from being zero. According to the above requirements of lane-change trajectory correction, the replanned trajectory needs to avoid the obstacle points to reduce the collision risk; the difference between the original lane-change trajectory and the replanned lane-change trajectory is as small as possible to be close to the original planned trajectory; the control variable applied should be as small as possible to meet the comfort requirements. Therefore, the objective function needs to include the collision risk function term, the deviation term between the replanned trajectory and the original planned trajectory and the control variable term. In summary, the objective function of the lane-change trajectory correction is shown in Equation (14).
where J ob (t) denotes the value of the collision risk function at time t, U(t) denotes the sequence of control quantities; η ref is the information related to the original planning trajectory, Q is the output quantity deviation weight matrix and R is the control quantity weight matrix.
In order that the replanned lane-change trajectory can ensure the driving stability and the driving comfort of the vehicle, it is necessary to add constraints to the objective function. At this point, the optimization problem is to find the sequence of control quantities corresponding to the minimum value of the objective function under multiple constraints: Solve the minimum value of the objective function and its corresponding optimal control sequence, and bring the optimal control quantity obtained from the solution to Equation (5) to obtain the replanning trajectory discrete points in the future period. Use the quintuple polynomial to fit the replanning trajectory discrete points, input the fitted replanning trajectory curve to the vehicle trajectory tracking control module to control the vehicle, and input the actual state quantity of the vehicle to the trajectory replanning module at the next trajectory replanning time, so as to achieve rolling replanning. The vehicle-following safety distance model is based on the time to collision (TTC) model [15], as shown in Equation (16).
where S s denotes the longitudinal safe following distance, v r denotes the rear vehicle velocity, v f denotes the front vehicle velocity and t TTC denotes the collision time, t TTC = 3 s. Returning to the original lane can generally be done within 7 s. In the process of returning to the original lane, if the velocity of the car in front of the original lane is slower than the velocity of the car, it may have an impact on the car. If the velocity of the car in front of the original lane is greater than the velocity of the following car or the distance between the car and the car in front of the original lane at the beginning of the trajectory replanning is S re ≥ 10 * (v r − v f ) + S s0 , then the minimum safe following distance can still be met after the lane change is completed, and this working condition considers that there is no collision risk in the original lane during the turnback process. The car maintains the original velocity in the planning of the turnback process, and then adjusts the distance between the following car and the front car after the turnback process is completed. If the distance S re between this car and the car in front of the original lane at the starting moment of trajectory replanning satisfies 3 * (v r − v f ) + S s0 ≤ S re < 10 * (v r − v f ) + S s0 , the risk of collision will increase if this car keeps the original velocity on the way to turning back, and it needs to slow down appropriately to keep following at a safe distance from the car in front.
where η c0 is the Y coordinate of the original lane centerline, The constraint conditions and solution functions are the same as above. After obtaining the discrete points of the turnback trajectory, the same quintuple polynomial is used for fitting, and the fitted trajectory curve is input to the vehicle trajectory tracking control module to control the vehicle and achieve the turnback replanning.
And if the original lane is at risk of collision, under this condition, the vehicle lateral movement is controlled while appropriate deceleration is required until the velocity is the same as that of the vehicle in front of the original lane.
Design the turnback process of longitudinal velocity change for uniform deceleration: the initial velocity for the start of the replanning moment t re of this car's velocity is v Ms , the final velocity for the original lane front car's velocity is v F0 ; acceleration is a x , a x is negative; In the process of deceleration and turning back, it is necessary to ensure that the actual longitudinal distance is always larger than the longitudinal safe following distance, in order to deal with special situations such as emergency braking of the car in front of the original lane.
Let the longitudinal distance between the two vehicles at the initial moment of replanning be: where S S0 indicates the static safe following distance to be maintained when the relative velocity of the two vehicles is zero, t S0 indicates that the two vehicles are driving in accordance with the t re moment state from the t re moment until the rear vehicle arrives at the front vehicle rear distance S S0 position of time.
After the start of the deceleration, the longitudinal distance between the two cars at moment t and the longitudinal safe following distance is: , consider the limit case; that is, the longitudinal distance between this car and the car in front of the original lane at the initial moment of lane-change replanning is exactly equal to the longitudinal safe following distance; that is, t s0 = 3 s, and solving the minimum value of the absolute value of the acceleration that makes . After t s0 ≥ 3 s, and decelerates with this rate of deceleration, it can ensure that the actual longitudinal distance between the two cars is constantly larger than the longitudinal safe following distance threshold to meet the safety condition.
Therefore, the longitudinal acceleration of the car from the beginning of the lane change to the end of the turnback is: By bringing the longitudinal acceleration to Equation (28), a vehicle state prediction model under the time-varying condition of longitudinal acceleration can be established. The objective function, constraints, construction and solution of the optimization problem, and discrete point fitting method are all consistent with the original lane collision-free risk above. The fitted replanned trajectory is input to the vehicle trajectory tracking control module for lateral and longitudinal control of the vehicle, and then replanning of the deceleration and return trajectory can be achieved.

Forward Active Collision Avoidance Based on MPC
In the vehicle lane-change process, if in the target lane the front car is emergency braking, so that the original planning trajectory cannot safely complete the lane change, while the original lane does not meet the turnback safety distance conditions or the original lane front car at this time is also braking and decelerating, then forward active collision avoidance is needed.
Under the premise that there is a safe distance from the initial moment, if the front car brakes urgently, the present car brakes with the same acceleration, and the collision can be avoided. Therefore, the longitudinal acceleration of the present car is planned as: the replanned trajectory needs to be as far away from the obstacles as possible to reduce the collision risk; the planned route imposes as small a control range as possible to meet the comfort requirements. Therefore, the objective function should contain the term of deviation of the replanned trajectory from the centerline of the target lane, the term of collision risk function and the term of control range. In summary, the objective function is proposed as shown below: where η c1 is the Y coordinate of the centerline of the target lane, The constraint conditions, the construction and solution of the optimization problem, and the discrete point fitting approach are consistent with the above. The fitted replanned trajectory is input to the vehicle trajectory tracking control module for lateral and longitudinal control of the vehicle, and then the replanning of forward active collision avoidance can be achieved.

Trajectory Tracking Based on Model Predictive Control
Trajectory tracking requires control of the vehicle's lateral and longitudinal motions. For lateral control, the MPC-based vehicle lateral motion controller is designed to solve the problem of the optimal front wheel turning angle. For longitudinal control, the vehicle longitudinal motion controller is designed based on dual PID to solve the vehicle drive/brake control value problems. The longitudinal velocity is used as the joint point, and the constraints are added to establish the integrated lateral and longitudinal controls for the whole vehicle.

Lateral Motion Controller Based on MPC
In Figure 6, XOY is the geodetic coordinate system, oxy is the body coordinate system, and o is the vehicle's center of mass. The names of vehicle-related parameters are shown in Table 1. Based on the vehicle three-degrees-of-freedom dynamics model, a nonlinear threedegrees-of-freedom vehicle dynamics model can be obtained, as shown in Equation (25).
drive/brake control value problems. The longitudinal velocity is used as the joint point, and the constraints are added to establish the integrated lateral and longitudinal controls for the whole vehicle.

Lateral Motion Controller Based on MPC
In Figure 6, XOY is the geodetic coordinate system, oxy is the body coordinate system, and o is the vehicle's center of mass. The names of vehicle-related parameters are shown in Table 1. Based on the vehicle three-degrees-of-freedom dynamics model, a nonlinear three-degrees-of-freedom vehicle dynamics model can be obtained, as shown in Equation (25). Figure 6. Three-degrees-of-freedom dynamics model.
Linearizing and discretizing the above model yields a linear time-varying discrete system as shown in Equation (26), where A k,t = I + TA(t), B k,t = I + TB(t), where I is the unit matrix and T is the control layer sampling period.
Linearizing and discretizing the above model yields a linear time-varying discrete system as shown in Equation (27), where A k,t = I + TA(t), B k,t = I + TB(t), where I is the unit matrix and T is the control layer sampling period.
In the formula: In order to make the vehicle achieve the tracking of the reference trajectory as accurately and stably as possible, it is necessary to minimize the deviation of the predicted output quantity from the reference output quantity and minimize the control increment. Therefore, the objective function is set as shown in Equation (29).
where Q denotes the output quantity deviation weight matrix, Q = diag(λ 1 , λ 2 , · · · , λ p ), where p denotes the number of output quantities and λ i (i = 1, 2, · · · , p) denotes the weight value of the ith output quantity deviation; R is the control quantity weight matrix, R = diag(λ 1 , λ 2 , · · · , λ Q ), where q denotes the number of control quantities and λ i (i = 1, 2, · · · , Q) denotes the weight value of the ith control quantity; ε is the relaxation factor and ρ is the relaxation factor weight coefficient.
To ensure the driving stability of the vehicle during the control process, it is necessary to constrain the system control amount, control increment, output amount and relaxation factor. Combining the objective function and constraints, the optimization problem that needs to be solved is shown in Equation (30). min ∆U(t),ε J(χ(t), U(t − 1), ∆U(t), ε) s.t. u min ≤ u(t + i|t) ≤ u max , i = 0, 1, 2, · · · , N c − 1 ∆u min ≤ u(t + i|t) ≤ ∆u max , i = 0, 1, 2, · · · , N c − 1 η min − εL p ≤ η(t + i t) ≤ η max + εL p , i = 1, 2, · · · , N p 0 ≤ ε ≤ ε max (30) u min and u max are the upper and lower limits of the control value, ∆u min and ∆u max are the upper and lower limits of the control increment, L p is a p-dimensional column matrix with 1 for each element, η min and η max represents the lower output and the upper output.
By solving the optimization problem, the optimal front wheel turning angle increment sequence is obtained, and the first term of the optimal control sequence is input to the controlled vehicle as the actual control value. In the next control cycle, the optimal control sequence continues to be solved, and so on, to achieve MPC rolling optimization.

Longitudinal Motion Controller Based on Double PID
The longitudinal control adopts a hierarchical design, and the upper controller adopts double PID control to calculate the desired acceleration based on the difference between the current position and velocity and the reference position and velocity, and outputs it to the lower controller. The lower controller selects the drive or brake mode or maintains the idle state according to the desired acceleration, calculates the relevant control values through the vehicle inverse dynamics model, and inputs them to the controlled vehicle to complete the vehicle longitudinal velocity control. The vehicle longitudinal controller is shown in Figure 7.

Longitudinal Motion Controller Based on Double PID
The longitudinal control adopts a hierarchical design, and the upper controller adopts double PID control to calculate the desired acceleration based on the difference between the current position and velocity and the reference position and velocity, and outputs it to the lower controller. The lower controller selects the drive or brake mode or maintains the idle state according to the desired acceleration, calculates the relevant control values through the vehicle inverse dynamics model, and inputs them to the controlled vehicle to complete the vehicle longitudinal velocity control. The vehicle longitudinal controller is shown in Figure 7.

Integrated Lateral and Longitudinal Controller
Since the lateral motion of the vehicle has less influence on the longitudinal motion control, the variation of the longitudinal vehicle velocity has more influence on the lateral motion control of the vehicle. Therefore, the actual longitudinal vehicle velocity is input to the lateral motion control system as a state value, the time-varying longitudinal vehicle velocity parameters are considered, and the vehicle prediction model is continuously updated by using the characteristics of MPC feedback correction. The integrated lateral and longitudinal controller of the whole vehicle is shown in Figure 8. In order to ensure the stability of the integrated lateral-longitudinal control, the constraints of lateral acceleration and trajectory curvature on the vehicle longitudinal velocity and the friction circle

Integrated Lateral and Longitudinal Controller
Since the lateral motion of the vehicle has less influence on the longitudinal motion control, the variation of the longitudinal vehicle velocity has more influence on the lateral motion control of the vehicle. Therefore, the actual longitudinal vehicle velocity is input to the lateral motion control system as a state value, the time-varying longitudinal vehicle velocity parameters are considered, and the vehicle prediction model is continuously updated by using the characteristics of MPC feedback correction. The integrated lateral and longitudinal controller of the whole vehicle is shown in Figure 8. In order to ensure the stability of the integrated lateral-longitudinal control, the constraints of lateral acceleration and trajectory curvature on the vehicle longitudinal velocity and the friction circle constraints related to the road surface adhesion coefficient and vehicle vertical load need to be added, as shown in Equations (31) and (32), respectively.

Integrated Simulation Verification
Based on the above lane-change trajectory planning module, lane-change replanning module and trajectory tracking module, the intelligent vehicle-integrated lane-change control is established, as shown in Figure 9. R is the trajectory curvature, µ is the coefficient of pavement friction, a x is longitudinal acceleration, a y lateral acceleration, F x is lateral force, F y is longitudinal force, F z is vertical force.

Integrated Simulation Verification
Based on the above lane-change trajectory planning module, lane-change replanning module and trajectory tracking module, the intelligent vehicle-integrated lane-change control is established, as shown in Figure 9.

Integrated Simulation Verification
Based on the above lane-change trajectory planning module, lane-change replanning module and trajectory tracking module, the intelligent vehicle-integrated lane-change control is established, as shown in Figure 9.       Figure 11.
As can be seen from Figure 11a, within 1 s from the start of the lane change, the vehicle tracks the original planned trajectory. When the lane change process is at 1 s, trigger the lanechange replanning and correct the lane-change trajectory. It can be seen from Figure 11b,c that in the process of lane-change replanning, in order to avoid rear-end collision with the vehicle in front and emergency braking, emergency obstacle avoidance must be carried out through rapid steering, resulting in certain fluctuations in the declination angle and yaw angle speed of the center of mass of the vehicle. The phase plane is widely used as the vehicle driving stability criterion for vehicle stability judgment [16]. The two black dashed lines in Figure 11d represent the boundary of the phase plane stabilization zone. And it can be seen that the driving state is always located in the phase plane stability zone during lane-change replanning. As can be seen from Figure 11a, within 1 s from the start of the lane change, the vehicle tracks the original planned trajectory. When the lane change process is at 1 s, trigger the lane-change replanning and correct the lane-change trajectory. It can be seen from Figure 11b-c that in the process of lane-change replanning, in order to avoid rear-end collision with the vehicle in front and emergency braking, emergency obstacle avoidance must be carried out through rapid steering, resulting in certain fluctuations in the declination angle and yaw angle speed of the center of mass of the vehicle. The phase plane is widely used as the vehicle driving stability criterion for vehicle stability judgment [16]. The two black dashed lines in Figure 11d represent the boundary of the phase plane stabilization zone. And it can be seen that the driving state is always located in the phase plane stability zone during lane-change replanning.
Using the vehicle center-of-mass position and heading angle information, the coordinates of the four corner points of the vehicle are calculated. At the moment tc1 = 1.82 s   Figure 12 shows that before the moment of tc1, the longitudinal distan two vehicles is always larger than 0, and no collision will occur; after the this vehicle completely crosses the collision risk auxiliary line Line1, and t sion risk. The simulation verifies that the lane-change trajectory correction safe lane-change trajectory to avoid collision, while the trajectory tracking the vehicle's driving state stability.   Figure 12 shows that before the moment of t c1 , the longitudinal distance between the two vehicles is always larger than 0, and no collision will occur; after the moment of t c1 , this vehicle completely crosses the collision risk auxiliary line Line1, and there is no collision risk. The simulation verifies that the lane-change trajectory correction can replan the safe lane-change trajectory to avoid collision, while the trajectory tracking control ensures the vehicle's driving state stability. At the start of the lane change, the velocity of the car in front of the target lane is larger than that of the car in question and the initial longitudinal distance is sufficient; if the car in front keeps its current driving state and there is no collision risk with the car, the safety factor of lane change is UL = 3 and the time of lane change is tL = 5.31 s. Within 1.5 s from the start of the lane change, the vehicle follows the original planning trajectory. After 1.5 s, the longitudinal distance between the two vehicles decreases sharply due to the braking of the vehicle in front of the target lane. If the car still tracks the original planning trajectory, a rear-end collision will occur at 4.22 s, as shown in Figure 13.    As can be seen from Figure 16a,e, the vehicle begins to perform forward active collision avoidance 1.5 s after the start of lane change, increases the steering angle to merge into the target lane as soon as possible, and brakes to decelerate. It can be seen from Figure  16b-d,f that the longitudinal and lateral acceleration of the vehicle is large, but it still meets the friction circle constraint. The declination angle and yaw angle velocity of the center of mass cause large fluctuations due to emergency obstacle avoidance, but the driving state of the vehicle is always in the phase plane stability zone. Stable driving is achieved throughout. The simulation verified that under the conditions that the vehicle in As can be seen from Figure 16a,e, the vehicle begins to perform forward active collision avoidance 1.5 s after the start of lane change, increases the steering angle to merge into the target lane as soon as possible, and brakes to decelerate. It can be seen from Figure 16b-d,f that the longitudinal and lateral acceleration of the vehicle is large, but it still meets the friction circle constraint. The declination angle and yaw angle velocity of the center of mass cause large fluctuations due to emergency obstacle avoidance, but the driving state of the vehicle is always in the phase plane stability zone. Stable driving is achieved throughout. The simulation verified that under the conditions that the vehicle in front of the original lane and the target lane are braking at the same time, forward active collision avoidance can avoid collision and effectively ensure the driving stability of the vehicle.

Conclusions
(1) In an intelligent vehicle lane-change process, other traffic vehicles' driving state changing will increase the risk of collision, so there is a need to carry out lane-change replanning. According to different traffic conditions, lane-change replanning is carried out for lane-change trajectory correction, lane-change turnback and forward active collision avoidance operation. All three operation strategies were implemented based on model predictive control, and different objective functions were designed according to the specific requirements of different strategies to obtain the optimal control volume under different working conditions, and the replanning trajectory was fitted based on the quintuple polynomial, which was input to the trajectory tracking control module, and the optimal control value continued to be solved at the next replanning moment to achieve rolling replanning. Data Availability Statement: Not applicable.

Conflicts of Interest:
The authors declare no conflict of interest.