基于UWB的消防员室内协同定位算法

doi:10.3778/j.issn.1002-8331.2008-0232

摘要/Abstract

摘要： 为了在复杂火场环境下获取消防员的精确位置，提出基于超宽带（ultra-wideband，UWB）的消防员室内协同定位算法，充分利用目标到UWB基站以及到其他目标的测距信息进行定位。采用线性拟合方式对测量距离中存在的标准偏差进行预处理；针对目标位置解算及非视距（non-line-of-sight，NLOS）误差缓解问题，提出基于偏移扩展卡尔曼滤波的协同定位算法，根据待定位目标之间的内在联系，建立新的状态方程和量测方程，并通过构造的系数矩阵调整卡尔曼增益，修正偏离的位置估计值；针对定位坐标跳变问题，提出基于阈值筛选的均值滤波算法对定位结果进行二次优化。实验结果表明，所提算法的定位精度在弱NLOS环境下高达0.17?m，在强NLOS环境下高达0.28?m，与文中其他算法相比具有更好的定位性能，降低了定位对UWB基站分布密度高的要求，最大程度地使用了整个协同网络的资源，为深入火场内部的消防员群体因障碍物遮挡导致的定位困难或定位不准问题提供了一种解决方案。

关键词: 超宽带（UWB）, 消防员定位, 协同定位, 扩展卡尔曼滤波, 均值滤波

Abstract: In order to obtain the accurate positions of firefighters in a complex fire environment, an ultra-wideband（UWB） based indoor collaborative positioning algorithm for firefighters is proposed, which makes full use of the ranging information from target to UWB base stations and other targets for positioning. Firstly, a linear fitting method is used to preprocess the standard deviations in the measurement distances. Then, aiming at the problem of target position calculation and non-line-of-sight（NLOS） error mitigation, a collaborative positioning algorithm based on biased extended Kalman filter is proposed. According to the internal connection between the targets to be located, the new state equation and measurement equation are established, and the Kalman gain is adjusted by the constructed coefficient matrix to correct the deviated position estimation values. Finally, for the problem of positioning coordinates jump, an improved mean filter algorithm based on threshold screening is proposed to optimize the positioning results secondarily. The experimental results show that the proposed algorithm has a positioning accuracy of up to 0.17 m in weak NLOS environment and 0.28 m in strong NLOS environment. Compared with other algorithms in this paper, the proposed algorithm has better positioning performance, reduces the requirement of high distribution density of UWB base stations, uses the resources of the whole collaboration network to the greatest extent, and provides a solution to the problem of difficult or inaccurate positioning caused by obstacles for the firefighters group in the fire scene.

Key words: ultra-wideband（UWB）, firefighters positioning, collaborative positioning, extended Kalman filter, mean filter

杨刚, 朱士玲, 李强, 赵克松, 赵杰, 郭建. 基于UWB的消防员室内协同定位算法[J]. 计算机工程与应用, 2022, 58(4): 106-117.

YANG Gang, ZHU Shiling, LI Qiang, ZHAO Kesong, ZHAO Jie, GUO Jian. UWB Based Indoor Collaborative Positioning Algorithm for Firefighters[J]. Computer Engineering and Applications, 2022, 58(4): 106-117.

参考文献

[1] ALARIFI A，ALSALMAN A，ALSALEH M，et al.Ultra wideband indoor positioning technologies：analysis and recent advances[J].Sensors，2016，16（5）：707.
[2] MAZHAR F，KHAN M G，SALLBERG B，et al.Precise indoor positioning using UWB：a review of methods，algorithms and implementations[J].Wireless Personal Communications，2017，97（3）：4467-4491.
[3] ZAFARI F，GKELIAS A，LEUNG K K，et al.A survey of indoor localization systems and technologies[J].IEEE Communications Surveys and Tutorials，2019，21（3）：2568-2599.
[4] MOGALE T H，SILVA B J，HANCKE G P，et al.A portable IR-UWB based WSN for personnel tracking in emergency scenarios[C]//2016 IEEE 14th International Conference on Industrial Informatics，Poitiers，2016：961-965.?
[5] 曹祥红，张华.基于UWB应急标志灯具的火场定位系统设计[J].消防科学与技术，2017，36（1）：82-85.
CAO X H，ZHANG H.Design of fireman positioning system based on UWB emergency indicating luminaire[J].Fire Science and Technology，2017，36（1）：82-85.
[6] XU L，HE J，YING J，et al.UWB body motion assisted indoor geolocation with a single reference point[C]//2018 IEEE/ION Position，Location and Navigation Symposium，Monterey，2018：1509-1514.
[7] ZHAO C，WANG B.A UWB/Bluetooth fusion algorithm for indoor localization[C]//2019 Chinese Control Conference，Guangzhou，2019：4142-4146.
[8] LI B，HAO Z，DANG X，et al.An indoor location algorithm based on Kalman filter fusion of ultra-wide band and inertial measurement unit[J].AIP Advances，2019，9（8）：085210.
[9] LIU R，YUEN C，DO T，et al.Cooperative positioning for emergency responders using self IMU and peer-to-peer radios measurements[J].Information Fusion，2020，56：93-102.
[10] 柯明星，吕晶，童凯翔，等.基于扩展卡尔曼滤波的动态协同定位算法[J].导航定位学报，2016，4（1）：44-49.
KE M X，LV J，TONG K X，et al.A research of dynamic cooperative localization system via extended Kalman filter[J].Journal of Navigation and Positioning，2016，4（1）：44-49.
[11] LOBO F L，GRAEL D C，OLIVEIRA H A，et al.Cooperative localization improvement using distance information in vehicular Ad Hoc networks[J].Sensors，2019，19（23）：5231.
[12] CAI H F，WU G，CHEN Y F，et al.Indoor collaborative localization method based on ultra-wideband ranging[C]//2015 9th European Conference on Antennas and Propagation，Lisbon，2015：1-2.
[13] VAGHEFI R M，BUEHRER R M.Cooperative localization in NLOS environments using semidefinite programming[J].IEEE Communications Letters，2015，19（8）：1382-1385.
[14] HAN R，CHEN S，BU Y，et al.Decentralized cooperative multi-robot localization with EKF[J].arXiv：1811.07506，2018.
[15] 梁玉珠，沈雪微，邱磊，等.物联网中基于扩展卡尔曼滤波的移动群体定位[J].北京邮电大学学报，2019，42（2）：95-100.
LIANG Y Z，SHEN X W，QIU L，et al.Extended Kalman filter for mobile group users localization in internet of things[J].Journal of Beijing University of Posts and Telecommunications，2019，42（2）：95-100.
[16] 李荣冰，王念曾，刘建业，等.面向相对导航的UWB测距误差估计与补偿方法[J].仪器仪表学报，2019，40（5）：28-35.
LI R B，WANG N Z，LIU J Y，et al.UWB ranging error estimation and compensation method for relative navigation[J].Chinese Journal of Scientific Instrument，2019，40（5）：28-35.
[17] 鲍小雨，王庆，阳媛，等.一种抑制NLOS误差的UWB定位方法[J].传感器与微系统，2019，38（9）：9-12.
BAO X Y，WANG Q，YANG Y，et al.A UWB positioning method for suppressing NLOS error[J].Transducer and Microsystem Technologies，2019，38（9）：9-12.
[18] 黄小平，王岩.卡尔曼滤波原理及应用：MATLAB仿真[M].北京：电子工业出版社，2015：77-87.
HUANG X P，WANG Y.Principle and application of Kalman filter：MATLAB simulation[M].Beijing：Publishing House of Electronics Industry，2015：77-87.
[19] FERREIRA A G，FERNANDES D，CATARINO A P.Performance analysis of ToA-based positioning algorithms for static and dynamic targets with low ranging measurements[J].Sensors，2017，17（8）：1915.
[20] 李静，刘琚.用卡尔曼滤波器消除TOA中NLOS误差的三种方法[J].通信学报，2005（1）：130-135.
LI J，LIU J.NLOS error mitigation in TOA using Kalman filter[J].Journal on Communications，2005（1）：130-135.
[21] 孙继平，李晨鑫.基于改进均值滤波和参数拟合的矿井TOA几何定位方法[J].煤炭学报，2015，40（5）：1206-1212.
SUN J P，LI C X.Mine TOA geometric positioning method based on improved mean filtering and parameter fitting[J].Journal of China Coal Society，2015，40（5）：1206-1212.