Efficiently Using Cost Maps For Planning Complex Maneuvers
Anytime Dynamic A*: An Anytime, Replanning Algorithm