基于因子图优化的船舶作业车间履带式打磨机器人定位算法

    Factor Graph Optimization-based Localization Algorithm for Tracked Sanding Robots in Marine Job Shops

    • 摘要: 针对船舶分段打磨作业环境下,存在自然环境特征缺乏、动态变化及基于反光柱的传统三边定位算法对反光柱数量依赖等问题,引入激光雷达、惯性测量单元(Inertial Measurement Unit, IMU)、里程计等传感器,提出一种融合多源传感器数据的改进定位算法。该算法融合三边定位与迭代最近点(Iterative Closest Point, ICP)算法进行点云匹配以定位,并引入因子图优化框架,实现多源数据融合。搭建实验平台开展定位试验,静态X/Y/航向定位误差分别达到12.876 mm、4.273 mm和0.0003 rad,动态复杂条件下X/Y/航向定位误差分别达到33.364 mm、16.95 mm和0.0263 rad,精度与鲁棒性均优于传统方法。试验结果表明,本文所提出的定位算法在静态X/Y/航向定位误差相较于三边定位及卡尔曼滤波降低5.1%,动态复杂条件下X/Y/航向定位误差降低14.5%。

       

      Abstract: Aiming at the problems of dynamic environmental changes, a lack of natural environmental characteristics, and the dependence on the number of reflector columns of the traditional trilateral localization algorithm based on reflective columns under the ship segmentation operation environment, an improved positioning strategy by introducing sensors such as Light Detection and Ranging, Inertial Measurement Unit (IMU), and odometer, and fusing multi-source sensor data is proposed. The algorithm fuses trilateral positioning with the iterative closest point (ICP) algorithm for point cloud matching for positioning and introduces a factor graph optimization framework to achieve multi-source data fusion. The experimental platform is built to carry out the localization test, and the static X/Y/heading localization error reaches 12.876 mm, 4.273 mm and 0.0003 rad respectively, and the X/Y/heading localization error under dynamic and complex conditions reaches 33.364 mm, 16.95 mm and 0.0263 rad respectively, which is better than the traditional method in terms of accuracy and robustness. The experimental results show that the proposed localization strategy reduces the static X/Y/heading localization error by more than 5.1% compared with the traditional trilateral localization and Kalman filtering, and reduces the dynamic complex X/Y/heading localization error by more than 14.5%.

       

    /

    返回文章
    返回