Concurrent filtering and smoothing: A parallel architecture for real-time navigation and full smoothing - Robotics Institute Carnegie Mellon University

Concurrent filtering and smoothing: A parallel architecture for real-time navigation and full smoothing

S. Williams, V. Indelman, M. Kaess, R. Roberts, J. Leonard, and F. Dellaert
Journal Article, International Journal of Robotics Research, Vol. 33, No. 12, pp. 1544 – 1568, October, 2014

Abstract

We present a parallelized navigation architecture that is capable of running in real-time and incorporating long-term loop closure constraints while producing the optimal Bayesian solution. This architecture splits the inference problem into a low-latency update that incorporates new measurements using just the most recent states (filter), and a high-latency update that is capable of closing long loops and smooths using all past states (smoother). This architecture employs the probabilistic graphical models of factor graphs, which allows the low-latency inference and high-latency inference to be viewed as sub-operations of a single optimization performed within a single graphical model. A specific factorization of the full joint density is employed that allows the different inference operations to be performed asynchronously while still recovering the optimal solution produced by a full batch optimization. Due to the real-time, asynchronous nature of this algorithm, updates to the state estimates from the high-latency smoother will naturally be delayed until the smoother calculations have completed. This architecture has been tested within a simulated aerial environment and on real data collected from an autonomous ground vehicle. In all cases, the concurrent architecture is shown to recover the full batch solution, even while updated state estimates are produced in real-time.

BibTeX

@article{Williams-2014-109888,
author = {S. Williams and V. Indelman and M. Kaess and R. Roberts and J. Leonard and F. Dellaert},
title = {Concurrent filtering and smoothing: A parallel architecture for real-time navigation and full smoothing},
journal = {International Journal of Robotics Research},
year = {2014},
month = {October},
volume = {33},
number = {12},
pages = {1544 – 1568},
}