Adaptive Path Planning for Robotic Winter Jujube Harvesting Using an Improved RRT-Connect Algorithm

Abstract

Winter jujube harvesting is traditionally labor-intensive, yet declining labor availability and rising costs necessitate robotic automation to maintain agricultural competitiveness. Path planning for robotic arms in orchards faces challenges due to the unstructured, dynamic environment containing densely packed fruits and branches. To overcome the limitations of existing robotic path planning methods, this research proposes BMGA-RRT Connect (BVH-based Multilevel-step Gradient-descent Adaptive RRT), a novel algorithm integrating adaptive multilevel step-sizing, hierarchical Bounding Volume Hierarchy (BVH)-based collision detection, and gradient-descent path smoothing. Initially, an adaptive step-size strategy dynamically adjusts node expansions, optimizing efficiency and avoiding collisions; subsequently, a hierarchical BVH improves collision-detection speed, significantly reducing computational time; finally, gradient-descent smoothing enhances trajectory continuity and path quality. Comprehensive 2D and 3D simulation experiments, dynamic obstacle validations, and real-world winter jujube harvesting trials were conducted to assess algorithm performance. Results showed that BMGA-RRT Connect significantly reduced average computation time to 2.23 s (2D) and 7.12 s (3D), outperforming traditional algorithms in path quality, stability, and robustness. Specifically, BMGA-RRT Connect achieved 100% path planning success and 90% execution success in robotic harvesting tests. These findings demonstrate that BMGA-RRT Connect provides an efficient, stable, and reliable solution for robotic harvesting in complex, unstructured agricultural settings, offering substantial promise for practical deployment in precision agriculture.