A Unified Trajectory Planning and Tracking Control Framework for Autonomous Overtaking Based on Hierarchical MPC.

Zhuoren Li,Lu Xiong,Bo Leng
DOI: https://doi.org/10.1109/itsc55140.2022.9922186
2022-01-01
Abstract:In this paper, we develop a unified trajectory planning and tracking control framework for autonomous overtaking in structured roads. The framework consists of two individual MPC to optimize the lateral and longitudinal motion in two successive steps. The lateral MPC use the vehicle kinematic model in Frenét coordinate frame as prediction model, which is expert in describing motion in curved roads over kinematic model in Cartesian. By reformulating the MPC as a quadratic program (QP) problem, the lateral planning controller calculates the optimal steering angle control command to manage lane keeping and lane changing behaviors. Then the longitudinal planning controller will choose the mode of speed keeping or target following in accordance with the lateral result and generate the safety corridor based on ST-Graph for collision avoidance. Eventually the optimal acceleration will be given by longitudinal MPC. The hierarchical structure reduces the complexity of optimization problems and improves the efficiency for overtaking planning and control. In simulation, we use two scenarios to validate the proposed autonomous overtaking framework. The result shows the framework can deal with different overtaking maneuvers well.
What problem does this paper attempt to address?