ARA*: Anytime A* with Provable Bounds on Sub-Optimality - Robotics Institute Carnegie Mellon University