introducing slambench , a performance and accuracy benchmarking methodology for slam .
A benchmark for RGB-D visual odometry, 3D reconstruction and SLAM