基于改进卡尔曼滤波和参数拟合的矿井TOA定位方法

MTOA positioning method of coalmine based on Kalman filter and parameter fitting

  • 摘要: 针对矿井TOA(Time of Arrival)定位精度易受电磁波NLOS(Non Line of Sight)传播时延的影响,且不能满足井下应急救援、人员作业管理以及矿井物联网建设等需求的问题,通过对NLOS时延参考模型和矿井巷道设备运动特点的分析,将巷道电磁波NLOS传播时延分为随机NLOS时延和固定NLOS时延,结合两类NLOS时延造成测距误差的特点,提出了基于改进卡尔曼滤波和参数拟合的矿井TOA定位方法。为了消除由矿井巷道中机车等移动设备以及不规律设置设备引起的、具有随机性和难以定量分析等特点的巷道随机NLOS时延误差,设计了将新息阈值引入卡尔曼滤波器中,提高其系统对脉冲误差的滤除能力的方法;为了抑制由矿井巷道中固定设施及设备造成的具有稳定性的巷道固定NLOS时延误差,建立了巷道测距误差模型,构建了井下固有设备参数与定位估计值间的函数关系,通过参数拟合与投影几何算法来提高系统的定位精度。仿真结果显示,测量数据经过基于新息阈值的卡尔曼滤波器处理之后,误差曲线趋于平稳,定位误差保持在1.9~3.1 m,再经参数拟合和几何算法处理后,定位误差在0~0.8 m,平均误差由2.4 m降为0.3 m;且相比于SDS-TWR(Symmetric Double-sided Two-way Ranging)方法、卡尔曼滤波和指纹定位方法以及卡尔曼滤波和参数拟合方法,所提方法平均定位误差分别减小了3.4,0.4和0.6 m。从而表明所提方法对TOA定位误差具有较明显的抑制作用,可以实现TOA方法在矿井NLOS环境中的有效应用。

     

    Abstract: The problem that the positioning accuracy of time of arrival (TOA) positioning method is susceptible to the delay of the non line of sight (NLOS) in propagation makes it difficult to meet the requirements of underground emer- gency rescue,personnel operation management and mine IoT (Internet of things) construction,etc. Based on the anal- ysis of the reference model and the characteristics of the mine roadway equipment,the NLOS propagation delay of the roadway electromagnetic wave is divided into random NLOS delay and fixed NLOS delay. Combined with the character- istics of two kinds of NLOS delays,a method of mine TOA positioning based on improved Kalman filter and parameter fitting is proposed. In order to eliminate the random NLOS delay error in roadway caused by mobile equipment,such as locomotives in mine roadway,and irregular equipment and features by randomness and difficulty in quantitative analysis,a new threshold is designed and introduced into the Kalman filter to improve the system's ability in filtering the pulse error. Meanwhile,in order to suppress the stable NLOS delay error caused by the fixed facilities and equipment in the mine roadway,the roadway range finding error model is proposed,in which the functional relationship between the inherent equipment parameters and the positioning estimated value is established. Thus,the positioning accuracy of the system can be improved by using the parameter fitting and projection geometry algorithm. The simulation results show that after the measurement data is processed by the Kalman filter based on the threshold of innovation,the error curve tends to be smoother,and the positioning error is kept between 1. 9 and 3. 1 m. After being processed by the pa- rameter fitting and geometric algorithm,the positioning error is between 0 and 0. 8 m,and the average error is reduced from 2. 4 m to 0. 3 m. Compared with the other three methods,including the symmetric double-sided two-way ranging (SDS-TWR) method,the Kalman filter and fingerprint localization method,and the Kalman filter and parameter simu- lation,the average positioning error of the proposed method is reduced by 3. 4 m,0. 4 m and 0. 6 m respectively. It shows that the proposed method has a significant inhibitory effect on the TOA positioning error,and can effectively im- plement the TOA method in the mine NLOS environment.

     

/

返回文章
返回
Baidu
map