高级检索

露天矿无人矿卡“RTK+INS+里程计”融合定位方法

Fusion positioning method of “RTK+INS+Odometer” in unmanned mining trucks in open-pit mines

  • 摘要: 针对露天矿无人矿卡在深凹矿坑中存在GPS信号衰减、多路径效应及通信中断导致载波相位差分观测的实时差分定位技术(RTK)定位不准,以及惯导(INS)与里程计融合定位受轮胎打滑与惯导位姿检测误差随时间累积导致定位不准的问题,提出了一种基于变分贝叶斯优化的Sage-Husa扩展卡尔曼滤波(VB-AEKF)的“RTK+INS+里程计”融合定位方法。针对位置精确检测问题,提出了RTK全局定位与INS+里程计局部定位相结合的融合定位方案,通过VB-AEKF算法实时估计并优化过程与量测噪声协方差,克服系统模型不确定性及噪声时变特性对定位的影响,借助INS与里程计融合修正RTK失稳,显著提升了位置检测的稳定性和准确性。针对矿卡在崎岖振动路面下轮胎打滑和惯导姿态角误差累积问题,提出基于位移信息构建伪姿态角约束的方法,有效抑制了姿态角漂移。搭建无人矿卡多传感器融合定位平台并开展露天矿环境模拟试验,结果表明:该方法在RTK信号受遮挡时东、北、天三向最大定位误差为0.570 7、0.554 3、0.364 7 m,较单一RTK定位分别降低了0.222 1、0.146 5、0.216 2 m,降幅为28.01%、20.90%和37.22%;无遮挡转弯时东、北、天三向最大定位误差为0.008 1、0.009 7、0.018 6 m,相对单一RTK分别降低了0.002 1、0.004 8、0.006 7 m,降幅为8.3%、20.69%和19.14%。在崎岖转弯路段,MEMS惯导的姿态角最大误差为0.312 1°,相较于未引入约束时的0.425 3°,误差降低约20%,显著提升了系统在复杂动态环境下的定位精度和稳定性。

     

    Abstract: To address the positioning inaccuracies of Real-Time Kinematic (RTK) technology caused by GPS signal attenuation, multipath, and communication interruptions in deep open-pit mines for unmanned mining trucks, as well as the errors in integrated inertial navigation system (INS) and odometer positioning resulting from tire slippage and the accumulation of INS pose detection deviations over time, proposes a “RTK+INS+Odometer” fusion positioning method based on Variational Bayesian-optimized Sage-Husa Adaptive Extended Kalman Filter (VB-AEKF). For precise position detection, a fusion positioning scheme combining RTK global positioning with INS+odometer local positioning is introduced, where the VB-AEKF algorithm estimates and optimizes process and measurement noise covariances in real time to mitigate the impact of system model uncertainties and time-varying noise characteristics on positioning. By integrating INS and odometer data to correct RTK instability, the stability and accuracy of position detection are significantly enhanced. To counteract tire slippage on rugged, vibrating terrain and the accumulation of INS attitude angle errors, a method constructing pseudo attitude angle constraints from displacement information is proposed, effectively suppressing attitude angle drift. A multi-sensor fusion positioning platform for unmanned mining trucks was established, and simulated open-pit mine environment experiments demonstrated that when the RTK signal is obstructed, the maximum positioning errors in the East, North, and Up directions are 0.570 7 m, 0.554 3 m, and 0.364 7 m, respectively, representing reductions of 0.222 1 m, 0.146 5 m, and 0.216 2 m compared to standalone RTK, with decrease rates of 28.01%, 20.90%, and 37.22%. During unblocked turning, the maximum positioning errors in the East, North, and Up directions are 0.008 1 m, 0.009 7 m, and 0.018 6 m, reduced by 0.002 1 m, 0.004 8 m, and 0.006 7 m relative to standalone RTK, corresponding to decrease rates of 8.3%, 20.69%, and 19.14%. On rugged turning sections, the maximum attitude angle error of the MEMS-based INS is 0.312 1°, which is reduced by approximately 20% compared to the error of 0.425 3° without constraints, significantly improving the system's positioning accuracy and stability in complex dynamic environments.

     

/

返回文章
返回