Sparse Bayesian information filters for localization and mapping
Walter, Matthew R.
MetadataShow full item record
This thesis formulates an estimation framework for Simultaneous Localization and Mapping (SLAM) that addresses the problem of scalability in large environments. We describe an estimation-theoretic algorithm that achieves significant gains in computational efficiency while maintaining consistent estimates for the vehicle pose and the map of the environment. We specifically address the feature-based SLAM problem in which the robot represents the environment as a collection of landmarks. The thesis takes a Bayesian approach whereby we maintain a joint posterior over the vehicle pose and feature states, conditioned upon measurement data. We model the distribution as Gaussian and parametrize the posterior in the canonical form, in terms of the information (inverse covariance) matrix. When sparse, this representation is amenable to computationally efficient Bayesian SLAM filtering. However, while a large majority of the elements within the normalized information matrix are very small in magnitude, it is fully populated nonetheless. Recent feature-based SLAM filters achieve the scalability benefits of a sparse parametrization by explicitly pruning these weak links in an effort to enforce sparsity. We analyze one such algorithm, the Sparse Extended Information Filter (SEIF), which has laid much of the groundwork concerning the computational benefits of the sparse canonical form. The thesis performs a detailed analysis of the process by which the SEIF approximates the sparsity of the information matrix and reveals key insights into the consequences of different sparsification strategies. We demonstrate that the SEIF yields a sparse approximation to the posterior that is inconsistent, suffering from exaggerated confidence estimates. This overconfidence has detrimental effects on important aspects of the SLAM process and affects the higher level goal of producing accurate maps for subsequent localization and path planning. This thesis proposes an alternative scalable filter that maintains sparsity while preserving the consistency of the distribution. We leverage insights into the natural structure of the feature-based canonical parametrization and derive a method that actively maintains an exactly sparse posterior. Our algorithm exploits the structure of the parametrization to achieve gains in efficiency, with a computational cost that scales linearly with the size of the map. Unlike similar techniques that sacrifice consistency for improved scalability, our algorithm performs inference over a posterior that is conservative relative to the nominal Gaussian distribution. Consequently, we preserve the consistency of the pose and map estimates and avoid the effects of an overconfident posterior. We demonstrate our filter alongside the SEIF and the standard EKF both in simulation as well as on two real-world datasets. While we maintain the computational advantages of an exactly sparse representation, the results show convincingly that our method yields conservative estimates for the robot pose and map that are nearly identical to those of the original Gaussian distribution as produced by the EKF, but at much less computational expense. The thesis concludes with an extension of our SLAM filter to a complex underwater environment. We describe a systems-level framework for localization and mapping relative to a ship hull with an Autonomous Underwater Vehicle (AUV) equipped with a forward-looking sonar. The approach utilizes our filter to fuse measurements of vehicle attitude and motion from onboard sensors with data from sonar images of the hull. We employ the system to perform three-dimensional, 6-DOF SLAM on a ship hull.
Submitted in partial fulfillment of the requirements for the degree of Doctor of Philosophy at the Massachusetts Institute of Technology and the Woods Hole Oceanographic Institution February 2008
Suggested CitationThesis: Walter, Matthew R., "Sparse Bayesian information filters for localization and mapping", 2008-02, DOI:10.1575/1912/2585, https://hdl.handle.net/1912/2585
Showing items related by title, author, creator and subject.
Bogdanoff, Alec S. (Massachusetts Institute of Technology and Woods Hole Oceanographic Institution, 2017-02)The daily heating of the ocean by the sun can create a stably stratified near-surface layer when the winds are slight and solar insolation is strong. This type of shallow stable layer is called a Diurnal Warm Layer (DWL). ...
Phenotypic diversity within two toxic dinoflagellate genera : environmental and transcriptomic studies of species diversity in Alexandrium and Gambierdiscus Pitz, Kathleen (Massachusetts Institute of Technology and Woods Hole Oceanographic Institution, 2016-09)Dinoflagellates are a diverse group of single-celled eukaryotic phytoplankton that are important for their unique genetics and molecular biology, the multitude of ecological roles they play, and the ability of multiple ...
Radium isotopes as tracers of boundary inputs of nutrients and trace elements to the coastal and open ocean Kipp, Lauren (Massachusetts Institute of Technology and Woods Hole Oceanographic Institution, 2018-09)Nutrients and trace metals are vital for supporting life in the ocean, but the boundary processes that control the distributions of these elements are poorly constrained. Radium isotopes are well suited to studying inputs ...