Robust factor graph optimization - a comparison for sensor fusion applications

While many applications of sensor fusion suffer from the occurrence of outliers, a broad range of outlier robust graph optimization techniques has been developed for simultaneous localization and mapping. In this paper we investigate the performance of some of the most advanced algorithms for a simulated wireless localization setting affected by non-Gaussian errors. With this first analysis we can show some of the advantages and disadvantages that are connected with the different concepts behind Max-Mixture, Generalized iSAM, Switchable Constraints and Dynamic Covariance Scaling.

[1]  Edwin Olson,et al.  Robust sensor characterization via max-mixture models: GPS sensors , 2013, 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[2]  Edwin Olson,et al.  Fast iterative alignment of pose graphs with poor initial estimates , 2006, Proceedings 2006 IEEE International Conference on Robotics and Automation, 2006. ICRA 2006..

[3]  Yasir Latif,et al.  Robust loop closing over time for pose graph SLAM , 2013, Int. J. Robotics Res..

[4]  W. Burgard,et al.  RAWSEEDS: Robotics Advancement through Web-publishing of Sensorial and Elaborated Extensive Data Sets , 2010 .

[5]  Sven Lange,et al.  Incremental smoothing vs. filtering for sensor fusion on an indoor UAV , 2013, 2013 IEEE International Conference on Robotics and Automation.

[6]  Wolfram Burgard,et al.  Robust map optimization using dynamic covariance scaling , 2013, 2013 IEEE International Conference on Robotics and Automation.

[7]  Frank Dellaert,et al.  iSAM2: Incremental smoothing and mapping using the Bayes tree , 2012, Int. J. Robotics Res..

[8]  John J. Leonard,et al.  Robust incremental online inference over sparse factor graphs: Beyond the Gaussian case , 2013, 2013 IEEE International Conference on Robotics and Automation.

[9]  Yasir Latif,et al.  Robust graph SLAM back-ends: A comparative analysis , 2014, 2014 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[10]  Niko Sünderhauf,et al.  Switchable constraints vs. max-mixture models vs. RRR - A comparison of three approaches to robust pose graph SLAM , 2013, 2013 IEEE International Conference on Robotics and Automation.

[11]  Wolfram Burgard,et al.  Experimental analysis of dynamic covariance scaling for robust map optimization under bad initial estimates , 2014, 2014 IEEE International Conference on Robotics and Automation (ICRA).

[12]  Niko Sünderhauf Robust optimization for simultaneous localization and mapping , 2012 .

[13]  Edwin Olson,et al.  Inference on networks of mixtures for robust robot mapping , 2013, Int. J. Robotics Res..

[14]  Marc Pollefeys,et al.  Robust pose-graph loop-closures with expectation-maximization , 2013, 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[15]  Marcus Obst,et al.  Switchable constraints and incremental smoothing for online mitigation of non-line-of-sight and multipath effects , 2013, 2013 IEEE Intelligent Vehicles Symposium (IV).