SOL-SLAM: Inverse Compositional Gauss-Newton Direct Registration for Fast Sonar-Only Local SLAM

Abstract

Autonomous underwater navigation typically relies on complex and expensive multi-modal sensor suites designed to prioritize global Simultaneous Localization and Mapping (SLAM) accuracy. However, local reactive behaviors such as coarse navigation and obstacle avoidance require only local consistency---a capability that should be feasible using only a Forward-Looking Sonar (FLS), yet remains largely unaddressed, leaving a critical gap in FLS-only local SLAM. Moreover, existing acoustic SLAM frameworks predominantly rely on sparse feature extraction methods that discard substantial portions of the already information-sparse acoustic returns. To overcome these limitations, this work introduces a dense direct registration approach that aligns full acoustic intensity scans to a recursively updated local map. Real-time execution is achieved via an Inverse Compositional Gauss-Newton optimization strategy that minimizes computational overhead. Experimental evaluations show that this dense method yields significant improvements on translation error compared to sparse keypoint baselines, maintaining stable sub-meter tracking precision over wide displacement gaps. Moreover, this approach delivers odometry performance comparable to multi-sensor fusion pipelines (FLS, DVL, and IMU), bypassing expensive payload dependencies in feature-rich environments. We validate real-world applicability through AUV field trials, running the full local SLAM approach onboard an embedded, resource-constrained computer.

The authors’ abstract, as arXiv lists it. arXiv’s listings, abstracts included, are free for anyone to reuse.

More in Robotics

• arXiv preprint · 16 September 2026

  Feedback-Modulated Harmonic Policies for Quadruped Locomotion

  Yixuan Jia, Steven Roche and Jonathan P. How
• arXiv preprint · 17 September 2026

  CoreSense: Traceable Failure Recall and Conflict-Aware Belief Gating for Auditable Robot Decisions

  Zoe Li
• arXiv preprint · 16 September 2026

  Missing Bridges: Composition-Aware Active Imitation Learning

  Maxwell J. Jacobson, Ahmed H Qureshi and Yexiang Xue
• arXiv preprint · 17 September 2026

  AMB3R-SLAM: Kilometer-scale SLAM with Hierarchical Backend

  Hengyi Wang and Lourdes Agapito
• arXiv preprint · 16 September 2026

  Causal-History Test-Time Scaling for Failure Recovery in Autoregressive World-Action Models

  Lin Li, Long Chen, Kwunhang and 10 others

All new papers in Robotics