Trajectory planning for car-like vehicles: A modular approach
From Reeds and Shepp's to continuous-curvature paths