Autonomous navigation for BigDog
Anytime Dynamic A*: An Anytime, Replanning Algorithm