A UWB-AOA/IMU Integrated Navigation System for 6-DoF Indoor UAV Localization

With the increasing deployment of unmanned aerial vehicles (UAVs) in indoor environments, the demand for high-precision six-degrees-of-freedom (6-DoF) localization has grown significantly. Ultra-wideband (UWB) technology has emerged as a key enabler for indoor UAV navigation due to its robustness against multipath effects and high-accuracy ranging capabilities. However, conventional UWB-based systems primarily rely on range measurements, operate at low measurement frequencies, and are incapable of providing attitude information. This paper proposes a tightly coupled error-state extended Kalman filter (TC–ESKF)-based UWB/inertial measurement unit (IMU) fusion framework. To address the challenge of initial state acquisition, a weighted nonlinear least squares (WNLS)-based initialization algorithm is proposed to rapidly estimate the UAV’s initial position and attitude under static conditions. During dynamic navigation, the system integrates time-difference-of-arrival (TDOA) and angle-of-arrival (AOA) measurements obtained from the UWB module to refine the state estimates, thereby enhancing both positioning accuracy and attitude stability. The proposed system is evaluated through simulations and real-world indoor flight experiments. Experimental results show that the proposed algorithm outperforms representative fusion algorithms in 3D positioning and yaw estimation accuracy.