果园机器人LiDAR/IMU紧耦合实时定位与建图方法
作者:
作者单位:

作者简介:

通讯作者:

中图分类号:

基金项目:

国家自然科学基金项目(32171908)


Real-time Localization and Mapping Method for Agricultural Robot in Orchards Based on LiDAR/IMU Tight-coupling
Author:
Affiliation:

Fund Project:

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

    针对果园环境中GNSS定位信号易丢失和传统SLAM算法鲁棒性较差的问题,本文提出一种基于LiDAR/IMU紧耦合框架的全局无偏状态估计果园机器人定位与建图方法。LiDAR/IMU紧耦合框架基于因子图进行多源约束的IMU里程计构建,实时输出高频位姿信息,IMU里程计因子和预积分因子优化LiDAR里程计并提供位姿先验约束IMU零偏。引入局部点云地图参与特征点云粗匹配和非特征点云递进式匹配进一步稠密化源点云,改善LiDAR里程计的性能。融合GPS信号与LiDAR/IMU紧耦合框架的地图构建,能够得到准确且高频连续的位姿信息,提高点云地图的复用率。在果园和苗木等场景验证了该算法的性能,实验结果表明,与LIO-SAM等算法相比,定位精度维持在0.05m左右,均方根误差为0.0162m。本文算法使机器人具有更高的精度、实时性和鲁棒性,有效降低了系统累积误差,保证了所构建地图的全局一致性。

    Abstract:

    Aiming at the problems of easy loss of GNSS positioning signals and poor robustness of traditional SLAM algorithms in forest and orchard environments, the problems of easy loss of GNSS positioning signals and poor robustness of traditional SLAM algorithms in forest and orchard environments was addressed. The proposed method was based on the factor graph for multi-source constrained IMU odometry construction, real-time output of high-frequency position information. The IMU odometry factors and pre-integration factors were used to optimize LiDAR odometry and provide a priori constraints on IMU bias. The LiDAR odometry was optimized by the odometry factor and pre-integration factor, which provided a priori constraints on the IMU bias of the position. The local point cloud map was introduced to participate in feature point cloud coarse matching and non-feature point cloud progressive matching to further densify the source point cloud and improve the performance of the LiDAR odometer. The map construction by fusing GPS signals with LiDAR/IMU tightly coupled framework can obtain accurate and high-frequency continuous position information and improve the reuse rate of point cloud maps. The experimental results showed that the positioning accuracy was maintained at around 0.05m and the root mean square error was 0.0162m compared with algorithms such as LIO-SAM. The algorithm presented enabled the robot to achieve higher accuracy, real-time performance and robustness, effectively reducing the cumulative error of the system and ensuring the global consistency of the constructed maps.

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

沈跃,肖鑫桦,刘慧,张璇.果园机器人LiDAR/IMU紧耦合实时定位与建图方法[J].农业机械学报,2023,54(11):20-28,48. SHEN Yue, XIAO Xinhua, LIU Hui, ZHANG Xuan. Real-time Localization and Mapping Method for Agricultural Robot in Orchards Based on LiDAR/IMU Tight-coupling[J]. Transactions of the Chinese Society for Agricultural Machinery,2023,54(11):20-28,48.

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