Trajectory tracking control of agricultural vehicles based on disturbance test

Zhengduo Liu, Wenxiu Zheng, Neng Wang, Zhaoqin Lyu, Wanzhi Zhang

Abstract


To improve the trajectory tracking robust stability of agricultural vehicles, a path tracking control method combined with the characteristics of agricultural vehicles and nonlinear model predictive control was presented. Through the proposed method, the path tracking problem can be divided into two problems with speed and steering angle constraints: the trajectory planning problem, and the trajectory tracking optimization problem. Firstly, the nonlinear kinematics model of the agricultural vehicle was discretized, then the derived model was inferred and regarded as the prediction function plant for the designed controller. Second, the objective function characterizing the tracking performance was put forward based on system variables and control inputs. Therefore, the objective function optimization problem, based on the proposed prediction equation plant, can be regarded as the nonlinear constrained optimization problem. What’s more, to enhance the robust stability of the system, a real-time feedback and rolling adjustment strategy was adopted to achieve optimal control. To validate the theoretical analysis before, the Matlab simulation was performed to investigate the path tracking performance. The simulation results show that the controller can realize effective trajectory tracking and possesses good robust stability. Meanwhile, the corresponding experiments were conducted. When the test vehicle tracked the reference track with a speed of 3 m/s, the maximum lateral deviation was 13.36 cm, and the maximum longitudinal deviation was 34.61 cm. When the added horizontal deviation disturbance Yr was less than 1.5 m,　the controller could adjust the vehicle quickly to make the test car return to the reference track and continue to drive. Finally, to better highlight the controller proposed in this paper, a comparison experiment with a linear model predictive controller was performed. Compared to the conventional linear model predictive controller, the horizontal off-track distance reduced by 36.8% and the longitudinal deviation reduced by 32.98% when performing circular path tracking at a speed of 3 m/s.
Keywords: path tracking, nonlinearity, controller, robustness
DOI: 10.25165/j.ijabe.20201302.4506

Citation: Liu Z D, Zheng W X, Wang N, Lyu Z Q, Zhang W Z. Trajectory tracking control of agricultural vehicles based on disturbance test. Int J Agric & Biol Eng, 2020; 13(2): 138–145.

Keywords


path tracking, nonlinearity, controller, robustness

Full Text:

PDF

References


Starcevica N, Thullner C, Bux M, Muller J. 3D path planning for a biomass processing robot via motion simulation. Robotics and Computer-Integrated Manufacturing, 2010; 26(1): 109–118.

Sutoh M, Otsuki M, Wakabayashi S, Hoshino T, Hashimoto T. The right path: comprehensive path planning for lunar exploration rovers. IEEE Robotics & Automation Magazine, 2015; 22(1): 22–23.

Garcia P L, Garcia A M C, Ribeiro A, Guinea D. An agent of behaviour architecture for unmanned control of a farming vehicle. Computers and Electronics in Agriculture, 2008; 60: 39–48.

Zhao Y S, Gong L, Zhou B, Huang Y X, Niu Q L, Liu C L. Object recognition algorithm of tomato harvesting robot using non-color coding approach. Transactions of the CSAE, 2016; 47(7): 1–7. (in Chinese)

Qian X M, Zhang H, Wang X Y, Wu X. Research on relative positioning technology of mobile robots based on laser scanning matching. Journal of agricultural machinery, 2016; 47(3): 14–21.

Huang Y J, Lee F F. An automatic machine vision-guided grasping system for Phalaenopsis tissue culture plantlets. Computers and Electronics in Agriculture, 2010; 70: 42–51.

Alberto T, Xavier P B, Gonzalo P. A new vision-based approach to differential spraying in precison agriculture. Computers and Electronics, 2010; 70(6): 144–155.

Cen Y, Song C, Xie N, Wang L. Path planning method for mobile robot based on ant colony optimization algorithm. Industrial Electronics and Applications . ICIEA, Iciea, 2008; pp.298–301.

Zhao Y, Yang W. Technological development of agricultural tractor. Transactions of the CSAE, 2010; 41(6): 42–48. (in Chinese)

Wang R G, Zhang H, Wang J. Linear parameter-varying controller design for four-wheel independently actuated electric ground vehicle with active steering systems. IEEE Transactions on Control Systems Technology, 2014; 22(4): 1281–1296.

Enache N M, Mammar S, Netto M, Lusetti B. Driver steering assistance for lane-departure avoidance based on hybrid automata and composite lyapunov function. IEEE Transactions on Intelligent Transportation Systems, 2010; 11(1): 28–39.

Wu S J, Chiang H H, Perng J W. The heterogeneous systems integration design and implementation for lane keeping on a vehicle. IEEE Transactions on Intelligent Transportation Systems, 2008; 9(2): 246–263.

Sun Y Y, Zhang S L, Li W. Guidance lane detection for pesticide spraying robot in cotton fields. Journal of Tsinghua University: Science and Technology, 2007; 47(2): 206–209. (in Chinese)

Wu X, Shen W, Lou P, Wang L. Research on robust feature recognition and accurate path tracking of vision-guided AGV. Journal of Agricultural Machinery, 2016; 47 (7): 48–56.

Li T H, Wu Z H, Lian X K, Hou J L, Shi G Y, Wang Q. Navigation line detection for greenhouse carrier vehicle based on fixed direction camera. Transactions of the CSAE, 2018; 49(S1): 8–13. (in Chinese)

Wei S, Li S C, Zhang M, Ji Y H, Xiang M, Li M Z. Automatic navigation path search and turning control of agricultural machinery based on GNSS. Transactions of the CSAE, 2017; 33(Z1): 70–77. (in Chinese)

Jin B, Li J X, Zhu D K, Guo J, Su B F. GPS/INS navigation based on adaptive finite impulse response-Kalman filter algorithm. Transactions of the CSAE, 2019; 35(3): 75–81. (in Chinese)

Ji C Y, Zhou J. Current situation of navigation technologies for agricultural machinery. Transactions of the CSAE, 2014; 45(9): 44–54. (in Chinese)

Luo X W, Zhang Z G, Zhao Z X, Chen B, Hu L, Wu X P．Design of DGPS navigation control system for Dongfanghong X-804 tractor. Transactions

of the CSAE, 2009; 25(11): 139–145. (in Chinese)

Erkan K, Erdal K, Herman R, Wouter S. Towards agrobots: Identification of the yaw dynamics and trajectory tracking of an autonomous tractor. Computers and Electronics in Agriculture, 2015; 115: 78–87.

Li Y J, Zhao Z X, Huang P K, Guan W, Wu X P. Automatic Navigation System of Tractor Based on DGPS and Double Closed-loop Steering Control. Transactions of the CSAE, 2017; 48(2): 11–19. (in Chinese)

Li Y J, Zhao Z X, Gao J W, Wu X P, Guan W. Agricultural automatic navigation system based on DGPS positioning and double closed-loop steering control. Research of Agricultural Modernization, 2016; 37(2): 387–394.

Zang Y, Zang Y, Zhou Z Y, Gu X Y, Jiang R, Kong L X, et al. Design and anti-sway performance testing of pesticide tanks in spraying UAVs. Int J Agric & Biol Eng, 2019; 12(1): 10–16.

Zhou Z Y, Ming R, Zang Y, He X G, Luo X W, Lan Y B. Development status and countermeasures of agricultural aviation in China. Transactions of the CSAE, 2017; 33(20): 1–20. (in Chinese)

Yu F H, Xu T Y, Du W, Ma H, Zhang G S, Chen C L. Radiative transfer models (RTMs) for field phenotyping inversion of rice based on UAV hyperspectral remote sensing. Int J Agric & Biol Eng, 2017; 10(4): 150–157.

Zhao D, Luo J, Sun Y P, Hong J Q, Zhang J. Design and experiment of navigation control system of automatic operation boat in river crab culture. Transactions of the CSAE, 2016; 32(11): 181–188. (in Chinese)

Liu Z D, Lv Z Q, Zheng W X, Zhang W Z, Cheng X X. Design of obstacle avoidance controller for agricultural tractor based on ROS. Int J Agric & Biol Eng, 2019; 12(6): 58–65.

Hu J T, Gao L, Bai X P. Research progress on automatic navigation of agricultural machinery. Transactions of the CSAE, 2015; 31(10): 1–10. (in Chinese)

Shamshiri R R, Weltzein C, Hameed I A, Yule I J, Grift T E, Balasundram S K, et al. Research and development in agricultural robotics: A perspective of digital farming. Int J Agric & Biol Eng, 2018; 11(4): 1–14.

Felix V H, Himmelsbach M, Hecker F, Andre M, Wuensche H J. Driving with tentaches: Integral structures for sensing and motion. Journal of Field Robotics, 2008; 25(9): 640–673.

Velenis E, Frazzoli E, Tsiotras P. Steady-state Cornering equilibria and stabilization for a vehicle during extreme operating conditon. International Journal of Vehicle Autonomous Systems, 2010, 8(2/3/4): 217–241.

Wang H, Wang G M, Luo X W, Zhang Z G, Gao Y, He J, Yue B B. Path tracking control method of agricultural machine navigation based on aiming pursuit model. Transactions of the CSAE, 2019; 35(4): 11–19. (in Chinese)

Yang J, Shi G S, Zhang W M, Zhao X, Dun H Y, Si J X. Path tracking algorithm of vehicles based on fuzzy hyperbolic tangent model. Transactions of the CSAE, 2017; 33(Z1): 78–84. (in Chinese)

Shamshiri R R, Hameed I A, Pitonakova L, Weltzien C, Balasundram S K, Yule I J, et al. Simulation software and virtual environments for acceleration of agricultural robotics: Features highlights and performance comparison. Int J Agric & Biol Eng, 2018; 11(4): 15–31.

Costa C, Febbi P, Pallottino F, Cecchini M, Figorilli S, Antonucci F, et al. Stereovision system for estimating tractors and agricultural machines transit area under orchards canopy. Int J Agric & Biol Eng, 2019; 12(1): 1–5.

Liu Z D, Lv Z Q, Zhang W Z. Design and experiment of path tracking of agricultural vehicle. IAEJ, 2018; 27(4): 44–52.




Copyright (c) 2020 International Journal of Agricultural and Biological Engineering

Creative Commons License
This work is licensed under a Creative Commons Attribution 4.0 International License.

2023-2026 Copyright IJABE Editing and Publishing Office