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.

Kinematic Filtering of Galileo System

Galileo Kinematic Positioning Based on Kalman Filtering

Design of Galileo system’s navigation filter

A New Direct Filtering Approach to INS/GNSS Integration

An Effective Kalman Filtering Algorithm for SINS+GPS Navigation System Using Error State Variables

Kalman Filter Based on Error State Variables in SINS + GPS Navigation Application

Apply of GPS on the Technologies of Mobile Robot Navigation and Location

The Detecting and Correcting of the Model Biases of Kinematic Positioning

Particle Filtering and Its Application for Kinematic GPS Positioning with High Speed Movement

Multi-System Real-Time Kinematic Positioning Based on Fast Satellite Selection and Improved Kalman Filter

Neural Network-based GPS/INS Integrated System for Spacecraft Attitude Determination

Adaptive Kalman Filtering for Low-cost INS/GPS

Multiple Model Kalman Filtering for MEMS-IMU/GPS Integrated Navigation

Applying Filtering Techniques to Improve GPS Positioning Accuracy

A Height Constrained Adaptive Kalman Filtering Based on Climbing Motion Model for GNSS Positioning

Quaternion-based Kalman Filtering on INS/GPS

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

Attitude Algorithm of Gyroscope-Free Strapdown Inertial Navigation System Using Kalman Filter

A Two-Step Robust Adaptive Filtering Algorithm for GNSS Kinematic Precise Point Positioning

Kalman Filtering Algorithm for Integrated Navigation System in Unmanned Aerial Vehicle

A Kalman Filter for Sins Self-Alignment Based on Vector Observation