针对剧烈运动下的传感器失准问题,提出新算法提升激光惯性定位稳定性。
Stretch-ICP: A Continuous-Trajectory Registration and Deskewing Algorithm in Scenarios of Aggressive Motions

- 通过饱和感知估计陀螺仪数据,恢复剧烈运动时的角速度
- 新算法在扫描边界处降低线速度与角速度误差超94%
- 适合高速移动或复杂地形下的机器人自主导航场景
在复杂环境中,机器人在不平或湿滑地形上易失稳,引发极端加速度和角速度,导致传感器数据扭曲、状态估计退化。为此,我们构建了Tumbling-Induced Gyroscope Saturation(TIGS)数据集,包含机械激光雷达与惯性测量单元(IMU)从山坡滚落的记录,其角速度最高达同类数据集的四倍,已公开。本文提出两种互补方法以提升激光惯性SLAM鲁棒性:第一,饱和感知角速度估计(SAAVE),在陀螺仪饱和时仍能估计角速度,使角速度估计误差降低83.4%;第二,Stretch-ICP,一种新型配准与去倾斜算法,在剧烈运动下相比经典ICP可重建更平滑的6自由度轨迹,扫描边界处线速度与角速度误差分别降低95.2%和94.8%。两项贡献共同提升了激光惯性状态估计在剧烈运动下的鲁棒性与一致性。
原文摘要 · Abstract (English)
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.
Thank you to arXiv for use of its open access interoperability. PaperDance 不是 arXiv 官方产品;中文卡片由大模型生成,请以原文为准。