Lazy theta*: any-angle path planning and path length analysis in 3D
Theta*: Any-Angle Path Planning on Grids