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.

Data Fusion in Redundant Inertial Measurement Unit Using a Fruit-Fly-Optimized Weighted Least Squares Algorithm

A Weighted Least Square Based Data Fusion Method for Precision Measurement of Freeform Surfaces

Optimal Weighted Fusion based on Recursive Least Squares for Dynamic North-Finding of MIMU on a Tilting Base

Multi-sensor weighted data fusion method using LMS algorithm

Mutual-information based weighted fusion for target tracking in underwater wireless sensor networks

Mutual-information basedweighted fusion for target tracking in underwater wireless sensor networks

A New Data Fusion Method for GNSS/INS Integration Based on Weighted Multiple Criteria

Fusion of Land-Based and Satellite-Based Localization Using Constrained Weighted Least Squares

Multi-Sensor Adaptive Weighted Data Fusion Based on Biased Estimation

The Research of Data Fusion Method for Sample Mean Random Weighting Estimation

Multi-sensor data fusion algorithm based on the improved weighting factor

Improving the Measurement Accuracy of the MEMS IMU Array by a New Calibration and Fusion Technology

Optimal Weight Scheme for Fusion-Assisted Cooperative Multi-Monostatic Object Localization in 6G Networks

The Research of Weigh-in-Motion Sensor Layout Based on Data Fusion.

A Fusion Algorithm of Underwater Dual-sensor Gravimeter

Sensor Data Fusion in Multi-Sensor Weigh-In-Motion Systems

A Linear Fusion Algorithm for Attitude Determination Using Low Cost Mems-Based Sensors

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

A Novel Fault Detection and Isolation Technology for Redundant Inertial Measurement Unit

Robust Optimization-Based Fusion of GNSS and Visual-Inertial-Wheel Odometry.

Multi-sensors Data and Information Fusion Algorithm for Indoor Localization