Adaptive Guidance Control Method with Sideslip Estimation for Land Leveler Pulling by Tractor
Abstract
Sideslip phenomenon often occur when land leveler works in farmland environment, in order to reduce the influence of sideslip angle on path tracking accuracy, an adaptive guidance control method with sideslip estimation for land leveler pulling by tractor was proposed. According to the position relationship between forklift and tractor, the kinematic model of land leveler was established. A sideslip estimator based on the kinematic model was designed, which could predict the wheel slip angle due to sideslip during navigation control. Moreover, the front wheel angle control rate considering sideslip effect of tractor was calculated. Finally, an improved nonlinear function construction method was adopted to adjust the parameters of PID controller KP, KI and KD in real time to realize the adaptive control of the farmland leveler. The results of fields test showed that the path tracking mean absolute lateral of the leveling shovel in this method was reduced by 6.78cm, and the standard lateral of the leveling shovel in this method was reduced by 10.1cm. Compared with the navigation control method with no sideslip estimation and parameters adaptive, this method can improve the path tracking accuracy and the adaptability and robustness of the navigation control system for the farmland leveler.
Keywords: land leveler, guidance, sideslip estimation, adaptive control, nonlinear self-tuning
Download Full Text:
PDFReferences
ZHANG Man, JI Yulian, LI Shichao, et al. Research progress of agricultural machinery navigation technology [J/OL]. Transactions of the Chinese Society for Agricultural Machinery, 2020, 51 (4) : 1 - 18. http: // www. j-csam. org/jcsam/ch/ reader/view_abstract. aspx? flag = 1 &file_no = 20200401 &joumal_id =jcsam. DOI: 10. 6041/j. issn. 1000-1298.2020.04.001.( in Chinese)
LIU Gang, LI Xiao, KANG Xi, et al. Automatic navigation path planning method for land leveling based on GNSS J/OL]. Transactions of the Chinese Society for Agricultural Machinery, 2016, 47 ( Supp. ) : 21 -29. http:// www. j-csam. org/jcsam/ ch/reader/view_abstract. aspx? flag = l&file_no = 2016s004&journal_id = jcsam. DOI: 10. 6041/j. issn. 1000-1298. 2016. SO. 004. (in Chinese)
LIU Gang, KANG Xi, XIA Youxiang, et al. Global path planning algorithm and experiment based on GNSS-controlled precise land leveling system [ J/OL]. Transactions of the Chinese Society for Agricultural Machinery, 2018, 49(5) : 27 -33. http:// www. j-csam. оrg/jcsam/eh/reader/view_abstract, aspx? flag = l&file_no = 20180503&joumal_id = jcsam. DOI; 10. 6041/j. issn. 1000-1298.2018.05.003. (in Chinese)
WANG Yan, LI Hongpeng, NIU Dongling, et al. Real-time path planning and navigation in GNSS-controlled land leveling [ J/ OL]. Transactions of the Chinese Society for Agricultural Machinery, 2014, 45 (Supp. ) ; 271 -275. http:// www. j-csam. org/ jcsam/ch/reader/view_abstract. aspx? flag = l&fde_no = 2014sl44&journal_id = jcsam. DOI: 10. 6041/j. issn. 1000-1298. 2014. SO. 044. ( in Chinese)
LI Ge, WANG Yu, GUO Liufen, et al. Improved pure pursuit algorithm for rice transplanter path tracking [J/OL]. Transactions of the Chinese Society for Agricultural Machinery, 2018, 49(5): 21 - 26. http: // www. j-csam. org/jcsam/ch/ reader/view_abstract. aspx? flag = l&file_no = 20180502&journal_id = jcsam. DOI: 10. 6041/j. issn. 1000-1298. 2018. 05. 002. (in Chinese)
FENG Huimin, GAO Na’na, MENG Zhijun, et al. Design and experiment of deep fertilizer applicator based on autonomous navigation for precise row-following [J/OL]. Transactions of the Chinese Society for Agricultural Machinery, 2018, 49(4) ; 60 - 67. http:// www. j-csam. org/jcsam/ch/reader/view _ abstract, aspx? flag = l&file_no = 20180407&journal_ id = jcsam. DOI; 10. 6041/j. issn. 1000-1298. 2018. 04. 007. (in Chinese)
BAI Xiaoping, HU Jingtao, GAO Lei, et al. Self-tuning model control method for farm machine navigation [J/OL]. Transactions of the Chinese Society for Agricultural Machinery, 2015, 46(2) :1 -7. http:// www. j-csam. org/jcsam/ch/reader/ view_abstract. aspx? flag = l&file_no = 20150201 &journal_id = jcsam. DOI; 10. 6041/j. issn. 1000-1298. 2015. 02. 001. ( in Chinese)
HU Lian, DU Pan, LUO Xiwen, el al. Design and experiment on multi-wheel support laser land leveler hanging on tractor [ J/OL]. Transactions of the Chinese Society for Agricultural Machinery, 2019, 50(8) ; 15-21. http://www.j-csam.org/jcsam/ ch/reader/view_abstract. aspx? flag = l&file_no = 20190802&journal_id = jcsam. D01:10. 6041/j. issn. 1000-1298. 2019. 08. 002. (in Chinese)
LI Xiao, LI Hongpeng, NIU Dongling, et al. Optimization of GNSS-controlled land leveling system and related experiments [J]. Transactions of the CSAE, 2015, 31(3) : 48 —55. (in Chinese)
BACKMAN J, OKSANEN T, VISALA A. Navigation system for agricultural machines; nonlinear model predictive path tracking [J]. Computers and Electronics in Agriculture, 2012, 82 *.32 -43.
ERKAN K, ERDAL K, HERMAN R, et al. Nonlinear modeling and identification of an autonomous tractor-trailer system [J]. Computers and Electronics in Agriculture, 2014, 106:1 - 10.
ZHANG Guangqing, ZHU Sihong, LI Weihua, et al. Simulation and experiment of in-situ steering of large wheel tractor with hinge swing link [J/OL]. Transactions of the Chinese Society for Agricultural Machinery, 2012, 43(10) ; 25 -30. http:// www. j-csam. org/jcsam/ch/reader/view_ abstract, aspx? flag = 1 &file_no = 20121005&journal_id = jcsam. DOI: 10. 6041/j. issn. 1000-1298.2012. 10.005. (in Chinese)
ZHAO Xuan, YANG Jue, ZHANG Wenming, et al. Sliding mode control algorithm for path tracking of articulated dump truck [ J ]. Transactions of the CSAE , 2015 , 31(10): 198 - 203. (in Chinese)
SHAO Junkai, ZHAO Xuan, YANG Jue, et al. Reinforcement learning algorithm for path following control of articulated vehicle [J/OL]. Transactions of the Chinese Society for Agricultural Machinery, 2017, 48(3) ; 376 -382. http:// www. j. csam.org/jcsam/ch/reader/view_ahstract. aspx? flag = l&file_no = 20170348&journal_id = jcsam. DOI; 10. 6041/j. issn. 1000-1298.2017.03.048. (in Chinese)
MENG Yu, WANG Yu, GU Qing, et al. LQR — GA path tracking control of articulated vehicle based on predictive information [J/OL]. Transactions of the Chinese Society for Agricultural Machinery, 2018,49(6) : 375 -384. http:// www. j-csam. org/ jcsam/ch/reader/view_abstract. aspx? flag = 1 &file_no = 20180645&joumal_id = jcsam. DOI: 10. 6041/j. issn. 1000-1298. 2018.06.045. (in Chinese)
BAI Guoxing, LIU Li, MENG Yu, et al. Study of obstacle avoidance controller of agricultural tractor -trailers based on predictive control of nonlinear model J/OL . Transactions of the Chinese Society for Agricultural Machinery, 2019,50(4) ; 356 -362. http://www. j-csam. org/jcsam/ch/reader/view_abstract. aspx? flag = l&file_no = 20190441 &journal_id = jcsam. DOI: 10. 6041/j. issn. 1000-1298. 2019. 04. 041. ( in Chinese)
ZHANG Yan, LI Yanming, LIU Xiangpeng, et al. Fuzzy adaptive control method for autonomous rice seeder J/OL]. Transactions of the Chinese Society for Agricultural Machinery, 2018,49( 10) ;30 - 37. http: // www. j-csam. org/jcsam/ch/ reader/view_abstract. aspx? flag = l&file_no =20181004& journal_id = jcsam. DOI; 10. 6041/j. issn. 1000-1298. 2018. 10. 004. ( in Chinese)
LENAIN R, THUILOT B, CARIOU C, et al. Adaptive and predictive path tracking control for off-road mobile robots [J]. European Journal of Control, 2007, 13(4) :419 -439.
ROLAND L, BENOIT T, CHRISTOPHE C, et al. High accuracy path tracking for vehicles in presence of sliding: application to farm vehicle automatic guidance for agricultural tasks [ J]. Auton Robot, 2006, 21(1) ;79 -97.
STEPHANT J, CHARARA A, MEIZEL D. Virtual sensor; application to vehicle sideslip angle and transversal forces [J]. In IEEE Trans, on Industrial Electronics, 2004, 53(2) ;278 -289.
HAN Xiongzhe, HAK-JIN К, CHAN W J, et al. Application of a 3D tractor-driving simulator for slip estimation-based path- tracking control of auto-guided tillage operation [J]. Biosystems Engineering, 2019, 178:70 -85.
TANG Xiaotao, TAO Jianfeng, LI Zhiteng, et al. Fuzzy control optimization method for stability of path tracking system of automatic transplanter [J/OL]. Transactions of the Chinese Society for Agricultural Machinery, 2018, 49( 1 ) ; 29 -34. http: //www. j-csam. org/jcsam/ch/reader/view_abstract. aspx? flag = l&file_no = 20180103&joumal_id = jcsam. DOI: 10. 6041/ j. issn. 1000-1298. 2018. 01. 003. (in Chinese)
GAO Li. Design of a nonlinear PID controller for position servo system J]. South Agricultural Machinery, 2019, 50( 14) ; 141. (in Chinese)
Refbacks
- There are currently no refbacks.