Hybrid Trajectory Planning for Autonomous Driving in Highly Constrained Environments

In this paper, we introduce a novel and efficient hybrid trajectory planning method for autonomous driving in highly constrained environments. The contributions of this paper are fourfold. First, we present a trajectory planning framework that is able to handle geometry constraints, nonholonomic constraints, and dynamics constraints of cars in a humanlike and layered fashion and generate curvature-continuous, kinodynamically feasible, smooth, and collision-free trajectories in real time. Second, we present a derivative-free global path modification algorithm to extract high-order state information in free space for state sampling. Third, we extend the regular state-space sampling method widely used in on-road autonomous driving systems to a multi-phase deterministic state-space sampling method that is able to approximate complex maneuvers. Fourth, we improve collision checking accuracy and efficiency by using a different car footprint approximation strategy and a two-phase collision checking routine. A range of challenging simulation experiments show that the proposed method returns high-quality trajectories in real time and outperforms existing planners, such as hybrid A* and conjugate-gradient descent path smoother in terms of path quality, efficiency, and computation resources used.