酿酒葡萄收获机自动对行驾驶局部路径动态规划算法
CSTR:
作者:
作者单位:

作者简介:

通讯作者:

中图分类号:

基金项目:

国家重点研发计划项目(2022YFD2002001)、智能农业动力装备全国重点实验室开放课题(SKLIAPE2023012)、芜湖市科技特派员专项(311222447023)


Local Path Dynamic Programming Algorithm for Automatic Row Alignment Traveling of Wine Grape Harvester
Author:
Affiliation:

Fund Project:

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

    葡萄精准对行采收可有效减少收获机振动机构与篱架碰撞几率,是实现大规模机械化采收的重要手段。基于Frenet坐标系下行间局部行驶场景模型,本文提出一种葡萄收获机自动对行路径规划算法。以全局作业路径为参考线,通过车载激光雷达实时识别前方葡萄行,利用K-means算法聚类葡萄点云;采用Lattice算法根据行驶车速对前方行驶区域动态点阵采样,基于五次多项式生成局部路径簇;以前、后轮转向极限位置为收获机轮廓特征点,进行特征点与横向条带分割的葡萄行最小包络矩形碰撞检测,并计算各条局部路径相对葡萄行和参考线的偏离代价;根据作业工况和环境条件确定葡萄行偏离参考线的决策限值,采用动态规划算法对加权求和后的偏离代价进行寻优,获得路径簇中代价最小路径作为当前局部路径;利用机器人仿真软件Gazebo和Rviz联合仿真并开展实车试验。结果表明,规划的局部路径相对葡萄行平均横向偏差为4.37cm,最大横向偏差为10.95cm,生成局部路径平均绝对曲率为0.0612m-1,最大绝对曲率为0.2011m-1。在全局路径相对葡萄行偏移较大时,局部路径能够有效纠正偏差,满足葡萄收获作业对行驾驶要求。在单次规划6m路径的仿真试验中,本文算法平均耗时213ms/次,最大耗时337ms/次;规划6m路径实车试验中,本文算法平均耗时577ms/次,最大耗时816ms/次。研究结果可为葡萄园场景下农机局部路径规划提供参考。

    Abstract:

    Accurate row alignment harvesting of grapes can effectively reduce the collision between vibration mechanism of the harvester and the trellis, which is an important means to achieve large-scale mechanized harvesting. Based on the local driving scene model between grape rows in Frenet coordinate system, an automatic row alignment path planning algorithm for grape harvesters was proposed. Using the global operation path as a reference line, the algorithm utilized onboard LiDAR to identify grape rows ahead in real time, and applied the K-means algorithm to cluster the point cloud of grape rows. The Lattice algorithm was used to dynamically sample the driving area ahead according to the traveling speed, and then the local path clusters were generated based on fifth-order polynomials. The extreme steering positions of the front and rear wheels were taken as the feature points of the harvester, and then the collision detections were conducted between feature points and the lateral segmentation minimum bounding rectangle of grape rows, and the offset costs of each local path relative to grape rows and the global path were calculated. Based on the operating states and environment condition, the decision limits of the grape line deviating from the reference line were determined, and the weighted sum of the offset costs were optimized by dynamic programming algorithm, and then the path with the minimum cost in the path cluster can be obtained as the current local path. The algorithm was validated through simulation by using the robot simulation software Gazebo and Rviz, as well as real experimental tests. The results showed that the average lateral error of the planned local path relative to grape rows was 4.37 cm, and the maximum absolute curvature was 0.201 1 m-1. When the global path deviated significantly from the grape row, the local path can effectively correct the deviation and meet the driving requirements for grape harvesting operations. In the simulation test for planning a path of 6 m, the average processing time of this algorithm was 213 ms per iteration, with a maximum of 337 ms per iteration. In the experimental test for planning a path of 6 m, the average processing time was 577 ms per iteration, with a maximum of 816 ms per iteration. The relevant research methods can provide reference for local path planning of agricultural machinery in vineyard scenarios.

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

戴祯,郭延超,王笑乐,张志宁,戴宝宝,杨洋,张铁,陈黎卿.酿酒葡萄收获机自动对行驾驶局部路径动态规划算法[J].农业机械学报,2025,56(2):124-135. DAI Zhen, GUO Yanchao, WANG Xiaole, ZHANG Zhining, DAI Baobao, YANG Yang, ZHANG Tie, CHEN Liqing. Local Path Dynamic Programming Algorithm for Automatic Row Alignment Traveling of Wine Grape Harvester[J]. Transactions of the Chinese Society for Agricultural Machinery,2025,56(2):124-135.

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