A Fast Path-Planning Method for Continuous Harvesting of Table-Top Grown Strawberries

Zhonghua Miao, Yang Chen, Ling Yang, Shi‐Min Hu, Ya Xiong

TL;DR

The Interactive Local Minima Search Algorithm (ILMSA) provides a high-speed path-planning solution for robots performing continuous strawberry harvesting. By projecting 3D environments into optimized 2D planes and using a geometry-based node expansion strategy, ILMSA reduces planning time by over 97% compared to traditional 3D-RRT methods while producing significantly shorter and smoother paths.

What Problem Does This Paper Address?

In modern agriculture, robotic harvesting is shifting from simple "pick-and-place" (one fruit at a time) to "continuous harvesting," where a robot picks multiple fruits before returning to a storage container. This significantly boosts efficiency but creates a complex path-planning nightmare.

Table-top grown strawberries present a particularly "messy" environment: fruits are intertwined with fragile stems, leaves, and other berries. Traditional algorithms like A or Rapidly-exploring Random Trees (RRT)* often struggle here. They are either computationally expensive in 3D space, produce jagged paths with too many redundant movements, or get "stuck" in local minima (dead ends) within the dense foliage. To be viable, a harvesting robot needs an algorithm that is fast enough for real-time response and smart enough to navigate tight clusters without damaging the plant.

Methods

The authors introduce the Interactive Local Minima Search Algorithm (ILMSA). Its novelty lies in two main areas:

  1. Iterative Node Expansion (2D): Instead of random sampling (like RRT), ILMSA starts with a straight line between the start and end points. If a collision is detected, the algorithm identifies the obstacle vertex furthest from the path segment. It then creates a new "key node" offset from that vertex by a safe distance. This process repeats until a collision-free path is formed, effectively using the obstacles' own geometry to "guide" the path.
  2. 3D via 2D Projections: To avoid the "curse of dimensionality" in 3D space, the algorithm projects 3D obstacles onto multiple 2D planes rotated around the axis connecting the start and end points. It solves the path in each 2D plane, then selects the best one based on a quality score that balances path length, safety (distance from obstacles), and smoothness.
  3. Smoothing: The final path is refined using B-spline curves to ensure the robotic arm moves fluidly rather than in jerky, linear segments.

Datasets

The researchers evaluated ILMSA using:

  • Simulated Environments: Two distinct scenarios were created: "Environment 1" (simple, 5 strawberries) and "Environment 2" (complex, 13 strawberries with dense obstacles).
  • Field Test Data: Real-world testing was conducted at Shennong Tiandi Strawberry Farms in Beijing. The hardware included a custom 6-DoF hybrid robotic arm, an Intel RealSense D455 depth camera, and a ROS-based control system.

Key Insights and Ideas

  • Geometry over Randomness: By using the "local minima" (the most intrusive points of an obstacle) as anchors for new nodes, the algorithm is far more deterministic and efficient than sampling-based methods like RRT.
  • Dimensionality Reduction is King: The decision to project 3D space into 2D planes is the primary driver of the 97%+ speedup. It turns a complex spatial search into a series of much simpler planar problems.
  • Continuous Harvesting Requirements: The paper highlights that for agricultural robots, "smoothness" is just as important as "length." Jerky movements can vibrate the plant, potentially causing undetected fruit to fall or damaging delicate stems.

Key Results

ILMSA showed dominant performance across both simulation and field tests:

  • Speed: In 3D simulations, ILMSA was 97.1% faster than 3D-RRT. Compared to a learning-based approach (QAPF), it was 97.8% faster.
  • Efficiency: It reduced path lengths by 21.5% compared to 3D-RRT and 11.6% compared to the heuristic Lowest Point of Strawberry (LPS) algorithm.
  • Node Reduction: ILMSA generated significantly fewer nodes (31 nodes in a 2D complex scenario vs. 458 for A*), which simplifies the command chain for the robotic arm.
  • Field Success: In real-world trials, the combined planning and execution time was only 58% of the time required by the baseline LPS method, proving its readiness for actual farm deployment.

Limitations and Future Work

While highly effective, the authors note a few areas for improvement:

  • Simplified Obstacle Models: Currently, the system simplifies strawberries and stems into cuboid bounding boxes. This abstraction might lead to errors in extremely dense clusters where the irregular shape of the fruit matters.
  • Parameter Tuning: The algorithm relies on a few "magic numbers," such as the collision distance threshold ($e$) and the rotation angle increment ($\Delta\theta$). Finding the perfect balance between computation speed and path optimality still requires some manual adjustment.
  • Dual-Arm Coordination: Future work will look into extending this algorithm for dual-arm robots to further double harvesting throughput.

Summary updated

Abstract

Continuous harvesting and storage of multiple fruits in a single operation allow robots to significantly reduce the travel distance required for repetitive back-and-forth movements. Traditional collision-free path planning algorithms, such as rapidly-exploring random tree (RRT) and A-star (A*), often fail to meet the demands of efficient continuous fruit harvesting due to their low search efficiency and the generation of excessive redundant points. This article presents the interactive local minima search algorithm (ILMSA), a fast path-planning method designed for the continuous harvesting of table-top grown strawberries. The algorithm featured an interactive node expansion strategy that iteratively extended and refined collision-free path segments based on local minima points. To enable the algorithm to function in 3-D, the 3-D environment was projected onto multiple 2-D planes, generating optimal paths on each plane. The best path was then selected, followed by integrating and smoothing the 3-D path segments. Simulations demonstrated that ILMSA outperformed existing methods, reducing path length by 21.5% and planning time by 97.1% compared to 3-D rapidly-exploring random tree, while achieving 11.6% shorter paths and 25.4% fewer nodes than the lowest point of the strawberry (LPS) algorithm in 3-D environments. In 2-D, ILMSA achieved path lengths 16.2% shorter than A*, 23.4% shorter than RRT, and 20.9% shorter than RRT-Connect, while being over 96% faster and generating significantly fewer nodes. In addition, ILMSA outperformed the partially guided Q-learning method, reducing path length by 36.7%, shortening planning time by 97.8%, and effectively avoiding entrapment in complex scenarios. Field tests confirmed ILMSA's suitability for complex agricultural tasks, having a combined planning and execution time and an average path length that were approximately 58% and 69%, respectively, of those achieved by the LPS algorithm.
BibTeX
@article{miao2025fast,
  author = {Zhonghua Miao and Yang Chen and Ling Yang and Shi‐Min Hu and Ya Xiong},
  title = {{A Fast Path-Planning Method for Continuous Harvesting of Table-Top Grown Strawberries}},
  journal = {IEEE Transactions on AgriFood Electronics},
  year = {2025},
  doi = {10.1109/tafe.2025.3528403},
}
Figure