摘要
Aiming to realize the obstacle avoidance of the fruit tree pruning manipulator in unstructured complex natural environment,an improved bidirectional fast extended random tree(RRT-Connect)algorithm was presented in this study.The manipulator and obstacles were properly simplified based on their geometrical characteristics to build collision detection models taking account of the obstacles,ground,and manipulator itself and to carry out the obstacle avoidance path planning.Goal-biased strategy and adaptive step size adjustment principle were introduced to accelerate the path search speed.Bidirectional pruning optimal strategy and cubic non-uniform B-spline interpolation method were adopted to optimize the path generated by RRT-Connect.The simulation path planning experiment was carried out in the simulation system of the fruit tree pruning manipulator and the practical obstacle avoidance path planning experiment was carried out on the real fruit tree pruning manipulator path planning experiment platform.The results showed that the path planning time and the path length of the improved RRT-Connect algorithm reduced by about 55%and 60%respectively compared with the basic RRT-Connect algorithm.The path planning success rate of the improved RRT-Connect algorithm was 100%,and the planned path was smooth,continual and executable,which could effectively guide the manipulator to avoid obstacles and lead the end effector of the manipulator to the goal point.The proposed improved algorithm not only has certain application value for obstacle avoidance of the fruit tree pruning manipulator in fruit tree pruning environment,but also has theoretical reference value for path planning of other types of robots.
基金
This study was supported by the National Natural Science Foundation of China(No.51765058)
the Corps Regional Innovation Guidance Plan(No.2021BB020).