Modified version of RGBDSLAMv2 which from http://github.com/felixendres/rgbdslam_v2/archive/kinetic.zip - View it on GitHub