Stretch-ICP: A Continuous-Trajectory Registration and Deskewing Algorithm in Scenarios of Aggressive Motions
Sensors · 21.04.2026 · 26 (8) · 2567
DOI: 10.3390/s26082567 ↗Kurz gefasst
Fachartikel in der Zeitschrift Sensors, online erschienen am 21.04.2026. Verfasst von Simon-Pierre Deschênes und 3 weiteren Autor:innen. Beteiligte Einrichtung: Northern Robotics Laboratory, Université Laval, Quebec City, QC G1V 0A6, Canada. Die Arbeit nennt 47 Literaturangaben. Der Volltext ist frei zugänglich (Open Access, CC BY 4.0). Gefördert von: Fonds de Recherche du Québec - Nature et Technologies, Natural Sciences and Engineering Research Council of Canada, Fonds de recherche du Québec—Nature et technologies.
Abstract (Originalsprache)
Robust robotic autonomy remains challenging in complex environments, where loss of stability on uneven or slippery terrain can induce extreme accelerations and angular velocities. Such motions corrupt sensor measurements and degrade state estimation, motivating the need for improved algorithmic robustness. To investigate this issue, we introduce the Tumbling-Induced Gyroscope Saturation (TIGS) dataset, which consists of recordings from a mechanical lidar and an Inertial Measurement Unit (IMU) tumbling down a hill. The dataset contains angular speeds up to four times higher than those in similar datasets and is publicly available. We then propose two complementary methods to improve Simultaneous Localization And Mapping (SLAM) robustness and evaluate them on TIGS. First, Saturation-Aware Angular Velocity Estimation (SAAVE) estimates angular velocities when gyroscope measurements become saturated during aggressive motions, reducing angular speed estimation error by 83.4%. Second, Stretch-ICP, a novel registration and deskewing algorithm, enables reconstruction of smoother 6-Degrees Of Freedom (DOF) trajectories under aggressive motions compared to classical Iterative Closest Point (ICP). Stretch-ICP reduces linear and angular velocity errors by 95.2% and 94.8%, respectively, at scan boundaries. Together, these contributions improve the robustness and consistency of lidar-inertial state estimation under aggressive motions.
Schlagwörter
Stichwörter der Autor:innen
Autor:innen und Institutionen
- Northern Robotics Laboratory, Université Laval, Quebec City, QC G1V 0A6, Canada.
ORCID-Profile: Simon-Pierre Deschênes, Veronica Vannini, Philippe Giguère, François Pomerleau
Förderung
- Fonds de Recherche du Québec - Nature et Technologies
- Natural Sciences and Engineering Research Council of Canada
- Fonds de recherche du Québec—Nature et technologies
Zitieren
APA
Deschênes, S. P., Vannini, V., Giguère, P., & Pomerleau, F. (2026). Stretch-ICP: A Continuous-Trajectory Registration and Deskewing Algorithm in Scenarios of Aggressive Motions. Sensors, 26(8), 2567. https://doi.org/10.3390/s26082567
Vancouver
Deschênes SP, Vannini V, Giguère P, Pomerleau F. Stretch-ICP: A Continuous-Trajectory Registration and Deskewing Algorithm in Scenarios of Aggressive Motions. Sensors. 2026;26(8):2567. doi:10.3390/s26082567
BibTeX
@article{Deschnes2026,
author = {Deschênes, Simon-Pierre and Vannini, Veronica and Giguère, Philippe and Pomerleau, François},
title = {Stretch-ICP: A Continuous-Trajectory Registration and Deskewing Algorithm in Scenarios of Aggressive Motions},
journal = {Sensors},
year = {2026},
volume = {26},
number = {8},
pages = {2567},
doi = {10.3390/s26082567}
}
EUVIMED