Lazy theta*: any-angle path planning and path length analysis in 3D
Using interpolation to improve path planning: The Field D* algorithm