基于鲁棒自适应地图约束的采煤机惯导定位方法

Shearer Inertial Navigation Positioning Method Based on Robust Adaptive Map Constraints

  • 摘要: 针对采煤机定位系统在井下复杂工况下存在的惯导累计误差漂移、固定地图约束存在局部失准以及地图边界处约束易突变等问题,提出一种基于鲁棒自适应地图约束的采煤机惯导/里程计组合导航方法。融合采煤机运动过程中的非完整性约束与前向速度约束,构建组合导航系统的速度测量模型;利用液压支架航向角与推移行程信息重建刮板输送机离散点集,建立刮板曲线地图模型与地图约束测量方程;采用新息自适应估计在线调节地图量测噪声协方差,实现地图约束权重自适应分配;引入fade-out渐退机制,使地图约束在边界区段或局部失效时平滑减弱并退出更新。依托智能综采实验平台开展连续三刀对比实验,并与固定地图约束方法和自适应地图约束等方法进行比较。结果表明,本文方法在连续三刀工况下均保持较稳定的定位精度;与无自适应地图约束方法相比,Y轴RMSE由0.8164 m降至0.0847 m,降低 89.6%,CEP由0.4746 m降至0.1325 m,降低 72.1%。结果说明,所提方法能够降低采煤机惯导累计误差,并改善地图边界及局部失准条件下的定位连续性与稳定性问题。

     

    Abstract: To address the problems of accumulated drift in inertial navigation, local mismatch of fixed map constraints, and abrupt constraint variations at map boundaries in shearer positioning systems under complex underground working conditions, a robust adaptive map-constrained INS/odometer integrated navigation method is proposed. Non-holonomic constraints and forward velocity constraints during shearer motion are incorporated to construct the velocity measurement model of the integrated navigation system. The discrete point set of the scraper conveyor is reconstructed from the heading angles and advancing strokes of hydraulic supports, on the basis of which the scraper-curve map model and the map-constrained measurement equation are established. Innovation-based adaptive estimation is employed to online adjust the covariance of map measurement noise, enabling adaptive allocation of map-constraint weights. In addition, a fade-out mechanism is introduced to ensure that map constraints are smoothly weakened and withdrawn from the update process in boundary sections or locally invalid regions. Comparative experiments involving three consecutive cutting cycles were carried out on an intelligent fully mechanized mining experimental platform, and the proposed method was compared with fixed map-constrained and adaptive map-constrained methods. The results show that the proposed method maintains relatively stable positioning accuracy over the three consecutive cutting cycles. Compared with the method without adaptive map constraints, the Y-axis RMSE decreases from 0.8164 m to 0.0847 m, corresponding to a reduction of 89.6%, while the CEP decreases from 0.4746 m to 0.1325 m, corresponding to a reduction of 72.1%. These results indicate that the proposed method can effectively reduce the accumulated inertial navigation error of the shearer and improve positioning continuity and stability under conditions of map boundary transitions and local map mismatch.

     

/

返回文章
返回