Conceptualization, H.C. and R.Z.; methodology, H.C.; software, H.C. and J.P.; validation, H.C., R.Z. and J.P.; resources, H.C.; data curation, Y.W.; writing—original draft preparation, H.C. and Y.W.; writing—review and editing, H.C., J.P., R.Z. and Y.W.; supervision, Y.W.; project administration, Y.W. and P.J.; funding acquisition, Y.W.; investigation, H.C. All authors have read and agreed to the published version of the manuscript. This research was funded by the National Key R&D Program of China under the sub-project “Research and System Development of Navigation Technology for Harvesting Machine of Special Economic Crops” (No. 2022YFD2002001) within the key program “Engineering Science and Comprehensive Interdisciplinary Research”.