add octomap in shape; all collision_managers can handle octomap now, and DynamicAABB manager has special optimization for octomap. Need more test.


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

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

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

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

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

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

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

fix bug in sse matrix


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

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

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

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

implement the morton curve version of broadphase structure construction, on test, of the same performance as SSaP.


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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

sphere-sphere, box-box special implementation. seems the precision is lower than standard GJK. So now is still not used.


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

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

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