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

摘要

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