An Indoor Fusion Positioning Method Based on UWB/IMU/MAG in Harsh Environment

Localization in complex indoor environments remains a serious challenge. To enhance the accuracy of pedestrian position estimation in such environment, a fused localization framework is proposed. It is primarily driven by ultra-wideband (UWB) technology aided by Inertial Measurement Unit (IMU) and geomagnetic (MAG) sensors in non-line-of-sight (NLOS) environments where UWB alone may fail. First, we introduce a MAG fingerprint map lightweighting algorithm based on lower bound functions and matching area constraints, aimed at reducing the number of fingerprints and improving algorithm efficiency. Secondly, we present an IMU/MAG fusion algorithm utilizing a dynamically weighted k-nearest neighbor (DWKNN), which adjusts the k-value in MAG matching through a method based fuzzy comprehensive evaluation (FCE). Furthermore, to fully use line-of-sight (LOS) distances when UWB cannot independently estimate location, we propose a UWB/IMU/MAG fusion positioning algorithm based on the tight combination of factor graphs (FG). Real-world experiments are conducted in harsh indoor environment and results demonstrate that our proposed UWB/IMU/MAG fusion framework improves average localization accuracy at least by 71.98% compared to UWB alone and by 18.18% compared to traditional Extended Kalman filter (EKF) fusion algorithms. It effectively addresses UWB localization failures in NLOS areas and significantly enhancing localization accuracy and robustness in complex environments.