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.

GPS/IMU/Hydrodynamic Model Fusion State Estimation for Unmanned Surface Vehicles Based on Moving Horizon Estimation Method

GPS/IMU/Hydrodynamic Model Fusion State Estimation for Unmanned Surface Vehicles Based on Moving Horizon Estimation Method

A Method of State Estimation for Underwater Vehicle Navigation Around a Cylindrical Structure

State Estimation of QAUV Based on Dynamic Model

Estimation of the Hydrodynamic Parameters of USVs for Velocity Prediction Using a Hybrid Adaptive Strategy

Learning-Based Trajectory Tracking Control of USV Based on Multi-Source Data.

A Model Predictive Control Approach for USV Autonomous Cruising Via Disturbance Learning

Cascaded Motion Estimation for Intelligent Vehicles in GNSS-Denied Scenes

Inertial-Aided Metric States and Surface Normal Estimation Using a Monocular Camera.

Real-Time Onboard 3D State Estimation of an Unmanned Aerial Vehicle in Multi-Environments Using Multi-Sensor Data Fusion

Metric Sensing and Control of a Quadrotor Using a Homography-Based Visual Inertial Fusion Method.

Inertial-aided State and Slope Estimation Using a Monocular Camera

A Homography-Based Visual Inertial Fusion Method for Robust Sensing of a Micro Aerial Vehicle

GNSS-INS-Dynamic Fusion with Robustness to Outliers Based on External Force State Estimation

Model Predictive Control Based on State Space and Risk Augmentation for Unmanned Surface Vessel Trajectory Tracking

Real-Time Optimal States Estimation with Inertial and Delayed Visual Measurements for Unmanned Aerial Vehicles

Sensing and Control of a Quadrotor Using a Visual Inertial Fusion Method

Accurate and Robust State Estimation via Fusion of Visual-Inertial-UWB with Time Synchronization

A generic multi-sensor fusion scheme for localization of autonomous platforms using moving horizon estimation

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

Position Estimation Method for Small Drones Based on the Fusion of Multisource, Multimodal Data and Digital Twins