Ask Your Question

Collision detection with Octomap

asked 2014-05-05 06:36:34 -0500

AdrianGonzalez gravatar image

updated 2014-05-05 07:21:55 -0500

Hi all:

I am recently introduced in Octomap. I am trying to implementa motion planner but I need two things:

  • given the robot shape and its pose, check if there is a collision given an stored octree
  • given the robot shape and its pose, retrieve the nearest obstacle in the octree

¿Is there anything implemented that I can use?

Thank you in advance

edit retag flag offensive close merge delete

1 Answer

Sort by » oldest newest most voted

answered 2014-05-05 21:20:00 -0500

AHornung gravatar image

Collision checking based on OctoMap is already implemented in the arm_navigation stack or better in its successor MoveIt, so the simplest thing would be to use that for collision checks. As an alternative you will have to iterate over the occupied voxels of OctoMap (best in a local bounding box) and see if they intersect with the robot.

Distance queries based on an existing OctoMap can be answered with the dynamicEDT3D library, which is distributed along with the source of OctoMap (although not yet released in ROS).

edit flag offensive delete link more


+1 for using the MoveIt framework to implement a motion planner.

Martin Günther gravatar image Martin Günther  ( 2014-05-05 22:21:12 -0500 )edit

thank you @AHornung. For my problem, I finally will require to iterate over a local bounding box over the occupied voxels, because I need to weight all the obstacles in a region around the robot according to several parameters of my application. Thank you for your response.

AdrianGonzalez gravatar image AdrianGonzalez  ( 2014-05-13 01:29:40 -0500 )edit

Your Answer

Please start posting anonymously - your entry will be published after you log in or create a new account.

Add Answer

Question Tools



Asked: 2014-05-05 06:36:34 -0500

Seen: 1,734 times

Last updated: May 05 '14