A. Nash, S. Koenig, and C. Tovey, “Lazy Theta*: Any-Angle Path Planning and Path Length Analysis in 3D”, AAAI, vol. 24, no. 1, pp. 147-154, Jul. 2010.