Converting ompl path to geometry_msgs
I'm writing a global planner plugin for the navigation stack using RRT. I am using OMPL to implement the RRT code but the return type for the states of the path is: std::vector< base::State * > &. I want to convert it to the geometry_msgs format of ros. Does anyone know how to do this conversion?