面向地下排水管网的轮式机器人自适应卡尔曼滤波定位算法

Adaptive Kalman Filter Localization Algorithm for Wheeled Robots for Underground Drainage Networks

  • 摘要: 为了提高管道机器人在直径400~600 mm地下管网中的定位精度,融合低成本轮式编码器、光流传感器和六轴惯性测量单元的数据,实现了机器人在缺失全局信息情况下的定位功能,推算出较为精确的机器人行走轨迹。首先,针对管道环境中常出现的轮式机器人打滑问题,加入异常值检测机制,设置异常值判断阈值,对轮式编码器的数据进行修正;其次,引入了田口算法来辅助完成卡尔曼滤波过程噪声协方差矩阵的参数调整,效率是试错法的5倍;另外,针对测量噪声协方差矩阵的调整问题,引入残差、遗忘因子和参数阈值来自适应调整矩阵参数;最后,通过实机平台开展实验,结果表明,改进后的算法能抑制纵滑带来的误差,定位精度是基于扩展卡尔曼滤波的定位算法的3.26倍。

     

    Abstract: To improve the positioning accuracy of pipeline robots in underground pipeline networks with diameters ranging from 400 to 600 mm, data from low-cost wheel encoders, optical flow sensors, and six-axis inertial measurement units are integrated to achieve robot localization in the absence of global information, thereby estimating a more precise trajectory of the robot movement. Firstly, an outlier detection mechanism is introduced to address the common issue of wheel slippage in pipeline environments, and the data from wheel encoders are corrected by setting a threshold for outlier judgment. Secondly,the Taguchi method is employed to assist in adjusting the parameters of the process noise covariance matrix in the Kalman filtering process, achieving an efficiency 5 times that of the trial-and-error method. Additionally, an adaptive parameter adjustment mechanism is implemented by incorporating residuals, a forgetting factor, and parameter thresholds, to tackle the adjustment of the measurement noise covariance matrix. Finally, experiments are conducted on a physical platform.The results demonstrate that the improved algorithm effectively suppresses errors caused by longitudinal slippage, with a positioning accuracy 3.26 times that of the extended Kalman filter-based positioning algorithm.

     

/

返回文章
返回