Collision detection with Octomap
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