Multiphase Overtaking Maneuver Planning for Autonomous Ground Vehicles Via a Desensitized Trajectory Optimization Approach

Abstract

This article studies the problem of trajectory optimization for autonomous ground vehicles with the consideration of irregularly placed on-road obstacles and multiple maneuver phases. By introducing a series of event sequences, a new multiphase constrained optimal control formulation is constructed to describe the automatic overtaking process. Although existing trajectory optimization techniques can be applied to address the constructed problem, they may suffer from poor or premature convergence issues due to the complexity of the mission formulation. Thus, to offer an effective alternative, a novel desensitized trajectory optimization method is designed and implemented to explore the optimal overtaking maneuver for the AGVs. The proposed method applies a double layer structure, where an enhanced intelligent optimization method is used in the outer layer such that the main inner optimization routine can be boosted by starting at a better reference solution. The algorithm convergence as well as the solution optimality conditions are theoretically analyzed. Numerical results are provided to illustrate the validity of the established formulation. Comparative case studies were executed to demonstrate the quality of the obtained solution and the enhanced performance of the proposed trajectory optimization method.