Abstract:With the widespread development of multiple sensors for UGVs, the multi-source fusion-navigation system, which overcomes the limitations of the use of a single sensor, is becoming increasingly important in the field of autonomous navigation for UGVs. Because federated filtering is not independent between the filter-output quantities, owing to the use of the same state equation in each of the local sensors, a new kinematic and static multi-source fusion-filtering algorithm based on the error-state Kalman filter (ESKF) is proposed in this paper for the positioning-state estimation of UGVs. The algorithm is based on INS/GNSS/UWB multi-source sensors, and the ESKF replaces the traditional Kalman filter in kinematic and static filtering. After constructing the kinematic EKSF based on GNSS/INS and the static ESKF based on UWB/INS, the error-state vector solved by the kinematic ESKF was injected and set to zero. On this basis, the kinematic ESKF filter solution was used as the state vector of the static ESKF for the rest of the static filtering in a sequential form. Finally, the last static ESKF filtering solution was used as the integral filtering solution. Through mathematical simulations and comparative experiments, it is demonstrated that the proposed method converges quickly, and the positioning accuracy of the method was improved by 21.98% and 13.03% compared to the loosely coupled GNSS/INS and the loosely coupled UWB/INS navigation methods, respectively. Furthermore, as shown by the error-variation curves, the main performance of the proposed fusion-filtering method was largely influenced by the accuracy and robustness of the sensors in the kinematic ESKF. Furthermore, the algorithm proposed in this paper demonstrated good generalizability, plug-and-play, and robustness through comparative analysis experiments.

Cooperative Localization Utilizing Sigma-Point Kalman Filters for UUVs

Localization algorithm for wireless sensor networks based on MDS-MAP and nonlinear filtering

Coordinated Target Localization and Tracking with Node Scheduling for a Network of Autonomous Underwater Vehicles

Particle Filter-Based AUV Integrated Navigation Methods

Multi-AUV Cooperative Localization in Adaptive Sampling for Marine Environmental Monitoring

Cooperative positioning method of underwater autonomous vehicle formation based on extended Kalman filter

A Combined UWB/IMU Localization Method with Improved CKF

Cooperative localization of AUVs using moving horizon estimation

A Multi-Sensor Fusion Underwater Localization Method Based on Unscented Kalman Filter on Manifolds

An Improved Fuzzy Adaptive Iterated SCKF for Cooperative Navigation

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

Cooperative navigation of unmanned aerial vehicle formation with delayed measurement

Accurate two-step filtering for AUV navigation in large deep-sea environment

Research on Kinematic and Static Filtering of the ESKF Based on INS/GNSS/UWB

The INS/GPS integrated navigation based on autonomous underwater vehicle using modified extended Kalman filter

An Improved Variational Adaptive Kalman Filter for Cooperative Localization

An USBL/DR Integrated Underwater Localization Algorithm Considering Variations of Measurement Noise Covariance

Robust Huber-based iterated divided difference filtering with application to cooperative localization of autonomous underwater vehicles

Cubature Kalman Hybrid Consensus Filter for Collaborative Localization of Unmanned Surface Vehicle Cluster with Random Measurement Delay

A Novel Factor Graph and Cubature Kalman Filter Integrated Algorithm for Single-Transponder-Aided Cooperative Localization