Forked from http://alufr-ros-pkg.googlecode.com/svn/trunk/rgbdslam_freiburg