Efficiently Using Cost Maps For Planning Complex Maneuvers
ARA*: Anytime A* with Provable Bounds on Sub-Optimality