Robust map optimization using dynamic covariance scaling
Switchable constraints for robust pose graph SLAM