Concurrent Filtering and Smoothing: A Parallel Architecture for Real-Time Navigation and Full Smoothing

Stephen Williams, Vadim Indelman, Michael Kaess, Richard Roberts, John J. Leonard and Frank Dellaert
Conference Paper, International Conference on Information Fusion, pp. 1300-1307, July, 2012

View Publication

Copyright notice: This material is presented to ensure timely dissemination of scholarly and technical work. Copyright and all rights therein are retained by authors or by other copyright holders. All persons copying this information are expected to adhere to the terms and constraints invoked by each author's copyright. These works may not be reposted without the explicit permission of the copyright holder.


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.

author = {Stephen Williams and Vadim Indelman and Michael Kaess and Richard Roberts and John J. Leonard and Frank Dellaert},
title = {Concurrent Filtering and Smoothing: A Parallel Architecture for Real-Time Navigation and Full Smoothing},
booktitle = {International Conference on Information Fusion},
year = {2012},
month = {July},
pages = {1300-1307},
} 2019-07-02T14:45:02-04:00