Navigation system for orchard spraying robot based on 3D LiDAR SLAM with NDT_ICP point cloud registration

Autonomous navigation of orchard spraying robots can effectively improve operational efficiency and reduce workload. The conventional robot navigation solutions based on the Global Navigation Satellite System (GNSS) are susceptible to signal loss in orchards due to interference from the canopy of fruit trees. In this paper, an autonomous navigation scheme for orchard spraying robots based on multi-sensor devices and the three-dimensional (3D) LiDAR Simultaneous Localization and Mapping (SLAM) technology. The initial step of the scheme involved the construction of a 3D point cloud map of the orchard using the 3D LiDAR SLAM algorithm. Subsequently, a designed point cloud map transformation algorithm was used to convert the 3D point cloud map of the orchard into a two-dimensional (2D) grid map containing key feature information of the orchard. To enhance the mapping accuracy of the orchard point cloud, a point cloud registration algorithm combining Iterative Closet Point (ICP) and Normal Distributions Transform (NDT) was proposed. This algorithm initially utilized the NDT algorithm for coarse point cloud registration to obtain transformation parameters. Then, the ICP algorithm was applied in conjunction with the obtained parameters for fine registration. Regarding obstacle avoidance, a cooperative obstacle avoidance algorithm based on the Robot Operating System (ROS) multithreaded communication mechanism was introduced. Experimental trials conducted in a standardized spindle-shaped peach orchard validated the successful completion of the SLAM mapping trajectory, which was achieved through the utilization of the proposed NDT_ICP point cloud registration algorithm. The average absolute pose error between the mapped trajectory and the reference trajectory was 1.173 m, with a standard deviation of 0.498 m. The robot's positioning and navigation errors increased with higher speeds, with the largest positioning deviation observed at 1.2 m/s speed, with a maximum lateral positioning error of 7.04 cm. The robot's average lateral navigation error did not exceed 16 cm, and the average heading deviation was less than 8° at different speeds of 0.4, 0.8 and 1.2 m/s. Both the positioning and navigation accuracies of the robot were sufficient to meet the autonomous operational requirements of orchard spraying robots.