Underground personnel positioning system based on 5G+UWB and inertial navigation technology
-
摘要: 针对煤矿井下人员定位系统在实际应用中存在因设备算力与存储资源不足导致无法使用复杂测距与定位算法，定位数据即时传输与响应性能不足，在系统部署方面人力物力损耗较大等问题，提出了一种基于5G+UWB和惯导技术的井下人员定位系统。在末端部署能耗低、抗干扰性强的UWB定位基站，定位基站与5G基站以级联的方式连接，定位基站采集UWB与惯导数据，利用5G网络回传至计算平台，在计算平台上完成定位信息的解算和存储。将基于惯导的人员位置估计作为预测值，将基于UWB的三边定位算法获取的人员位置估计作为观测值，利用卡尔曼滤波器将预测值和观测值进行融合，降低定位误差。在煤矿主体实验基地搭建测试系统，模拟真实煤矿井下环境并进行对比实验。结果表明：① 在x轴和y轴，融合惯导的卡尔曼滤波算法得出的位置信息和真实位置信息的重合度最高，说明融合惯导的卡尔曼滤波算法得出的位置信息最接近真实位置,平均误差为22.192 cm。② 5G+UWB和惯导技术组合的井下人员定位系统的位置信息和真实位置信息的重合度最高，误差为[15 cm，20 cm]，x轴最大平均误差为26 cm，y轴最大平均误差为24 cm，超过目前大多数井下人员定位系统精度。Abstract: In practical applications of coal mine personnel positioning systems, there are problems of insufficient equipment computing power and storage resources. The problems result in preventing the use of complex ranging and positioning algorithms, inadequate real-time transmission and response performance of positioning data, and significant human and material resource losses in system deployment. In order to solve the above problems, a new underground personnel positioning system based on 5G+UWB and inertial navigation technology is proposed. The system deploys UWB positioning base stations with low energy consumption and strong anti-interference capability at the end. The positioning base station is connected to the 5G base station in a cascaded manner. The positioning base station collects UWB and inertial navigation data, and uses the 5G network to transmit it back to the computing platform. The positioning information is solved and stored on the computing platform. The inertial navigation based personnel position estimation is used as the predicted value. The UWB based trilateral positioning algorithm is used to obtain personnel position estimation as the observed value. The Kalman filter is used to fuse the predicted and observed values to reduce positioning errors. The testing system is built at the main experimental base of the coal mine, simulating the real underground environment of the coal mine, and conducting comparative experiments. The results show the following points. ①In the x-axis direction and the y-axis direction, the coincidence degree between the position information obtained by the Kalman filter algorithm of the fusion inertial navigation and the real position information is the highest, indicating that the position information obtained by the Kalman filter algorithm of the fusion inertial navigation is closest to the real position, and the average error is 22.192 cm. ② The position information of the underground personnel positioning system combined with 5G + UWB and inertial navigation technology has the highest coincidence degree with the real position information, and the error is [15 cm, 20 cm], with a maximum average error of 26 cm on the x-axis and 24 cm on the y-axis, exceeding the precision of most current underground personnel positioning systems.
-
Key words:
- underground personnel positioning /
- 5G /
- UWB /
- inertial navigation technology /
- Kalman filtering
-
图 4 基于5G+UWB和惯导的井下人员定位系统架构
Figure 4. Network structure of underground personnel positioning system based on 5G + UWB and inertial navigation
表 1 煤矿井下人员定位系统架构
Table 1. Positioning system structure of underground coal mine personnel
系统架构 功能 硬件 硬件层 采集定位信息 人员标志卡、
UWB定位基站网络层 数据传输 光纤、交换机等 应用层 人员定位、车辆定位、
人员管理、紧急报警、智能巡检等地面计算平台、
车载智能计算与控制平台
下载: 导出CSV
表 2 我国运营商5G主力频段
Table 2. Main frequency band of 5G in China
运营商 频率范围/MHz 带宽/MHz 频段 中国移动 2 515~2 675 160 n41 4 800~4 900 100 n79 中国广电 4 900~4 960 60 n79 703~733/758~788 2×30 n28 中国电信/
中国联通/
中国广电3 300~3 400 100 n78 中国电信 3 400~3 500 100 n78 中国联通 3 500~3 600 100 n78
下载: 导出CSV
表 3 算法定位结果及误差
Table 3. Algorithm positioning results and error
cm 真实位置坐标 卡尔曼滤波 加权最小二乘 惯导+卡尔曼滤波 位置坐标 欧氏距离 位置坐标 欧氏距离 位置坐标 欧氏距离 （984，1121） （1023，1081） 55.865 91 （1071，1143） 89.738 51 （981，1110） 11.401 75 （859，607） （845，651） 46.173 59 （889，590） 34.481 88 （829，626） 35.510 56 （1135，1498） （1156，1454） 48.754 49 （1156，1533） 40.816 66 （1119，1509） 19.416 49 （1063，1472） （1072，1486） 16.643 32 （1061，1433） 39.051 25 （1068，1471） 5.099 02 （1333，1249） （1308，1300） 56.797 89 （1295，1290） 55.901 70 （1356，1265） 28.017 85 （577，847） （661，771） 113.27 84 （640，752） 113.991 20 （559，838） 20.124 61 （899，1107） （815，1011） 127.561 7 （922，1007） 102.610 90 （926，1086） 34.205 26 （1394，373） （1446，373） 52.000 0 （1489，409） 101.592 30 （1406，368） 13.00000 （900，597） （957，546） 76.485 29 （882，678） 82.975 90 （890，617） 22.360 68 （614，1219） （663，1206） 50.695 17 （688，1258） 83.648 07 （595，1221） 19.104 97 （1005，1030） （1015，960） 70.710 68 （1053，934） 107.331 30 （979，1027） 26.172 50 （851，1176） （776，1130） 87.982 95 （801，1243） 83.600 24 （827，1155） 31.890 44
下载: 导出CSV
表 4 x轴真实位置坐标与定位位置坐标的定位误差
Table 4. Location error between the true position coordinates and position position coordinates of the x-axis
cm 标签1 标签2 标签3 $ {x_1} $ $ {x_2} $ E1 $ {x_1} $ $ {x_2} $ E1 $ {x_1} $ $ {x_2} $ E1 677 647 30 989 973 16 1 207 1 186 21 1 194 1 197 3 407 429 22 1 320 1 319 1 821 844 23 1 225 1 243 18 921 947 26 1 076 1 044 32 1 331 1 326 5 1 214 1 176 38 570 584 14 858 841 17 482 513 31 1 469 1 446 23 755 746 9 607 644 37 499 469 30 797 813 16 460 425 35 1 077 1 045 32 717 692 25 1 257 1 264 7 1 463 1 502 39 544 509 35 602 634 32 497 528 31 727 741 14 1 463 1 429 34 702 718 16 1 303 1 282 21 499 495 4 327 363 36 887 868 19 1335 1 343 8
下载: 导出CSV
表 5 y轴真实位置坐标与定位位置坐标的定位误差
Table 5. Location error between the true position coordinates and position position coordinates ofthe y-axis
cm 标签1 标签2 标签3 $ {y_1} $ $ {y_2} $ $ {E_2} $ $ {y_1} $ $ {y_2} $ $ {E_2} $ $ {y_1} $ $ {y_2} $ $ {E_2} $ 893 918 25 1432 1 447 15 1 095 1 085 10 1 429 1 412 17 1 204 1 199 5 933 918 15 1 319 1 322 3 1 170 1 151 19 1 105 1 112 7 814 839 25 733 751 18 1 231 1 202 29 487 524 37 969 958 11 427 443 16 489 451 38 813 820 7 1 334 1 330 4 658 692 34 639 609 30 1 255 1 241 14 653 621 32 1 045 1 037 8 783 778 5 738 742 4 563 558 5 1 158 1 173 15 1 188 1 181 7 574 604 30 1 142 1 169 27 353 313 40 321 284 37 620 638 18 732 706 26 1 331 1323 8 1 259 1 239 20
下载: 导出CSV
-
[1] 刘宇,李瑶,路永乐,等. 基于MEMS传感器组合的行人室内高度定位算法[J]. 压电与声光,2019,41(5):690-693,746.LIU Yu,LI Yao,LU Yongle,et al. Pedestrian indoor height localization algorithm based on MEMS sensor combination[J]. Piezoelectrics & Acoustooptics,2019,41(5):690-693,746. [2] 汪义庭. 基于UWB的无线室内定位系统设计与实现[D]. 淮南:安徽理工大学,2019.WANG Yiting. Design and implementation of wireless indoor positioning system based on UWB[D]. Huainan:Anhui University of Science and Technology,2019. [3] WANG Yixin,YE Qiang,CHENG Jie,et al. RSSI-based bluetooth indoor localization[C]. 11th International Conference on Mobile Ad-hoc and Sensor Networks ,Shenzhen,2015:165-171. [4] LI Qiyue,LI Wei,SUN Wei,et al. Fingerprint and assistant nodes based WiFi localization in complex indoor environment[J]. IEEE Access,2016,4:2993-3004. doi: 10.1109/ACCESS.2016.2579879 [5] GHOLOOBI A,STAVROU S. Accelerating TOA/TDOA packet based localization methods[C]. IEEE Conference on Wireless Sensors ,Subang,2014:31-35. [6] 吕瑞杰. 煤矿井下UWB信号路径损耗测量及中心频率选择[J]. 工矿自动化,2023,49(4):147-152.LYU Ruijie. Measurement of UWB signal path loss and center frequency selection in underground coal mines[J]. Journal of Mine Automation,2023,49(4):147-152. [7] ZENG Zhuoqi,LIU S,WANG Lei. UWB NLOS identification with feature combination selection based on genetic algorithm[C]. IEEE International Conference on Consumer Electronics,Las Vegas,2019. DOI: 10.1109/ICCE.2019.8662065. [8] 孙建强,尚俊娜,刘新华,等. 一种基于模糊推理的改进加权KNN定位算法[J]. 传感技术学报,2020,33(6):882-888. doi: 10.3969/j.issn.1004-1699.2020.06.015SUN Jianqiang,SHANG Junna,LIU Xinhua,et al. An improved weighted KNN location algorithm based on fuzzy reasoning[J]. Chinese Journal of Sensors and Actuators,2020,33(6):882-888. doi: 10.3969/j.issn.1004-1699.2020.06.015 [9] 孙晔,肖竹,李小蓓,等. UWB定位中基于神经网络的TDOA解算方法[J]. 航空计算技术,2019,49(2):6-10. doi: 10.3969/j.issn.1671-654X.2019.02.002SUN Ye,XIAO Zhu,LI Xiaobei,et al. Neural network based TDOA calculation algorithm in a UWB system[J]. Aeronautical Computing Technique,2019,49(2):6-10. doi: 10.3969/j.issn.1671-654X.2019.02.002 [10] STRAETEN M,AHAMED M J. Intuitive ultrasonic INS augmentation for pedestrian path tracking and navigation[J]. Sensors and Actuators A Physical,2019. DOI: 10.1016/j.sna.2019.111641. [11] LIU Fei,LI Xin,WANG Jian,et al. An adaptive UWB/MEMS-IMU complementary kalman filter for indoor location in NLOS environment[J]. Remote Sensing,2019,11(22). DOI: 10.3390/rs11222628. [12] FENG Daquan,WANG Chunqi,HE Chunlong,et al. Kalman-filter-based integration of IMU and UWB for high-accuracy indoor positioning and navigation[J]. IEEE Internet of Things Journal,2020,7(4):3133-3146. doi: 10.1109/JIOT.2020.2965115 [13] WANG Tianyu,HU Keke,LI Zhihang,et al. A semi-supervised learning approach for UWB ranging error mitigation[J]. IEEE Wireless Communications Letters,2021,10(3):688-691. doi: 10.1109/LWC.2020.3046531 [14] SANG C L,STEINHAGEN B,HOMBURG J D,et al. Identification of NLOS and multi-path conditions in UWB localization using machine learning methods[J]. Applied Sciences,2020,10(11). DOI: 10.3390/app10113980. [15] FERREIRA A,FERNANDES D,BRANCO S,et al. Feature selection for real-time NLOS identification and mitigation for body-mounted UWB transceivers[J]. IEEE Transactions on Instrumentation and Measurement,2021,70. DOI: 10.1109/TIM.2021.3070619. [16] TRAN D H,CHUNG B D,JANG Y M. GAN-based data augmentation for UWB NLOS identification using machine learning[C]. International Conference on Artificial Intelligence in Information and Communication ,Jeju Island,2022:417-420. [17] JIANG Changhui,SHEN Jichun,CHEN Shuai,et al. UWB NLOS/LOS classification using deep learning method[J]. IEEE Communications Letters,2020,24(10):2226-2230. doi: 10.1109/LCOMM.2020.2999904 [18] YANG Bo,LI Jun,SHAO Zhanpeng,et al. Robust UWB indoor localization for NLOS scenes via learning spatial-temporal features[J]. IEEE Sensors Journal,2022,22(8):7990-8000. doi: 10.1109/JSEN.2022.3156971 [19] CHEN Shanzhi,KANG Shaoli. A tutorial on 5G and the progress in China[J]. Frontiers of Information Technology & Electronic Engineering,2018,19(3):309-321. [20] CHU Yeping,LIN Pan,LENG Kaijun,et al. Research on key technologies of service quality optimization for industrial IoT 5G network for intelligent manufacturing[J]. The International Journal of Advanced Manufacturing Technology,2022,123(7/8). DOI: 10.1007/S00170-022-10418-6. [21] 霍振龙. 5G专网技术及煤矿5G专网方案分析[J]. 工矿自动化,2022,48(11):6-10,19.HUO Zhenlong. Analysis of 5G private network technology and coal mine 5G private network scheme[J]. Journal of Mine Automation,2022,48(11):6-10,19. [22] ELSANHOURY M,MAKELA P,KOLJONEN J,et al. Precision positioning for smart logistics using ultra-wideband technology-based indoor navigation:a review[J]. IEEE Access,2022,10:44413-44445. doi: 10.1109/ACCESS.2022.3169267 [23] LI Yinya,QI Guoqing,SHENG Andong. Performance metric on the best achievable accuracy for hybrid TOA/AOA target localization[J]. IEEE Communications Letters,2018,22(7):1474-1477. doi: 10.1109/LCOMM.2018.2833544 [24] 蓝威涛,张卫强,罗健宇. 一种自适应智能三边定位算法的设计与实现[J]. 传感技术学报,2017,30(7):1089-1094.LAN Weitao,ZHANG Weiqiang,LUO Jianyu. Design and implementation of adaptive intelligent trilateral localization algorithm[J]. Chinese Journal of Sensors and Actuators,2017,30(7):1089-1094. [25] 王鼎杰,吕汉峰,吴杰. 基于微惯导随机误差时间序列建模的改进组合导航方法[J]. 国防科技大学学报,2016,38(6):64-69. doi: 10.11887/j.cn.201606011WANG Dingjie,LYU Hanfeng,WU Jie. ARMA-based stochastic modeling method for improving the performance of low-cost MIMU/GNSS integration[J]. Journal of National University of Defense Technology,2016,38(6):64-69. doi: 10.11887/j.cn.201606011 -
点击查看大图
图(9) / 表(5)
计量
- 文章访问数: 713
- HTML全文浏览量: 196
- PDF下载量: 89
- 被引次数: 0
