Abstract:Due to the state trajectory-independent features of invariant Kalman filtering (InEKF), it has attracted widespread attention in the research community for its significantly improved state estimation accuracy and convergence under disturbance. In this paper, we formulate the full-source data fusion navigation problem for fixed-wing unmanned aerial vehicle (UAV) within a framework based on error state right-invariant extended Kalman filtering (ES-RIEKF) on Lie groups. We merge measurements from a multi-rate onboard sensor network on UAVs to achieve real-time estimation of pose, air flow angles, and wind speed. Detailed derivations are provided, and the algorithm's convergence and accuracy improvements over established methods like Error State EKF (ES-EKF) and Nonlinear Complementary Filter (NCF) are demonstrated using real-flight data from UAVs. Additionally, we introduce a semi-aerodynamic model fusion framework that relies solely on ground-measurable parameters. We design and train an Long Short Term Memory (LSTM) deep network to achieve drift-free prediction of the UAV's angle of attack (AOA) and side-slip angle (SA) using easily obtainable onboard data like control surface deflections, thereby significantly reducing dependency on GNSS or complicated aerodynamic model parameters. Further, we validate the algorithm's robust advantages under GNSS denied, where flight data shows that the maximum positioning error stays within 30 meters over a 130-second denial period. To the best of our knowledge, this study is the first to apply ES-RIEKF to full-source navigation applications for fixed-wing UAVs, aiming to provide engineering references for designers. Our implementations using MATLAB/Simulink will open source.

Combining Extended Kalman Filter with Complementary Filter for Uav Attitude Estimation Based on Mems Marg Sensors

Filter-based Adaptive Backstepping Attitude Control for Multi-Rotor UAVs with Parametric Uncertainty, External Disturbance and Input Saturation

A Fusion Algorithm for Pico-Satellite Attitude Determination Using Low Cost Mems-Based Sensors

Attitude Calculation of Quadrotor UAV Based on Extended Kalman Filter and Complementary Filter

Multi-sensor Data Fusion Using Adaptive Kalman Filter

A Dual-Linear Kalman Filter for Real-Time Orientation Determination System Using Low-Cost MEMS Sensors

Improved attitude estimation accuracy by data fusion of a MEMS MARG sensor and a low-cost GNSS receiver

Computationally Efficient Attitude Estimation with Extended $\mathcal{H}_2$ Filtering

Data Fusion Method of Quad-Rotor Aircraft Attitude Measurement System

Nonlinear Extended Kalman Filter for Attitude Estimation of the Fixed-Wing UAV

Improved Attitude and Heading Accuracy with Double Quaternion Parameters Estimation and Magnetic Disturbance Rejection

Semi-Aerodynamic Model Aided Invariant Kalman Filtering for UAV Full-State Estimation

A novel adaptive Kalman filter for Euler-angle-based MEMS IMU/magnetometer attitude estimation

Multiplicative Quaternion Extended Consensus Kalman Filter for Attitude and Augmented State Estimation

Compounded Calibration Based on FNN and Attitude Estimation Method Using Intelligent Filtering for Low Cost MEMS Sensor Application

Comparison of complementary and Kalman filter based data fusion for attitude heading reference system

Can Superextended Lymph Node Dissection be Justified for Gastric Cancer with Pathologically Positive Para-aortic Lymph Nodes?

Adaptive Kalman Filter Enhanced With Spectrum Analysis for Wide-Bandwidth Angular Velocity Estimation Fusion

Attitude and heading measurement based on adaptive complementary Kalman filter for PS/MIMU integrated system.

A fuzzy adaptive complementary filter for attitude estimation based on norm judgment

MEMS Sensors Based Attitude Measurement System Using UKF