Trajectory Planning Design for Parallel Parking of Autonomous Ground Vehicles with Improved Safe Travel Corridor

In this paper, the concept of symmetry is utilized to design the trajectory planning for parallel parking of autonomous ground vehicles—that is, the construction and the solution of the optimization-based trajectory planning approach are symmetrical. Parking is the main factor that troubles most drivers for their daily driving travel, and it can even lead to traffic congestion in severe cases. With the rise of new intelligent and autonomous vehicles, automatic parking seems to have become a trend. Traditional geometric planning methods are less adaptable to parking scenarios, while the parking paths planned by graph search methods may only achieve local optimality. Additionally, significant computational time is often required by numerical optimization methods to find a parking path when a good initial solution is not available. This paper presents a hierarchical trajectory planning approach for high-quality parallel parking of autonomous ground vehicles. The approach begins with a graph search layer to roughly generate an initial solution, which is refined by a numerical optimization layer to produce a high-quality parallel parking trajectory. Considering the high dimensionality and difficulty of finding an optimal solution for the path planning optimization problem, this paper proposes an improved safe travel corridor (I-STC) with the construction of collision constraints isolated from surrounding environmental obstacles. By constructing collision constraints of the I-STC based on the initial solution, the proposed method avoids the complexities and non-differentiability of traditional obstacle avoidance constraints, and simplifies the problem modeling the subsequent numerical optimization process. The simulation results demonstrate that the I-STC is capable of generating parallel parking trajectories with both comfort and safety.