iSAM2: Incremental smoothing and mapping using the Bayes tree

We present a novel data structure, the Bayes tree, that provides an algorithmic foundation enabling a better understanding of existing graphical model inference algorithms and their connection to sparse matrix factorization methods. Similar to a clique tree, a Bayes tree encodes a factored probabili...

Full description

Bibliographic Details
Main Authors: Kaess, Michael, Johannsson, Hordur, Roberts, Richard, Ila, Viorela, Leonard, John Joseph, Dellaert, Frank
Other Authors: Massachusetts Institute of Technology. Computer Science and Artificial Intelligence Laboratory
Format: Article
Language:en_US
Published: Sage Publications 2013
Online Access:http://hdl.handle.net/1721.1/78894
https://orcid.org/0000-0002-8863-6550
_version_ 1826189522170281984
author Kaess, Michael
Johannsson, Hordur
Roberts, Richard
Ila, Viorela
Leonard, John Joseph
Dellaert, Frank
author2 Massachusetts Institute of Technology. Computer Science and Artificial Intelligence Laboratory
author_facet Massachusetts Institute of Technology. Computer Science and Artificial Intelligence Laboratory
Kaess, Michael
Johannsson, Hordur
Roberts, Richard
Ila, Viorela
Leonard, John Joseph
Dellaert, Frank
author_sort Kaess, Michael
collection MIT
description We present a novel data structure, the Bayes tree, that provides an algorithmic foundation enabling a better understanding of existing graphical model inference algorithms and their connection to sparse matrix factorization methods. Similar to a clique tree, a Bayes tree encodes a factored probability density, but unlike the clique tree it is directed and maps more naturally to the square root information matrix of the simultaneous localization and mapping (SLAM) problem. In this paper, we highlight three insights provided by our new data structure. First, the Bayes tree provides a better understanding of the matrix factorization in terms of probability densities. Second, we show how the fairly abstract updates to a matrix factorization translate to a simple editing of the Bayes tree and its conditional densities. Third, we apply the Bayes tree to obtain a completely novel algorithm for sparse nonlinear incremental optimization, named iSAM2, which achieves improvements in efficiency through incremental variable re-ordering and fluid relinearization, eliminating the need for periodic batch steps. We analyze various properties of iSAM2 in detail, and show on a range of real and simulated datasets that our algorithm compares favorably with other recent mapping algorithms in both quality and efficiency.
first_indexed 2024-09-23T08:16:11Z
format Article
id mit-1721.1/78894
institution Massachusetts Institute of Technology
language en_US
last_indexed 2024-09-23T08:16:11Z
publishDate 2013
publisher Sage Publications
record_format dspace
spelling mit-1721.1/788942022-09-30T08:43:06Z iSAM2: Incremental smoothing and mapping using the Bayes tree Kaess, Michael Johannsson, Hordur Roberts, Richard Ila, Viorela Leonard, John Joseph Dellaert, Frank Massachusetts Institute of Technology. Computer Science and Artificial Intelligence Laboratory Massachusetts Institute of Technology. Department of Electrical Engineering and Computer Science Massachusetts Institute of Technology. Department of Mechanical Engineering Kaess, Michael Johannsson, Hordur Leonard, John Joseph We present a novel data structure, the Bayes tree, that provides an algorithmic foundation enabling a better understanding of existing graphical model inference algorithms and their connection to sparse matrix factorization methods. Similar to a clique tree, a Bayes tree encodes a factored probability density, but unlike the clique tree it is directed and maps more naturally to the square root information matrix of the simultaneous localization and mapping (SLAM) problem. In this paper, we highlight three insights provided by our new data structure. First, the Bayes tree provides a better understanding of the matrix factorization in terms of probability densities. Second, we show how the fairly abstract updates to a matrix factorization translate to a simple editing of the Bayes tree and its conditional densities. Third, we apply the Bayes tree to obtain a completely novel algorithm for sparse nonlinear incremental optimization, named iSAM2, which achieves improvements in efficiency through incremental variable re-ordering and fluid relinearization, eliminating the need for periodic batch steps. We analyze various properties of iSAM2 in detail, and show on a range of real and simulated datasets that our algorithm compares favorably with other recent mapping algorithms in both quality and efficiency. United States. Office of Naval Research (Grant N00014-06-1-0043) United States. Office of Naval Research (Grant N00014-10-1-0936) 2013-05-14T20:17:26Z 2013-05-14T20:17:26Z 2011-12 Article http://purl.org/eprint/type/JournalArticle 0278-3649 1741-3176 http://hdl.handle.net/1721.1/78894 Kaess, M. et al. “iSAM2: Incremental Smoothing and Mapping Using the Bayes Tree.” The International Journal of Robotics Research 31.2 (2011): 216–235. https://orcid.org/0000-0002-8863-6550 en_US http://dx.doi.org/10.1177/0278364911430419 International Journal of Robotics Research Creative Commons Attribution-Noncommercial-Share Alike 3.0 http://creativecommons.org/licenses/by-nc-sa/3.0/ application/pdf Sage Publications MIT web domain
spellingShingle Kaess, Michael
Johannsson, Hordur
Roberts, Richard
Ila, Viorela
Leonard, John Joseph
Dellaert, Frank
iSAM2: Incremental smoothing and mapping using the Bayes tree
title iSAM2: Incremental smoothing and mapping using the Bayes tree
title_full iSAM2: Incremental smoothing and mapping using the Bayes tree
title_fullStr iSAM2: Incremental smoothing and mapping using the Bayes tree
title_full_unstemmed iSAM2: Incremental smoothing and mapping using the Bayes tree
title_short iSAM2: Incremental smoothing and mapping using the Bayes tree
title_sort isam2 incremental smoothing and mapping using the bayes tree
url http://hdl.handle.net/1721.1/78894
https://orcid.org/0000-0002-8863-6550
work_keys_str_mv AT kaessmichael isam2incrementalsmoothingandmappingusingthebayestree
AT johannssonhordur isam2incrementalsmoothingandmappingusingthebayestree
AT robertsrichard isam2incrementalsmoothingandmappingusingthebayestree
AT ilaviorela isam2incrementalsmoothingandmappingusingthebayestree
AT leonardjohnjoseph isam2incrementalsmoothingandmappingusingthebayestree
AT dellaertfrank isam2incrementalsmoothingandmappingusingthebayestree