Fast iterative alignment of pose graphs with poor initial estimates
The DOI matches its Crossref record; 20 of the 20 references it cites were found in a registry or an index.
Abstract
A robot exploring an environment can estimate its own motion and the relative positions of features in the environment. Simultaneous localization and mapping (SLAM) algorithms attempt to fuse these estimates to produce a map and a robot trajectory. The constraints are generally non-linear, thus SLAM can be viewed as a non-linear optimization problem. The optimization can be difficult, due to poor initial estimates arising from odometry data, and due to the size of the state space. We present a fast non-linear optimization algorithm that rapidly recovers the robot trajectory, even when given a poor initial estimate. Our approach uses a variant of stochastic gradient descent on an alternative state-space representation that has good stability and computational properties. We compare our algorithm to several others, using both real and synthetic data sets
Overview
Integrity signals
Registry
Cites
Statistics
Verification
Claims the paper makes
Claims other papers make about this one
Each is checked against this paper’s own text: does it say what the citing paper says it does?
In the citing paper
“Most SLAM algorithms are based on iterative nonlinear optimization [63, 99, 125, 126, 192, 204].”
From Past, Present, and Future of Simultaneous Localization and Mapping: Toward the Robust-Perception Age (2016) · cites this paper as [192]
Citations
Cites
A Stochastic Approximation Method
Robbins, H., & Monro, S. (1951) · The Annals of Mathematical Statistics · doi:10.1214/aoms/1177729586 · Cited by 9,643
Thrun, S. (2002) · Communications of the ACM · doi:10.1145/504729.504754 · Cited by 7,994
An Introduction to the Conjugate Gradient Method Without the Agonizing Pain
Shewchuk, J. R. (1994) · Cited by 2,173
Introduction to linear algebra
(2016) · Cybersecurity and Applied Mathematics · doi:10.1016/b978-0-12-804452-0.09998-x · Cited by 1,646
Globally Consistent Range Scan Alignment for Environment Mapping
Lu, F., & Milios, E. (1997) · Autonomous Robots · doi:10.1023/a:1008854305733 · Cited by 1,304
Simultaneous Localization and Mapping with Sparse Extended Information Filters
Thrun, S., Liu, Y., Koller, D., Ng, A. Y., Ghahramani, Z., & Durrant-Whyte, H. (2004) · The International Journal of Robotics Research · doi:10.1177/0278364904045479 · Cited by 651
Montemerlo, M., Whittaker, W., & Thrun, S. (2003) · Cited by 379
Dynamic Maps for Long-Term Operation of Mobile Service Robots
Biber, P., & Duckett, T. (2005) · Robotics: Science and Systems I · doi:10.15607/rss.2005.i.003 · Cited by 334
An Atlas framework for scalable mapping
Bosse, M., Newman, P., Leonard, J., Soika, M., Feiten, W., & Teller, S. (2003) · 2003 IEEE International Conference on Robotics and Automation (Cat. No.03CH37422) · doi:10.1109/robot.2003.1241872 · Cited by 313
Self-citationA multilevel relaxation algorithm for simultaneous localization and mapping
Frese, U., Larsson, P., & Duckett, T. (2005) · IEEE Transactions on Robotics · doi:10.1109/tro.2004.839220 · Cited by 283
Research works printed but not linked: 1
- guivant, 2001, Compressed filter for real time implmentation of simultaneous localization and map building, FSR 2001 International Conference on Field and Service Robots
Cited by
Items 401–423 of 423
Garcia‐Fidalgo, E., & Ortiz, A. (2018) · Springer tracts in advanced robotics · doi:10.1007/978-3-319-75993-7_3
Valencia, R., & Andrade‐Cetto, J. (2017) · Springer tracts in advanced robotics · doi:10.1007/978-3-319-60603-3_6
Visual metric and semantic localization for UGV
Zhang, H. (2022) · DR-NTU (Nanyang Technological University) · doi:10.32657/10356/162442
Enhanced Indoor Visual Navigation using Sensor Fusion and Semantic Information
Mahmoud, A. (2022) · Carleton University's Institutional Repository (MacOdrum Library, Carleton University) · doi:10.22215/etd/2022-15197
Lifelong, learning-augmented robot navigation
Doherty, K. (2023) · Woods Hole Open Access Server (WHOAS) · doi:10.1575/1912/29652 · Cited by 1
Localização e mapeamento semânticos em florestas
Nardari, G. V. (2023) · Digital Library of Theses and Dissertations (Universidade de São Paulo) · doi:10.11606/t.55.2023.tde-18042023-163053
kollagen: A Collaborative SLAM Pose Graph Generator
Sundin, R. C., & Umsonst, D. (2023) · Proceedings - IEEE International Conference on Robotics and Automation/Proceedings · doi:10.1109/icra48891.2023.10160514
Robot Path Estimation from Odometry Measurements: Loop Closure Based on Autocorrelation
Dermatas, E. (2022) · Robotics & Automation Engineering Journal · doi:10.19080/raej.2022.05.555662
Leveraging deep-learned object detectors for real-world semantic localization and mapping
Nicholson, L. (2023) · Queensland University of Technology · doi:10.5204/thesis.eprints.242733 · Cited by 2
Monocular visual odometry based on epipolar geometry
da Silva, R. S. (2021) · doi:10.47749/t/unicamp.2021.1164461
Scale Jump-Aware Pose Graph Relaxation for Monocular SLAM with Re-Initializations
Yuan, R., Cheng, R., Liu, L., Sun, T. S., & Kneipl, L. (2023) · IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS) · doi:10.1109/iros55552.2023.10341995 · Cited by 1
Chen, K., Bai, F., Huang, S., & Sun, Y. (2024) · IEEE Robotics and Automation Letters · doi:10.1109/lra.2024.3440088
Warke, W. D., Ramos, J. H., Ganesh, P., Brink, K., & Hale, M. (2024) · IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS) · doi:10.1109/iros58592.2024.10802328 · Cited by 2
An Updated Tutorial on Graph-Based SLAM
Grisetti, G., Kümmerle, R., Stachniss, C., & Burgard, W. (2025) · Springer eBooks · doi:10.1007/978-3-319-74095-9_8
Ghanta, S., & Parasuraman, R. N. (2025) · International Symposium on Multi-Robot and Multi-Agent Systems (MRS) · doi:10.1109/mrs66243.2025.11357260
vMF Distribution-Based Particle Filtering for Range-Only SLAM
Ma, Y., Yu, C., & Ran, F. (2026) · IEEE Internet of Things Journal · doi:10.1109/jiot.2026.3659244
Gonzalez, H. (2019) · theses.fr (ABES) · doi:10.70675/e6e67bd9z1eaez4517zb42dze3f97a5be056
Atchuthan, D. (2018) · theses.fr (ABES) · doi:10.70675/cca5615dz133az4b0bz93bdz32710533daaa · Cited by 6
Two views camera motion in the presence of planar degeneracy
Rebert, M. (2020) · theses.fr (ABES) · doi:10.70675/323967ddz3579z416dza7c8z3faa1b44d1b8 · Cited by 4
A FLS Based Target Localization Method with in-situ Misalignment Calibration of INS/DVL Integration
Sun, T., Wu, D., Yan, Z., Fang, L., & Hao, L. (2025) · China Automation Congress (CAC) · doi:10.1109/cac67268.2025.11486794
Global Optimization for 2D SLAM Problem
Qayyum, U., & Kim, J. (2014) · Lecture notes in electrical engineering · doi:10.1007/978-3-319-03500-0_3 · Cited by 1
Metadata
- Authors
- Olson, E., Leonard, J., & Teller, S.
- Affiliations
- MIT Computer Science and Artificial Intelligence Laboratory (US)
- ORCID
- Venue
- Proceedings 2006 IEEE International Conference on Robotics and Automation, 2006. ICRA 2006.
- Publisher
- IEEE
- Published
- 2006-07-10
- Pages
- 2262-2269
- ISSN
- 1050-4729 (ISSN-L)
- OpenAlex
- W2107905629
- Cited by
- 427
- References
- 20
- Citations by year
- 2026: 2 · 2025: 9 · 2024: 11 · 2023: 15 · 2022: 12 · 2021: 20 · 2020: 20 · 2019: 22 · 2018: 23 · 2017: 18 · 2016: 26 · 2015: 33 · 2014: 33 · 2013: 25 · 2012: 30
- FWCI
- 39.56
- Type
- conference paper
- Language
- en
- Open access
- closed
- Locations
- Proceedings - IEEE International Conference on Robotics and Automation/Proceedings (publishedVersion)
- 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 › Computer Science › Artificial Intelligence › Reinforcement Learning in Robotics
- Keywords
- SLAM, nonlinear programming, stochastic gradient descent, robot trajectory estimation, odometry, state-space model
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
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.