巷道掘进机多传感融合定位系统及试验研究

煤矿巷道掘进机的自主精确定位是煤矿掘进智能化发展的基础,而复杂的掘进工艺和恶劣的掘进环境使得掘进机定位存在自主性不足、精度低以及易受环境干扰等问题.为实现巷道掘进机自主精确定位,首先,基于扩展卡尔曼滤波构建了里程计辅助惯性定位系统以约束惯性定位的误差发散;其次,结合掘进机施工工艺提出柔性零速校正方法,进一步提升掘进机惯性定位精度;然后,基于误差状态卡尔曼滤波和多状态约束模型实现了惯性、视觉和里程定位的高效融合;最后,搭建了掘进机在暗环境下自主定位的样机试验系统.实验结果表明:所提柔性零速校正方法可以提升掘进机定位精度约21.64％;所提掘进机多传感融合定位系统三轴定位误差分别可达到横向0.13 m以内、前向0.17 m以内、天向0.02 m以内,相比独立惯性和视觉系统的定位精度分别提升49.62％和57.71％.实验结果验证了所提方法与系统的可行性与有效性,满足煤矿规程中巷道掘进机定位需求.