Convert Costmap2D to OMPL State Space
I am writing a global planner plugin for the navigation stack using OMPL. I need to convert the Costmap2D in ROS to its corresponding State Space representation. Has anyone done this before?
Hey, have you solved your problem in any way?