Lazy theta*: any-angle path planning and path length analysis in 3D
3D Field D: Improved Path Planning and Replanning in Three Dimensions