rgbdslam that works with hydro, to compile this you need add the header file OctomapROS.h to the folder /opt/ros/hydro/include/octomap_ros/