基于ESKF与改进IMM算法的煤矿无人驾驶车辆井上−井下无缝定位

Seamless aboveground-underground positioning for coal mine driverless vehicles based on ESKF and improved IMM algorithm

  • 摘要: 随着我国煤矿智能化建设的不断推进,矿井辅助运输车辆向无人驾驶的方向发展已成为必然趋势。定位系统作为无人驾驶车辆的核心单元,单一定位方式及传统定位算法均难以满足煤矿辅运车辆从地面料场−斜井巷道−井下巷道−采掘工作面的全流程、高精度、低时延定位要求。首先,根据煤矿辅运车辆的运行工况及巷道环境,设计了一种基于GNSS/UWB融合IMU的井上−井下无缝定位系统,提出采用模型切换延时(Model Switching Delay,DMS)作为无缝定位系统的性能评价指标;其次,针对UWB定位过程中的非视距(NLOS)误差问题,设计了UWB/IMU紧组合井下定位算法,并使用误差状态卡尔曼滤波(ESKF)对其进行滤波优化,仿真结果表明:ESKF优化算法平均定位误差为0.19 m,精度相较于单一UWB定位提高了56%;再次,分析了交互式多模型的影响因素,针对模型概率矩阵误差大影响无缝定位精度的问题,设计了一种基于ESKF与模糊自适应改进交互式多模型(FAIMM-ESKF)的矿井无缝定位算法,仿真结果表明:FAIMM-ESKF算法的定位精度比改进前提高了29%;最后,在实验室搭建模拟斜井巷道,利用无人驾驶试验车开展了无缝定位系统的定位与评估试验,结果表明:无缝定位系统在井上−井下交互区域的平均误差为0.131 m、最大误差为0.452 m,相较于传统算法分别降低了17.6%与14.8%;在整个试验过程中,FAIMM-ESKF算法的最大误差为0.498 m,平均误差为0.25 m,模型切换延时均值为35 ms,可满足煤矿辅运车辆全流程无人驾驶的定位精度与时延要求。研究结果可为推动建立煤矿井上−井下无缝衔接、精确高效的定位系统及定位算法提供理论参考,对于加快实现煤矿辅运车辆常态化无人驾驶、加速推进煤矿智能化建设具有重要理论意义和实用价值。

     

    Abstract: With the continuous promotion of intelligent construction in coal mines in China, the development of mine auxiliary transportation vehicles towards unmanned driving has become an inevitable trend. As the core unit of unmanned vehicles, the positioning system cannot meet the full process, high-precision, and low time delay positioning requirements of coal mine auxiliary transportation vehicles from the ground fabric field, inclined shaft roadway, underground roadway, to mining face with a single positioning method and traditional positioning algorithms. Firstly, based on the operating conditions of coal mine auxiliary transportation vehicles and the tunnel environment, a seamless positioning system for underground and above mines based on GNSS/UWB fusion IMU was designed, and a model switching delay (DMS) was proposed as the performance evaluation index for the seamless positioning system; Secondly, to address the issue of non line of sight (NLOS) errors in UWB positioning, a UWB/IMU tight combination downhole positioning algorithm was designed, and Error State Kalman Filter (ESKF) was used to filter and optimize it. Simulation results showed that the ESKF optimization algorithm had an average positioning error of 0.19 m, with an accuracy improvement of 56% compared to single UWB positioning; Once again, the influencing factors of interactive multiple models were analyzed. In response to the problem of large model probability matrix errors affecting seamless positioning accuracy, a mine seamless positioning algorithm based on ESKF and fuzzy adaptive improved interactive multiple models (FAIMM-ESKF) was designed. Simulation results showed that the positioning accuracy of the FAIMM-ESKF algorithm was improved by 29% compared to before improvement; Finally, a simulated inclined shaft tunnel was constructed in the laboratory, and a seamless positioning system positioning and evaluation experiment was conducted using an unmanned test vehicle. The results showed that the average error of the seamless positioning system in the interaction area between the well and the underground was 0.131 m, and the maximum error was 0.452 m, which was reduced by 17.6% and 14.8% compared to traditional algorithms, respectively; Throughout the entire experimental process, the maximum error of the FAIMM-ESKF algorithm was 0.498 m, the average error was 0.25 m, and the average model switching delay was 35 ms, which can meet the positioning accuracy and delay requirements of unmanned driving in the entire process of coal mine auxiliary transportation vehicles. The research results can provide theoretical reference for promoting the establishment of a seamless connection, precise and efficient positioning system and positioning algorithm for coal mines, and have important theoretical significance and practical value for accelerating the normalization of unmanned driving of auxiliary transportation vehicles in coal mines and accelerating the intelligent construction of coal mines.

     

/

返回文章
返回