Tightly Coupled Integration of INS and UWB Using Fixed-Lag Extended UFIR Smoothing for Quadrotor Localization
Yuan Xu, Yuriy S. Shmaliy, Choon Ki Ahn, Tao Shen, Yuan Zhuang
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.