Robust INS/GPS sensor fusion for UAV localization using SDRE nonlinear filtering

摘要

The aim of this paper is to present a new INS/GPS sensor fusion scheme, based on State-Dependent Riccati Equation (SDRE) nonlinear filtering, for Unmanned Aerial Vehicle (UAV) localization problem. SDRE navigation filter is proposed as an alternative to Extended Kalman Filter (EKF), which has been largely used in the literature. Based on optimal control theory, SDRE filter solves issues linked with EKF filter such as linearization errors, which severely decrease UAV localization performances. Stability proof of SDRE nonlinear filter is also presented and validated on a 3D UAV flight scenario. Results obtained by SDRE navigation filter were compared to EKF navigation filter results. This comparison shows better UAV localization performance using SDRE filter. The suitability of the SDRE navigation filter over an Unscented Kalman navigation filter for highly nonlinear UAV flights is also demonstrated.