Orchard Navigation Algorithm for Self-Driving Vehicles Under Poor GPS Signal
摘要
This paper develops a navigation algorithm for self-driving orchard robots that can be used even in situations where GPS signals are poor. RTK GPS can be used to estimate the location of outdoor mobile vehicles and robots, but in orchard environments, location accuracy may be reduced due to trees. To solve this problem, we present a monocular camera-based local localization method that estimates the position and heading of the robots relative to the row center line. Local localization results have inaccuracies due to the absence of accurate distance information. To complement this, we propose a Kalman filter-based global localization algorithm that combines vision, RTK GPS, IMU, and BLDC motor hall sensors. The proposed algorithm under poor GPS signal is compared with the ground truth results that always use RTK GPS signal. Additionally, we developed a path tracking control algorithm based on preview distance. The combined localization and control algorithm verified through experiments.