Optimal, Smooth, Nonholonomic Mobile Robot Motion Planning in State Lattices
Optimal paths for a car that goes both forwards and backwards