Two-way D* algorithm for path planning and replanning
A Formal BasisfortheHeuristic Determination of Minimum CostPaths