Optimal, Smooth, Nonholonomic Mobile Robot Motion Planning in State Lattices
From Reeds and Shepp's to continuous-curvature paths