目前煤矿井下掘进装备定位方法大多采用机器视觉、里程计、全站仪等单一的辅助测量方式与惯导组合测量来抑制惯导解算随时间所产生的位置累积误差,但是单一的辅助测量方式易受井下环境的影响,位置测量存在一定的误差,从而导致与惯导组合测量方法的精度降低。针对上述问题,以煤矿护盾式掘进机器人系统为研究对象,提出了一种捷联惯导+数字全站仪+位移传感器的组合定位方法。首先采用捷联惯导解算出掘进机器人的位置与姿态角参数;然后利用数字全站仪测量出的掘进机器人的位置信息与位移传感器推算出的掘进机器人的位置信息对捷联惯导解算出的位置信息进行反馈修正,减少惯导随时间所产生的位置累积误差;最后利用基于联邦滤波器的多信息融合算法将捷联惯导解算出的位置及姿态角信息、全站仪测量得到的位置信息及位移传感器推算的位置信息进行融合,从而得到掘进机器人准确的位姿信息。仿真及工业性实验结果表明:该组合定位方法能够很好地抑制纯惯性导航位置解算误差的累积,实现煤矿护盾式掘进机器人的精确定位,X轴和Y轴方向上的位置误差分别控制在±0.03 m和±0.02 m,满足井下掘进工作面要求。
主办单位:煤炭科学研究总院有限公司 中国煤炭学会学术期刊工作委员会