Theta*: Any-Angle Path Planning on Grids
A Formal BasisfortheHeuristic Determination of Minimum CostPaths