rgbdslam_freiburg, updated and modified to work on ROS Hydro