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.

Application of unscented Kalman filter to novel terrain passive integrated navigation system

A New Method of Seamless Navigation for the Ins/Wsn-Integrated System

The Integrated Navigation System of Auv "Xuanwu"

Integrated Navigation for an Autonomous Underwater Vehicle Carrying Synthetic Aperture Sonar

Particle Filter-Based AUV Integrated Navigation Methods

An Integrated Auv Navigation Method Using Bayes Filtering

Unscented Kalman Filtering on Manifolds for AUV Navigation -- Experimental Results

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

Kalman Filtering Algorithm for Integrated Navigation System in Unmanned Aerial Vehicle

Improved Underwater Integrated Navigation System using Unscented Filtering Approach

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

Filtering based multi-sensor data fusion algorithm for a reliable unmanned surface vehicle navigation

System noise variance matrix adaptive Kalman filter method for AUV INS/DVL navigation system

Robust Filter Method for SINS/DVL/USBL Tight Integrated Navigation System

A Multi-Model EKF Integrated Navigation Algorithm for Deep Water AUV

Automated Tuning of Nonlinear Kalman Filters for Optimal Trajectory Tracking Performance of AUVs

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

GNSS-aided Installation Error Compensation for DVL/INS Integrated Navigation System Using Error-State Kalman Filter

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

Application of Extended and Unscented Kalman Filtering for Non-Linear Positioning in Nearby Region of Navigation Sources