C. Balaguer. Reduction of Free-Space-Loss for Good and Rapid 3D Path Planning of 6DOF Robots. Journal of Intelligent & Robotic Systems , vol: 13, number: 3, pages: 263 - 278. 1995.