Concurrent filtering and smoothing
Year: 2012
Type: conference-paper
Abstract: —This paper presents a novel algorithm for integrating real-time filtering of navigation data with full map/trajectory smoothing. Unlike conventional mapping strategies, the result of loop closures within the smoother serve to correct the real-time navigation solution in addition to the map. This solution views filtering and smoothing as different operations applied within a single graphical model known as a Bayes tree. By maintaining all information within a single graph, the optimal linear estimate is guaranteed, while still allowing the filter and smoother to operate asynchronously. This approach has been applied to simulated aerial vehicle sensors consisting of a high-speed IMU and stereo camera. Loop closures are extracted from the vision system in an external process and incorporated into the smoother when discovered. The performance of the proposed method is shown to approach that of full batch optimization while maintaining real-time operation. Index Terms—Navigation, smoothing, filtering, loop closing, Bayes tree, factor graph Figure 1. Smoother and filter combined in a single optimization problem and represented as a Bayes tree. A separator is selected so as to enable parallel computations. I.
Authors: Michael Kaess, S. R. Williams, Vadim Indelman, Richard Roberts, John J. Leonard, Frank Dellaert
Language: English
Subfield: Computer Vision and Pattern Recognition
Field: Computer Science
Domain: Physical Sciences
Open Access status: green
Funder: Air Force Research Laboratory
Award: G3463227357
OpenAlex ID: W1877821613
