煤矿井下连续采煤机定位方法研究

Research on the positioning method of continuous shearer in coal mines

  • 摘要: 目前井下采掘装备定位方法大多采用惯导加里程计、视觉测量、测距雷达等辅助测量方式来降低惯导随时间累积所产生的位置漂移误差,但这些方法对辅助测量方式的可靠性与测量精度要求较高,且采用集中式卡尔曼滤波对数据进行滤波解算,存在计算量较大、容错性较差等问题。针对上述问题,提出了一种由捷联式惯导、测距雷达及里程计组成的连续采煤机定位方法,使用测距雷达与里程计分别测量连续采煤机的位移量,通过航位推算法推算得出机身的二维位置信息,利用二维位置信息对惯导位置解算信息进行反馈修正,减少惯导随时间累积所产生的位置漂移误差。采用联邦式卡尔曼滤波对各传感器推算得出的位置信息进行滤波解算及数据融合,通过降低方程维数减少计算量,在保证测量精度的同时还具备一定的容错性。仿真实验结果表明,该定位方法的定位精度可达±2 cm,定向精度可达15′,联邦式卡尔曼滤波算法计算量小且具备一定容错性,可为连续采煤机在巷道约束环境下的位姿精确测量、巷道自动成形控制和远程控制奠定基础。

     

    Abstract: At present, most of the underground mining equipment positioning methods use inertial navigation plus odometer, visual measurement, ranging radar and other auxiliary measurement methods to reduce the position error drift accumulated by inertial navigation over time. However, these methods requires high reliability and measurement accuracy of the auxiliary measurement methods, and the centralized Kalman filter is used to filter and solve the data. There are problems such as a large amount of calculation and poor fault tolerance. In order to solve the above problems, a continuous shearer positioning method consisting of strapdown inertial navigation, ranging radar and odometer is proposed, using the ranging radar and odometer to measure the displacement of the continuous shearer respectively. The dead reckoning method is used to calculate the two-dimensional position information of the machine body, and the two-dimensional position information is applied to correct the inertial navigation position solution information so as to reduce the position drift error accumulated by inertial navigation over time. The federated Kalman filter is used to filter, solve and fuse the position information derived from each sensor, and reduce the calculation amount by reducing the dimension of the equation. Therefore, this method ensures the measurement accuracy while having a certain degree of fault tolerance. The simulation results show that the positioning accuracy of this positioning method can reach ±2 cm, and the orientation accuracy can reach 15′. The federated Kalman filter algorithm has small calculation amount and certain fault tolerance, which can lay the foundation for accurate measurement of the position of the continuous shearer in the roadway constrained environment, automatic roadway forming control and remote control.

     

/

返回文章
返回