Incremental real-time multibody VSLAM with trajectory optimization using stereo camera. - N. Dinesh Reddy; Iman Abbasnejad; Sheetal Reddy; Amit Kumar Mondal; Vindhya Devalla (IROS, 2016)