Incremental real-time multibody VSLAM with trajectory optimization using stereo camera
A benchmark for the evaluation of RGB-D SLAM systems