ROS Resources: Documentation | Support | Discussion Forum | Index | Service Status | ros @ Robotics Stack Exchange
Ask Your Question

Collision detection with Octomap

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

AdrianGonzalez gravatar image

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

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 -0600

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 -0600 )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 -0600 )edit

Question Tools



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

Seen: 2,064 times

Last updated: May 05 '14