SCORE: A Second-Order Conic Initialization for Range-Aided SLAM

2023 IEEE International Conference on Robotics and Automation (ICRA 2023) May 29 - June 2, 2023. London, UK

Bibliographic Details
Main Authors: Papalia, Alan, Morales, Joseph, Doherty, Kevin J., Rosen, David M., Leonard, John J.
Format: Article
Language:English
Published: IEEE 2024
Online Access:https://hdl.handle.net/1721.1/153656
_version_ 1826188580626628608
author Papalia, Alan
Morales, Joseph
Doherty, Kevin J.
Rosen, David M.
Leonard, John J.
author_facet Papalia, Alan
Morales, Joseph
Doherty, Kevin J.
Rosen, David M.
Leonard, John J.
author_sort Papalia, Alan
collection MIT
description 2023 IEEE International Conference on Robotics and Automation (ICRA 2023) May 29 - June 2, 2023. London, UK
first_indexed 2024-09-23T08:01:53Z
format Article
id mit-1721.1/153656
institution Massachusetts Institute of Technology
language English
last_indexed 2024-09-23T08:01:53Z
publishDate 2024
publisher IEEE
record_format dspace
spelling mit-1721.1/1536562024-03-13T04:07:12Z SCORE: A Second-Order Conic Initialization for Range-Aided SLAM Papalia, Alan Morales, Joseph Doherty, Kevin J. Rosen, David M. Leonard, John J. 2023 IEEE International Conference on Robotics and Automation (ICRA 2023) May 29 - June 2, 2023. London, UK We present a novel initialization technique for the range-aided simultaneous localization and mapping (RASLAM) problem. In RA-SLAM we consider measurements of point-to-point distances in addition to measurements of rigid transformations to landmark or pose variables. Standard formulations of RA-SLAM approach the problem as nonconvex optimization, which requires a good initialization to obtain quality results. The initialization technique proposed here relaxes the RA-SLAM problem to a convex problem which is then solved to determine an initialization for the original, non-convex problem. The relaxation is a second-order cone program (SOCP), which is derived from a quadratically constrained quadratic program (QCQP) formulation of the RASLAM problem. As a SOCP, the method is highly scalable. We name this relaxation Second-order COnic RElaxation for RASLAM (SCORE). To our knowledge, this work represents the first convex relaxation for RA-SLAM. We present real-world and simulated experiments which show SCORE initialization permits the efficient recovery of quality solutions for a variety of challenging single- and multi-robot RA-SLAM problems with thousands of poses and range measurements. 2024-03-12T14:52:09Z 2024-03-12T14:52:09Z 2023-05-29 2024-03-12T14:16:32Z Article http://purl.org/eprint/type/ConferencePaper https://hdl.handle.net/1721.1/153656 A. Papalia, J. Morales, K. J. Doherty, D. M. Rosen and J. J. Leonard, "SCORE: A Second-Order Conic Initialization for Range-Aided SLAM," 2023 IEEE International Conference on Robotics and Automation (ICRA), London, United Kingdom, 2023, pp. 10637-10644. en 10.1109/icra48891.2023.10160787 2023 IEEE International Conference on Robotics and Automation (ICRA) Creative Commons Attribution-Noncommercial-ShareAlike http://creativecommons.org/licenses/by-nc-sa/4.0/ application/pdf IEEE arxiv
spellingShingle Papalia, Alan
Morales, Joseph
Doherty, Kevin J.
Rosen, David M.
Leonard, John J.
SCORE: A Second-Order Conic Initialization for Range-Aided SLAM
title SCORE: A Second-Order Conic Initialization for Range-Aided SLAM
title_full SCORE: A Second-Order Conic Initialization for Range-Aided SLAM
title_fullStr SCORE: A Second-Order Conic Initialization for Range-Aided SLAM
title_full_unstemmed SCORE: A Second-Order Conic Initialization for Range-Aided SLAM
title_short SCORE: A Second-Order Conic Initialization for Range-Aided SLAM
title_sort score a second order conic initialization for range aided slam
url https://hdl.handle.net/1721.1/153656
work_keys_str_mv AT papaliaalan scoreasecondorderconicinitializationforrangeaidedslam
AT moralesjoseph scoreasecondorderconicinitializationforrangeaidedslam
AT dohertykevinj scoreasecondorderconicinitializationforrangeaidedslam
AT rosendavidm scoreasecondorderconicinitializationforrangeaidedslam
AT leonardjohnj scoreasecondorderconicinitializationforrangeaidedslam