刘天湖, 张迪, 郑琰, 程一丰, 裘健, 齐龙. 基于改进RRT*算法的菠萝采收机导航路径规划[J]. 农业工程学报, 2022, 38(23): 20-28. DOI: 10.11975/j.issn.1002-6819.2022.23.003
    引用本文: 刘天湖, 张迪, 郑琰, 程一丰, 裘健, 齐龙. 基于改进RRT*算法的菠萝采收机导航路径规划[J]. 农业工程学报, 2022, 38(23): 20-28. DOI: 10.11975/j.issn.1002-6819.2022.23.003
    Liu Tianhu, Zhang Di, Zheng Yan, Cheng Yifeng, Qiu Jian, Qi Long. Navigation path planning of the pineapple harvester based on improved RRT* algorithm[J]. Transactions of the Chinese Society of Agricultural Engineering (Transactions of the CSAE), 2022, 38(23): 20-28. DOI: 10.11975/j.issn.1002-6819.2022.23.003
    Citation: Liu Tianhu, Zhang Di, Zheng Yan, Cheng Yifeng, Qiu Jian, Qi Long. Navigation path planning of the pineapple harvester based on improved RRT* algorithm[J]. Transactions of the Chinese Society of Agricultural Engineering (Transactions of the CSAE), 2022, 38(23): 20-28. DOI: 10.11975/j.issn.1002-6819.2022.23.003

    基于改进RRT*算法的菠萝采收机导航路径规划

    Navigation path planning of the pineapple harvester based on improved RRT* algorithm

    • 摘要: 为了提高菠萝收获的机械化和自动化水平,该研究采用改进RRT*(Rapidly-exploring Random Trees Star)算法进行菠萝采收机全局作业路径规划。首先引入自启发式思想约束采样点的生成,借鉴人工势场引入方向权重对新节点拓展方向进行约束,同时计算合适的权重取值范围,采用双向拓展加快迭代速度,然后利用贪心算法修剪路径冗余节点,并利用Cantmull-Rom插值函数对路径进行平滑处理。根据农田道路情况创建多障碍物、迷宫和狭窄通道3种仿真环境,分别对RRT*算法、双向RRT*算法和改进后RRT*算法的性能进行测试。试验结果表明:3种环境下,本文算法的平均收敛时间是RRT*算法的18%,是双向RRT*算法的46.12%,平均规划速度是RRT*算法的5.7倍,是双向RRT*算法的2.3倍左右,平均拓展节点数量比 RRT* 算法减少87.23%,比双向 RRT* 算法减少 52.52%,平均路径长度比 RRT* 算法减少 3.81%,比双向 RRT* 算法减少 6.08%。田间试验结果表明:本文算法的规划时间仅为RRT*算法的14.12%,为双向RRT*的20.34%,迭代次数比RRT*算法减少80.89%,比双向RRT*减少69.70%。另外,RRT*和双向RRT*算法规划路径上大于60°的转角分别是本文算法的1.56和2.06倍,大于100°的转角分别是本文算法的1.55和2.18倍,本文算法规划的路径更平滑。研究结果可为菠萝采收机导航提供参考。

       

      Abstract: All pineapples are harvested manually at present in China. But manual harvesting cannot fully meet the large-scale production against the ever-increasing greying workforce. Fortunately, automatic navigation can be expected to develop the pineapple harvester. In this study, a path planning algorithm was proposed as the navigation scheme to improve the mechanization and automation level of pineapple harvesting. An improved RRT* algorithm was also used for global path planning. Firstly, the self-heuristic idea was used to constrain the generation range of sampling points. Then, the bias probability pbias was introduced to generate the random sampling points. Specifically, the sampling points were randomly generated with the probability p in the space, when p>pbias. Otherwise, the target point was used as the sampling point, in order to decrease the blindness of sampling point generation. Thirdly, the gravitational field of the artificial potential field, and the concept of direction weight were introduced in the new node expansion. The weights wg and wk were assigned to the directions of the sampling and target point, respectively, where the direction was constrained in the expansion of the new node. Fourthly, the bidirectional expansion was used to speed up the iteration speed in the double-tree expansion. Finally, the greedy algorithm was applied to prune the redundant nodes of the path. The Cantmull-Rom interpolation function was also used to smooth the path corners. Three environments (including multiple obstacles, mazes, and narrow passages) were created to simulate the path planning process, in order to evaluate the performance among the improved navigation path planning, RRT* and bidirectional RRT* algorithm. Planning time, node number, and path length were selected as the indicators. Each algorithm experimented with 30 times in every single environment. The average, maximum, minimum, and standard deviation were calculated for the simulation data of the three indicators, respectively. The simulation results showed that the average planning time of the path planning algorithm of this paper in the three environments was 18%, and 46.12% higher than that of the RRT* and bidirectional RRT* algorithms, respectively, while the average programming speed was 5.7, and 2.3 times as rapid as that of the RRT*, and bidirectional RRT* algorithm, respectively. Furthermore, the average node number was 87.23% and 52.52% less than that of the RRT* and bidirectional RRT* algorithms, respectively. The average path length was 3.81% and 6.08% less than the RRT* and bidirectional RRT* algorithms, respectively. The field test showed that the planning time was only 14.12% and 20.34% of the RRT* and bidirectional RRT*, respectively. The iteration number was 80.89% and 69.70% less than that of the RRT* and bidirectional RRT*, respectively. In addition, the rotation angles larger than 60° on the path planned by RRT* and bidirectional RRT* algorithms were 1.56 and 2.06 times as much as that of the improved, respectively, and the rotation angles larger than 100° on the path were 1.55 and 2.18 times. The improved RRT* algorithm can fully meet the path navigation requirements of agricultural machinery in the field. The pineapple harvester can run along the planned path to the target point as moving with the speed of 0.2, 0.4, and 0.6 m/s, but the position and heading deviation increase with the moving speed. This finding can provide a sound reference for the navigation development in agricultural machines.

       

    /

    返回文章
    返回