René Wagner, Udo Frese, Berthold Bäuml: 3D modeling, distance and gradient computation for motion planning: A direct GPGPU approach. ICRA 2013: 3586-3592