收稿日期: 2025-01-08
网络出版日期: 2025-05-19
基金资助
广东省基础与应用基础研究基金项目(2024A1515010397);中山市重大科技计划专项(2023A4011)
UWB/INS Indoor Positioning Method Based on Self-Resetting Genetic Particle Filtering
Received date: 2025-01-08
Online published: 2025-05-19
Supported by
the Basic and Applied Basic Research Fund of Guangdong Province(2024A1515010397)
超宽带(UWB)技术作为新一代室内定位技术的典范,在实际应用中常结合惯性导航系统(INS)以解决定位中的非视距(NLOS)误差问题。但集中式信息处理方法无法有效区分NLOS误差来源,为保证定位精度需额外部署锚点,导致定位锚点出现冗余,进而造成信息浪费及成本增加。针对室内定位中的NLOS误差识别和剔除问题,该文提出了一种基于自复位遗传粒子滤波(SGPF)的UWB/INS室内定位方法。该方法以SGPF算法为核心,通过INS估计值对测量值中的NLOS误差进行溯源,以提高NLOS环境下的跟踪稳定性。该方法首先对物理锚点进行分组,并结合虚拟锚点划分似然区域;然后基于INS的初步估计,通过NLOS误差识别策略确定高概率区域,同时剔除NLOS锚点组及对应的测量值;最后结合有效粒子数判别粒子集状态,决定是否启用遗传重采样以优化粒子多样性,最终提升算法鲁棒性。SGPF算法融合了标准粒子滤波(PF)和遗传算法的结构优势,可有效缓解粒子退化与贫化问题,在更低的粒子数量与时耗下实现更高的鲁棒性。实验结果表明:在视距环境下,SGPF算法只需PF算法30%的粒子数即可达到同等定位效果,且其计算时耗远低于传统遗传粒子滤波算法;在非视距环境下,SGPF算法的平均定位误差为0.055 2 m,相比于传统粒子滤波与传统遗传粒子滤波算法分别降低了56.98%与48.94%。
杨永辉 , 李智贤 , 王敏蕙 , 许函铭 , 陈颖聪 , 文尚胜 . 基于自复位遗传粒子滤波的UWB/INS室内定位方法[J]. 华南理工大学学报(自然科学版), 2026 , 54(1) : 83 -93 . DOI: 10.12141/j.issn.1000-565X.250011
As a paradigm of the new-generation indoor positioning technology, ultra-wideband (UWB) technology is often combined with the inertial navigation system (INS) in practical applications to solve the non-line-of-sight (NLOS) error issue in positioning. However, the centralized information processing method fails to effectively distinguish the sources of NLOS errors. To ensure positioning accuracy, additional anchor nodes need to be deployed, which leads to redundancy of positioning anchor nodes, and further results in information waste and increased costs. Aiming at the problems of NLOS error identification and elimination in indoor positioning, this paper proposed a UWB/INS indoor positioning method based on self-reset genetic particle filtering (SGPF). With the SGPF algorithm as its core, this method traces the source of NLOS errors in measured values using the estimated values of the INS system, so as to improve the tracking stability under NLOS environments. The method first groups physical anchor nodes and divides likelihood regions in combination with virtual anchor nodes. Then, based on the preliminary estimation of the INS, it identifies high-probability regions through an NLOS error identification strategy, while eliminating NLOS anchor node groups and their corresponding measured values. Finally, it judges the state of the particle set by combining the number of effective particles, determines whether to enable genetic resampling to optimize particle diversity, and ultimately improves the robustness of the algorithm. The SGPF algorithm integrates the structural advantages of the standard particle filter (PF) and genetic algorithms, and can effectively alleviate the problems of particle degradation and impoverishment and achieve higher robustness with a smaller number of particles and lower time consumption. Experimental results show that: under line-of-sight environments, the SGPF algorithm requires only 30% of the number of particles used in the PF algorithm to achieve the same positioning effect, and its calculation time is much lower than that of the traditional genetic particle filter algorithm; under NLOS environments, the SGPF algorithm has an average positioning error of 0.055 2 m. Compared to traditional particle filter and traditional genetic particle filter algorithms, the localization error is reduced by 56.98% and 48.94% respectively.
| [1] | BENOUAKTA A, FERRERO F, LIZZI L,et al .Advancements in industrial RTLSs:a technical review of UWB localization devices emphasizing antennas for enhanced accuracy and range[J].Electronics,2024,13(4):751-758. |
| [2] | QU J .A review of UWB indoor positioning[J].Journal of Physics:Conference Series,2023,2669:012003/1-9. |
| [3] | MAZHAR K, KHAN A A, ALOMAINY A .Precise indoor positioning using UWB:a review of methods,algorithms and implementations[J].Wireless Personal Communications,2017,97(3):4467-4491. |
| [4] | YAO L, YAO L, WU Y W .Analysis and improvement of indoor positioning accuracy for UWB sensors[J].Sensors,2021,21(17):5731-5753. |
| [5] | CHEN C, HUANG Z, WANG J,et al .Channel qua-lity evaluation based anchor node selection for UWB indoor positioning[J].Electronics,2022,11(3):436-451. |
| [6] | ALBAIDHANI A, MORELL A, VICARIO J L .Anchor selection for UWB indoor positioning[J].Transactions on Emerging Telecommunications Technologies,2019,30(6):73-78. |
| [7] | YANG J Q, GAO J B, SUN W,et al .A UWB indoor positioning method based on triple filtering fingerprint matching algorithm[J].Journal of Physics:Confe-rence Series,2024,2813:012003/1-6. |
| [8] | 蔡礼贤,邹进贵,赵胤植 .一种基于UWB测距信号信噪比的优化定位方法[J].测绘地理信息,2023,48(6):36-39. |
| CAI Lixian, ZOU Jingui, ZHAO Yinzhi .An optimized positioning method based on the SNR of UWB ranging signals[J].Journal of Geomatics,2023,48(6):36-39. | |
| [9] | WANG F, TANG H, CHEN J .Survey on NLOS identification and error mitigation for UWB indoor positioning[J].Electronics,2023,12(7):1-41. |
| [10] | KE C, SHU Y, KE X .Research on indoor visible light location based on fusion clustering algorithm[J].Photonics,2023,10(7):853/1-15. |
| [11] | GEZICI S, TIAN Z, GIANNAKIS G B,et al .Locali-zation via ultra-wideband radios:a look at positioning aspects for future sensor networks[J].IEEE Signal Processing Magazine,2005,22(4):70-84. |
| [12] | RATHJE P, LANDSIEDEL O .Precise ranging:mode-ling bias and variance of double-sided two-way ranging with TDoA extraction under multipath and NLOS effects[J].Navigation,2024,71(4):1-15. |
| [13] | WANG Y, ZHOU Y, LU Y,et al .MSTSCKF-based INS/UWB integration for indoor localization[J].Ain Shams Engineering Journal,2024,15:102939/1-16. |
| [14] | XU Y, SHMALIY Y S, AHN C K,et al .Blind robust multi-horizon EFIR filter for tightly integrating INS and UWB[J].IEEE Sensors Journal,2021,21(20):23037-23045. |
| [15] | 文尚胜,丘志强,许函铭,等 .基于差分算法优化的自复位粒子滤波算法[J].华南理工大学学报(自然科学版),2023,51(3):133-145. |
| WEN Shangsheng, QIU Zhiqiang, XU Hanming,et al .Self-reset particle filter method optimized based on di-fferential evolution algorithm[J].Journal of South China University of Technology (Natural Science Edition),2023,51(3):133-145. | |
| [16] | ZHOU N, MENG D, LU S .Estimation of the dynamic states of synchronous machines using an extended particle filter[J].IEEE Transactions on Power Systems,2013,28(4):4152-4161. |
| [17] | LIU J S, CHEN R, LOGVINENKO T .A theoretical framework for sequential importance sampling with resampling[M]∥ Sequential Monte Carlo methods in practice.New York:Springer,2001:225-246. |
| [18] | 蔡保杰,邵雷,李正杰 .采用卡方检验和牛顿插值的抗差卡尔曼滤波新算法[J].空军工程大学学报(自然科学版),2020,21(1):38-43. |
| CAI Baojie, SHAO Lei, LI Zhengjie .A new robust Kalman filter algorithm based on chi-square test and Newton interpolation[J].Journal of Air Force Engineering University (Natural Science Edition),2020,21(1):38-43. | |
| [19] | BURSTEIN H .Close approximations of percentage points of the chi-square distribution and poisson confidence limits[J].Journal of the American Statistical Association,1973,68(343):581-584. |
| [20] | 黄家才,王徐寅,高芳征,等 .基于改进天牛须优化粒子滤波的UWB/LiDAR室内定位方法[J].控制与决策,2024,39(10):3261-3269. |
| HUANG Jia-cai, WANG Xu-yin, GAO Fang-zheng,et al .UWB/LiDAR indoor positioning method based on improved beetle antennae search algorithm optimized particle filter[J].Control and Decision,2024,39(10):3261-3269. | |
| [21] | QIU Z, QIAN H .Adaptive genetic particle filter and its application to attitude estimation system[J].Digital Signal Processing,2018,81(10):163-172. |
| [22] | LI H, WU C, SHEN Y,et al .Observer-based fuzzy control for nonlinear networked systems under unmeasurable premise variables[J].IEEE Transactions on Fuzzy Systems,2016,24(5):1233-1245. |
/
| 〈 |
|
〉 |