Automotive Innovation ›› 2024, Vol. 7 ›› Issue (4): 627-643.doi: 10.1007/s42154-024-00306-y
Trajectory Planning for Autonomous Vehicle with Numerical Optimization Method
Chao Ge, Hongbo Yao, Yajuan Liu contributed equally to this work.
Chao Ge1, Jiabin Zhang1, Hongbo Yao2 & Yajuan Liu3
- 1. College of Electrical Engineering, North China University of Science and Technology, Tangshan, Hebei, China
2. College of Artificial Intelligence, Tangshan University, Tangshan, Hebei, China
3. Control and Computer Engineering, North China Electric Power University, Beijing, China
Trajectory Planning for Autonomous Vehicle with Numerical Optimization Method
Chao Ge, Hongbo Yao, Yajuan Liu contributed equally to this work.#br#
- 1. College of Electrical Engineering, North China University of Science and Technology, Tangshan, Hebei, China
2. College of Artificial Intelligence, Tangshan University, Tangshan, Hebei, China
3. Control and Computer Engineering, North China Electric Power University, Beijing, China
摘要： In this paper, trajectory planning for autonomous vehicle is investigated based on the model prediction control to plan a safe, comfortable and efficient driving path. Firstly, an expanded safe zone of the three circles is proposed to simplify the planning environment. Secondly, the process of trajectory planning is decoupled into lateral planning and longitudinal planning. The model prediction method is utilized in lateral planning to generate a series of candidate trajectories. In addition, the dynamic programming algorithm of unequal distance scattering points is used in longitudinal planning, which significantly improves the planning efficiency. Finally, the cost functions of path planning and speed planning are proposed to find the optimal driving path and speed in the current environment. The collision detection link is increased, which guarantees the absolute safety of trajectories. Simulation results show that the proposed approach is able to generate satisfactory lane change trajectories for automatic lane change maneuvering.