Hi,
I have a populated Costmap2DROS object and a vector of poses which make up the robot's path. I need to verify that on every pose, the robot is not in collision.
It should be sufficient to check whether the pose lies within the robot's inscribed radius, although if the computational load is light enough I could check the robot's footprint.
What are the best practices for doing this with a Costmap2DROS? I have found that I can make a copy of the underlying costmap, but this seems inefficient.
Thanks!
Asked: Feb 20
Seen: 78 times
Last updated: Feb 21
ROS Answers is licensed under Creative Commons Attribution 3.0 Content on this site is licensed under a Creative Commons Attribution Share Alike 3.0 license.