A fast and accurate approximation for planar pose graph optimization

International Journal of Robotics Research

Volumn 33, Issue 7, 2014, Pages 965-987

  Carlone, Luca ^a   Aragues, Rosario ^b,c   Castellanos, José A ^d   Bona, Basilio ^e  

^a Georgia Institute of Technology   (United States)

^b UNIVERSITÉ BLAISE PASCAL   (France)

^c CNRS   (France)

^d UNIVERSITY OF ZARAGOZA   (Spain)

^e POLITECNICO DI TORINO   (Italy)

Author keywords

graph theory; linear estimation; mobile robots; Pose graph optimization; simultaneous localization and mapping

Indexed keywords

GRAPH THEORY; MAXIMUM LIKELIHOOD ESTIMATION; MOBILE ROBOTS; OPTIMIZATION; QUADRATIC PROGRAMMING;

LINEAR ESTIMATION; MAXIMUM LIKELIHOOD APPROACHES; MAXIMUM LIKELIHOOD ESTIMATE; POSE GRAPH OPTIMIZATIONS; QUADRATIC OPTIMIZATION PROBLEMS; SIMULTANEOUS LOCALIZATION AND MAPPING; STATE-OF-THE-ART APPROACH; STATE-OF-THE-ART TECHNIQUES;

ROBOTICS;

EID: 84901641435     PISSN: 02783649     EISSN: 17413176     Source Type: Journal    
DOI: 10.1177/0278364914523689     Document Type: Article

References (54)

1. Barooah P Estimation and control with relative measurements: Algorithms and scaling laws. Santa Barbara: University of California ; 2007 :
2. Barooah P, Hespanha J. Estimation on graphs from relative measurements. Control Systems Magazine. 2007 ; 27 (4). 57-74 (Pubitemid 47225416)
3. Bonarini A, Burgard W, Fontana G, Matteucci M, Sorrenti D, Tardós J. RAWSEEDS: Robotics advancement through web-publishing of sensorial and elaborated extensive data sets. Proceedings of the IROS'06 workshop on benchmarks in robotics research. 2006 ;:
4. Bosse M, Zlot R. Keypoint design and evaluation for place recognition in 2D lidar maps. Robotics and Autonomous System Journal. 2009 ; 57 (12). 1211-1224
5. Cadena C, Galvez-Lopez D, Ramos F, Tardós J, Neira J. Robust place recognition with stereo cameras. Proceedings of the IEEE/RSJ International conference on intelligent robots and systems (IROS). 2010 ;: 5182-5189
6. Carlone L. Convergence analysis of pose graph optimization via Gauss-Newton methods. International Conference on robotics and automation (ICRA). 2013 ;:
7. Carlone L, Aragues R, Castellanos J, Bona B. A first-order solution to simultaneous localization and mapping with graphical models. ; 2011a ; 2011a. 1764.
8. Carlone L, Aragues R, Castellanos J, Bona B. A linear approximation for graph-based simultaneous localization and mapping. Robotics: Science and Systems (RSS). 2011b ;:
9. CarloneLAraguesRCastellanosJBonaB (2012a) A linear approximation for nonlinear pose graph optimization. Technical Report, available at: http://www.lucacarlone.com/index.php/resources/research/lago.
10. CarloneLAraguesRCastellanosJBonaB (2013) A fast and accurate approximation for pose graph optimization. Supplementary material, available at: http://www.lucacarlone.com/index.php/resources/research/lago.
11. CarloneLCensiA (2012) From angular manifolds to the integer lattice: Guaranteed orientation estimation with application to pose graph optimization. ArXiv preprint: http://arxiv.org/abs/1211.3063.
12. Carlone L, Yin J, Rosa S, Zehui Y. Graph optimization with unstructured covariance: Fast, accurate, linear approximation. International conference on simulation, modeling, and programming, for autonomous robots. 2012b ;:
13. Chen W Graph Theory and Its Engineering Applications. London: World Scientific ; 1997 :
14. Crandall D, Ovens A, Snavely N, Huttenlocher D. Discrete-continuous optimization for large-scale structure from motion. ; 2011 ; 2011. 3001.
15. Dellaert F, Carlson J, Ila V, Ni K, Thorpe C. Subgraph-preconditioned conjugate gradients for large scale SLAM. ; 2010 ; 2010. 2566.
16. Dellaert F, Stroupe A. Linear 2D localization and mapping for single and multiple robots. ; 2002 ; 2002. 688.
17. Dubbelman G, Esteban I, Schutte K. Efficient trajectory bending with applications to loop closure. ; 2010 ; 2010. 1.
18. Dubbelman G, Hansen P, Browning B, Dias M. Orientation only loop-closing with closed-form trajectory bending. ; 2012 ; 2012. 815.
19. Durrant-Whyte H, Bailey T. Simultaneous localization and mapping (SLAM): Part I. Robotics and Automation Magazine. 2006a ; 13: 99-110
20. Durrant-Whyte H, Bailey T. Simultaneous localization and mapping (SLAM): Part II. Robotics and Automation Magazine. 2006b ; 13: 108-117 (Pubitemid 46530408)
21. Frese U, Larsson P, Duckett T. A multilevel relaxation algorithm for simultaneous localization and mapping. IEEE Transactions on Robotics. 2005 ; 21 (2). 196-207 (Pubitemid 40608450)
22. Govindu V. Lie-algebraic averaging for globally consistent motion estimation. Proceedings of the International conference on computer vision and pattern recognition (CVPR). 2004 ;: 684-691
23. Grisetti G, Kuemmerle R, Stachniss C, Frese U, Hertzberg C. A hierarchical optimization on manifolds for online 2D and 3D mapping. Proceedings of the IEEE International conference on robotics and automation (ICRA). 2010 ;: 273-278
24. Grisetti G, Stachniss C, Burgard W. Non-linear constraint network optimization for efficient map learning. IEEE Transactions on Intelligent Transportation Systems. 2009 ; 10 (3). 428-439
25. Gross J, Tucker T Topological graph theory. New York: Wiley Interscience ; 1987 :
26. Hartley R, Zisserman A Multiple View Geometry in Computer Vision. Cambridge: Cambridge University Press ; 2000 :
27. Horn R, Johnson C Matrix Analysis. Cambridge: Cambridge University Press ; 1985 :
28. Huang S, Lai Y, Frese U, Dissanayake G. How far is SLAM from a linear least squares problem. Proceedings of the IEEE/RSJ International conference on intelligent robots and systems (IROS) ; 2010 ; 2010. 3011.
29. Kaess M, Johannsson H, Roberts R, Ila V, Leonard J, Dellaert F. iSAM2: Incremental smoothing and mapping with fluid relinearization and incremental variable reordering. Proceedings of the IEEE International conference on robotics and automation (ICRA) ; 2011 ; 2011. 3281.
30. Kaess M, Johannsson H, Roberts R, Ila V, Leonard J, Dellaert F. iSAM2:incremental smoothing and mapping using the Bayes tree. The International Journal of Robotics Research. 2012 ; 31: 217-236
31. Kaess M, Ranganathan A, Dellaert F. iSAM: incremental smoothing and mapping. IEEE Transactions on Robotics. 2008 ; 24 (6). 1365-1378
32. Kavitha T, Liebchen C, Mehlhorn K, et al. Cycle bases in graphs: characterization, algorithms, complexity, and applications. Computer Science Review. 2009 ; 3 (4). 199-243
33. Konolige K. Large-scale map-making. Proceedings of the AAAI National conference on artificial intelligence ; 2004 ; 2004..
34. Konolige K, Grisetti G, Kümmerle R, Burgard W, Limketkai B, Vincent R. Efficient sparse pose adjustment for 2D mapping. Proceedings of the IEEE/RSJ International conference on intelligent robots and systems (IROS) ; 2010 ; 2010. 22.
35. Kuemmerle R, Grisetti G, Strasdat H, Konolige K, Burgard W. g2o: A general framework for graph optimization. Proceedings of the IEEE International conference on robotics and automation (ICRA) ; 2011 ; 2011. 3607.
36. Kümmerle R, Steder B, Dornhege C, et al. On measuring the accuracy of SLAM algorithms. Autonomous Robots. 2009a ; 27 (4). 387-407
37. KümmerleRStederBDornhegeCRuhnkeMGrisettiGStachnissCKleinerA (2009b) SLAM benchmarking webpage. http://ais.informatik.uni-freiburg.de/slamevaluation.
38. Lu F, Milios E. Globally consistent range scan alignment for environment mapping. Autonomous Robots. 1997 ; 4: 333-349 (Pubitemid 127508781)
39. Martinec D, Pajdla T. Robust rotation and translation estimation in multiview reconstruction. Proceedings of the International conference on computer vision and pattern recognition (CVPR) ; 2007 ; 2007. 1.
40. Mendel J Lessons in estimation theory for signal processing, communications, and control. Englewood Cliffs, NJ: Prentice-Hall ; 1995 :
41. Meyer C Matrix Analysis and Applied Linear Algebra. Philadelphia, PA: SIAM ; 2000 :
42. Olson E, Agarwal P. Inference on networks of mixtures for robust robot mapping. Robotics: Science and Systems (RSS). 2012 ;:
43. Olson E, Leonard J, Teller S. Fast iterative alignment of pose graphs with poor estimates. Proceedings of the IEEE International conference on robotics and automation (ICRA) ; 2006 ; 2006. 2262.
44. Quan L, Kanade T. Affine structure from line correspondences with uncalibrated affine cameras. IEEE Transactions on Pattern Analysis and Machine Intelligence. 1997 ; 19: 834-845 (Pubitemid 127762275)
45. Rizzini DL. A closed-form constraint networks solver for maximum likelihood mapping. Proceedings of the European conference on mobile robots (ECMR) ; 2010 ; 2010. 223.
46. Rosen D, Kaess M, Leonard J. An incremental trust-region method for robust online sparse least-squares estimation. Proceedings of the IEEE International conference on robotics and automation (ICRA) ; 2012 ; 2012. 1262.
47. Russell W, Klein D, Hespanha J. Optimal estimation on the graph cycle space. IEEE Transactions on Signal Processing. 2011 ; 59 (6). 2834-2846
48. Sabatta D, Scaramuzza D, Siegwart R. Improved appearance-based matching in similar and dynamic environments using a vocabulary tree. Proceedings of the IEEE International conference on robotics and automation (ICRA) ; 2010 ; 2010. 2262.
49. Sharp G, Lee S, Wehe D. Multiview registration of 3D scenes by minimizing error between coordinate frames. IEEE Transactions on Pattern analysis and Machine Intelligence. 2004 ; 26 (8). 1037-1050
50. Sünderhauf N, Protzel P. Switchable constraints for robust pose graph SLAM. Proceedings of the IEEE/RSJ International conference on intelligent robots and systems (IROS) ; 2012a ; 2012a..
51. Sünderhauf N, Protzel P. Towards a robust back-end for pose graph SLAM. Proceedings of the IEEE International conference on robotics and automation (ICRA) ; 2012b ; 2012b..
52. Thrun S, Montemerlo M. The GraphSLAM algorithm with applications to large-scale mapping of urban structures. The International Journal of Robotics Research. 2006 ; 25: 403-429 (Pubitemid 43735582)
53. Triggs B, McLauchlan P, Hartley R, Fitzgibbon A Vision Algorithms: Theory and Practice. Triggs W Zisserman A Szeliski R, ed. Berlin: Springer-Verlag ; 1999 :
54. WangHHuGHuangSDissanayakeG (2012) On the structure of nonlinearities in pose graph SLAM. In: Robotics: Science and Systems (RSS). Available at: http://www.roboticsproceedings.org/rss08/p54.pdf.