toward efficient task assignment and motion planning for large scale underwater mission .
Anytime Dynamic A*: An Anytime, Replanning Algorithm