A Joint Graph-Based Approach for Simultaneous Underwater Localization and Mapping for AUV Navigation Fusing Bathymetric and Magnetic-Beacon-Observation Data

Shuai Chang, Dalong Zhang, Linfeng Zhang, Guoji Zou, Chengcheng Wan, Wencong Ma, Qingji ZhouJournal of Marine Science and Engineering 2024 · DOI

TL;DR

This paper introduces a novel joint graph-based Simultaneous Localization and Mapping (SLAM) approach for Autonomous Underwater Vehicles (AUVs) that fuses bathymetric data with magnetic beacon observations. This method addresses limitations in traditional bathymetric SLAM, particularly in areas with gentle topography, by improving data association accuracy and achieving a positioning error of less than 10 meters.

What Problem Does This Paper Address?

Accurate navigation is crucial for AUVs performing tasks like environmental monitoring and target search. However, underwater environments lack GPS signals, leading to accumulated errors in navigation systems like Inertial Navigation Systems (INS). While bathymetric SLAM offers a way to bound these errors, it struggles with two main issues: loop closures are limited to path intersections, and data association fails in areas with subtle topographic changes. This paper tackles these limitations by proposing a more robust and comprehensive SLAM system.

Methods

The proposed approach employs a two-stage front-end and a robust back-end:

  • Dual-Stage Bathymetric Data Association:
    • Stage 1 (Coarse Registration): Uses multi-scale curvature feature vectors to establish initial transformations between bathymetric point clouds, making it robust to initial pose errors.
  • Stage 2 (Fine Registration): Employs the Generalized Iterative Closest Point (GICP) algorithm for precise alignment, leveraging the coarse registration as initialization.
  • Magnetic Beacon Detection:
    • Utilizes Euler-deconvolution to initially locate potential magnetic beacons.
  • Applies a nonlinear optimization approach, incorporating magnetic strength and gradient measurements, to accurately determine beacon positions and magnetic moments.
  • Joint-Factor Graph Construction: Integrates dead-reckoning (DR) factors, bathymetric loop closures, and magnetic beacon observations into a unified factor graph.
  • Robust Back-End Optimizer: Introduces a diagnosis mechanism with three conditions (error ellipse intersection, heading consistency, and bathymetric consistency) to identify and reject false loop closures, enhancing the system's robustness to outliers.

Datasets

The experiments were conducted using field multibeam-bathymetric data surveyed by the authors' group in the Huanghai Sea, China. This dataset covered a 2 km x 2 km area with water depths ranging from 5.2 to 69.8 meters, and bathymetric point resolution of approximately 5 meters. Nine magnetic beacons were simulated within this area. The AUV's GPS path was also used to simulate the dead-reckoning estimates.

Key Insights and Ideas

  • Fusion is Key: Combining bathymetric data with magnetic beacon observations significantly enhances SLAM performance, especially in challenging environments.
  • Multi-Stage Registration Matters: A two-stage approach for bathymetric data association (coarse feature-based followed by fine GICP) is more effective than single-stage methods, particularly for maps with low overlap.
  • Robustness Through Diagnosis: Explicitly detecting and rejecting false loop closures is crucial for building a reliable SLAM system, preventing error propagation.
  • Magnetic Beacons as Reliable Landmarks: Magnetic beacons, when accurately localized, provide valuable constraints for loop closure, complementing topographic features.

Key Results

  • The proposed dual-stage bathymetric data association method improved data association accuracy by 51.7% compared to GICP.
  • The average positioning error after optimization converged to less than 10 meters.
  • The joint SLAM approach, incorporating magnetic beacons, provided better optimization results than using only bathymetric loop closures.
  • The proposed method demonstrated superior performance compared to RRR and Fast SLAM algorithms, achieving the closest path to the truth with an average error under 10 meters.
  • The running time for the proposed method was 521.4 seconds, which was faster than RRR (665.6 s) and Fast SLAM (752.0 s) on the tested hardware.

Limitations and Future Work

The authors acknowledge two primary limitations:

  • Environmental Noise Sensitivity: The magnetic beacon detection is sensitive to environmental noise, and shielding the AUV's own electronic noise is a challenge.
  • Distance Decay: Magnetic field strength decays rapidly with distance, limiting the effective range of this method for very large sea areas.

Future work will focus on:

  • Combining geomagnetic anomaly fields with magnetic beacons to further enrich the factor graph.
  • Improving the robustness of the magnetic beacon detection algorithm against environmental noise.

Summary updated

Abstract

Accurate positioning is the necessary basis for autonomous underwater vehicles (AUV) to perform safe navigation in underwater tasks, such as port environment monitoring, target search, and seabed exploration. The position estimates of underwater navigation systems usually suffer from an error accumulation problem, which makes the AUVs difficult use to perform long-term and accurate underwater tasks. Underwater simultaneous localization and mapping (SLAM) approaches based on multibeam-bathymetric data have attracted much attention for being able to obtain error-bounded position estimates. Two problems limit the use of multibeam bathymetric SLAM in many scenarios. The first is that the loop closures only occur in the AUV path intersection areas. The second is that the data association is prone to failure in areas with gentle topographic changes. To overcome these problems, a joint graph-based underwater SLAM approach that fuses bathymetric and magnetic-beacon measurements is proposed in this paper. In the front-end, a robust dual-stage bathymetric data-association method is used to first detect loop closures on the multibeam bathymetric data. Then, a magnetic-beacon-detection method using Euler-deconvolution and optimization algorithms is designed to localize the magnetic beacons using a magnetic measurement sequence on the path. The loop closures obtained from both bathymetric and magnetic-beacon observations are fused to build a joint-factor graph. In the back-end, a diagnosis method is introduced to identify the potential false factors in the graph, thus improving the robustness of the joint SLAM system to outliers in the measurement data. Experiments based on field bathymetric datasets are performed to test the performance of the proposed approach. Compared with classic bathymetric SLAM algorithms, the proposed algorithm can improve the data-association accuracy by 50%, and the average positioning error after optimization converges to less than 10 m.
BibTeX
@article{chang2024joint,
  author = {Shuai Chang and Dalong Zhang and Linfeng Zhang and Guoji Zou and Chengcheng Wan and Wencong Ma and Qingji Zhou},
  title = {{A Joint Graph-Based Approach for Simultaneous Underwater Localization and Mapping for AUV Navigation Fusing Bathymetric and Magnetic-Beacon-Observation Data}},
  journal = {Journal of Marine Science and Engineering},
  year = {2024},
  doi = {10.3390/jmse12060954},
}
Figure