Theta*: Any-Angle Path Planning on Grids
principles of robot motion : theory , algorithms , and implementations [ book review ] .