now the user can choose solver for the basic shape distance/collision. 



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

The shape collision basic code is finished. Support both collision and distance. can use gjk in libccd or use independent gjk. tested on simple examples. 
remove geometric_shapes_intersect.h/cpp, replace by gjk_libccd.h/cpp and move them to narrowphase folder

Next step is testing the external interface for shape/mesh 



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

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

Add basic code for primitive shape distance by extending the libccd a bit. Correctness is tested on basic benchmarks. The external interface will be provided soon.

One small problem is that the precision seems not very high in some cases (like the error is 0.1 when distance is 30). 




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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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