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.

Extended kalman filtering and its application to intelligent missile formation flight mechanics

Applying a Novel Extended Kalman Filter to Missile–target Interception with APN Guidance Law: A Benchmark Case Study

Research on Relative Navigation Method Based on INS/Vision Using Sigma-Point Kalman Filter

A Relative Navigation Method Based on INS/Vision for UAV

Cooperative Localization Approach to Intelligent Missile Based on Data Link

Kalman Filtering Algorithm for Integrated Navigation System in Unmanned Aerial Vehicle

Study of Relative Navigation System Based on INS/GPS for Cooperative Intelligent Missile

Application of a New Developed Adaptive Federated Kalman Filter in Tactical Missile Integrated Navigation System

Relative Attitude Determination of Formation Spacecraft Based on Flight Mechanics

Large Scale Formation Relative Navigation with Relative Measurement Time Delay and Communication Jam

Clifford Algebra-Based Iterated Extended Kalman Filter with Application to Low-Cost INS/GNSS Navigation

Information filtering and its application to relative navigation

GPS/VISNAV Integrated Relative Navigation and Attitude Determination System for Ultra-Close Spacecraft Formation Flying

Relative Navigation for Spacecraft Formation Flying Based on Robust Kalman Filter

Relative Navigation for Space-based Platform with Extended Kalman Filter

Multisensor Integrated Autonomous Navigation Based on Intelligent Information Fusion

Mid-range Relative Navigation Method for Non-Cooperative Target Satellite

Attitude Estimation for Guided Projectiles Based on Magnetometers and Accelerometers

Using cooperative intelligent missile to localize targets based on adaptive sigma-point filtering

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

Relative Navigation with Maneuvers Using a Suboptimal Fading Extended Kalman Filtera