add kIOS which can handle collision and distance simultaneously. and refactor the collision_func_matrix.cpp


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