Incremental real-time multibody VSLAM with trajectory optimization using stereo camera
Simultaneous Localization, Mapping and Moving Object Tracking