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

Shearer inertial navigation positioning method based on robust adaptive map constraints

  • 摘要: 针对现有采煤机定位方法在井下复杂工况下存在惯导累计误差漂移、固定地图约束存在局部失准及地图边界处约束易突变等问题,提出了一种基于鲁棒自适应地图约束的采煤机惯导定位方法。融合采煤机运动过程中的非完整性约束与前向速度约束,构建速度量测模型;利用液压支架航向角与推移行程信息重建刮板输送机离散点集,建立地图约束测量方程;在卡尔曼滤波框架下引入自适应鲁棒机制,采用新息自适应估计在线调节地图量测噪声协方差,实现地图约束权重自适应分配;引入fade-out地图渐退机制,使地图约束在边界区段或局部失效时平滑减弱并退出更新,避免边界或失效区的滤波振荡。实验结果表明:该方法在连续3刀下均保持了较稳定的定位性能;在部分地图存在误差的条件下,相较于固定地图约束方法,可将推进方向均方根误差(RMSE)由0.816 4 m降至0.084 7 m,圆概率误差(CEP)由0.474 6 m降至0.132 5 m,说明新息自适应估计能够根据地图可信度变化动态调节约束权重,减弱失准地图对定位结果的干扰;在部分地图缺失条件下,相较于无fade-out地图渐退机制的方法,可将推进方向RMSE由0.550 1 m降至0.154 8 m,CEP由0.354 1 m降至0.149 0 m,说明fade-out地图渐退机制能够提高地图约束失效过渡阶段的平滑性与轨迹连续性。

     

    Abstract: Existing shearer positioning methods suffer from cumulative inertial navigation error drift under complex underground operating conditions, and fixed map constraints have problems such as local map inaccuracy and abrupt constraint changes at map boundaries. A shearer inertial navigation positioning method based on robust adaptive map constraints was proposed. The non-holonomic constraint and forward velocity constraint during shearer movement were fused to construct a velocity measurement model. The discrete point set of the scraper conveyor was reconstructed using hydraulic support heading angle and pushing stroke information, and a map constraint measurement equation was established. An adaptive robust mechanism was introduced into the Kalman filtering framework, and innovation adaptive estimation was used to adjust the map measurement noise covariance online to realize adaptive allocation of map constraint weights. A fade-out map gradual withdrawal mechanism was introduced so that map constraints were smoothly weakened and withdrawn from updates in boundary sections or local failure areas, avoiding filtering oscillation in boundary or failure areas. Experimental results showed that the method maintained stable positioning performance during three consecutive cuts. Under conditions with partial map errors, compared with the fixed map constraint method, it reduced the Root Mean Square Error (RMSE) in the advancing direction from 0.816 4 m to 0.084 7 m and the Circular Error Probable (CEP) from 0.474 6 m to 0.132 5 m, indicating that innovation adaptive estimation dynamically adjusted constraint weights according to changes in map credibility and reduced the interference of inaccurate maps on positioning results. Under conditions with partial map loss, compared with the method without the fade-out map gradual withdrawal mechanism, it reduced the advancing-direction RMSE from 0.550 1 m to 0.154 8 m and the CEP from 0.354 1 m to 0.149 0 m, indicating that the fade-out map gradual withdrawal mechanism improved the smoothness and trajectory continuity during transition stage of map constraint failure.

     

/

返回文章
返回