Gokul Varadhan Young J. Kim Shankar Krishnan Dinesh Manocha Topology Preserving Approximation of Free Configuration Space. 3041-3048 2006 conf/icra/2006 ICRA db/conf/icra/icra2006.html#VaradhanKKM06