Research on 2D Laser Automatic Navigation Control for Standardized Orchard

: With the increase of labor cost and the development of agricultural mechanization, standardized orchards suitable for autonomous operations of agricultural machinery will be a future development trend of the fruit-planting industry. For ﬁeld-planting processes of standardized orchards, autonomous navigation of orchard vehicles in complex environments is the foundation of mechanized and intelligent ﬁeld operations. In order to realize autonomous driving and path-tracking of vehicles in complex standardized orchards that involve much noise and interference between rows of fruit trees, an automatic navigation system was designed for orchard vehicles, based on 2D lasers. First, considering the agronomic requirements for orchard planting such as plant spacing, row spacing and trunk diameter, di ﬀ erent ﬁltering thresholds were established to eliminate discrete points of 2D laser point cloud data e ﬀ ectively. Euclidean clustering algorithm and the important geometric theorems of three points collinearity was used to extract the central feature points of the trunk, as the same time, navigation path was ﬁtted based on the least square method. Secondly, an automatic navigation control algorithm was designed, and the fuzzy control was used to realize the dynamic adjustment of the apparent distance of the pure pursuit model. Finally, the reliability of the proposed approach was veriﬁed by simulation using MATLAB / Simulink, and ﬁeld tests were carried out based on electric agricultural vehicle. Experimental results show that the method proposed in this study can e ﬀ ectively improve the precision of automatic navigation in complex orchard environment and realize the autonomous operation of orchard vehicles.


Introduction
In recent years, with the acceleration of the industrialization process and the aging of the population, the problem of insufficient agricultural labor will become increasingly serious. Fruit is an important source of human nutrition and a pillar industry of the planting industry. However, compared with the traditional agriculture, the management technology and the mechanization are relatively backward [1]. In addition, traditional agricultural operations are generally carried out by people or people operating agricultural machinery, and the labor is repeated and monotonous. It is easy for the operator to fatigue, which will cause the operator's operation accuracy to decrease and the danger to rise for a long time. The modern agricultural equipment led by agricultural robots developed later can largely solve the above problems. Therefore, the system design of this project is suitable for advanced equipment for orchard operations [2,3]. strong robustness by using Proportion Integration Differentiation (PID) [38], fuzzy control [39] or sliding mode control [40], but due to the lack of positioning accuracy, the navigation control accuracy will be seriously affected.
This paper designed an automatic navigation system for standardized orchards with 2D laser for orchard low-speed operation wheeled vehicles. The system considers the influence of small interfering objects on the traveling route of the wheeled vehicle on the accuracy of the point cloud data acquired by the 2D laser. The distance threshold and the statistical filtering were used to complete the filtering process. Euclidean clustering algorithm and the important geometric theorems of three points collinearity was used to extract the central feature points of the trunk. Finally, the linear navigation path was identified and extracted by the least square method. Based on obtaining lateral deviation and heading deviation, this paper designed an adaptive pure pursuit path-tracking controller combined with the advantages of fuzzy control without the need to construct an accurate mathematical model. The modified agricultural electric vehicle was used as an experimental platform for simulation and field tests in order to verify the accuracy and robustness of the automatic navigation system.

System Composition
The orchard vehicle automatic test platform based on the electric agricultural vehicle (model: SH-GL) was mainly composed of 2D laser, automatic steering system and front wheel rotation angle detection system. The structure of the test platform is shown in Figure 1. The laser was installed at the center of the front of the vehicle, the height was 0.6 m from the ground and data were transmitted to the main controller PC through the network port. The automatic steering system was composed of 86BYGH2503 stepper motor, DLD6-20B electromagnetic clutch and chain transmission. Based on Stm32F103 which communicates with the main controller PC through the USB serial port, it realizes automatic steering through Proportion Integration Differentiation (PID) control. The front wheel angle system was based on Wittower-RE38 encoder and communicates with the Stm32F103 through AD conversion. A tracking device was fixed at the center axis of the test platform and made the ink outlet of the device as close to the ground as possible. The white ink was placed in the tracking device, and the actual walking path of the test platform was recorded by the ink droplet trajectory.
Appl. Sci. 2020, 10, x FOR PEER REVIEW 3 of 19 [38], fuzzy control [39] or sliding mode control [40], but due to the lack of positioning accuracy, the navigation control accuracy will be seriously affected. This paper designed an automatic navigation system for standardized orchards with 2D laser for orchard low-speed operation wheeled vehicles. The system considers the influence of small interfering objects on the traveling route of the wheeled vehicle on the accuracy of the point cloud data acquired by the 2D laser. The distance threshold and the statistical filtering were used to complete the filtering process. Euclidean clustering algorithm and the important geometric theorems of three points collinearity was used to extract the central feature points of the trunk. Finally, the linear navigation path was identified and extracted by the least square method. Based on obtaining lateral deviation and heading deviation, this paper designed an adaptive pure pursuit path-tracking controller combined with the advantages of fuzzy control without the need to construct an accurate mathematical model. The modified agricultural electric vehicle was used as an experimental platform for simulation and field tests in order to verify the accuracy and robustness of the automatic navigation system.

System Composition
The orchard vehicle automatic test platform based on the electric agricultural vehicle (model: SH-GL) was mainly composed of 2D laser, automatic steering system and front wheel rotation angle detection system. The structure of the test platform is shown in Figure 1. The laser was installed at the center of the front of the vehicle, the height was 0.6 m from the ground and data were transmitted to the main controller PC through the network port. The automatic steering system was composed of 86BYGH2503 stepper motor, DLD6-20B electromagnetic clutch and chain transmission. Based on Stm32F103 which communicates with the main controller PC through the USB serial port, it realizes automatic steering through Proportion Integration Differentiation (PID) control. The front wheel angle system was based on Wittower-RE38 encoder and communicates with the Stm32F103 through AD conversion. A tracking device was fixed at the center axis of the test platform and made the ink outlet of the device as close to the ground as possible. The white ink was placed in the tracking device, and the actual walking path of the test platform was recorded by the ink droplet trajectory.  The 2D laser was UST-20LXLiDAR manufactured by HOYUKO. Its specific parameters are shown in Table 1. As shown in Figure 2, the navigation control terminal PC was the core of the control system. This study was based on Windows 10 Visual Studio 2015 for data processing and software algorithm design. The 2D laser was UST-20LXLiDAR manufactured by HOYUKO. Its specific parameters are shown in Table 1. As shown in Figure 2, the navigation control terminal PC was the core of the control system. This study was based on Windows 10 Visual Studio 2015 for data processing and software algorithm design.  In order to test the performance of the front wheel angle system, a bench test was designed. The front wheel was set up, the test platform was in no-load state and the pulse control signal was applied to control the front wheel of the test platform to rotate 30° to the left and right (the maximum rotation angle of the test platform was [−30°, 30°]). The result is shown in Figure 3. The fitting degree R 2 of the regression equation of the left and right turn response curves of the test platform was 0.9938 and 0.9918, respectively, indicating that the system obtains the rotation angle as linear. In order to test the performance of the front wheel angle system, a bench test was designed. The front wheel was set up, the test platform was in no-load state and the pulse control signal was applied to control the front wheel of the test platform to rotate 30 • to the left and right (the maximum rotation angle of the test platform was [−30 • , 30 • ]). The result is shown in Figure 3. The fitting degree R 2 of the regression equation of the left and right turn response curves of the test platform was 0.9938 and 0.9918, respectively, indicating that the system obtains the rotation angle as linear.
Appl. Sci. 2020, 10, x FOR PEER REVIEW 4 of 19 The 2D laser was UST-20LXLiDAR manufactured by HOYUKO. Its specific parameters are shown in Table 1. As shown in Figure 2, the navigation control terminal PC was the core of the control system. This study was based on Windows 10 Visual Studio 2015 for data processing and software algorithm design.  In order to test the performance of the front wheel angle system, a bench test was designed. The front wheel was set up, the test platform was in no-load state and the pulse control signal was applied to control the front wheel of the test platform to rotate 30° to the left and right (the maximum rotation angle of the test platform was [−30°, 30°]). The result is shown in Figure 3. The fitting degree R 2 of the regression equation of the left and right turn response curves of the test platform was 0.9938 and 0.9918, respectively, indicating that the system obtains the rotation angle as linear.   In order to test the performance of the automatic steering control system, the sine wave steering tracking test was designed. Place the test platform on the open concrete pavement, apply a sine wave signal with frequency of 0.5 πHz and an angular amplitude of 10 • . Finally, record front wheel angle data. The test results are shown in Figure 4. The electric steering control system can track the control signal well, with slight oscillation near the peak ±10 • , the large tracking error was 0.86 • and the average absolute tracking error was 0.304 • , indicating that the automatic steering control system has better performance.
Appl. Sci. 2020, 10, x FOR PEER REVIEW 5 of 19 In order to test the performance of the automatic steering control system, the sine wave steering tracking test was designed. Place the test platform on the open concrete pavement, apply a sine wave signal with frequency of 0.5 πHz and an angular amplitude of 10°. Finally, record front wheel angle data. The test results are shown in Figure 4. The electric steering control system can track the control signal well, with slight oscillation near the peak ±10°, the large tracking error was 0.86° and the average absolute tracking error was 0.304°, indicating that the automatic steering control system has better performance.

Fruit Tree Position Information Determination
When using the 2D laser to scan the orchard environment, the laser receiver will receive signal feedback with different lengths due to the occlusion of the laser pulse by the trunk. According to this principle, the position of the fruit tree can be determined.
As shown in Figure 5, we have established a rectangular coordinate system with the laser scanner's mounting position O as the origin and the Y-axis in the vehicle's forward direction. The ρ i is the distance between the laser scanner's emission point and the target. The λi is the angle formed laser beam with the coordinate axis. The point (x i , y i ) is the Cartesian coordinates of the i-th point scanned by the 2D laser.

Fruit Tree Position Information Determination
When using the 2D laser to scan the orchard environment, the laser receiver will receive signal feedback with different lengths due to the occlusion of the laser pulse by the trunk. According to this principle, the position of the fruit tree can be determined.
As shown in Figure 5, we have established a rectangular coordinate system with the laser scanner's mounting position O as the origin and the Y-axis in the vehicle's forward direction. The ρ i is the distance between the laser scanner's emission point and the target. The λ i is the angle formed laser beam with the coordinate axis. The point (x i , y i ) is the Cartesian coordinates of the i-th point scanned by the 2D laser.
Appl. Sci. 2020, 10, x FOR PEER REVIEW 5 of 19 In order to test the performance of the automatic steering control system, the sine wave steering tracking test was designed. Place the test platform on the open concrete pavement, apply a sine wave signal with frequency of 0.5 πHz and an angular amplitude of 10°. Finally, record front wheel angle data. The test results are shown in Figure 4. The electric steering control system can track the control signal well, with slight oscillation near the peak ±10°, the large tracking error was 0.86° and the average absolute tracking error was 0.304°, indicating that the automatic steering control system has better performance.

Fruit Tree Position Information Determination
When using the 2D laser to scan the orchard environment, the laser receiver will receive signal feedback with different lengths due to the occlusion of the laser pulse by the trunk. According to this principle, the position of the fruit tree can be determined.
As shown in Figure 5, we have established a rectangular coordinate system with the laser scanner's mounting position O as the origin and the Y-axis in the vehicle's forward direction. The ρ i is the distance between the laser scanner's emission point and the target. The λi is the angle formed laser beam with the coordinate axis. The point (x i , y i ) is the Cartesian coordinates of the i-th point scanned by the 2D laser. By the Equation (1), we complete the process of the Cartesian coordinate transformation of the fruit tree position information. x Due to the complex environment of the orchard, there were more interference points or outlier noise in the point cloud data acquired by the 2D laser, which seriously affects the accuracy of the navigation path identification. Therefore, the acquired point cloud data needs to be filtered first.
As shown in Figure 6a, when the heading direction of the vehicle differs greatly from the navigation path, the laser beam can obtain the fruit tree information at a long distance through the spacing of the plant spacing between the fruit trees, thereby causing interference to obtain effective information. We set the i-th data point to q i . Its eigenvector is shown in Equation (2). Set the distance thresholds to ρ max and x max . If ρ i < ρ max and x i < x max , q i is retained. Otherwise it is eliminated. (3), we can see that μ is the distance mean, σ is the distance standard and g is the constant coefficient of standard range H i . When D avr-i > H i , the point is regarded ete point and culled. Otherwise it is retained. n we obtain the complete fruit tree coordinate points, we use European clustering to cluster ordinate points on the same fruit tree. As shown in the equations (4), M i , i+1 is the Euclidean of the laser data points q i and q i+1 . The cluster search radius is r and its value is related to the adius of the fruit trees.
n M i , i+1 < r, we think that two points come from the same fruit tree and gather into one kind; , i+1 > r, we think that two points come from different fruit trees.
ugh this experiment, we found that the point cloud data region obtained by the 2D laser s the outer surface of the fruit tree trunk at the current laser height. The trunk of the fruit be approximated as a cylinder, and the central feature point of the trunk can be extracted important geometric theorem of three points collinearity. As shown in Figure 7, we set the polar coordinates of the central feature point of the trunk as N(ρ n , λ n ), the n consecutive data points of the trunk cluster are q n , the point with the smallest ρ value is selected as the feature point (ρ min , λ min ) and the R ave is expressed as the average radius of the frui tree trunk. The Equation (5)

Navigation Control Parameter Acquisition
In order to obtain the vehicle navigation path, this experiment needs to fit the central feature points of all trunks in a straight line. We set the coordinates of the center points of the left and righ When there were small obstacles such as weeds, it does not affect the travel of the vehicle. The laser data of this experiment often contains some discrete points, as shown in Figure 6b. The d i is the Euclidean distance from point q i to any point. The D avr-i is the average distance of q i to all its k neighbors and the H i is the standard range of calculation.
As shown in the Equation (3), we can see that µ is the distance mean, σ is the distance standard deviation and g is the constant coefficient of standard range H i . When D avr-i > H i , the point is regarded as a discrete point and culled. Otherwise it is retained.
When we obtain the complete fruit tree coordinate points, we use European clustering to cluster all the coordinate points on the same fruit tree. As shown in the equations (4), M i,i+1 is the Euclidean distance of the laser data points q i and q i+1 . The cluster search radius is r and its value is related to the average radius of the fruit trees.
When M i,i+1 < r, we think that two points come from the same fruit tree and gather into one kind; when M i,i+1 > r, we think that two points come from different fruit trees.
Through this experiment, we found that the point cloud data region obtained by the 2D laser scanner is the outer surface of the fruit tree trunk at the current laser height. The trunk of the fruit tree can be approximated as a cylinder, and the central feature point of the trunk can be extracted using the important geometric theorem of three points collinearity.
As shown in Figure 7, we set the polar coordinates of the central feature point of the trunk as N(ρ n , λ n ), the n consecutive data points of the trunk cluster are q n , the point with the smallest ρ value is selected as the feature point (ρ min , λ min ) and the R ave is expressed as the average radius of the fruit tree trunk. The Equation (5) can be obtained through geometric derivation. As shown in Figure 7, we set the polar coordinates of the central feature point of the trunk as N(ρ n , λ n ), the n consecutive data points of the trunk cluster are q n , the point with the smallest ρ value is selected as the feature point (ρ min , λ min ) and the R ave is expressed as the average radius of the fruit tree trunk. The Equation (5) can be obtained through geometric derivation.

Navigation Control Parameter Acquisition
In order to obtain the vehicle navigation path, this experiment needs to fit the central feature points of all trunks in a straight line. We set the coordinates of the center points of the left and right fruit trees as (x li , y li ) and (x ri , y ri ). In this experiment, the coordinates of the center points of the three fruit trees on the left and right sides of the vehicle are selected to form two groups, forming 9 groups. Use the following equation to find the midpoint coordinates (x c , y c ).

Navigation Control Parameter Acquisition
In order to obtain the vehicle navigation path, this experiment needs to fit the central feature points of all trunks in a straight line. We set the coordinates of the center points of the left and right fruit trees as (x li , y li ) and (x ri , y ri ). In this experiment, the coordinates of the center points of the three fruit trees on the left and right sides of the vehicle are selected to form two groups, forming 9 groups. Use the following equation to find the midpoint coordinates (x c , y c ).
Set the fitted line to be y = ax + b, where a represents the slope of the fitted line and b represents the intercept with the Y-axis. The best estimate of the parameters a, b is obtained according to the Equation (7): After completing the navigation path fitting, we need to obtain the navigation parameters for implementing the automatic navigation control of the vehicle according to the current position of the vehicle. As shown in Figure 8, The line S is a navigation path, the angle θ between the line S and the Y-axis is the heading deviation, and the flat distance d between the center position of the laser and the line S is the lateral deviation.
After completing the navigation path fitting, we need to obtain the navigation parameters for implementing the automatic navigation control of the vehicle according to the current position of the vehicle. As shown in Figure 8, The line S is a navigation path, the angle θ between the line S and the Y-axis is the heading deviation, and the flat distance d between the center position of the laser and the line S is the lateral deviation. The calculation equation of heading deviation θ and lateral deviation d in this experiment are as follows: As shown in the Equation (8), k is the slope of the navigation path, and b is the intercept of the navigation path.

Navigation Controller Design
The navigation controller of this experiment was mainly composed of 2D laser acquisition and processing system, path-tracking control system and automatic steering control system. We collect the fruit tree information in real time from the 2D laser and send it to the main controller PC which processes the acquired laser data. The system recognizes the navigation path and calculates the front wheel angle of the vehicle target and sends it to the Stm32F103. The embedded development platform The calculation equation of heading deviation θ and lateral deviation d in this experiment are as follows: As shown in the Equation (8), k is the slope of the navigation path, and b is the intercept of the navigation path.

Navigation Controller Design
The navigation controller of this experiment was mainly composed of 2D laser acquisition and processing system, path-tracking control system and automatic steering control system. We collect the fruit tree information in real time from the 2D laser and send it to the main controller PC which processes the acquired laser data. The system recognizes the navigation path and calculates the front wheel angle of the vehicle target and sends it to the Stm32F103. The embedded development platform uses PID control to drive the stepper motor to rotate and adjust the front wheel angle to achieve path-tracking. The working principle of the control system is shown in Figure 9. uses PID control to drive the stepper motor to rotate and adjust the front wheel angle to achieve pathtracking. The working principle of the control system is shown in Figure 9.   According to the vehicle kinematics model in Figure 10, the front turning angle of vehicle can be obtained: As show in the Figure 11, a pure pursuit model under the line tracking condition is established. According to the geometric relationship in Figure 11, the vehicle's turning curve γ and the target's abscissa xg in the car body coordinate system can be obtained: Combined with the above Equations (9)-(11), the front turning angle of vehicle under pure pursuit model can be obtained: According to the vehicle kinematics model in Figure 10, the front turning angle of vehicle can be obtained: As show in the Figure 11, a pure pursuit model under the line tracking condition is established. According to the geometric relationship in Figure 11, the vehicle's turning curve γ and the target's abscissa x g in the car body coordinate system can be obtained: Appl. Sci. 2020, 10, x FOR PEER REVIEW 10 of 19 When the forward-looking distance is selected to be larger, the vehicle will drive along the smaller curvature to the desired path, resulting in a longer control response time [41]. When the forward-looking distance is too small, the system will cause the vehicle to approach the set route along the large arc curve, causing the system to generate large oscillations. Therefore, this paper uses fuzzy controller to adaptively adjust the forward-looking distance in the pure pursuit algorithm to overcome the above shortcomings.

Adaptive Pure Tracking Model Controller Design
After research, we found that the magnitude of the forward-looking distance was affected by both the lateral deviation d and the heading deviation θ. Therefore, d and θ were used as the input of the fuzzy controller and Ld was used as the output. The Ld was adjusted in real time by the fuzzy controller. When d and θ were large, the smaller Ld was used to make the vehicle approach the tracking path quickly, reduce the system adjustment time and improve the system response speed. When d and θ were small, a larger Ld was used to prevent system overshoot and improve system stability.
We According to the positional relationship between the orchard intelligent vehicle and the orchard Figure 11. Pure pursuit model. Note: S is the navigation tracking path; G (x g , y g ) is the target point on the path; O is the turning center; γ is the turning rate of the vehicle (m −1 ); L d is the forward looking distance (m); R is the instantaneous turning radius (m); d is Lateral deviation (m); θ is the heading deviation (rad); v is the forward speed of the vehicle (m·s −1 ); l is the vehicle wheelbase (m); δ is the front wheel angle (rad); Ψ is the angle of course change when the vehicle reaches the target point along the steering arc (rad).
Combined with the above Equations (9)-(11), the front turning angle of vehicle under pure pursuit model can be obtained: When the forward-looking distance is selected to be larger, the vehicle will drive along the smaller curvature to the desired path, resulting in a longer control response time [41]. When the forward-looking distance is too small, the system will cause the vehicle to approach the set route along the large arc curve, causing the system to generate large oscillations. Therefore, this paper uses fuzzy controller to adaptively adjust the forward-looking distance in the pure pursuit algorithm to overcome the above shortcomings.

Adaptive Pure Tracking Model Controller Design
After research, we found that the magnitude of the forward-looking distance was affected by both the lateral deviation d and the heading deviation θ. Therefore, d and θ were used as the input of the fuzzy controller and L d was used as the output. The L d was adjusted in real time by the fuzzy controller. When d and θ were large, the smaller L d was used to make the vehicle approach the tracking path quickly, reduce the system adjustment time and improve the system response speed. When d and θ were small, a larger L d was used to prevent system overshoot and improve system stability.
We After several anti-simulation experiments, the optimal 49 fuzzy control rules were determined as shown in Table 2; the fuzzy control surface was plotted as shown in Figure 13.  After several anti-simulation experiments, the optimal 49 fuzzy control rules were determined as shown in Table 2; the fuzzy control surface was plotted as shown in Figure 13.  In this study, Mamdani's fuzzy reasoning method and extremely small fuzzy logic inference synthesis rules were used; the defuzzification work is completed by the center of gravity method [42]. The fuzzy control query table is shown in Table 3.  In this study, Mamdani's fuzzy reasoning method and extremely small fuzzy logic inference synthesis rules were used; the defuzzification work is completed by the center of gravity method [42]. The fuzzy control query table is shown in Table 3.

Path-Tracking Simulation Test
In order to verify the path-tracking control algorithm, the simulation model was established by MATLAB/Simulink, as shown in Figure 14 In the simulation, with set the vehicle speed v 0 = 0.45 m/s and the fixed forward-looking distance 2 m, the initial position of the controlled object is (0 m, 0.1 m), the tracking distance is 30 m. Set two kinds of simulation tracking trajectories. The linear tracking path is shown in Equation (13), and the curve tracking path is shown in Equation (14). The path-tracking simulation results are shown in Figure 15.
It can be seen from Figure 15c that there was a large tracking error in the linear path-tracking in the initial distance. We found that this was because the model sets the initial deviation. After the experiment was adjusted by the controller, when the vehicle was running to about 5.4 m, the pure tracking controller with fixed front view distance reached the basic steady state, and the steady-state average tracking error was 0.089 m. When the vehicle was running to 2.5 m, the adaptive pure tracking controller can achieve steady state, and the steady-state average tracking error was 0.054 m. Therefore, the adaptive pure tracking controller designed in this paper has faster response speed and higher tracking accuracy. It can be seen from Figure 15d that the adaptive pure tracking controller designed in the section with large curvature has better stability than the pure tracking controller with fixed forward-looking distance.
In the simulation, with set the vehicle speed v 0 = 0.45 m/s and the fixed forward-looking distance 2 m, the initial position of the controlled object is (0 m, 0.1 m), the tracking distance is 30 m. Set two kinds of simulation tracking trajectories. The linear tracking path is shown in Equation (13), and the curve tracking path is shown in Equation (14). The path-tracking simulation results are shown in Figure 15.
It can be seen from Figure 15c that there was a large tracking error in the linear path-tracking in the initial distance. We found that this was because the model sets the initial deviation. After the experiment was adjusted by the controller, when the vehicle was running to about 5.4 m, the pure tracking controller with fixed front view distance reached the basic steady state, and the steady-state average tracking error was 0.089 m. When the vehicle was running to 2.5 m, the adaptive pure tracking controller can achieve steady state, and the steady-state average tracking error was 0.054 m. Therefore, the adaptive pure tracking controller designed in this paper has faster response speed and higher tracking accuracy. It can be seen from Figure 15d that the adaptive pure tracking controller designed in the section with large curvature has better stability than the pure tracking controller with fixed forward-looking distance.
average tracking error was 0.089 m. When the vehicle was running to 2.5 m, the adaptive pure tracking controller can achieve steady state, and the steady-state average tracking error was 0.054 m. Therefore, the adaptive pure tracking controller designed in this paper has faster response speed and higher tracking accuracy. It can be seen from Figure 15d that the adaptive pure tracking controller designed in the section with large curvature has better stability than the pure tracking controller with fixed forward-looking distance.

Feature Map and Navigation Parameter Acquisition Accuracy Test
In order to test the reliability of the system, this paper build a simulation experimental environment in the experimental field of the Northwest A & F University (108°4'30'' E, 34°17'28'' N). And three experiments had been carried out successively which involved navigation path fitting, parameter acquisition accuracy test, vehicle trajectory tracking test. The simulated orchards were arranged in two rows with a spacing of 2.5 m and a row spacing of 4 m, and PVC plastic pipes with a length of 1.2 m were selected to simulate the trunk. The layout of the simulated test scene was similar to the real orchard environment in terms of soil environment, trunk characteristics and trunk arrangement. As shown in Figure 16a, the absolute coordinate system XOY was established with the tree P as a reference, 2 m to the left and 2.5 m to the rear as the origin O. In Figure 16b, the circumference of the simulated fruit tree trunk was measured with a tape measure at the same height as the 2D laser, and the diameter of the tree was obtained to be 0.04 m. The test platform was the hardware system described in Section 2.1.

Feature Map and Navigation Parameter Acquisition Accuracy Test
In order to test the reliability of the system, this paper build a simulation experimental environment in the experimental field of the Northwest A & F University (108 • 4 30" E, 34 • 17 28" N). And three experiments had been carried out successively which involved navigation path fitting, parameter acquisition accuracy test, vehicle trajectory tracking test. The simulated orchards were arranged in two rows with a spacing of 2.5 m and a row spacing of 4 m, and PVC plastic pipes with a length of 1.2 m were selected to simulate the trunk. The layout of the simulated test scene was similar to the real orchard environment in terms of soil environment, trunk characteristics and trunk arrangement. As shown in Figure 16a, the absolute coordinate system XOY was established with the tree P as a reference, 2 m to the left and 2.5 m to the rear as the origin O. In Figure 16b, the circumference of the simulated fruit tree trunk was measured with a tape measure at the same height as the 2D laser, and the diameter of the tree was obtained to be 0.04 m. The test platform was the hardware system described in Section 2.1.
We placed the test platform statically to capture 2D laser point data at the center of the simulated orchard environment. We placed tree branches as noise disturbance in the driving area of the test platform. The method of fruit tree position information determination in Section 2.2 was used to process the laser point cloud data. According to the actual simulated environmental parameters, take the left and right three fruit trees as the target, set the distance threshold ρ max = 10 m, x max = 2.5 m, the number of adjacent points k = 5. The laser point cloud figure after distance threshold processing was shown in Figure 17a; the laser point cloud figure after filter processing was shown in Figure 17b. As shown in Figure 17c, the red points were actual points of trunk, the black points were prediction points of trunk. The method of Section 2.3 was used to fit navigation path and obtain navigation control parameter, as show in Figure 17d.

Feature Map and Navigation Parameter Acquisition Accuracy Test
In order to test the reliability of the system, this paper build a simulation experimental environment in the experimental field of the Northwest A & F University (108°4'30'' E, 34°17'28'' N). And three experiments had been carried out successively which involved navigation path fitting, parameter acquisition accuracy test, vehicle trajectory tracking test. The simulated orchards were arranged in two rows with a spacing of 2.5 m and a row spacing of 4 m, and PVC plastic pipes with a length of 1.2 m were selected to simulate the trunk. The layout of the simulated test scene was similar to the real orchard environment in terms of soil environment, trunk characteristics and trunk arrangement. As shown in Figure 16a, the absolute coordinate system XOY was established with the tree P as a reference, 2 m to the left and 2.5 m to the rear as the origin O. In Figure 16b, the circumference of the simulated fruit tree trunk was measured with a tape measure at the same height as the 2D laser, and the diameter of the tree was obtained to be 0.04 m. The test platform was the hardware system described in Section 2.1. We placed the test platform statically to capture 2D laser point data at the center of the simulated orchard environment. We placed tree branches as noise disturbance in the driving area of the test platform. The method of fruit tree position information determination in Section 2.2 was used to process the laser point cloud data. According to the actual simulated environmental parameters, take the left and right three fruit trees as the target, set the distance threshold ρmax = 10 m, xmax = 2.5 m, the number of adjacent points k = 5. The laser point cloud figure after distance threshold processing was shown in Figure 17a; the laser point cloud figure after filter processing was shown in Figure 17b. As shown in Figure 17c, the red points were actual points of trunk, the black points were prediction points of trunk. The method of Section 2.3 was used to fit navigation path and obtain navigation control parameter, as show in Figure 17d. It can be seen from Figure 17b that the number of laser points on the same fruit tree after European clustering was five or six points. The density of laser points was related to the distance from the trunk to the laser and the diameter of it. In this study, laser data processing was carried out with three singles as one cycle. The distance of the furthest trunk was 7.5 m. It was within the range of laser measurement. Since the laser angle resolution was 0.25°, the problem of missing laser data points was small when locating a simulated trunk with a maximum distance of 7.5 m and a diameter of 4 cm. Therefore, it can provide enough laser points support for the extraction of trunk center feature point.
In Figure 17c, the obtained center point feature map of the trunk has no interference points; the error from the actual position of trunk were 6.79 cm, 2.86 cm, 2.67 cm, 2.33 cm, 2.29 cm and 3.01 cm, from left to right and bottom to top, the average error was 3.325 cm. The results show that the method of obtaining the center point feature map of trunk meets the requirements of positioning accuracy. It can be seen from Figure 17b that the number of laser points on the same fruit tree after European clustering was five or six points. The density of laser points was related to the distance from the trunk to the laser and the diameter of it. In this study, laser data processing was carried out with three singles as one cycle. The distance of the furthest trunk was 7.5 m. It was within the range of laser measurement. Since the laser angle resolution was 0.25 • , the problem of missing laser data points was small when locating a simulated trunk with a maximum distance of 7.5 m and a diameter of 4 cm. Therefore, it can provide enough laser points support for the extraction of trunk center feature point.
In Figure 17c, the obtained center point feature map of the trunk has no interference points; the error from the actual position of trunk were 6.79 cm, 2.86 cm, 2.67 cm, 2.33 cm, 2.29 cm and 3.01 cm, from left to right and bottom to top, the average error was 3.325 cm. The results show that the method of obtaining the center point feature map of trunk meets the requirements of positioning accuracy. The linear regression fitting R 2 of the navigation path was 0.988, which is close to 1. The results show that the method of extracting the navigation path was accurate and reliable.
This experiment puts the test platform in static simulation 2D laser point data at any position in the simulated orchard environment; the heading deviation and lateral deviation obtained by human measurement were taken as the true value. The result is a measured value. The detection range θ is [−30 • , 30 • ], with a sampling interval of 5 • . In order to avoid random errors caused by human operation, three tests were performed for each position to obtain an average value as the calculated heading deviation and calculation at that angle. The test results were shown in Table 4. The mean absolute deviation (MAD) and the standard deviation (SD) were used to evaluate and analyze experiment data. It can be seen from Table 4 that the maximum deviation of the heading angle is 0.95 • , the MAD of heading angle θ was 0.682 • , the SD of heading angle θ was 0.237 • . The lateral deviation d maximum error was 4.66 cm, the MAD was 2.119 cm and the SD was 1.010 cm. The method proposed was used to obtain the navigation path identification and navigation parameter acquisition, which can meet the accuracy requirements of the experimental platform in the orchard autonomous navigation operation.

Path-Tracking Accuracy Test
The test platform was automatically driven at a speed of 0.45 m/s, the test distance was 30 m and the measurement was carried out at intervals of 30 cm. The test was carried out in 5 groups; the test section of the unilateral fruit tree was missing at a driving distance of 10 m-15 m. At 20 m-25 m, the test section of the bilateral fruit trees was missing. The results after each test were shown in Table 5; the average tracking deviation of the test is shown in Figure 18.  Figure 18. Variation of average deviation of lateral deviation and walking distance.
As can be seen from Table 4, the maximum lateral deviation after the five tests was 0.13 m, the maximum average deviation was 0.08 m, the MAD of maximum deviation was 0.096 m, the MAD of average deviation was 0.048 m and the SD of average deviation was 0.034 m. It can be seen from Figure 18 that the lateral deviation gradually decreases after the vehicle was 2.5 m. At 5 m, the lateral deviation tends to zero, and then the lateral deviation gradually increases. At 10.6 m, the average maximum lateral deviation was 0.096 m., The deviation fluctuates continuously, and the lateral deviation was basically 0 m at 30 m. At the same time, we can observe that the variation of lateral deviation was not increased due to the loss of fruit trees. Therefore, the effect of missing fruit trees on the accuracy of the navigation control system proposed in this paper was not obvious, indicating that the system has good accuracy and robustness.

Conclusions
In order to achieve autonomous driving and path-tracking of vehicles in complex standardized orchards that involve high noise and interference between rows of fruit trees, an automatic vehicle navigation method based on 2D lasers was developed for standardized orchards under complex disturbance environments. This study presents a filtering algorithm based on Euclidean clustering algorithms by analyzing different types of orchard interference points. The algorithm can effectively eliminate noise generated by small disturbances in the orchard by setting different thresholds, thus greatly improving positioning accuracy. Considering prior knowledge of plant spacing, row spacing and trunk diameter, a topographic map of orchard trees' center was extracted and a target navigation path with higher precision was fit, based on least square methods and geometric linear fitting. It reduces the computation of data processing and complex mathematical models. At the same time, in the pure tracking model, fuzzy control was used to realize the adaptive adjustment of the forwardlooking distance. Additionally, the orchard 2D laser automatic navigation system based on agricultural electric vehicle was designed, and its robustness and control accuracy were verified by experiments. This study satisfies the precision requirements of orchard vehicle automatic navigation and provides guidance and suggestions for the industrial application of laser navigation with high precision and low cost in the standardized orchard planting industry.
Author Contributions: Methodology, S.Z. and C.G.; validation, Z.G. and A.S.; formal analysis, S.Z. and J.C., writing-original draft preparation, S.Z.; writing-review and editing, J.C. and Y.C. As can be seen from Table 4, the maximum lateral deviation after the five tests was 0.13 m, the maximum average deviation was 0.08 m, the MAD of maximum deviation was 0.096 m, the MAD of average deviation was 0.048 m and the SD of average deviation was 0.034 m. It can be seen from Figure 18 that the lateral deviation gradually decreases after the vehicle was 2.5 m. At 5 m, the lateral deviation tends to zero, and then the lateral deviation gradually increases. At 10.6 m, the average maximum lateral deviation was 0.096 m., The deviation fluctuates continuously, and the lateral deviation was basically 0 m at 30 m. At the same time, we can observe that the variation of lateral deviation was not increased due to the loss of fruit trees. Therefore, the effect of missing fruit trees on the accuracy of the navigation control system proposed in this paper was not obvious, indicating that the system has good accuracy and robustness.

Conclusions
In order to achieve autonomous driving and path-tracking of vehicles in complex standardized orchards that involve high noise and interference between rows of fruit trees, an automatic vehicle navigation method based on 2D lasers was developed for standardized orchards under complex disturbance environments. This study presents a filtering algorithm based on Euclidean clustering algorithms by analyzing different types of orchard interference points. The algorithm can effectively eliminate noise generated by small disturbances in the orchard by setting different thresholds, thus greatly improving positioning accuracy. Considering prior knowledge of plant spacing, row spacing and trunk diameter, a topographic map of orchard trees' center was extracted and a target navigation path with higher precision was fit, based on least square methods and geometric linear fitting. It reduces the computation of data processing and complex mathematical models. At the same time, in the pure tracking model, fuzzy control was used to realize the adaptive adjustment of the forward-looking distance. Additionally, the orchard 2D laser automatic navigation system based on agricultural electric vehicle was designed, and its robustness and control accuracy were verified by experiments. This study satisfies the precision requirements of orchard vehicle automatic navigation and provides guidance