Motion planning in urban environments: Part II
Anytime Dynamic A*: An Anytime, Replanning Algorithm