GNSS and LiDAR Integrated Navigation Method in Orchards with Intermittent GNSS Dropout

Considering the vulnerability of satellite positioning signals to obstruction and interference in orchard environments, this paper investigates a navigation and positioning method based on real-time kinematic global navigation satellite system (RTK-GNSS), inertial navigation system (INS), and light detection and ranging (LiDAR). This method aims to enhance the research and application of autonomous operational equipment in orchards. Firstly, we design and integrate robot vehicles; secondly, we unify the positioning information of GNSS/INS and laser odometer through coordinate system transformation; next, we propose a dynamic switching strategy, whereby the system switches to LiDAR positioning when the GNSS signal is unavailable; and finally, we combine the kinematic model of the robot vehicles with PID and propose a path-tracking control system. The results of the orchard navigation experiment indicate that the maximum lateral deviation of the robotic vehicle during the path-tracking process was 0.35 m, with an average lateral error of 0.1 m. The positioning experiment under satellite signal obstruction shows that compared to the GNSS/INS integrated with adaptive Kalman filtering, the navigation system proposed in this article reduced the average positioning error by 1.6 m.