Concurrent filtering and smoothing: A parallel architecture for real-time navigation and full smoothing
Open accessThe DOI matches its Crossref record; 38 of the 38 references it cites were found in a registry or an index.
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.
Overview
Integrity signals
Registry
Cites
Statistics
Verification
Claims the paper makes
Citations
Cites
On Information and Sufficiency
Kullback, S., & Leibler, R. A. (1951) · The Annals of Mathematical Statistics · doi:10.1214/aoms/1177729694 · Cited by 20,193 · cited 6×
“Additionally, a metric known as the Kullback–Leibler divergence (KLD) Kullback and Leibler (1951) has been computed, comparing the CFS and the fixed-lag smoother results with that of the batch optimization.”
MethodInfluentialObject recognition from local scale-invariant features
Lowe, D. G. (1999) · Proceedings of the Seventh IEEE International Conference on Computer Vision · doi:10.1109/iccv.1999.790410 · Cited by 16,472 · cited 1×
“In this example, SIFT Lowe (1999) features and descriptors are used.”
MethodAre we ready for autonomous driving? The KITTI vision benchmark suite
Geiger, A., Lenz, P., & Urtasun, R. (2012) · 2012 IEEE Conference on Computer Vision and Pattern Recognition · doi:10.1109/cvpr.2012.6248074 · Cited by 14,897 · cited 3×
“2 Karlsruhe Dataset To test the proposed method on real-world data, we make use of the KITTI Vision Benchmark Suite (Geiger et al., 2012). These datasets were captured from the autonomous vehicle platform “Annieway” during traverses around the city of Karlsruhe, Germany. This platform consists of a car chassis outfitt…”
MethodInfluentialFactor graphs and the sum-product algorithm
Kschischang, F. R., Frey, B. J., & Loeliger, H.-A. (2001) · IEEE Transactions on Information Theory · doi:10.1109/18.910572 · Cited by 6,486 · cited 2×
“For probabilistic inference, the language of factor graphs has been shown to be convenient and appropriate Kschischang et al. (2001).”
MethodParallel Tracking and Mapping for Small AR Workspaces
Klein, G., & Murray, D. (2007) · 2007 6th IEEE and ACM International Symposium on Mixed and Augmented Reality · doi:10.1109/ismar.2007.4538852 · Cited by 4,346 · cited 4×
“Filtering techniques, such as the extended Kalman filter (EKF), maintain constant-time updates by marginalizing out all past variables.”
BackgroundMethodInfluentialKinectFusion: Real-time dense surface mapping and tracking
Newcombe, R. A., Fitzgibbon, A., Izadi, S., Hilliges, O., Molyneaux, D., Kim, D., Davison, A. J., Kohi, P., Shotton, J., & Hodges, S. (2011) · 2011 10th IEEE International Symposium on Mixed and Augmented Reality · doi:10.1109/ismar.2011.6092378 · Cited by 4,008 · cited 1×
“The same parallelization is also used in more recent dense solutions such as dense tracking and mapping by Newcombe et al. (2011b) and KinectFusion by Newcombe et al. (2011a).”
MethodBundle Adjustment — A Modern Synthesis
Triggs, B., McLauchlan, P. F., Hartley, R. I., & Fitzgibbon, A. W. (2000) · Lecture Notes in Computer Science · doi:10.1007/3-540-44480-7_21 · Cited by 3,988
DTAM: Dense tracking and mapping in real-time
Newcombe, R. A., Lovegrove, S. J., & Davison, A. J. (2011) · 2011 International Conference on Computer Vision · doi:10.1109/iccv.2011.6126513 · Cited by 2,078 · cited 1×
“The same parallelization is also used in more recent dense solutions such as dense tracking and mapping by Newcombe et al. (2011b) and KinectFusion by Newcombe et al. (2011a).”
MethodA Multi-State Constraint Kalman Filter for Vision-aided Inertial Navigation
Mourikis, A. I., & Roumeliotis, S. I. (2007) · Proceedings 2007 IEEE International Conference on Robotics and Automation · doi:10.1109/robot.2007.364024 · Cited by 1,951 · cited 1×
“Examples include GPS-aided (Farrell, 2008) and vision-aided (Mourikis and Roumeliotis, 2007; Zhu et al., 2007; Jones and Soatto, 2011) inertial navigation.”
BackgroundiSAM2: Incremental smoothing and mapping using the Bayes tree
Kaess, M., Johannsson, H., Roberts, R., Ila, V., Leonard, J. J., & Dellaert, F. (2012) · The International Journal of Robotics Research · doi:10.1177/0278364911430419 · Cited by 1,362 · cited 6×
“Partial elimination results from the unchanged portion of the filter branch can be reused, as was recognized in incremental smoothing and mapping (iSAM2) Kaess et al. (2011, 2012a).”
BackgroundMethodInfluentialSelf-citation
Research works printed but not linked: 10
- Bar-Shalom Y, 1995, Multitarget-multisensor Tracking: Principles and Techniques
- Farrell J, 2008, Aided Navigation: GPS with High Rate Sensors
- Heggernes P, 1996, Proceedings of the 2nd SIAM conference on sparse matrices
- Indelman V, 2012, Proceedings of the International conference on information fusion (FUSION), 2154
- 10.1007/978-3-642-17452-0_10 · DOI
- Kaess M, 2012, Proceedings of the International conference on information fusion (FUSION), 2154
- Maybeck P, 1979, Stochastic Models, Estimation and Control, 1
- Moutarlier P, 1989, Proceedings of Experimental Robotics I, the first International symposium, 327
- Smith R, 1988, Proceedings of the International symposium on robotics research (ISRR), 467
- Thrun S, 2005, Probabilistic Robotics
Cited by
Past, Present, and Future of Simultaneous Localization and Mapping: Toward the Robust-Perception Age
Cadena, C., Carlone, L., Carrillo, H., Latif, Y., Scaramuzza, D., Neira, J., Reid, I., & Leonard, J. J. (2016) · IEEE Transactions on Robotics · doi:10.1109/tro.2016.2624754 · Cited by 3,596
“In the colored box below we provide an example of SLAM for a robot equipped with a monocular camera and a 3D laser scanner.”
Self-citationAdvances in Inference and Representation for Simultaneous Localization and Mapping
Rosen, D. M., Doherty, K., Espinoza, A. T., & Leonard, J. J. (2021) · Annual Review of Control Robotics and Autonomous Systems · doi:10.1146/annurev-control-072720-082553 · Cited by 106
Self-citationA systematic literature review on long‐term localization and mapping for mobile robots
Sousa, R. B., Sobreira, H., & Moreira, A. P. (2023) · Journal of Field Robotics · doi:10.1002/rob.22170 · Cited by 67
Distributed stereo vision‐based 6D localization and mapping for multi‐robot teams
Schuster, M. J., Schmid, K., Brand, C., & Beetz, M. (2018) · Journal of Field Robotics · doi:10.1002/rob.21812 · Cited by 64
“Our explicit decoupling of filter and graph SLAM thereby gives us greater design freedom for both subsystems compared to tightly coupled solutions such as, for example, concurrent filtering and smoothing (Williams et al., 2014).”
BackgroundMulti-robot 6D graph SLAM connecting decoupled local reference filters
Schuster, M. J., Brand, C., Hirschmüller, H., Suppa, M., & Beetz, M. (2015) · IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS) · doi:10.1109/iros.2015.7354094 · Cited by 49
“[11] feed loop closure results back into their filter, they cannot guarantee it to produce a smooth trajectory, which however is required for stabilization and control of highly dynamic systems.”
BackgroundMethodInfluential
Metadata
- Authors
- Williams, S., Indelman, V., Kaess, M., Roberts, R., Leonard, J. J., & Dellaert, F.
- Affiliations
- Georgia Institute of Technology (US)
- Carnegie Mellon University (US)
- MIT Computer Science and Artificial Intelligence Laboratory (US)
- Venue
- The International Journal of Robotics Research
- Publisher
- SAGE Publications
- Published
- 2014-07-14
- Volume
- 33
- Issue
- 12
- Pages
- 1544-1568
- ISSN
- 0278-3649 (ISSN-L)
- 1741-3176
- OpenAlex
- W1521090460
- Cited by
- 2
- References
- 38
- Citations by year
- 2023: 1 · 2019: 1
- FWCI
- 0.00
- Type
- journal article
- Language
- en
- Open access
- green
- hdl.handle.net
- Licence
- cc-by-nc-sa
- journals.sagepub.com/page/policies/text-and-data-mining-license (tdm)
- Locations
- The International Journal of Robotics Research (publishedVersion)
- DSpace@MIT (Massachusetts Institute of Technology) (submittedVersion, cc-by-nc-sa)
- SMARTech Repository (Georgia Institute of Technology) (submittedVersion)
- Other univ. web domain
- Topics
- Physical Sciences › Computer Science › Computer Vision and Pattern Recognition › Robotics and Sensor-Based Localization
- Physical Sciences › Computer Science › Artificial Intelligence › Target Tracking and Data Fusion in Sensor Networks
- Physical Sciences › Engineering › Aerospace Engineering › Inertial Sensor and Navigation
- Keywords
- loop closure constraints, factor graphs, Bayesian state estimation, real-time navigation, asynchronous inference, autonomous ground vehicles, aircraft navigation
About these checks
Registry, retraction, Cites and statistics results are computed, not judged, with one exception: a printed reference that no index lists is read once by a model before it counts as a citation error. Claims are extracted by a model and kept only when their quote appears verbatim in the text; each cited source is then checked, with a model’s help, for whether it says what the claim relies on. Those verdicts can be wrong — read the claim’s quote and the cited source before relying on one.
Statistics and arithmetic are recomputed, not judged.
Confidence bands are shown only for fields calibrated on our annotated test set. None is calibrated yet, so no band is shown.
What counts as a claim ›How we measure confidence ›How we check this ›
Are you an author, or do you see a problem with this page? Request a review
How to cite
Cite CoChat for the checks on this page, and the paper for its own findings.
- This page
- CoChat. (2026). Citation check: Concurrent filtering and smoothing: A parallel architecture for real-time navigation and full smoothing. https://app.cochat.ai/papers/10.1177/0278364914531056
- The paper
- Williams, S., Indelman, V., Kaess, M., Roberts, R., Leonard, J. J., & Dellaert, F. (2014). Concurrent filtering and smoothing: A parallel architecture for real-time navigation and full smoothing. The International Journal of Robotics Research. https://doi.org/10.1177/0278364914531056
Data sources
Bibliographic data: Semantic Scholar, OpenAlex, Crossref.
Contains information from the Semantic Scholar Academic Graph Datasets, made available under the ODC Attribution License (ODC-BY 1.0).
Semantic Scholar’s data is described in: Kinney, R., et al. (2023). The Semantic Scholar Open Data Platform. arXiv:2301.10140.