Dynamic Trajectory Planning for Automated Lane Changing Using the Quintic Polynomial Curve

Abstract

As one of the key algorithms in supporting AV (autonomous vehicle) to complete the LC (lane changing) maneuver, the LTP (LC trajectory planning) algorithm generates safe and efficient LC trajectory for the AV. This paper proposes a novel dynamic LTP algorithm based on the quintic polynomial curve. This algorithm is capable of adjusting LC trajectory according to the state changes of the surrounding driving environment. The formulation of our proposed algorithm mainly consists the underlying form of trajectory equation, the optimization objective function, the corresponding constrains, and the SQP (sequential quadratic programming) algorithm. For each planning step, the time-based quintic polynomial function is introduced to model the trajectory equation. The problem of solving the parameters of the corresponding equation is then transformed into an optimization problem, which takes driver’s safety, comfort, and efficiency into account. After that, the SQP algorithm is employed to solve this optimization problem. Finally, both numerical simulation and field-data validation are used to verify the effectiveness of our proposed algorithm. We anticipate that the research could provide certain valuable insights for developing more reliable LC algorithms for AVs.