fix more bugs. the new dynamicAABBTree broadphase works quite well in both...

fix more bugs. the new dynamicAABBTree broadphase works quite well in both distance and collision. besides the old self-collision, collision with an object, distance to an object interface, added self-distance, collision with a set of objects, distance to a set of objects. This simplifies the function in collision_detection_fcl and also makes some optimization possible.


git-svn-id: https://kforge.ros.org/fcl/fcl_ros@114 253336fb-580f-4252-a368-f3cef5a2a82b