Abstract:Multi-sensor fusion is an effective way to enhance the positioning performance of autonomous underwater vehicles (AUVs). However, underwater multi-sensor fusion faces challenges such as heterogeneous frequency and dynamic availability of sensors. Traditional filter-based algorithms suffer from low accuracy and robustness when sensors become unavailable. The factor graph optimization (FGO) can enable multi-sensor plug-and-play despite data frequency. Therefore, we present an FGO-based strapdown inertial navigation system (SINS) and long baseline location (LBL) system tightly coupled navigation system (FGO-ILNS). Sensors such as Doppler velocity log (DVL), magnetic compass pilot (MCP), pressure sensor (PS), and global navigation satellite system (GNSS) can be tightly coupled with FGO-ILNS to satisfy different navigation scenarios. In this system, we propose a floating LBL slant range difference factor model tightly coupled with IMU preintegration factor to achieve unification of global position above and below water. Furthermore, to address the issue of sensor measurements not being synchronized with the LBL during fusion, we employ forward-backward IMU preintegration to construct sensor factors such as GNSS and DVL. Moreover, we utilize the marginalization method to reduce the computational load of factor graph optimization. Simulation and public KAIST dataset experiments have verified that, compared to filter-based algorithms like the extended Kalman filter and federal Kalman filter, as well as the state-of-the-art optimization-based algorithm ORB-SLAM3, our proposed FGO-ILNS leads in accuracy and robustness.

An Acoustic-Inertial Pose Estimation Method with Robust Feature Match and Graph Optimization.

Robust Inertial-aided Underwater Localization and Navigation based on Imaging Sonar Keyframes

A Method of State Estimation for Underwater Vehicle Navigation Around a Cylindrical Structure

An Unscented Kalman Filter-based Visual Pose Estimation Method for Underwater Vehicles

Underwater Robot Pose Estimation Using Acoustic Methods and Intermittent Position Measurements at the Surface

Robust Inertial-aided Underwater Localization based on Imaging Sonar Keyframes

An adaptive grouping sonar-inertial odometry for underwater navigation

FGO-ILNS: Tightly Coupled Multi-Sensor Integrated Navigation System Based on Factor Graph Optimization for Autonomous Underwater Vehicle

Underwater Tightly-Coupled State Estimation Method Using IMU and Artificial Lateral Line Systems

Bundle Adjustment-Based Sonar-Inertial Odometry for Underwater Navigation.

Improving Localization Accuracy for an Underwater Robot with a Slow-Sampling Sonar Through Graph Optimization

Autonomous Underwater Vehicle Navigation Enhancement by Optimized Side-Scan Sonar Registration and Improved Post-Processing Model Based on Factor Graph Optimization

LiDAR and Inertial Fusion for Pose Estimation by Non-linear Optimization

Robust Real-Time AUV Self-Localization Based on Stereo Vision-Inertia

Pose Estimation from Camera Images for Underwater Inspection

Fast Lidar Inertial Odometry and Mapping for Mobile Robot SE(2) Navigation

Pose Estimation Based on Bidirectional Visual–Inertial Odometry with 3D LiDAR (BV-LIO)

Pose-Based Graphslam Algorithm For Robotic Fish With A Mechanical Scanning Sonar

Underwater Simultaneous Localization and Mapping Based on Ekf and Point Features

A Robust INS/USBL/DVL Integrated Navigation Algorithm Using Graph Optimization

Towards Stereo Vision Slam Based Pose Estimation For Ship Hull Inspection