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.

FOG strapdown inertial navigation system based on high-speed FIFO and double CPUs

The Research Of Digital Close-Loop Depolarized Fog

Field Programmable Gate Array Based Parallel Strapdown Algorithm Design for Strapdown Inertial Navigation Systems

Research of Parallel Strapdown Inertial Navigation Algorithm for High Dynamic Conditions

The Integrated Navigation System of Auv "Xuanwu"

Design and Implementation of the Digital Detection Circuit for RFOG Based on a Single FPGA

Attitude Output of Strapdown Inertial Navigation System Based on Laser Gyro

Design of navigation computer based on DSP & FPGA

Design of Navigation System Based on Dual DSP and FPGA

FPGA Implementation of Non-Parametric Stereo Matching Algorithm

FPGA Implementation of High-Speed Data Acquisition System for High-Resolution Millimeter Wave Radar.

Design of system for high performance navigation computer system base on dual DSPs & FPGA

A Novel Single Chip Implementation of MEMS INS Data Acquisition and Processing System Using FPGA and Its Soft Processors

Design of Distributed Navigation Computer System Based on PC104 & DSP

High-Performance Digital Signal Processor for Navigation Grade Resonant Fiber Optic Gyroscope

FPGA-Based Real-Time Synchronous Parallel System for Underwater Acoustic Positioning and Navigation

Design of onboard image real-time processing system based on FPGA

Motion Object Tracking System Based on FPGA

A High-Speed Well Logging Telemetry System Based on Low-Power FPGA

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

Development of multisensor integrated navigation system based on distributed multiprocessor