converting between costmap_2d::Costmap2D and nav_msgs::OccupancyGrid
Is there an established or convenient way to convert between these two? I don't see any methods that suggest this is possible.
The manual approach of course is to create a message and populate it by iterating over all the cells in the Costmap2D, but this seems like something that might already exist.