面向主从跟随协同作业的导航路径规划方法
作者:
作者单位:

作者简介:

通讯作者:

中图分类号:

基金项目:

国家自然科学基金项目(32101622、52072407)和国家重点研发计划项目(2017YFD0700403)


Collaborative Path Planning for Autonomous Agricultural Machinery of Master-Slave Cooperation
Author:
Affiliation:

Fund Project:

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

    针对传统多机协同路径规划方法未充分考虑从机自主性,地头转弯路径可能发生重叠,存在碰撞风险的问题,本文提出一种面向主从跟随模式的多机协同作业导航路径规划方法。基于方向包围盒算法和分离轴定理建立农机安全状态检测模型,检测农机之间是否发生碰撞;建立基于地块全覆盖算法的主机路径规划模型,计算最佳作业方向角并规划地头转弯模型;建立从机作业路径规划模型,根据主机与从机在协同作业中的相对距离要求规划从机直线作业路径,制定协同转弯策略,根据主机和从机的转弯状态判定从机停车等待时刻,避免因转弯路径交叠引发的碰撞危险。以某小麦收获地块为测试场景开展仿真试验。试验结果表明,所建方法能够规划出地块覆盖率高、作业时间短、动力消耗少的多机协同作业路径;当地头转弯路径发生重叠时,主机和从机能够根据所设计的协同转弯策略先后转向,避免碰撞危险;路径规划算法用时最小值为0.453s、最大值为1.563s、平均值为0.951s,可为小麦、青贮收获等主从跟随式多机协同自主作业提供有效的全局作业路径。

    Abstract:

    The traditional multi-machine collaborative path planning method exists several problems which ignore the autonomy of the slave and the turning path may overlap on the ground. A multi-machine cooperative navigation path planning method oriented to master-slave cooperation mode was proposed. Firstly, the safety state detection model of agricultural machinery was established based on the directional bounding box algorithm and the separation axis theorem. By comparing the relationship between the sum of the projection radius of each agricultural machinery envelope section on the separation axis and the projection length from the geometric center of the section, the collision between agricultural machinery can be detected. Then, the host path planning model based on the full coverage algorithm was established, and the optimal operation direction angle was solved with the minimum turning number as the optimization objective; according to the size relationship between the minimum turning radius and operation width of the main engine, two kinds of U-shaped and T-shaped turning models were established. Finally, the path planning model of slave was established, and the linear operation path of slave machine was planned according to the relative distance between master and slave in cooperative operation; The cooperative turning modes of master and slave were divided into three types: double U-type, double-T-type and UT type. The cooperative turning strategy was proposed, according to the turning state of the master and slave, the waiting time of the slave was determined to avoid the collision risk caused by overlapping turning paths. Taking the wheat harvest scene under a convex polygon plot as the experimental sample plot, the longitude and latitude coordinates of the plot vertex were extracted by using LocaSpace Viewer, and the rectangular coordinates of the plot were obtained through coordinate transformation. The simulation experiment was carried out by using Matlab. The experimental results showed that the proposed method can plan multi-machine collaborative operation path with high land coverage, short operation time and low power consumption; the master and slave can turn successively according to the designed cooperative turning strategy to avoid collision, when the turning path overlaped; the minimum, maximum and average time of path planning algorithm were 0.453s, 1.563s and 0.951s, respectively. The proposed method can avoid collision risk and can provide an effective global operation path for wheat and silage harvesting.

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

翟志强,王秀倩,王 亮,朱忠祥,杜岳峰,毛恩荣.面向主从跟随协同作业的导航路径规划方法[J].农业机械学报,2021,52(S0):542-547. ZHAI Zhiqiang, WANG Xiuqian, WANG Liang, ZHU Zhongxiang, DU Yuefeng, MAO Enrong. Collaborative Path Planning for Autonomous Agricultural Machinery of Master-Slave Cooperation[J]. Transactions of the Chinese Society for Agricultural Machinery,2021,52(S0):542-547.

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