Linear SLAM: A linear solution to the feature-based and pose graph SLAM based on submap joining
iSAM2: Incremental smoothing and mapping using the Bayes tree