Method for the fruit tree recognition and navigation in complex environment of an agricultural robot

To realize the visual navigation of agricultural robots in the complex environment of orchards, this study proposed a method for fruit tree recognition and navigation based on YOLOv5. The YOLOv5s model was selected and trained to identify the trunks of the left and right rows of fruit trees; the quadratic curve was fitted to the bottom center of the fruit tree recognition box, and the identified fruit trees were divided into left and right columns by using the extreme value point of the quadratic curve to obtain the left and right rows of fruit trees; the straight-line equation of the left and right fruit tree rows was further solved, the median line of the two straight lines was taken as the expected navigation path of the robot, and the path tracing navigation experiment was carried out by using the improved LQR control algorithm. The experimental results show that under the guidance of the machine vision system and guided by the improved LQR control algorithm, the lateral error and heading error can converge quickly to the desired navigation path in the four initial states of [0 m, −0.34 rad], [0.10 m, 0.34 rad], [0.15 m, 0 rad] and [0.20 m, −0.34 rad]. When the initial speed was 0.5 m/s, the average lateral error was 0.059 m and the average heading error was 0.2787 rad for the navigation trials in the four different initial states. Its average driving was 5.3 m into the steady state, the average value of steady state lateral error was 0.0102 m, the average value of steady state heading error was 0.0253 rad, and the average relative error of the robot driving along the desired navigation path was 4.6%. The results indicate that the navigation algorithm proposed in this study has good robustness, meets the operational requirements of robot autonomous navigation in orchard environment, and improves the reliability of robot driving in orchard.