Improved Pure Pursuit Path Tracking Control Method for Automatic Navigation Tractor Based on Drive Wheel Lateral Deviation Compensation

HE Jie, ZENG Hongxi, ZENG Hongxi, LI Mingjin, HE Jing, MO Jiajun, WANG Pei, ZHAO Runmao

Abstract

Automatic navigation tractors experience large path tracking errors, easy overshoot in correction, and long adjustment times under conditions such as lateral deviation and sideslip. Aiming to address the problem of fast correction for lateral deviation and sideslip in tractors, an improved pure pursuit path tracking control method was proposed, based on a lateral control compensation strategy for the drive wheels. By constructing a tractor sideslip model on a slope and combining it with a two-wheel vehicle kinematic model, a lateral control compensation strategy was introduced to improve the classic pure pursuit algorithm, achieving precise lateral compensation control for autonomous tractors. To validate the performance of the proposed lateral deviation compensation improved pure pursuit path tracking algorithm, CarSim/ Simulink co-simulation was designed. The results of the sloped test showed that the improved algorithm enhanced control accuracy by 73.6% on a 10°slope compared with that of the classic algorithm. In the continuous sideslip simulation, the classic algorithm failed to escape, whereas the improved algorithm completed escape within 3.9 s, with lateral deviation converging to within 0.01 m and an overshoot of 0.14 m. Field tests were conducted to verify the effectiveness of the improved algorithm, with multiple trials showing an average escape time of 7.03 s and a maximum overshoot of 0.054 m. The test results demonstrated that the proposed lateral control compensation strategy significantly improved the control accuracy and stability of autonomous navigation tractors in complex working conditions.

 

Keywords: tractor, autonomous navigation, path tracking, pure pursuit algorithm, lateral deviation compensation, sideslip

 

Download Full Text:

PDF


References


XIE Bin, WU Zhongbin, MAO Enrong, et al. Development status and prospect of key technologies for agricultural tractors [J]. Transactions of the Chinese Society for Agricultural Machinery,2018,49(8) : 1 — 17. (in Chinese)

MENG Zhijun, WANG Hao, FU Weiqiang, et al. Research status and prospects of automatic driving technology for agricultural equipment [J]. Transactions of the Chinese Society for Agricultural Machinery, 2023, 54(10) ; 1 -24. (in Chinese)

WEI Liguo. Research on multi-modal variable structure intelligent control methods for agricultural machinery navigation[ J]. Beijing: Chinese Academy of Agricultural Mechanization Sciences, 2015. (in Chinese)

ZHANG Man, JI Yuhan, LI Shichao, et al. Progress in agricultural machinery navigation technology research [J]. Transactions of the Chinese Society for Agricultural Machinery,2020,51 (4) -.1 - 18. (in Chinese)

BAYAR G, BERGERMAN M, KOKU A B. Improving the trajectory tracking performance of autonomous orchard vehicles using wheel slip compensation[ J ]. Biosystems Engineering,2016,146; 149 - 164.

JING Y, LIU G, LUO C. Path tracking control with slip compensation of a global navigation satellite system based tractor- scraper land levelling system [ J ]. Biosystems Engineering ,2021 ,212;360 -377.

LI Meng, WANG Yuan, TANG Yanling, et al. Heading control technology of unmanned agricultural machinery considering body shake and slip [J ]. Southern Agricultural Machinery,2024,55(8) : 1 — 4. (in Chinese)

XIAO Shide, JIANG Haifeng, IU Jinlan, et al. Research on agricultural vehicle path tracking algorithm based on two-stage pure tracking model [J ]. Transactions of the Chinese Society for Agricultural Machinery, 2023, 54 (4) ; 439 - 446. (in Chinese)

JIANG Guiyuan. Agricultural machinery path tracking method based on fuzzy adaptive pure tracking model [ J ]. Southern Agricultural Machinery, 2022, 53(23) :56 -59. (in Chinese)

ТАО Jinjing, LIAO Min, PAN Qunlin, et al. Static longitudinal stability of wheeled tractor-implement combinations [J]. Science Technology and Engineering,2019,19(34) ;108-115. (in Chinese)

JING Yunpeng, LIU Gang, JIN Zhikun. Estimation of side slip and adaptive control method for farm land leveler navigation [ J ]. Transactions of the Chinese Society for Agricultural Machinery, 2020,51 (9) :26 -33. (in Chinese)

AHMADI 1. Dynamics of tractor lateral overturn on slopes under the influence of position disturbances (model development) [J ]. Journal of Terramechanics ,2011 ,48 (5) :339 - 346.

HAN J, WANG Y, SUN C. A method for analysing the lateral stability of wheeled farm tractors by obstacles on slopes[ J ]. International Journal of Vehicle Design, 2023, 91(4) : 289 -302.

LL Wenjie, MA Kong, LI Suilao, et al. Improved path tracking algorithm based on pure pursuit model[ J]. Measurement & Control Technology ,2011 ,30(7) ;93 -96. (in Chinese)

ZHANG Wenyu, DING Youchun, WANG Xueling, et al. Pure pursuit control method of tractor navigation based on SVR inverse model [J]. Transactions of the Chinese Society for Agricultural Machinery,2016,47(1) :29 -36. (in Chinese)

GAMEZ SEKNA C, LOMBARD A, RUICHEK Y, et al. GPS-based curve estimation for an adaptive pure pursuit algorithm [C]// Advances in Computational Intelligence: 15th Mexican International Conference on Artificial Intelligence,2016;497 - 511.

ZHANG Huaqiang, WANG Guodong, LL Yunfei, et al. Research on agricultural machinery path tracking algorithm based on improved pure pursuit model[J] . Transactions of the Chinese Society for Agricultural Machinery,2020,51 (9) : 18 -25. (in Chinese)

YANG Y, LI Y, WEN X, et al. An optimal goal point determination algorithm for automatic navigation of agricultural machinery: improving the tracking accuracy of the Pure Pursuit algorithm [J] . Computers and Electronics in Agriculture,2022, 194:106760.

LI Ge, WANG Yu, GUO Liufen, et al. Improved pure pursuit algorithm for rice transplanter navigation path tracking [ J]. Transactions of the Chinese Society for Agricultural Machinery,2018,49(5) ;21 -26. (in Chinese)

KORAYEM M H, SAFARBALI M, LADEMAKHI N Y. Adaptive robust control with slipping parameters estimation based on intelligent learning for wheeled mobile robot[ J ]. ISA Transactions,2024,147:577 -589.


Refbacks

  • There are currently no refbacks.