A Factor Graph With Mercator Projection-Based Cooperative Localization Algorithm for Multiple AUVs
- 2 July 2025
- journal article
- Published by Institute of Electrical and Electronics Engineers (IEEE) in IEEE Transactions on Instrumentation and Measurement
- Vol. 74 (00189456) , 1-10
Abstract
To address the discrepancy between geodetic coordinates provided by navigation equipment on Autonomous Underwater Vehicles (AUVs) and Cartesian coordinates employed for calculating Euclidean distance within a Cooperative Localization (CL) system, a Factor Graph (FG) with Mercator Projection-based CL algorithm for multiple AUVs (MAUVs) is proposed. First, the Mercator projection is utilized to formulate the range measurement equation, and with the kinematic equation of the AUV, a state-space model of a CL system for MAUVs is constructed. Furthermore, the homologous FG model of the CL system is established. Leveraging the independence of the coordinates inherent in the Mercator projection, the FG model avoids the introduction of additional cycles. The Sum-Product Algorithm (SPA) is utilized to calculate navigation states of the slave AUV. Then, a Performance Evaluation Function (PEF) for a CL system with two master AUVs in the Mercator projection-based coordinate system is established, and the consistency of PEFs across different coordinate systems is demonstrated. Finally, both simulation and field test results indicate that the proposed CL algorithm offers superior localization accuracy and lower execution time compared to conventional Extended Kalman Filter (EKF)-based CL algorithms.Keywords
Funding Information
- National Natural Science Foundation of China (52371368)
- Natural Science Foundation of Heilongjiang Province of China (YQ2021E011)
This publication has 25 references indexed in Scilit:
- Cooperative localization for master–salve multi-AUVs based on range measurementsPhysical Communication, 2023
- Autonomous Underwater Vehicle navigation: A reviewOcean Engineering, 2023
- A multi-AUV cooperative navigation method based on the augmented adaptive embedded cubature Kalman filter algorithmNeural Computing and Applications, 2022
- A novel cooperative navigation algorithm based on factor graph with cycles for AUVsOcean Engineering, 2021
- Multi-AUV Collaborative Operation Based on Time-Varying Navigation Map and Dynamic Grid ModelIEEE Access, 2020
- Cooperative Navigation Based on Bearing and Range Measurements to Different VehiclesIFAC-PapersOnLine, 2020
- Three Dimensional Formation Control to Pursue an Underwater Evader Utilizing Underwater Robots Measuring the Sound Generated From the EvaderIEEE Access, 2019
- On some information geometric structures concerning Mercator projectionsPhysica A: Statistical Mechanics and its Applications, 2019
- An Advanced Cooperative Positioning Algorithm Based on Improved Factor Graph and Sum-Product Theory for Multiple AUVsIEEE Access, 2019
- Direct and Inverse Solutions with Geodetic Latitude in Terms of Longitude for Rhumb Line SailingJournal of Navigation, 2012