基于改进APF-FMT*的农业机器人路径规划算法

    Path planning algorithm of agricultural robot based on improved APF-FMT*

    • 摘要:
      目的 解决农业机器人在复杂农业环境下全局路径规划耗时过长、路径最优解求解困难的问题。
      方法 提出一种基于改进人工势场法的快速行进树算法(APF-FMT*)。首先,在引力势场中引入相对距离,根据与目标点的距离改变引力大小,克服了人工势场法距离目标点过远时引力过大的问题;然后,将FMT*算法与改进人工势场法相结合,采用三阶B样条曲线对路径进行平滑处理;最后,建立3个农业工作地图进行仿真试验。
      结果 仿真结果表明,与FMT*、RRT*和Informed-RRT* 3种算法对比,在地图Map1和Map2中,APF-FMT*都能快速找到良好的解,且随样本数量增加获得的路径解得到改善,搜索时间比其他3种算法减少45%以上;在有狭小通道的Map3中,APF-FMT*、FMT*搜索时间比RRT*和Informed-RRT*减少75%以上,并且获得更好的解。
      结论 本研究提出的APF-FMT*算法不仅克服了FMT*算法冗余探索问题,还有效地解决了人工势场法目标点不可达的问题,提高了农业机器人路径规划效率和作业安全性。

       

      Abstract:
      Objective The study is aimed to address the issue of lengthy global path planning of agricultural robot in complex agricultural environment and the path solution is not optimal.
      Method A fast marching tree algorithm based on an improved artificial potential field method (APF-FMT*) was proposed. Firstly, relative distance was introduced in the gravitational potential field, adjusting the strength of attraction based on the distance from the target point. This overcomed the issue of excessive attraction force in the artificial potential field method when the distance to the target point was too far. The FMT* algorithm was combined with the improved artificial potential field method, and a third order B-spline curve was used to smooth the path. Finally, three agricultural working maps were created for simulation experiments.
      Result APF-FMT* was compared with FMT*, RRT*, and Informed-RRT* algorithms. The simulation results demonstrated that in maps Map1 and Map2, APF-FMT* consistently found good solutions quickly, and the path solutions were improved with an increasing number of samples. The search time reduced by over 45% compared with the other three algorithms. In Map3 with narrow channels, the search times of APF-FMT* and FMT* reduced by more than 75% compared with RRT* and Informed RRT*, and better solutions were obtained.
      Conclusion The proposed APF-FMT* algorithm based on the improved artificial potential field method not only overcomes the issue of redundant exploration in the FMT* algorithm, but also effectively solves the problem of unreachable target points in the artificial potential field method. This algorithm improves the efficiency and safety of path planning for agricultural robots.

       

    /

    返回文章
    返回