Small Agricultural Machinery Path Intelligent Tracking Control Based on Fuzzy Immune PID
XIONG Zhonggang1,2, YE Zhenhuan1, HE Juan1,2, CHEN Liangui1,2, LINGHU Jinqing1,2
1. College of Engineering and Technology, Zunyi Normal College, Zunyi 563002, China;
2. Guizhou Province Electronic and Electrician Experiment Demonstration Research Center, Zunyi 563002, China
An intelligent path tracking control method is proposed based on fuzzy immune PID (proportional-integraldifferential), to realize path tracking control for small agricultural machinery in complex environment. Firstly, a path tracking control task is decomposed into linear automatic navigation control task and automatic steering control task, and a fuzzy controller for automatic navigation and an automatic steering control method based on fuzzy immune PID are constructed. An automatic navigation control system is developed with dual laser source localization technology, electronic compass and angle sensor based on the hardware system of the unmanned high speed transplanter. Secondly, the straight line and the curve line path tracking methods are proposed based on the machinery construction and working principle of the automatic navigation control system. At last, the effectiveness of the path tracking control principle and fuzzy controller design is verified by using Matlab/Simulink simulation platform and the transplanter kinematics model, and the straight line and the curve line path tracking experiments are also completed. When a transplanter makes the linear tracking at 1 m/s, the maximum deviation is only 4 cm, and the average tracking error is 0.84 cm; when it makes the curve line path tracking at the same speed, the maximum deviation is 0.6 m, and the average tracking error is within 12 cm. Simulation and experiment results show that the unmanned high-speed transplanter based on this control system can effectively track the predefined path.
[1] Reid J F. Agricultural automatic guidance research in North America[J]. Computers and Electronics in Agriculture, 2000, 25(1): 133-153.[2] Keicher R, Seufert H. Automatic guidance for agricultural vehicles in Europe[J]. Computers and Electronics in Agriculture, 2000, 25(3): 169-194.[3] Hu J T, Gao L, Hu H C, et al. Design and development of an experiment platform for study on agricultural machinery navigation technology[J]. International Agricultural Engineering Journal, 2011, 20(2): 30-35.[4] 罗锡文,张智刚,赵祚喜,等.东方红X-804 拖拉机的DGPS 自动导航控制系统[J].农业工程学报,2009, 25(11):139-145. Luo X W, Zhang Z G, Zhao Z X, et al. Design of DGPS navigation control system for Dongfanghong X-804 tractor[J]. Transactions of the Chinese Society of Agricultural Engineering, 2009, 25(11): 139-145.[5] 丁幼春,王书茂.联合收获机视觉导航控制系统设计与试验[J].农业机械学报,2010,41(5):137-142. Ding Y C, Wang S M. Vision navigation control system for combine harvester[J]. Transactions of the Chinese Society of Agricultural Machinery, 2010, 41(5): 137-142.[6] Qiu H C. Navigation control for autonomous tractor guidance[D]. Illinois, USA: University of Illinois at Urbana- Champaign, 2002.[7] 代峰燕.基于机器视觉的农用车辆自动驾驶导航系统研究[D].北京:中国农业大学,2006.Dai F Y. Research on automatic driving vehicle navigation system based on machine vision[D]. Beijing: China Agricultural University, 2006.[8] Zhang Q, Reid J F, Noguchi N. Agricultural vehicle navigation using multiple guidance sensors[C]//Proceedings of the International Conference of Field and Service Robotics. Berlin, Germany: Springer-Verlag, 1999: 293-298.[9] Zhu Z X, Chen J, Yoshida T, et al. Path tracking control of autonomous agricultural mobile robots[J]. Journal of Zhejiang University: Science A, 2007, 8(10): 1596-1603. [10] 李进,陈无畏,李碧春,等.自动导引车视觉导航的路径识别和跟踪控制[J].农业机械学报,2008,39(2):20-24. Li J, Chen W W, Li B C, et al. Road recognition and tracking control of an vision guided AGV[J]. Transactions of the Chinese Society for Agricultural Machinery, 2008, 39(2): 20-24.[11] 李胜,马国梁,胡维礼.基于Backstepping 方法的车式移动机器人轨迹追踪控制[J].东南大学学报:自然科学版,2005,35(2):248-252. Li S, Ma G L, HuWL. Tracking control of car-like mobile robot based on backstepping[J]. Journal of Southeast University: Natural Science Edition, 2005, 35(2): 248-252.[12] Urmson C, Ragusa C, Ray D, et al. A robust approach to highspeed navigation for unrehearsed desert terrain[J]. Journal of Field Robotics, 2006, 23(8): 467-508. [13] Wu J B, Xu G H, Yin Z P. Robust adaptive control for a nonholonomic mobile robot with unknown parameters[J]. Journal of Control Theory and Applications, 2009, 7(2): 212-218. [14] Yanagiya M, Tomita K, Tsugawa S. Effects of field of view on lateral control performance in a vision-based autonomous vehicle[J]. JSAE Review, 1999, 20(4): 499-504. [15] 王家恩,陈无畏,王檀彬,等.基于期望横摆角速度的视觉导航智能车辆横向控制[J].机械工程学报,2012, 48(4):108-115. Wang J E, ChenWW,Wang T B, et al. Vision guided intelligent vehicle lateral control based on desired yaw rate[J]. Journal of Mechanical Engineering, 2012, 48(4): 108-115.[16] 李庆中,顾伟康,叶秀清,等.移动机器人路径跟踪的智能预瞄控制方法研究[J].机器人,2002,24(3):252-255. Li Q Z, Gu W K, Ye X Q, et al. A study of intelligent preview control method for mobile robot road following[J]. Robot, 2002, 24(3): 252-255.[17] 高剑,刘富樯,赵江,等.欠驱动自主水面船的非线性路径跟踪控制[J].机器人,2012,34(3):329-336. Gao J, Liu F Q, Zhao J, et al. Non-linear path following control of underactuated autonomous surface vehicles[J]. Robot, 2012, 34(3): 329-336.[18] 白永强,刘昊,石宗英,等.四旋翼无人直升机鲁棒飞行控制[J].机器人,2012,34(5):519-524. Bai Y Q, Liu H, Shi Z Y, et al. Robust flight control of quadrotor unmanned air vehicles[J]. Robot, 2012, 34(5):519-524.[19] 陈无畏,李进,王檀彬,等.视觉导航智能车辆的路径跟踪预瞄控制[J].机械工程学报,2008,44(10):278-280. Chen W W, Li J, Wang T B, et al. Preview control for road following of vision guided intelligent vehicle[J]. Chinese Journal of Mechanical Engineering, 2008, 44(10): 278-280.[20] Tarakanov A, Dasgupta D. A formal model of an artificial immune system[J]. Biosystems, 2000, 55(9): 15-18.[21] Gutnikov S, Melnikov Y. A simple non-linear model of immune response[J]. Chaos, Solitons and Fractals, 2003, 16(7): 125- 132.[22] 刘俊,陈无畏.车辆电动转向系统的卡尔曼滤波模糊PID控制[J].农业机械学报,2007,38(9):4-5. Liu J, Chen W W. Study on EPS using fuzzy and PID multimode control with Kalman filter[J]. Transactions of the Chinese Society for Agricultural Machinery, 2007, 38(9): 4-5.[23] 何卿.基于多传感器融合的拖拉机行间导航系统研究[D].北京:中国农业大学,2007.He Q. Automatic guidance system for tractor inter-row operations based on multiple sensors[D]. Beijing: China Agricultural University, 2007.[24] Zhang Q, Qiu H. A dynamic path search algorithm for tractor automatic navigation[J]. Transactions of the ASAE, 2003, 47(2):639-646.[25] Gan-Mor S, Clark R L, Upchurch B L. Implement lateral position accuracy under RTK-GPS tractor guidance[J]. Computers and Electronics in Agriculture, 2007, 59(1): 31-38.[26] 石辛民,郝整清.模糊控制及其MATLAB 仿真[M].北京:清华大学出版社,2008:127-129. Shi X M, Hao Z Q. Fuzzy control and MATLAB simulation[M]. Beijing: TsingHua University Press, 2008: 127-129.