Incremental real-time multibody VSLAM with trajectory optimization using stereo camera
LSD-SLAM: Large-Scale Direct Monocular SLAM