Robust map optimization using dynamic covariance scaling
Parameter Estimation Techniques: A Tutorial with Application to Conic Fitting