电子、通信与自动控制

基于自复位遗传粒子滤波的UWB/INS室内定位方法

  • 杨永辉 ,
  • 李智贤 ,
  • 王敏蕙 ,
  • 许函铭 ,
  • 陈颖聪 ,
  • 文尚胜
展开
  • 1.华南理工大学 材料科学与工程学院,广东 广州 510640
    2.东北大学 机械工程与自动化学院,辽宁 沈阳 110167
    3.北师香港浸会大学 工商管理学院,广东 珠海 519087
杨永辉(1975—),男,博士,高级工程师,主要从事室内外一体化定位、信号处理研究。E-mail: shshwen@scut.edu.cn
文尚胜(1964—),男,博士,教授,主要从事UWB室内定位、智能信息处理研究。E-mail: shshwen@scut.edu.cn

收稿日期: 2025-01-08

  网络出版日期: 2025-05-19

基金资助

广东省基础与应用基础研究基金项目(2024A1515010397);中山市重大科技计划专项(2023A4011)

UWB/INS Indoor Positioning Method Based on Self-Resetting Genetic Particle Filtering

  • YANG Yonghui ,
  • LI Zhixian ,
  • WANG Minhui ,
  • XU Hanming ,
  • CHEN Yingcong ,
  • WEN Shangsheng
Expand
  • 1.School of Material Science and Engineering,South China University of Technology,Guangzhou 510640,Guangdong,China
    2.School of Mechanical Engineering and Automation,Northeastern University,Shenyang 110167,Liaoning,China
    3.Faculty of Business and Management,Beijing Normal-Hong Kong Baptist University,Zhuhai 519087,Guangdong,China

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

Abstract

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].Electronics202413(4):751-758.
[2] QU J .A review of UWB indoor positioning[J].Journal of Physics:Conference Series20232669: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 Communications201797(3):4467-4491.
[4] YAO L, YAO L, WU Y W .Analysis and improvement of indoor positioning accuracy for UWB sensors[J].Sensors202121(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].Electronics202211(3):436-451.
[6] ALBAIDHANI A, MORELL A, VICARIO J L .Anchor selection for UWB indoor positioning[J].Transactions on Emerging Telecommunications Technologies201930(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 Series20242813:012003/1-6.
[8] 蔡礼贤,邹进贵,赵胤植 .一种基于UWB测距信号信噪比的优化定位方法[J].测绘地理信息202348(6):36-39.
  CAI Lixian, ZOU Jingui, ZHAO Yinzhi .An optimized positioning method based on the SNR of UWB ranging signals[J].Journal of Geomatics202348(6):36-39.
[9] WANG F, TANG H, CHEN J .Survey on NLOS identification and error mitigation for UWB indoor positioning[J].Electronics202312(7):1-41.
[10] KE C, SHU Y, KE X .Research on indoor visible light location based on fusion clustering algorithm[J].Photonics202310(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 Magazine200522(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].Navigation202471(4):1-15.
[13] WANG Y, ZHOU Y, LU Y,et al .MSTSCKF-based INS/UWB integration for indoor localization[J].Ain Shams Engineering Journal202415: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 Journal202121(20):23037-23045.
[15] 文尚胜,丘志强,许函铭,等 .基于差分算法优化的自复位粒子滤波算法[J].华南理工大学学报(自然科学版)202351(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)202351(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 Systems201328(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].空军工程大学学报(自然科学版)202021(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)202021(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 Association197368(343):581-584.
[20] 黄家才,王徐寅,高芳征,等 .基于改进天牛须优化粒子滤波的UWB/LiDAR室内定位方法[J].控制与决策202439(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 Decision202439(10):3261-3269.
[21] QIU Z, QIAN H .Adaptive genetic particle filter and its application to attitude estimation system[J].Digital Signal Processing201881(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 Systems201624(5):1233-1245.
文章导航

/