基于改进双向RRT*的果园机器人运动规划算法
作者:
作者单位:

作者简介:

通讯作者:

中图分类号:

基金项目:

国家自然科学基金项目(32171908)、江苏省现代农机装备与技术示范推广项目(NJ2021-14)、宁夏回族自治区重点研发计划重大项目(2018BBF02020)和江苏高校优势学科项目(PAPD)


Orchard Robot Motion Planning Algorithm Based on Improved Bidirectional RRT*
Author:
Affiliation:

Fund Project:

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

    为提高果园机器人在果园中作业的自主性、安全性和效率,需要进行有效合理的运动规划。针对传统RRT*(Rapidly exploring random tree star)全局路径规划算法在连续走廊式环境下存在搜索效率低、采样点利用率低、生成路径折线多转角大等问题,以阿克曼底盘果园喷雾机器人为运动模型,提出一种改进双向RRT*的果园喷雾机器人运动规划算法。首先,根据激光雷达建立果园二维平面地图,将果树和障碍物均视为障碍物区域,并结合喷雾机器人本体尺寸,对障碍物进行膨胀化处理;然后,通过改进双向RRT*算法搜索路径,搜索路径过程中结合动态末梢节点导向和势场导向进行偏置采样,并对初步生成的路径进行路径点去冗余以及相邻折线段转角约束处理;最后,采用三阶准均匀B样条曲线对处理后的路径点进行轨迹优化,在优化过程中主要考虑轨迹的碰撞检测和喷雾机器人底盘曲率约束。试验结果表明,相较于传统双向RRT*算法,本文所提出的改进算法规划时间平均减少57.5%,采样点利用率平均提高28.55个百分点,最终路径长度平均缩短7.14%;经三阶准均匀B样条曲线优化后所得轨迹在有、无障碍物两种环境下均满足喷雾机器人最大曲率约束,且仅在换行以及障碍物处存在转弯行为,符合喷雾机器人作业轨迹条件,提高了喷雾机器人的工作效率和自主性。

    Abstract:

    In order to improve the autonomy, safety and efficiency of agricultural robots in orchards, effective and reasonable motion planning methods are essential. Aiming at the problems of the traditional RRT* (rapidly exploring random tree star) global path planning algorithm in the continuous corridor environment, such as low search efficiency, low utilization of sampling points, and large corners of the generated path. The Ackerman chassis spray robot was used as the motion model, and an improved bidirectional RRT* algorithm was proposed. Firstly, a two-dimensional plane map of the orchard was established based on lidar, and the fruit trees and obstacles were regarded as obstacle areas. The obstacles were expanded with the kinematic constraints of the spray robot. Then, the improved bidirectional RRT* algorithm was used to search the path. In the process of searching the path, the dynamic terminal node guidance and potential field guidance were combined to conduct bias sampling, and the paths generated initially were de-redundant and adjacent broken line segment angle constraint processing. Finally, the third-order quasi-uniform B-spline curve was used to optimize the trajectory of the processed path points, and the collision detection and the curvature constraint of the spray robot were mainly considered in the optimization process. Experimental results showed that compared with the traditional bidirectional RRT* algorithm, the proposed improved algorithm reduced the planning time by 57.5% on average, improved the sampling point utilization by 28.55 percentage points on average, and shorted the final path by 7.14% on average. The trajectory obtained by the third-order quasi-uniform B-spline curve optimization satisfied the maximum curvature constraint of the spray robot in both environments with and without obstacles, and only turns occurred at line breaks and obstacles, which conformed to the operating trajectory conditions of the spray robot, and improved the work efficiency and autonomy of the spray robot.

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

刘慧,张世义,段云鹏,贾卫东,沈跃.基于改进双向RRT*的果园机器人运动规划算法[J].农业机械学报,2022,53(11):31-39.

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