基于改进ORB-SLAM2的果园喷药机器人定位与稠密建图算法
作者:
作者单位:

作者简介:

通讯作者:

中图分类号:

基金项目:

中央引导地方科技发展专项资金项目(桂科ZY19183003)和广西重点研发计划项目(桂科AB20058001)


Localization and Dense Mapping Algorithm for Orchard Spraying Robot Based on Improved ORB-SLAM2
Author:
Affiliation:

Fund Project:

  • 摘要
  • |
  • 图/表
  • |
  • 访问统计
  • |
  • 参考文献
  • |
  • 相似文献
  • |
  • 引证文献
  • |
  • 资源附件
  • |
  • 文章评论
    摘要:

    针对果园喷药机器人视觉导航过程中定位精度低、地图构建效果差等问题,本文提出一种新的视觉定位与稠密建图算法。该算法基于ORB-SLAM2算法架构,首先,通过优化FAST角点、描述子阈值,并采取图像金字塔法与高斯滤波算法,剔除劣质ORB特征点,以提升图像关键帧质量和特征匹配精度。其次,引入稠密建图线程,利用点云恢复算法、统计滤波方法形成点云队列,采取点云拼接技术与体素滤波算法输出稠密点云地图,并在ORB-SLAM2算法的ROS节点中增加关键帧输出接口与位姿发布话题,通过NeedNewKeyFrame函数选取ORB-SLAM2算法所生成的关键帧,减少系统计算量。最终,由RGB-D相机实现果园喷药机器人的精准定位与稠密建图。为验证本文算法的有效性与实用性,进行TUM数据集仿真分析与真实场景测试,结果表明:相较ORB-SLAM2算法,本文算法的绝对轨迹平均误差降低44.01%、相对轨迹平均误差降低7.93%,ORB特征点匹配数量平均提升19.03%,定位精度与运行轨迹效果均有显著提升,此外,还能获取较高精度的果园喷药机器人工作场景信息。本文算法可为果园喷药机器人的自主导航提供理论基础。

    Abstract:

    In view of low localization accuracy and poor map construction during the visual navigation for orchard spraying robot, a visual localization and dense mapping algorithm was proposed. The algorithm was based on the ORB-SLAM2 algorithm architecture, firstly, through the optimization of FAST corner points, descriptor thresholds, and adopting the image pyramid method and Gaussian filtering algorithm, poor quality ORB feature points were eliminated to improve the image key frame quality and feature matching accuracy. Secondly, the dense map building thread was introduced, the point cloud recovery algorithm and statistical filtering method were used to form the point cloud queue, the point cloud stitching technology and voxel filtering algorithm were adopted to output the dense point cloud maps, and the key frame output interface and position publishing topic were added in the ROS node of ORB-SLAM2 algorithm, and then the key frame generated by ORB-SLAM2 algorithm was selected through the NeedNewKeyFrame function to reduce the system computation. Finally, the RGB-D camera was used to realize the precise positioning and dense mapping of the orchard spraying robot. In order to verify the effectiveness and practicality of the algorithm, simulation analysis of TUM dataset and real scenario testing were conducted. The results showed that compared with that of ORB-SLAM2 algorithm, the absolute trajectory average error of this algorithm was reduced by 44.01%, the relative trajectory average error was reduced by 7.93%, the average number of ORB feature point matching was increased by 19.03%, and the positioning accuracy and running trajectory effect were improved significantly. In addition, the working scene information of orchard spraying robot can be obtained with high accuracy. The algorithm can provide a theoretical basis for the autonomous navigation of orchard spraying robot.

    参考文献
    相似文献
    引证文献
引用本文

丛佩超,崔利营,万现全,李佳星,刘俊杰,张欣.基于改进ORB-SLAM2的果园喷药机器人定位与稠密建图算法[J].农业机械学报,2023,54(7):45-55. CONG Peichao, CUI Liying, WAN Xianquan, LI Jiaxing, LIU Junjie, ZHANG Xin. Localization and Dense Mapping Algorithm for Orchard Spraying Robot Based on Improved ORB-SLAM2[J]. Transactions of the Chinese Society for Agricultural Machinery,2023,54(7):45-55.

复制
分享
文章指标
  • 点击次数:
  • 下载次数:
  • HTML阅读次数:
  • 引用次数:
历史
  • 收稿日期:2022-11-02
  • 最后修改日期:
  • 录用日期:
  • 在线发布日期: 2023-07-10
  • 出版日期: