Tightly Coupled Integration of INS and UWB Using Fixed-Lag Extended UFIR Smoothing for Quadrotor Localization

Abstract

Accurate indoor localization information of the quadrotor plays an important role in many Internet-of-Things applications. To improve the estimation accuracy and robustness, a fixed-lag extended finite impulse response smoother (FEFIRS) algorithm is proposed for fusing the inertial navigation system (INS) and ultra wideband (UWB) data tightly, which employs a distance between the UWB reference nodes and a blind node measured by the INS and UWB. The FEFIRS algorithm consists of an extended unbiased finite impulse response (EFIR) filter and a fixed-lag unbiased FIR (UFIR) smoother. The EFIR filter is employed to improve the robustness, and the fix-lag UFIR smoother is capable of improving the accuracy. Based on extensive test investigations employing real data, the proposed FEFIRS has higher accuracy and robustness than the Kalman-based solutions in the tightly integrated INS/UWB-based indoor quadrotor localization.