ISAM2: Incremental smoothing and mapping using the Bayes tree

International Journal of Robotics Research

Volumn 31, Issue 2, 2012, Pages 216-235

  Kaess, Michael ^a   Johannsson, Hordur ^a   Roberts, Richard ^b   Ila, Viorela ^b   Leonard, John J ^a   Dellaert, Frank ^b  

^a MASSACHUSETTS INSTITUTE OF TECHNOLOGY   (United States)

^b Georgia Institute of Technology   (United States)

Author keywords

clique tree; graphical models; junction tree; nonlinear optimization; probabilistic inference; SLAM; smoothing and mapping; sparse linear algebra

Indexed keywords

CLIQUE TREE; GRAPHICAL MODEL; JUNCTION TREES; NON-LINEAR OPTIMIZATION; PROBABILISTIC INFERENCE; SLAM;

ALGORITHMS; CONFORMAL MAPPING; DATA STRUCTURES; GRAPHIC METHODS; MATRIX ALGEBRA; OPTIMIZATION; PROBABILITY DENSITY FUNCTION; ROBOTICS; SPEECH RECOGNITION;

FORESTRY;

ALGORITHMS; MAPPING; MATHEMATICAL MODELS; PROBLEM SOLVING;

EID: 84856742278     PISSN: 02783649     EISSN: 17413176     Source Type: Journal    
DOI: 10.1177/0278364911430419     Document Type: Article

References (63)

1. Arnborg S, Corneil D, Proskurowski A. Complexity of finding embeddings in a k-tree. SIAM J Algebraic Discrete Meth. 1987 ; 8: 277-284
2. Blair J, Peyton B Graph Theory and Sparse Matrix Computations (IMA Volumes in Mathematics and its Applications, vol. 56). George J Gilbert J Liu J-H, ed. New York: Springer-Verlag ; 1993: 1-27.
3. Bosse M, Newman P, Leonard J, Teller S. Simultaneous localization and map building in large-scale cyclic environments using the Atlas framework. Int J Robotics Res. 2004 ; 23: 1113-1139
4. Brooks R. Visual map making for a mobile robot. IEEE International Conference on Robotics and Automation (ICRA) ; 1985 ; 1985. 824.
5. Castellanos J, Montiel J, Neira J, Tardós J. The SPmap: A probabilistic framework for simultaneous localization and map building. IEEE Trans Robot Automat. 1999 ; 15: 948-953
6. Chen Y, Davis T, Hager W, Rajamanickam S. Algorithm 887: CHOLMOD, supernodal sparse Cholesky factorization and update/downdate. ACM Trans Math Softw. 2008 ; 35 (3). 22:1-22:14
7. Cowell R, Dawid A, Lauritzen S, Spiegelhalter D Probabilistic Networks and Expert Systems. Berlin: Springer-Verlag ; 1999 :
8. Davis T, Gilbert J, Larimore S, Ng E. A column approximate minimum degree ordering algorithm. ACM Trans Math Softw. 2004 ; 30: 353-376
9. Dellaert F. Square Root SAM: Simultaneous location and mapping via square root information smoothing. Robotics: Science and Systems (RSS). 2005 ;:
10. Dellaert F, Carlson J, Ila V, Ni K, Thorpe C. Subgraph-preconditioned conjugate gradient for large scale SLAM. IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS) ; 2010 ; 2010..
11. Dellaert F, Kaess M. Square Root SAM: Simultaneous localization and mapping via square root information smoothing. Int J Robotics Res. 2006 ; 25: 1181-1203 (Pubitemid 44745891)
12. Dellaert F, Kipp A, Krauthausen P. A multifrontal QR factorization approach to distributed inference applied to multi-robot localization and mapping. Proceedings 22nd AAAI National Conference on AI ; 2005 Pittsburgh, PA ; 2005..
13. Dissanayake M, Newman P, Durrant-Whyte H, Clark S, Csorba M. A solution to the simultaneous localization and map building (SLAM) problem. IEEE Trans Robot Automat. 2001 ; 17: 229-241 (Pubitemid 32829731)
14. Duckett T, Marsland S, Shapiro J. Fast, on-line learning of globally consistent maps. Autonomous Robots. 2002 ; 12: 287-300 (Pubitemid 34566391)
15. Eade E, Drummond T. Monocular SLAM as a graph of coalesced observations. International Conference on Computer Vision (ICCV) ; 2007 Rio de Janeiro, Brazil ; 2007. 1.
16. Folkesson J, Christensen H. Graphical SLAM - a self-correcting map. IEEE International Conference on Robotics and Automation (ICRA) ; 2004 ; 2004. 383.
17. Folkesson J, Christensen H. Closing the loop with Graphical SLAM. IEEE Trans Robotics. 2007 ; 23: 731-741 (Pubitemid 47308111)
18. Folkesson J, Leonard J, Leederkerken J, Williams R. Feature tracking for underwater navigation using sonar. IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS) ; 2007 ; 2007. 3678.
19. Frese U. Treemap: An O(logn) algorithm for indoor simultaneous localization and mapping. Autonomous Robots. 2006 ; 21: 103-122 (Pubitemid 44359124)
20. Frese U, Larsson P, Duckett T. A multilevel relaxation algorithm for simultaneous localisation and mapping. IEEE Trans Robotics. 2005 ; 21: 196-207 (Pubitemid 40608450)
21. GaussC (1809) Theoria Motus Corporum Coelestium in Sectionibus Conicis Solem Mabientium [Theory of the Motion of the Heavenly Bodies Moving about the Sun in Conic Sections]. Hamburg: Perthes and Besser. English translation available at http://name.umdl.umich.edu/AGG8895.0001.001.
22. Gentleman W. Least squares computations by Givens transformations without square roots. IMA J Appl Math. 1973 ; 12: 329-336
23. Gill P, Golub G, Murray W, Saunders M. Methods for modifying matrix factorizations. Maths Computat. 1974 ; 28: 505-535
24. Golub G, Loan CV Matrix Computations. 1996 ) Matrix Computations, 3rd edn.Baltimore, MD: Johns Hopkins University Press. Baltimore, MD: Johns Hopkins University Press ; 1996 :
25. Grassia FS. Practical parameterization of rotations using the exponential map. J Graph Tools. 1998 ; 3: 29-48
26. Grisetti G, Kuemmerle R, Stachniss C, Frese U, Hertzberg C IEEE Intl. Conf. on Robotics and Automation (ICRA). Anchorage, AK: ; 2010 :
27. GrisettiGStachnissCGrzonkaSBurgardW (2007) A tree parameterization for efficiently computing maximum likelihood maps using gradient descent. In Robotics: Science and Systems (RSS).
28. Gutmann J-S, Nebel B Autonome Mobile Systeme. Berlin: Springer-Verlag ; 1997 :
29. Hall B Lie Groups, Lie Algebras, and Representations: An Elementary Introduction. Berlin: Springer ; 2000 :
30. Hartley R, Zisserman A Multiple View Geometry in Computer Vision. Cambridge: Cambridge University Press ; 2000 :
31. Heggernes P, Matstoms P. Finding good column orderings for sparse QR factorization. Second SIAM Conference on Sparse Matrices ; 1996 ; 1996..
32. Howard A, Sukhatme G, Mataric M. Multi-robot mapping using manifold representations. Proc IEEE. 2006 ; 9: 1360-1369
33. Julier S, Uhlmann J. A counter example to the theory of simultaneous localization and map building. IEEE International Conference on Robotics and Automation (ICRA) ; 2001 ; 2001. 4238.
34. Kaess M, Dellaert F. Covariance recovery from a square root information matrix for data association. J Robotics Auton Syst. 2009 ; 57: 1198-1210
35. Kaess M, Ila V, Roberts R, Dellaert F. The Bayes tree: An algorithmic foundation for probabilistic robot mapping. International Workshop on the Algorithmic Foundations of Robotics ; 2010 Singapore ; 2010. 157.
36. Kaess M, Johannsson H, Roberts R, Ila V, Leonard J, Dellaert F. iSAM2: Incremental smoothing and mapping with fluid relinearization and incremental variable reordering. IEEE International Conference on Robotics and Automation (ICRA) ; 2011 Shanghai, China ; 2011..
37. Kaess M, Ranganathan A, Dellaert F. Fast incremental square root information smoothing. International Joint Conference on AI (IJCAI) ; 2007 Hyderabad, India ; 2007. 2129.
38. Kaess M, Ranganathan A, Dellaert F. iSAM: Incremental smoothing and mapping. IEEE Trans Robotics. 2008 ; 24: 1365-1378
39. Kim B, Kaess M, Fletcher L, Leonard J, Bachrach A, Roy N, et al. Multiple relative pose graphs for robust cooperative mapping. IEEE International Conference on Robotics and Automation (ICRA) ; 2010 Anchorage, Alaska ; 2010. 3185.
40. Koller D, Friedman N Probabilistic Graphical Models: Principles and Techniques. Cambridge, MA: The MIT Press ; 2009 :
41. Konolige K. Large-scale map-making. Proceedings 21st AAAI National Conference on AI ; 2004 San Jose, CA ; 2004..
42. Konolige K, Agrawal M. FrameSLAM: from bundle adjustment to realtime visual mapping. IEEE Trans Robotics. 2008 ; 24: 1066-1077
43. Konolige K, Grisetti G, Kuemmerle R, Burgard W, Benson L, Vincent R. Sparse pose adjustment for 2D mapping. IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS) ; 2010 ; 2010..
44. KrauthausenPDellaertFKippA (2006) Exploiting locality by nested dissection for square root smoothing and mapping. In Robotics: Science and Systems (RSS).
45. Kschischang F, Frey B, Loeliger H-A. Factor graphs and the sum-product algorithm. IEEE Trans Inform Theory. 2001 ; 47 (2). 498-519 (Pubitemid 32318087)
46. Lipton R, Tarjan R. Generalized nested dissection. SIAM J Appl Maths. 1979 ; 16: 346-358
47. Lu F, Milios E. Globally consistent range scan alignment for environment mapping. Autonomous Robots. 1997 ;: 333-349 (Pubitemid 127508781)
48. Mahon I, Williams S, Pizarro O, Johnson-Roberson M. Efficient view-based SLAM using visual loop closures. IEEE Trans Robotics. 2008 ; 24: 1002-1014
49. Ni K, Dellaert F. Multi-level submap based SLAM using nested dissection. IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS) ; 2010 ; 2010..
50. Ni K, Steedly D, Dellaert F. Tectonic SAM: Exact; out-of-core; submap-based SLAM. IEEE International Conference on Robotics and Automation (ICRA) ; 2007 Rome, Italy ; 2007..
51. Olson E, Leonard J, Teller S. Fast iterative alignment of pose graphs with poor initial estimates. IEEE International Conference on Robotics and Automation (ICRA) ; 2006 ; 2006..
52. Paskin M. Thin junction tree filters for simultaneous localization and mapping. International Joint Conference on AI (IJCAI) ; 2003 ; 2003..
53. Paz L, Pinies P, Tardós J, Neira J. Large scale 6DOF SLAM with stereo-in-hand. IEEE Trans Robotics. 2008 ; 24: 946-957
54. Pearl J Probabilistic Reasoning in Intelligent Systems: Networks of Plausible Inference. San Francisco, CA: Morgan Kaufmann ; 1988 :
55. Pothen A, Sun C. Distributed multifrontal factorization using clique trees. Proceedings of the Fifth SIAM Conference on Parallel Processing for Scientific Computing ; 1992 Philadelphia, PA: Society for Industrial and Applied Mathematics ; 1992. 34.
56. Ranganathan A, Kaess M, Dellaert F. Loopy SAM. International Joint Conference on AI (IJCAI) ; 2007 Hyderabad, India ; 2007. 2191.
57. Sibley G, Mei C, Reid I, Newman P. Adaptive relative bundle adjustment. Robotics: Science and Systems (RSS). 2009 ;:
58. Smith R, Self M, Cheeseman P. A stochastic map for uncertain spatial relationships. International Symposium on Robotics Research ; 1987 ; 1987..
59. Strasdat H, Montiel J, Davison A. Real-time monocular SLAM: Why filter?. IEEE International Conference on Robotics and Automation (ICRA) ; 2010 ; 2010..
60. Tarjan R, Yannakakis M. Simple linear-time algorithms to test chordality of graphs, test acyclicity of hypergraphs and selectively reduce acyclic hypergraphs. SIAM J Comput. 1984 ; 13: 566-579 (Pubitemid 15514404)
61. Thrun S, Burgard W, Fox D Probabilistic Robotics. Cambridge, MA: The MIT Press ; 2005 :
62. Triggs B, McLauchlan P, Hartley R, Fitzgibbon A Vision Algorithms: Theory and Practice (Lecture Notes in Computer Science, vol. 1883). Triggs W Zisserman A Szeliski R, ed. Berlin: Springer-Verlag ; 1999: 298-375.
63. WangZ (2007) Exactly Sparse Information Filters for Simultaneous Localization and Mapping. PhD thesis, The University of Technology, Sydney.