Tunable Trajectory Planner Using G3 Curves
This addresses trajectory planning for autonomous driving, offering a tunable approach, but it appears incremental as it builds on existing methods with specific simplifications.
The paper tackles the problem of planning continuous-curvature-rate trajectories for autonomous driving to balance passenger comfort and travel time, proposing a method that simplifies and discretizes the optimization, with numerical examples demonstrating benefits.
Trajectory planning is commonly used as part of a local planner in autonomous driving. This paper considers the problem of planning a continuous-curvature-rate trajectory between fixed start and goal states that minimizes a tunable trade-off between passenger comfort and travel time. The problem is an instance of infinite dimensional optimization over two continuous functions: a path, and a velocity profile. We propose a simplification of this problem that facilitates the discretization of both functions. This paper also proposes a method to quickly generate minimal-length paths between start and goal states based on a single tuning parameter: the second derivative of curvature. Furthermore, we discretize the set of velocity profiles along a given path into a selection of acceleration way-points along the path. Gradient-descent is then employed to minimize cost over feasible choices of the second derivative of curvature, and acceleration way-points, resulting in a method that repeatedly solves the path and velocity profiles in an iterative fashion. Numerical examples are provided to illustrate the benefits of the proposed methods.