How can I make possible for Rtabmapros to work with octomap. I see in the documentation that I need to build rtabmapros with octomap, but I don't know how to this...

I tried putting this in the CMakeLists.txt:

find_package(octomap_msgs) 
find_package(octomap REQUIRED) 
include_directories(${OCTOMAP_INCLUDE_DIRS}) 
link_libraries(${OCTOMAP_LIBRARIES})

And this in the package.xml:

<build_depend>octomap</build_depend>
<build_depend>octomap_msgs</build_depend>
<exec_depend>octomap</exec_depend>
<exec_depend>octomap_msgs</exec_depend>

But still doesn't work.