基于鲁棒改进EKF的爬壁机器人外部定位系统

    External Localization for Wall-climbing Robots with an Improved Robust EKF

    • 摘要: 针对当前爬壁机器人定位技术研究存在定位精度不足、环境适应性弱的问题,提出一种基于云台激光追踪的外部定位系统。该系统利用变焦相机追踪AprilTag码控制两轴云台运动,结合激光测距仪数据融合解算机器人的三维坐标。为解决动态追踪过程中因激光光斑短暂偏离码标产生的非高斯离群噪声问题,提出一种基于Sigmoid函数的平滑鲁棒扩展卡尔曼滤波(SREKF)算法。该算法利用观测新息的马氏距离构造Sigmoid加权因子,通过自适应调整观测噪声协方差矩阵来平滑抑制离群值干扰。实验结果表明,该系统在6 m×2.5 m的钢构表面上实现了稳定定位。相比于标准扩展卡尔曼滤波(EKF)和Huber鲁棒滤波(HREKF),SREKF算法在复杂运动模式下的定位精度显著提升,位置均方根误差(RMSE)分别降低了1.40 cm和0.38 cm,总体RMSE优于0.02 m,最大定位误差小于0.08 m。研究结果表明,该方法有效抑制离群噪声对定位精度的干扰,提高了系统定位精度,为大型钢结构环境下的机器人作业提供了高可靠性的位置基准。

       

      Abstract: To address the challenges of insufficient positioning accuracy and weak environmental adaptability in current wall-climbing robot localization, an external positioning system based on pan-tilt laser tracking is proposed. This system utilizes a zoom camera to track AprilTags for controlling the motion of a two-axis pan-tilt mechanism and fuses data from a laser rangefinder to calculate the three-dimensional coordinates of the robot. To address the issue of non-Gaussian outlier noise caused by the temporary deviation of the laser spot from the marker during dynamic tracking, a smooth robust extended Kalman filter (SREKF) algorithm based on the Sigmoid function is proposed. This algorithm constructs a Sigmoid weighting factor using the Mahalanobis distance of the observation innovation to adaptively adjust the observation noise covariance matrix, thereby smoothly suppressing outlier interference. Experimental results demonstrate that the system achieves stable localization on a 6m×2.5m steel structure surface. Compared with the standard extended Kalman filter (EKF) and Huber robust extended Kalman filter (HREKF), the positioning accuracy of the SREKF algorithm in complex motion modes is significantly improved, with the root mean square error (RMSE) reduced by 1.40 cm and 0.38 cm, respectively. The overall RMSE is better than 0.02 m, and the maximum positioning error is less than 0.08 m. The results indicate that this method effectively suppresses the interference of outlier noise on localization accuracy and improves system precision, providing a highly reliable position reference for robot operations in large-scale steel structure environments.

       

    /

    返回文章
    返回