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.

Model Predictive Based Unscented Kalman Filter for Hypersonic Vehicle Navigation With INS/GNSS Integration

Navigation for fixed-wing unmanned aerial vehicles in the presence of GNSS outages

Kalman Filtering Algorithm for Integrated Navigation System in Unmanned Aerial Vehicle

An Inertial-Based Integrated Navigation Robust Filtering Algorithm Based on Vehicle Model for GNSS Failure

An Adaptive Unscented Kalman Filtering Algorithm for MEMS/GPS Integrated Navigation Systems

A Dual Adaptive Unscented Kalman Filter Algorithm for SINS-based Integrated Navigation System

Multi-sensor Optimal Data Fusion for INS/GNSS/CNS Integration Based on Unscented Kalman Filter

Model Aided Airborne Integrated Navigation System Based on an Improved Square-Root Unscented H∞ Filter

An Unscented Kalman Filter Algorithm For Mems-Based Imu/Gps Integration With Non-Holonomic Constraint

Unscented kalman filter with process noise covariance estimation for vehicular ins/gps integration system

M-M Estimation-Based Robust Cubature Kalman Filter for INS/GPS Integrated Navigation System

Computationally Efficient Unscented Kalman Filtering Techniques for Launch Vehicle Navigation using a Space-borne GPS Receiver

Robust M–M unscented Kalman filtering for GPS/IMU navigation

SINS/GPS integrated navigation system using an improved particle filter based on state reconstruction

A Hypothesis Test-Constrained Robust Kalman Filter for INS/GNSS Integration With Abnormal Measurement

Integrated Navigation Algorithm Based on Multiple Fading Factors Kalman Filter

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

Adaptive Kalman Filtering for Low-cost INS/GPS

Low-cost integrated INS/GNSS using adaptive H∞ Cubature Kalman Filter

Deep Kalman Filter: Simultaneous Multi-Sensor Integration and Modelling; A GNSS/IMU Case Study

A New Adaptive Federated Cubature Kalman Filter Based on Chi-Square Test for SINS/GNSS/SRS/CNS Integration