基于多约束条件的果园喷雾机器人路径规划方法
作者:
作者单位:

作者简介:

通讯作者:

中图分类号:

基金项目:

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


Orchard Spray Robot Planning Algorithm Based on Multiple Constraints
Author:
Affiliation:

Fund Project:

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

    果园喷雾机器人路径轨迹规划影响机器人行驶路线的平滑线和行驶过程的可靠性和平稳性。针对目前果园喷雾机器人路径规划中存在的转弯处参考轨迹不够平滑、曲率较大、行驶不平稳等问题,提出了一种基于果园喷雾机器人运动学多约束条件的三次非均匀B样条曲线果园喷雾机器人轨迹优化方法。通过先验地图获取树行位置信息对行间路径点进行拟合处理,保证果园喷雾机器人行驶在树行中心线上符合喷雾作业要求,综合考虑最小转弯半径、首末端点约束、转向机构延迟约束、曲率连续等多约束条件构建路径曲率最小化目标函数,并通过最优化算法求解待优化的曲线参数,生成符合果园喷雾机器人行驶要求的全局路径,最后采用纯跟踪算法进行跟踪试验来验证机器人行驶精度。仿真与试验结果表明,规划生成轨迹的最大曲率为0.31m-1,平均曲率为0.15m-1,符合果园喷雾机器人的行驶要求;针对该轨迹跟踪行驶的平均横向误差为0.225m,标准差为0.031m,满足果园喷雾机器人在果园内喷雾作业时对行驶精度的要求。

    Abstract:

    The path trajectory planning of orchard spray robot affects the smooth line of robot driving route and the reliability and smoothness of the driving process which needs more comprehensive consideration and more comprehensive planning. Aiming at the problems that the reference trajectory at the turn is not smooth enough and the curvature is large in the path planning of orchard spray robot, a trajectory optimization method of cubic non-uniform B-spline curve for orchard spray robot based on kinematics multiple constraints of orchard spray robot was proposed. The prior map was used to obtain the position information of the tree rows, and the path points between the rows were fitted to ensure that the orchard spray robot driving on the center line of the tree row met the requirements of the spray operation. The objective function of minimizing the path curvature was constructed by considering the minimum turning radius, the constraint of the first and end points, the delay constraint of the steering mechanism, and the continuity of curvature. The curve parameters to be optimized were solved by the optimization algorithm, and the global path that met the driving requirements of the orchard spray robot was generated. Finally, the pure tracking algorithm was used to verify the driving accuracy of the robot. The simulation and test results showed that the maximum curvature of the planned trajectory was 0.31m-1, and the average curvature was 0.15m-1, which met the driving requirements of the orchard spray robot. The average error of the trajectory tracking driving was 0.225m, and the mean square error was 0.031m, which met the requirements of the orchard spray robot for driving accuracy when spraying in the orchard.

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

沈跃,刘子涵,刘慧,杜伟.基于多约束条件的果园喷雾机器人路径规划方法[J].农业机械学报,2023,54(7):56-67. SHEN Yue, LIU Zihan, LIU Hui, DU Wei. Orchard Spray Robot Planning Algorithm Based on Multiple Constraints[J]. Transactions of the Chinese Society for Agricultural Machinery,2023,54(7):56-67.

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