Optimal Vehicle Lane Change Trajectory Planning in Multi-Vehicle Trafﬁc Environments

Featured Application: This paper is mainly dedicated to research on a trajectory planning strategy for intelligent vehicle autonomous lane changing in the V2V scenario of an urban multi-vehicle trafﬁc environment


Introduction
With rapid economic growth, artificial intelligence will be more widely applied to automobile development. At present, Automatic Driving Systems (ADSs) are being developed to prevent accidents and reduce carbon emissions [1]. If automatic driving can be achieved, traffic congestion will be alleviated. In addition, if accidents and fuel consumption are reduced [2], the annual social benefits of autonomous driving systems are expected to reach nearly $800 billion by 2050 [3]. However, automatic driving systems are not yet mature for use in urban environments, and have already resulted in many traffic accidents, making many people wary of using them [4]. As early as 2005, in the DARPA competition, five teams completed the cross-country project. The biggest difficulty of automatic driving technology is not cross-country, but rather, urban environments [5]. On structured roads, the traffic environments are very complex, and vehicles need to interact with multiple vehicles during the lane-changing process [6]. Therefore, the development of a safe and feasible active lane-changing system remains a challenge.
A complete automatic lane change system includes environmental perception, behavior decision, trajectory planning and trajectory tracking control [7]. Trajectory planning comprises the calculation of a lane change trajectory after receiving a lane change signal [8]. Path planning only plans a reference trajectory without considering traffic conditions. compare the polynomial lane changing model; the second defines the vehicle lateral stability constraints; the third step involves the online collision avoidance algorithm, designed to search for safe trajectory clusters; and in the final step, the multi-objective optimization problem is solved by the TOPSIS algorithm to obtain the optimal lane changing trajectory. Three typical working conditions were verified by simulations. The results show that the proposed algorithm can be used to solve the problem of collision-free trajectory planning problem in multi-vehicle traffic environments.

Methods
Environmental perception is based on V2V transmission information, whereby behavior decisions directly output lane changing instructions. The overall framework of this paper is shown in Figure 1.

Subject vehicle Surrounding vehicle
Vehicle dynamics limits

Subject vehicle Surrounding vehicle
Have collision

Subject vehicle Surrounding vehicle
Optimal lane change trajectory

Lane-Changing Trajectory Model
The vehicle is assumed to be travelling in a straight line and at the same longitudinal speed before changing lanes. To improve comfort, it is necessary to reduce longitudinal and transverse fluctuations. As such, the vehicle's transverse velocity, longitudinal displacement, lateral displacement and longitudinal acceleration are all zero at the initial moment. The first step is to set up a lane-changing model. Conventional lane-changing trajectory models include cubic, fifth and seventh-degree polynomials [23]. The initial expression of the cubic polynomial is: where x is the longitudinal displacement of the vehicle; y des is the ideal lateral displacement of the vehicle, and c i is the fitting coefficient. The initial position of the vehicle is (x 0 , y 0 ), and the end position is (x t , y t ). The vehicle is traveling at a constant speed, so its lateral displacement is y 0 = 0, its lateral speed is . y x=x 0 = 0 and its lateral acceleration is .. y x=x 0 = 0 at this time. The lateral displacement y t = a of the vehicle at the end of collision avoidance and the longitudinal travel distance x t = b. The constraint of the reference trajectory is summarized in the following formula.
Based on the above formula, the reference path of the cubic polynomial is calculated as: The lateral velocity and lateral acceleration constraints of the vehicle at the end moment of collision avoidance are taken into account in the fifth polynomial reference path, as shown in the following formula: This reference path constraint is as follows: where . y x=t and .. y x=t are lateral vehicle speed and lateral acceleration at the end of the lane change, respectively. From the above formula, the reference path of the fifth polynomial is calculated as: The rate of change of lateral acceleration at the initial and end moments of the vehicle is further considered for the planning of the seventh-degree polynomial reference path: The reference path constraint conditions are as follows: where ... y | x=0 and ... y | x=t are the lateral jerk at the start and end of the lane change, respectively. From the above formula, the reference path of the seventh-degree polynomial is calculated as: Comparing the lateral displacements under the constraints of a longitudinal vehicle speed of 72 km/h, a longitudinal distance of the obstacle ahead of l = 50 m and a lateral deflection of the vehicle w = 3.75 m, the lateral displacements under the third, fifth and seventh order polynomial planning are determined. The result is shown in Figure 2.
The reference path constraint conditions are as follows: x t are the lateral jerk at the start and end of the lane change, respectively. From the above formula, the reference path of the seventh-degree polynomial is calculated as:  The reference transverse angular velocity and lateral acceleration of the fifth polynomial are relatively smaller and simpler to calculate than those of the seventh order polynomial. In summary, the fifth polynomial provides both comfortable and efficient trajectories for changing lanes. Figure 2d shows fifth polynomial reference lane change trajectories at different speeds. If the longitudinal speed of the vehicle is constant, the only variable of this expression is f t , so the analytic formula can be rewritten as: The reference transverse angular velocity and lateral acceleration of the fifth polynomial are relatively smaller and simpler to calculate than those of the seventh order polynomial. In summary, the fifth polynomial provides both comfortable and efficient trajectories for changing lanes. Figure 2d shows fifth polynomial reference lane change trajectories at different speeds. If the longitudinal speed of the vehicle is constant, the only variable of this expression is t f , so the analytic formula can be rewritten as: In the geodetic coordinate system, the longitudinal speed of the vehicle remains constant when changing lanes, that is: u x0 = u x (t) = u. Due to x n = u n t n , l n = u n t n f , divided by u n to get Formula (10), where w is lane width, t is lane change time, and t f is lane change end time. Different lane changing end times lead to different trajectories. The optimal lane changing trajectory will be selected from the fifth polynomial trajectory cluster.

Vehicle Lateral Dynamic Stability Constraint
The 2-DOF vehicle model was built to determine the boundary value of vehicle lateral stability, from which some trajectory clusters that exceed the lateral stability constraints can be eliminated, the 2-DOF vehicle model is shown in Figure 3. The remaining trajectory clusters are lane changing trajectory clusters with lateral stability.
The reference transverse angular velocity and lateral acceleration of the fifth polyno-mial are relatively smaller and simpler to calculate than those of the seventh order polynomial. In summary, the fifth polynomial provides both comfortable and efficient trajectories for changing lanes. Figure 2d shows fifth polynomial reference lane change trajectories at different speeds. If the longitudinal speed of the vehicle is constant, the only variable of this expression is f t , so the analytic formula can be rewritten as: ( ) In the geodetic coordinate system, the longitudinal speed of the vehicle remains constant when changing lanes, that is: The optimal lane changing trajectory will be selected from the fifth polynomial trajectory cluster.

Vehicle Lateral Dynamic Stability Constraint
The 2-DOF vehicle model was built to determine the boundary value of vehicle lateral stability, from which some trajectory clusters that exceed the lateral stability constraints can be eliminated, the 2-DOF vehicle model is shown in Figure 3. The remaining trajectory clusters are lane changing trajectory clusters with lateral stability.  According to automobile theory, the relationship between the vehicle yaw rate and the front and rear axle slip angles can be determined using the following formula [24]: where · β is the side-slip angular velocity of the center of mass, F y f and F yr are the lateral force of the front axle and the lateral force of the rear axle, respectively, δ f is the front wheel angle of the vehicle (the left and right wheel angles are approximately equal), m is the vehicle mass, and γ is the yaw rate. To keep the vehicle lateral dynamics in a stable state, · β approaches 0 [25], and the yaw rate limit can be deduced using Formula (12).
The brush tire model can be used to calculate the tire lateral force, and the tire slip angle can be approximated according to the vertical force. Then, the brush tire model is referenced to constrain the side slip angle of the vehicle's center of mass, as Formula (13): where F y is tire lateral force, α f ,r is the side slip angle between the rear axle and the front axle, F z f ,r is the vertical force of the rear or front axle of the vehicle, and C α f ,r is the cornering Appl. Sci. 2022, 12, 9662 7 of 19 stiffness of the rear and front axles. Based on the assumption of a small angle, the range of stability is: where a and b are the distances from the front and rear axles to the center of mass of the vehicle, derived from Formulas (13) and (14). The limit of the side slip angle of the center of mass can be obtained as: In summary, the stability limits of the vehicle yaw rate and the of sideslip angle of centroid can be determined using Formulas (12) and (14) respectively. From the above vehicle dynamics stability limit, in order to accurately quantify the lateral dynamic stability limit, it is necessary to know the vehicle model and other relevant parameters (such as the parameters of the steering and tire systems. The D-class vehicle in CarSim is used as the research object; it is equipped with a 150 kw engine, a six-speed automatic transmission, an independent suspension, and an ABS (Anti-lock Braking System) system.
The vehicle changes lanes at a speed of 72 km/h. Different expected trajectories are calculated by changing the end time of different lane changes. At the same time, the road adhesion coefficient and vehicle speed are constantly changed to complete the lane change. The time of each lane change can be measured. Through data fitting, the following three-dimensional diagram can be obtained: It can be found from Figure 4 that within the vehicle dynamic stability limit, t f becomes larger, the vehicle speed increases, and the adhesion coefficient decreases; when the road adhesion coefficient is larger, x decreases significantly; this is also in line with the driver's daily driving habits. Therefore, for a specific vehicle, when the road environment and vehicle speed are determined, there must be a minimum lane change completion time, denoted as t f min , at this time, the non-stable lane change trajectory cluster can be eliminated, and the remaining trajectory clusters are called stable trajectory clusters [26]. It can be found from Figure 4 that within the vehicle dynamic stability limit, f t becomes larger, the vehicle speed increases, and the adhesion coefficient decreases; when the road adhesion coefficient is larger, x decreases significantly; this is also in line with the driver's daily driving habits. Therefore, for a specific vehicle, when the road environment and vehicle speed are determined, there must be a minimum lane change completion time, denoted as min

Collision Avoidance Algorithm
The traditional method for studying safe lane change is the minimum safe distance algorithm, which is most widely used in the forward warning of automatic emergency braking system. Classic safety distance models include the Berkeley model, the Honda safe distance model and the Mazda safe distance model; The forward warning system is too conservative, which leads to frequent automatic braking, and the driver and passenger will feel uncomfortable. There are few application scenarios for the safety distance model algorithm: it is applied in a one-way two lane environment, and the surrounding vehicles have no intention to change lanes, in the multi-vehicle traffic environment, the minimum safe distance method is ineffective because it can not be applied to the scenario where other vehicles have to change lanes. Therefore, heuristic collision avoidance algorithm is used to deal with the problem of lane changing in multi-vehicle traffic environment. The

Collision Avoidance Algorithm
The traditional method for studying safe lane change is the minimum safe distance algorithm, which is most widely used in the forward warning of automatic emergency braking system. Classic safety distance models include the Berkeley model, the Honda safe distance model and the Mazda safe distance model; The forward warning system is too conservative, which leads to frequent automatic braking, and the driver and passenger will feel uncomfortable. There are few application scenarios for the safety distance model algorithm: it is applied in a one-way two lane environment, and the surrounding vehicles have no intention to change lanes, in the multi-vehicle traffic environment, the minimum safe distance method is ineffective because it can not be applied to the scenario where other vehicles have to change lanes. Therefore, heuristic collision avoidance algorithm is used to deal with the problem of lane changing in multi-vehicle traffic environment. The algorithm has a safety rule, all dangerous trajectory clusters are eliminated based on safety rules, and the remaining lane-changing trajectory clusters meet the requirements of safe lane-changing which are called safe trajectory clusters.
Then the collision avoidance algorithm includes two rules: first, if the traffic vehicle is in a straight-line driving state, the subject vehicle will not collide with the traffic vehicle when changing lanes; Second, if the traffic vehicle also needs to change lanes, the subject vehicle will not collide with the traffic vehicle. Whether two vehicles collide is equivalent to whether two rectangles intersect at the same time. As shown in Figure 5: the intersection of two rectangles includes the following four situations.
braking system. Classic safety distance models include the Berkeley model, the Honda safe distance model and the Mazda safe distance model; The forward warning system is too conservative, which leads to frequent automatic braking, and the driver and passenger will feel uncomfortable. There are few application scenarios for the safety distance model algorithm: it is applied in a one-way two lane environment, and the surrounding vehicles have no intention to change lanes, in the multi-vehicle traffic environment, the minimum safe distance method is ineffective because it can not be applied to the scenario where other vehicles have to change lanes. Therefore, heuristic collision avoidance algorithm is used to deal with the problem of lane changing in multi-vehicle traffic environment. The algorithm has a safety rule, all dangerous trajectory clusters are eliminated based on safety rules, and the remaining lane-changing trajectory clusters meet the requirements of safe lane-changing which are called safe trajectory clusters.
Then the collision avoidance algorithm includes two rules: first, if the traffic vehicle is in a straight-line driving state, the subject vehicle will not collide with the traffic vehicle when changing lanes; Second, if the traffic vehicle also needs to change lanes, the subject vehicle will not collide with the traffic vehicle. Whether two vehicles collide is equivalent to whether two rectangles intersect at the same time. As shown in Figure 5: the intersection of two rectangles includes the following four situations. Assuming that there are vehicles i and j in the same scene, the first situation is that a vertex of the two rectangles is inside each other, and the second situation is that all the vertices of the two rectangles do not fall inside the rectangle, but penetrate each other.
Assuming that rectangle i keeps going straight, and rectangle j collides with rectangle i when changing lanes, it is certain that rectangle i has a vertex inside rectangle j . If the collision continues, the two rectangles will pass through. none of the vertices are inside the rectangle j , according to the judgment, it can be seen that the second situation must occur after the first situation.
In order to make the point p outside the rectangle ABCD, an algebraic inequality based on the area of the graph can be used to establish a constraint condition. If the following area conditions are satisfied, it can be proved that the two vehicles will not collide.
In Formula (16), Δ S is the area of the triangle, and S  is the area of the rectangle.
The geometric description is shown in Figure 6.  Assuming that there are vehicles i and j in the same scene, the first situation is that a vertex of the two rectangles is inside each other, and the second situation is that all the vertices of the two rectangles do not fall inside the rectangle, but penetrate each other. Assuming that rectangle i keeps going straight, and rectangle j collides with rectangle i when changing lanes, it is certain that rectangle i has a vertex inside rectangle j. If the collision continues, the two rectangles will pass through. none of the vertices are inside the rectangle j, according to the judgment, it can be seen that the second situation must occur after the first situation.
In order to make the point p outside the rectangle ABCD, an algebraic inequality based on the area of the graph can be used to establish a constraint condition. If the following area conditions are satisfied, it can be proved that the two vehicles will not collide. Assuming that there are vehicles i and j in the same scene, the first situation is that a vertex of the two rectangles is inside each other, and the second situation is that all the vertices of the two rectangles do not fall inside the rectangle, but penetrate each other.
Assuming that rectangle i keeps going straight, and rectangle j collides with rectangle i when changing lanes, it is certain that rectangle i has a vertex inside rectangle j . If the collision continues, the two rectangles will pass through. none of the vertices are inside the rectangle j , according to the judgment, it can be seen that the second situation must occur after the first situation.
In order to make the point p outside the rectangle ABCD, an algebraic inequality based on the area of the graph can be used to establish a constraint condition. If the following area conditions are satisfied, it can be proved that the two vehicles will not collide.
In Formula (16), Δ S is the area of the triangle, and S  is the area of the rectangle.
The geometric description is shown in Figure 6. The lane-changing trajectory of the vehicle is determined by the end time of the lanechanging [27], and the position of the vertex of the rectangle at any time in formula (17).
In Formula (16) Assuming that there are vehicles i and j in the same scene, the first situation is that a vertex of the two rectangles is inside each other, and the second situation is that all the vertices of the two rectangles do not fall inside the rectangle, but penetrate each other.
Assuming that rectangle i keeps going straight, and rectangle j collides with rectangle i when changing lanes, it is certain that rectangle i has a vertex inside rectangle j . If the collision continues, the two rectangles will pass through. none of the vertices are inside the rectangle j , according to the judgment, it can be seen that the second situation must occur after the first situation. In order to make the point p outside the rectangle ABCD, an algebraic inequality based on the area of the graph can be used to establish a constraint condition. If the following area conditions are satisfied, it can be proved that the two vehicles will not collide.
In Formula (16), Δ S is the area of the triangle, and S  is the area of the rectangle.
The geometric description is shown in Figure 6. The lane-changing trajectory of the vehicle is determined by the end time of the lanechanging [27], and the position of the vertex of the rectangle at any time in formula (17).
is the area of the rectangle. The geometric description is shown in Figure 6.
The lane-changing trajectory of the vehicle is determined by the end time of the lanechanging [27], and the position of the vertex of the rectangle at any time in Formula (17).
In order to make the point p outside the rectangle ABCD, an algebraic inequality based on the area of the graph can be used to establish a constraint condition. If the following area conditions are satisfied, it can be proved that the two vehicles will not collide.
In Formula (16), Δ S is the area of the triangle, and S  is the area of the rectangle.
The geometric description is shown in Figure 6.
In Formula (17) The collision between vehicles is approximately the intersection of two rectangles. According to geometric principles, the following Algorithm 1 is constructed to determine whether the rectangles intersect.
, y k1 (t)); B = (x k2 (t), y k2 (t)); C = (x k3 (t), y k3 (t)); D = (x k4 (t), y k4 (t)) A i = (x Ti1 (t), y Ti1 (t)); B i = (x Ti2 (t), y Ti2 (t)); C i = (x Ti3 (t), y Ti3 (t)); D i = (x Ti4 (t), y Ti4 (t)) According to CoL function, when the following rules are observed, whether the subject vehicle collides with the traffic vehicle can be judged: x In the formula, i = 1, 2, 3, 4 are respectively represented as the four traffic vehicles in different lanes, the coordinates of each vertex of the rectangle and the schematic diagram of whether there is a collision are shown in Figure 7, where [x T_in (t), y T_in (t)] is the vertex coordinate of the traffic vehicle, i represents the traffic vehicle, n represents a certain vertex, The lower left corner of the rectangle is marked as 1, and the remaining numbers increase counterclockwise along the rectangle.   For the subject vehicle, when the following criteria are complied with, it proves that the vehicle traveling along the lane-changing trajectory cluster will not collide.
After the safe collision avoidance trajectory is planned, the remaining trajectory meets both vehicle dynamics stability and safe collision avoidance, but it is still a group of trajectory clusters, so it is still necessary to plan the next step in order to solve the optimal lane change trajectory (Figure 8).

TOPSIS Algorithm for Solving Multiple Indexes
Clusters of safe trajectories are multi-objectively optimised to solve for optimal lane change trajectories. Autonomous vehicles change lanes not only for dynamic stability and safety, but also for comfort and lane change efficiency. Four evaluation indicators are proposed for this question, including Index of trajectory deviation, Index of rollover hazard, Index of Side Sliping and Index of Efficiency [28,29]. For the subject vehicle, when the following criteria are complied with, it proves that the vehicle traveling along the lane-changing trajectory cluster will not collide.

Index of rollover hazard
After the safe collision avoidance trajectory is planned, the remaining trajectory meets both vehicle dynamics stability and safe collision avoidance, but it is still a group of trajectory clusters, so it is still necessary to plan the next step in order to solve the optimal lane change trajectory (Figure 8).   For the subject vehicle, when the following criteria are complied with, it proves that the vehicle traveling along the lane-changing trajectory cluster will not collide.
After the safe collision avoidance trajectory is planned, the remaining trajectory meets both vehicle dynamics stability and safe collision avoidance, but it is still a group of trajectory clusters, so it is still necessary to plan the next step in order to solve the optimal lane change trajectory (Figure 8).

TOPSIS Algorithm for Solving Multiple Indexes
Clusters of safe trajectories are multi-objectively optimised to solve for optimal lane change trajectories. Autonomous vehicles change lanes not only for dynamic stability and safety, but also for comfort and lane change efficiency. Four evaluation indicators are proposed for this question, including Index of trajectory deviation, Index of rollover hazard, Index of Side Sliping and Index of Efficiency [28,29].

TOPSIS Algorithm for Solving Multiple Indexes
Clusters of safe trajectories are multi-objectively optimised to solve for optimal lane change trajectories. Autonomous vehicles change lanes not only for dynamic stability and safety, but also for comfort and lane change efficiency. Four evaluation indicators are proposed for this question, including Index of trajectory deviation, Index of rollover hazard, Index of Side Sliping and Index of Efficiency [28,29].

1.
Index of trajectory deviation where f (t) is the reference trajectory, y(t) is the actual vehicle trajectory, · β(t) is the massside eccentricity speed, ∧ E is the trajectory deviation threshold and ∧ β is the mass-side eccentricity threshold.

2.
Index of rollover hazard where ∧ a y is the lateral acceleration threshold, a y (t) is the vehicle lateral acceleration, φ(t) is the vehicle side camber and ∧ φ is the vehicle side camber threshold.

Index of Side Slip
where F y f ,r (t) is the lateral force on the front and rear axles respectively, F z f ,r (t) is the vertical force on the front and rear axles respectively and ∧ µ is the road friction coefficient threshold value.

4.
Index of Efficiency The less time it takes to change lanes, the higher the efficiency of changing lanes [30]. The attributes of each evaluation index are defined as: Benefit indicators include Index of trajectory deviation, Index of rollover hazard and Index of Side Sliping, the cost index is Index of Efficiency. Then the vector N is expanded into a decision matrix, which is the first step of the TOPSIS algorithm.
Among them, the number of rows of the matrix is calculated as Formula (28).
where q is the number of rows in the decision matrix, t f max represents the maximum lane change time, which is 9 s, t f min (u) is the minimum lane-changing time. Previous studies have shown that the minimum lane change time can be calculated when the longitudinal speed of the vehicle and the road adhesion coefficient are determined. ∆t represents unit interval, which can be expressed as follows. (30) Each element of this set corresponds to each row of the matrix M 1 . In order to be able to assign weight values, the elements in matrix M 1 need to be normalized in the way shown below.
One lane changing track (t f ) corresponds to one sample, and the weights of four evaluation indicators in each sample are recorded as: A reasonable weight value is calculated through a large number of repetitions: 2: 3: 3: 2.. Where w T , w R , w S and w E denote the relative weights of 1/J T , 1/J R , 1/J S and J E , respectively; they have the following relation: The weighted matrix is shown in formula (2): Among them, i = 1, 2, 3, . . . , q; j = 1, 2, 3, 4. To calculate the positive ideal solution based on the above formula, the specific method is to select the maximum value of the benefit index in the optimization index as the positive ideal solution, and the minimum value of the cost index in the optimization index as the positive solution. Negative solution is the same as above.
h n j = maxh ij , j ∈ benefit index minh ij , j ∈ cos t index , j = 1, 2, 3, 4. (34) According to the above formula, the positive solution and the negative solution can be calculated after assigning the weight values. The Euclidean distance to the positive solution and negative solution are: d * i is the Euclidean distance of positive solution, d 0 i is the Euclidean distance of positive solution. The evaluation function is used to calculate the optimal lane change trajectory. The evaluation function formula is as follows: After calculating the sample score, each sample should be sorted; The sample with the highest score is regarded as the optimal trajectory planning scheme, and the lane change trajectory is the optimal reference lane change trajectory. The above ranking and evaluation are performed in the stability region, In other words, t f is quantitatively ranked according to the score in the stability region.

Results
The lane change trajectory planning strategy not only considers the dynamic stability of vehicles, but also meets the requirements of collision avoidance. At the same time, the lane change trajectory also takes into account the lane change efficiency. Next, the feasibility and effectiveness of the lane change trajectory were verified in three simulation scenarios with increasing complexity. The multi-vehicle traffic environment is shown in Figure 9.

Results
The lane change trajectory planning strategy not only considers the dynamic stability of vehicles, but also meets the requirements of collision avoidance. At the same time, the lane change trajectory also takes into account the lane change efficiency. Next, the feasibility and effectiveness of the lane change trajectory were verified in three simulation scenarios with increasing complexity. The multi-vehicle traffic environment is shown in Figure 9.

Overtaking and Lane-Changing Scenario
Overtaking is one of the most common reasons to change lanes. In this section, the longitudinal speed of the subject vehicle is 80 km/h, the speed of the vehicle in front is 72 km/h, the longitudinal distance between the two vehicles in the initial position is 15 m, and the road adhesion coefficient is 0.7. The minimum vehicle lane change time, as shown in Figure 6, is 1.906 s, while the maximum change time is generally defined as 9 s. Matlab and CarSim were used for the simulations, and the results are shown below.
As shown in Figure 10a, the lane changing track of VM is not a single trajectory. but the trajectory clusters. As shown in Figure 10b, the safe lane-changing time for the subject vehicle ranged from 1.906 s to 5.9 s. As shown in Figure 10c, the multi-objective optimization results show that the best lane change end time was 2.8 s. The results of the Matlab and CraSim simulation are shown in Figure 10d. It can be seen that the two vehicles did not collide, and both vehicles followed their expected trajectories without skidding or overturning. In engineering, it is generally stipulated that the time of an automatic auxiliary lane change is 3 s. Our trajectory planning algorithm improves the efficiency of lanechanging while also reducing the interference time of vehicle lane-changing behavior on traffic flow.

Overtaking and Lane-Changing Scenario
Overtaking is one of the most common reasons to change lanes. In this section, the longitudinal speed of the subject vehicle is 80 km/h, the speed of the vehicle in front is 72 km/h, the longitudinal distance between the two vehicles in the initial position is 15 m, and the road adhesion coefficient is 0.7. The minimum vehicle lane change time, as shown in Figure 6, is 1.906 s, while the maximum change time is generally defined as 9 s. Matlab and CarSim were used for the simulations, and the results are shown below.
As shown in Figure 10a, the lane changing track of VM is not a single trajectory. but the trajectory clusters. As shown in Figure 10b, the safe lane-changing time for the subject vehicle ranged from 1.906 s to 5.9 s. As shown in Figure 10c, the multi-objective optimization results show that the best lane change end time was 2.8 s. The results of the Matlab and CraSim simulation are shown in Figure 10d. It can be seen that the two vehicles did not collide, and both vehicles followed their expected trajectories without skidding or overturning. In engineering, it is generally stipulated that the time of an automatic auxiliary lane change is 3 s. Our trajectory planning algorithm improves the efficiency of lane-changing while also reducing the interference time of vehicle lane-changing behavior on traffic flow.

Results
The lane change trajectory planning strategy not only considers the dynamic stability of vehicles, but also meets the requirements of collision avoidance. At the same time, the lane change trajectory also takes into account the lane change efficiency. Next, the feasibility and effectiveness of the lane change trajectory were verified in three simulation scenarios with increasing complexity. The multi-vehicle traffic environment is shown in Figure 9.

Overtaking and Lane-Changing Scenario
Overtaking is one of the most common reasons to change lanes. In this section, the longitudinal speed of the subject vehicle is 80 km/h, the speed of the vehicle in front is 72 km/h, the longitudinal distance between the two vehicles in the initial position is 15 m, and the road adhesion coefficient is 0.7. The minimum vehicle lane change time, as shown in Figure 6, is 1.906 s, while the maximum change time is generally defined as 9 s. Matlab and CarSim were used for the simulations, and the results are shown below.
As shown in Figure 10a, the lane changing track of VM is not a single trajectory. but the trajectory clusters. As shown in Figure 10b, the safe lane-changing time for the subject vehicle ranged from 1.906 s to 5.9 s. As shown in Figure 10c, the multi-objective optimization results show that the best lane change end time was 2.8 s. The results of the Matlab and CraSim simulation are shown in Figure 10d. It can be seen that the two vehicles did not collide, and both vehicles followed their expected trajectories without skidding or overturning. In engineering, it is generally stipulated that the time of an automatic auxiliary lane change is 3 s. Our trajectory planning algorithm improves the efficiency of lanechanging while also reducing the interference time of vehicle lane-changing behavior on traffic flow.

Lane-Exchanging Scenario
Lane-exchanging is more complex than overtaking and is in urban traffic environments. Assume that two vehicles exchange information through V2V and then change lanes, and the initial times of changing lanes are the same.
In this section, the longitudinal speed of the subject vehicle is 100 km/h, the speed of the Lead vehicle is 72 km/h, the longitudinal distance between the two vehicles in the initial position is 18 m, and the road adhesion coefficient is 0.7; the vehicle model parameters are shown in Table 1. The minimum vehicle lane change time, as shown in Figure 6, is 2.013 s, while maximum lane change time is generally defined as 9 s. Matlab and CarSim were applied for the simulation, and the results are shown below: As shown in Figure 11a, lane change trajectories for both VM and VLe are trajectory clusters. As shown in Figure 11b, the safe lane-changing time for the Subject vehicle ranged from 2.013 s to 6.4 s. As shown in Figure 11c, the multi-objective optimization results showed that the best lane change end time was 5.6 s. The results of the Matlab and CraSim simulation are shown in Figure 11d. It can be seen that the two vehicles did not collide and both vehicles followed the expected trajectories without skidding or overturning.

Lane-Exchanging Scenario
Lane-exchanging is more complex than overtaking and is in urban traffic environments. Assume that two vehicles exchange information through V2V and then change lanes, and the initial times of changing lanes are the same.
In this section, the longitudinal speed of the subject vehicle is 100 km/h, the speed of the Lead vehicle is 72 km/h, the longitudinal distance between the two vehicles in the initial position is 18 m, and the road adhesion coefficient is 0.7; the vehicle model parameters are shown in Table 1. The minimum vehicle lane change time, as shown in Figure 6, is 2.013 s, while maximum lane change time is generally defined as 9 s. Matlab and CarSim were applied for the simulation, and the results are shown below:  Figure 11a, lane change trajectories for both VM and VLe are trajectory clusters. As shown in Figure 11b, the safe lane-changing time for the Subject vehicle ranged from 2.013 s to 6.4 s. As shown in Figure 11c, the multi-objective optimization results showed that the best lane change end time was 5.6 s. The results of the Matlab and CraSim simulation are shown in Figure 11d. It can be seen that the two vehicles did not collide and both vehicles followed the expected trajectories without skidding or overturning. Figure 11a, lane change trajectories for both VM and VLe are trajectory clusters. As shown in Figure 11b, the safe lane-changing time for the Subject vehicle ranged from 2.013 s to 6.4 s. As shown in Figure 11c, the multi-objective optimization results showed that the best lane change end time was 5.6 s. The results of the Matlab and CraSim simulation are shown in Figure 11d. It can be seen that the two vehicles did not collide and both vehicles followed the expected trajectories without skidding or overturning.   Figure 6, was 1.996 s, while the maximum lane change time was

Cut-In of a Vehicle from Lane 3
At the beginning of the lane change of the Subject vehicle, the Separate vehicle changed from the third lane to the middle lane. This scenario was considered to verify whether the above planning algorithm was suitable for complex lane changing scenarios.
In this section, the longitudinal speed of the subject vehicle is 90 km/h, the speed of the Lag vehicle and Separate vehicle are 72 km/h, the initial longitudinal displacement between the Subject vehicle and Lag vehicle is 15 m, the initial longitudinal displacement between the Subject vehicle and Separate vehicle is 10 m, and the road adhesion coefficient is 0.7; the vehicle model parameters are shown in Table 1. The minimum vehicle lane change time, as shown in Figure 6, was 1.996 s, while the maximum lane change time was generally defined as 9 s. Matlab and CarSim were applied for these simulations; the results are shown below: As shown in Figure 12a, different lane change end times correspond to different lane change trajectories. As shown in Figure 12b, the safe lane-changing time for the Subject vehicle ranged from 1.996 s to 7.0 s. It can be seen from Figure 12c, the multi-objective optimization results showed that the optimal vehicle lane change end time was 5.8 s. The results of the Matlab and CraSim simulation are shown in Figure 12d. It can be seen that the two vehicles did not collide and that both vehicles followed their expected trajectories, with no sideslip or rollover.

Discussion
University and corporate research methods are mostly end-to-end for intelligent driving, whereby vehicles are directly controlled by training driving behavior data. However, this research method requires a large amount of experimental data, and as a result, it poses a challenge in terms of computational requirements. When a vehicle changes lanes, lateral stability is a key point. Because vehicle dynamics are considered in the trajectory planning module, it is unnecessary to design a vehicle lateral stability controller, which simplifies the research. In a multi-vehicle traffic environment, it is inevitable that other vehicles will change lanes. In this case, it is necessary to propose a safe collision avoidance algorithm so that even if two vehicles change lanes at the same time, there will be no collision. However, in this paper, it was assumed that the speed of the vehicle was constant. Real-time changes of vehicle speed need to be tested in an experimental environment. This will be done in future research.
Many trajectories result from the application of vehicle lateral stability constraints and safe collision avoidance algorithms. These processes seek to determine the optimal lane change trajectory. Most previous research has tended to establish the optimization objective function and constraints; subsequently, the optimization variables are calculated by the algorithm. The four indexes and simulation test data can be used for quantitative analyses of lane change performance. In other words, the four optimization indexes corresponding to each lane-changing trajectory can be obtained with specific values. Multiobjective optimization belongs to the multi-attribute decision making problem, and the best way to solve this kind of problem is by using the TOPSIS algorithm.

Discussion
University and corporate research methods are mostly end-to-end for intelligent driving, whereby vehicles are directly controlled by training driving behavior data. However, this research method requires a large amount of experimental data, and as a result, it poses a challenge in terms of computational requirements. When a vehicle changes lanes, lateral stability is a key point. Because vehicle dynamics are considered in the trajectory planning module, it is unnecessary to design a vehicle lateral stability controller, which simplifies the research. In a multi-vehicle traffic environment, it is inevitable that other vehicles will change lanes. In this case, it is necessary to propose a safe collision avoidance algorithm so that even if two vehicles change lanes at the same time, there will be no collision. However, in this paper, it was assumed that the speed of the vehicle was constant. Real-time changes of vehicle speed need to be tested in an experimental environment. This will be done in future research.
Many trajectories result from the application of vehicle lateral stability constraints and safe collision avoidance algorithms. These processes seek to determine the optimal lane change trajectory. Most previous research has tended to establish the optimization objective function and constraints; subsequently, the optimization variables are calculated by the algorithm. The four indexes and simulation test data can be used for quantitative analyses of lane change performance. In other words, the four optimization indexes corresponding to each lane-changing trajectory can be obtained with specific values. Multi-objective optimization belongs to the multi-attribute decision making problem, and the best way to solve this kind of problem is by using the TOPSIS algorithm.
For traditional auxiliary lane changing system, decisions made by engineers regarding lane change times are based on driver habits; generally, the minimum lane change time is 3 s, which lacks flexibility. In contrast, our simulation results show that a lane-changing time of 2.8 s would be acceptable, improving lane-changing efficiency by 6.67% in overtaking scenarios. In addition, in lane-exchanging and cut-in scenarios, the general auxiliary lane-changing system is unable to plan the trajectory. The traditional RRT algorithm (Rapidly Exploring Random Tree) and APF algorithm (Artificial Potential Field) can be used to perform simulations in overtaking scenarios, but they cannot handle the latter two complex scenarios; for example, the APF algorithm is generally unable to build an attractive area in a random environment, while the RRT algorithm will report an error. The absence of collisions, as well as efficiency and comfort, are the advantages of the optimized reference trajectory. The above proposed planning strategies provide ideas and methods for intelligent driving research. However, our planning strategy is a non-game system, which does not take the psychological factors of the driver into account. The typical scenarios cannot represent all the scenarios, more complex lane changing scenarios need to be researched in the future.

Conclusions
In this paper: the multi-vehicle traffic environment as the research context and intelligent vehicle as the research object; the research on the autonomous lane-changing trajectory planning of intelligent vehicles is based on vehicle-to-vehicle. The fifth polynomial as a mathematical model for lane-changing trajectories; the center of mass slip angle and yaw rate are limited to improve the lateral stability of the vehicle; Collision avoidance algorithm is used to eliminate potentially dangerous trajectories, and TOPSIS algorithm is used to calculate the optimal lane-changing trajectory. Simulation results show that compared with the conventional auxiliary lane-changing system, the above algorithm can improve the lane changing efficiency, and it can be applied to more complex traffic scenarios, such as Lane-exchanging and Cut-in scenarios. In a word, optimal lane changing trajectory is a collision free, comfortable and efficient lane-changing trajectory.
Please note that the proposed trajectory planning algorithm cannot address the interaction of multiple vehicles at different times, hence, our future work will be to provide reasonable planning for more complex interactive scenarios. Uninterrupted vehicle-tovehicle communication is an ideal situation, If the lane change intention of other vehicles cannot be perceived, trajectory correction strategy is a key issue in lane-changing trajectory planning. In the future research, trajectory correction and trajectory re-planning will be considered in the trajectory planning framework in order to achieve a safe and smooth lane-changing. Funding: Thanks to the sponsorship provided by the Chongqing Natural Science Foundation Project (cstc2019jcyj-msxmX0204).

Institutional Review Board Statement:
This study waived ethical review and approval, because it does not involve humans or animals.

Informed Consent Statement: Not applicable.
Data Availability Statement: As the project involves confidentiality, research data is not provided. If readers need research data, please contact the corresponding author.