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.

U-GPF Information Fusion Algorithm for GPS/DR Integrated Positioning System

Research of STUPF Filter Algorithm on GPS/SINS

Carrier Tracking Algorithm Based on Adaptive Unscented Kalman Filter in High Dynamic

Fast Gaussian particle filtering algorithm

An Adaptive UKF Filtering Algorithm for GPS Position Estimation

Location Information Fusion Algorithm for GPS/Base-Station Positioning System Based on Federated Kalman Filter

Improving GPS Positioning Accuracy Based on Particle Filter Algorithm

Gaussian Particle Filter Based Pose and Motion Estimation

Integration of GPS Precise Point Positioning and MEMS-Based INS Using Unscented Particle Filter

UAV clusters information geometry fusion positioning method with LEO satellite system

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

Two-stage fusion localization based on UWB/PDR/Geomagnetism in underground space

An information fusion algorithm for integrated autonomous orbit determination of navigation satellites

Application of RBUKF Algorithm in Real-Time GPS Position Estimatin

The Geometric Unscented Kalman Filter

Optimal vehicle position estimation using adaptive unscented Kalman filter based on sensor fusion

An adaptive information fusion method to vehicle integrated navigation

FE-GUT: Factor Graph Optimization hybrid with Extended Kalman Filter for tightly coupled GNSS/UWB Integration

Wi-Fi/GPS integrated positioning system using a federated Kalman filter

UPF-based Fault Detection Method of Integrated Navigation System with Non-Gaussian Noises

A Novel KGP Algorithm for Improving INS/GPS Integrated Navigation Positioning Accuracy