Differentially constrained path planning with graduated state space