Path Following Model Predictive Control of Four Wheel Independent Drive High Ground Clearance Sprayer

doi:10.12133/j.smartag.2021.3.3.202105-SA006

Abstract

Abstract:

In order to solve the problems of low transmission efficiency, high carbon emissions, environmental pollution, low intelligence, and poor flexibility in traditional fuel-driven and front-wheel steering high ground clearance sprayers, a new type of high ground clearance four-wheel independent drive (4WID) sprayer which was suitable for the unmanned driving was proposed in this research. The sprayer adopted the hybrid power of fuel and battery and was steered by the 4WID driving mode of the front and rear double steering axles. For this reason, the turning radius of the proposed 4WID sprayer was small, and the running track of the front and rear wheels were uniform in height, which reduced the phenomenon of seedling crushing during field plant protection operations. Considering the slippage and sinking of the driving wheel in the extremely complex operating environment of the paddy field, based on the linear time-varying kinematics model (LTV) of the sprayer, a layered path tracking control considering the slippage of the driving wheel was constructed. The upper model predictive controller (MPC) obtained the steering angle and movement speed of the sprayer according to the expected path and the current position of the vehicle to realize path tracking. The lower layer used fuzzy control and integral separation PID control to construct a driving wheel slip controller, so as to achieve effective control of path tracking, speed, and driving wheel slip, which improved the stability and path tracking accuracy of the sprayer in a complex operating environment. The co-simulation results of Adams and Matlab showed that under complex working conditions, the slip rate of the driving wheel of the sprayer was controlled within ±20%, so as to prevent excessive slip of the driving wheel from having adverse effects on the speed and steering angle, which was conducive to the improvement of the stability of the sprayer. The sprayer could be tracked quickly and accurately the desired path, the path tracking in road conditions outside attached coefficients were 0.3 and 0.7 of the lateral deviation could be controlled within ±0.018 m. In stage C roughness 3D road conditions, the sprayer could adjust the steering angle of the front wheels in time to stabilize the body posture and the lateral deviation could be controlled within ±0.054 m. Compared with the controller that didn't consider the slip of the driving wheel, the stability and path tracking accuracy of the sprayer had been significantly improved.

Key words: front and rear double steering axles, four-wheel independent drive, model predictive control, fuzzy control, slip, path tracking

CLC Number:

WANG Zijie, LIU Guohai, ZHANG Duo, SHEN Yue, YAO Zhen, ZHANG He. Path Following Model Predictive Control of Four Wheel Independent Drive High Ground Clearance Sprayer[J]. Smart Agriculture, 2021, 3(3): 82-93.

References

1	VOUGIOUKAS S, ARVANITIS K, SIGRIMIS N. A nonlinear model predictive tracking controller for agricultural vehicles[C]// 2007 European Control Conference (ECC). Piscataway, New York, USA: IEEE, 2007: 4937-4943.
2	李金刚. 以农机化转型升级推进中国制造2025的相关思考[J]. 时代农机, 2019, 46(6): 10-11.
2	LI J. Thoughts on promoting made in China 2025 with agricultural mechanization transformation and upgrade[J]. Times Agricultural Machinery, 2019, 46(6): 10-11.
3	黄腾达, 蒋蘋, 胡文武, 等. 田间管理机路径跟踪系统设计及试验[J]. 浙江大学学报, 2020, 46(4): 509-518.
3	HUANG T, JIANG P, HU W, et al. Design and experiment of path tracking system of field management machine[J]. Journal of Zhejiang University, 2020, 46(4): 509-518.
4	郑巍, 黄盛杰, 刘斌. 浅析北斗卫星导航系统在农业工程中的发展和应用[J]. 农业装备与车辆工程, 2020, 58(7): 143-144.
4	ZHENG W, HUANG S, LIU B. Analysis on development and application of Beidou positioning system in agricultural engineering[J]. Agricultural Equipment & Vehicle Engineering, 2020, 58(7): 143-144.
5	张雁. 水田环境下的无人农机自动驾驶与作业系统研究[D]. 上海: 上海交通大学, 2019.
5	ZHANG Y. Research on autonomous driving and operation system of unmanned agricultural machines in paddy field environment[D]. Shanghai: Shanghai Jiao Tong University. 2019.
6	熊璐, 杨兴, 卓桂荣, 等. 无人驾驶车辆的运动控制发展现状综述[J]. 机械工程学报, 2020, 56(10): 127-143.
6	XIONG L, YANG X, ZHUO G, et al. Review on the development of motion control of unmanned vehicle[J]. Journal of Mechanical Engineering, 2020, 56(10): 127-143.
7	SONG X, SHAO Y, QU Z. A vehicle trajectory tracking method with a time-varying model based on the model predictive control[J]. IEEE Access, 2020, 8: 16573-16583.
8	LIU S, HOU Z, TIAN T, et al. A novel dual successive projection-based model-free adaptive control method and application to an autonomous car[J]. IEEE Transactions on Neural Networks and Learning Systems, 2019, 30(11): 3444-3457.
9	LENAIN R, THUILOT B, CARIOU C, et al. Mobile robot control in presence of sliding: Application to agricultural vehicle path tracking[C]// The 45th IEEE Conference on Decision and Control, San Diego, CA. Piscataway, New York, USA: IEEE, 2006: 6004-6009.
10	张华强, 王国栋, 吕云飞, 等. 基于改进纯追踪模型的农机路径跟踪算法研究[J]. 农业机械学报, 2020, 51(9): 18-25.
10	ZHANG H, WANG G, LYU Y, et al. Research on path tracking algorithm of agricultural machinery based on improved pure tracking model[J]. Transactions of the CSAM, 2020, 51(9): 18-25.
11	王辉, 王桂民, 罗锡文, 等. 基于预瞄追踪模型的农机导航路径跟踪控制方法[J]. 农业工程学报, 2019, 35(4): 11-19.
11	WAGN H, WANG G, LUO X, et al. Tracking control method of agricultural machinery navigation path based on preview tracking model[J]. Transactions of the CSAE, 2019, 35(4): 11-19.
12	刘兆朋, 张智刚, 罗锡文, 等. 雷沃ZP9500高地隙喷雾机的GNSS自动导航作业系统设计[J]. 农业工程学报, 2018, 34(1): 15-21.
12	LIU Z, ZHANG Z, LUO X, et al. Design of GNSS automatic navigation operation system for Leiwo ZP9500 high ground clearance sprayer[J]. Transactions of the CSAE, 2018, 34(1): 15-21.
13	白国星, 刘丽, 孟宇, 等. 基于非线性模型预测控制的移动机器人实时路径跟踪[J]. 农业机械学报, 2020, 51(9): 47-52, 60.
13	BAI G, LIU L, MENG Y, et al. Real-time path tracking of mobile robot based on nonlinear model predictive control[J]. Transactions of the CSAM, 2020, 51(9): 47-52, 60.
14	刘正铎, 张万枝, 吕钊钦, 等. 基于非线性模型的农用车路径跟踪控制器设计与试验[J]. 农业机械学报, 2018, 49(7): 23-30.
14	LIU Z, ZHANG W, LYU Z, et al. Design and test of path tracking controller for agricultural vehicle based on nonlinear model[J]. Transactions of the CSAM, 2018, 49(7): 23-30.
15	沈跃, 何思伟, 刘慧, 等. 高地隙喷雾机自转向电动底盘控制系统设计与试验[J]. 农业机械学报, 2020, 51(11): 385-392, 402.
15	SHEN Y, HE S, LIU H, et al. Design and test of self-steering electric chassis control system for highland gap sprayer[J]. Transactions of the CSAM, 2020, 51(11): 385-392, 402.
16	邱恒浪. 基于轮毂电机的四轮驱动差速转向控制系统的研究[D]. 重庆: 西南大学, 2012.
16	QIU H. Research on four wheel drive differential steering control system based on hub motor[D]. Chongqing: Southeast University, 2012.
17	YOON S, JEON H, KUM D. Predictive cruise control using radial basis function network-based vehicle motion prediction and chance constrained model predictive control[J]. IEEE Transactions on Intelligent Transportation Systems, 2019, 20(10): 3832-3843.
18	TANG Z, XU X, WANG F, et al. Coordinated control for path following of two-wheel independently actuated autonomous ground vehicle[J]. IET Intelligent Transport Systems, 2019, 13(4): 628-635.
19	刘洋, 于树友, 郭洋, 等. 基于滚动时域优化的轮式移动机器人路径跟踪问题研究[J]. 控制理论与应用, 2017, 34(4): 424-432.
19	LIU Y, YU S, GUO Y, et al. Model predictive control based on extended state observer for vehicle yaw stability[J]. Control Theory & Applications, 2017, 34(4): 424-432.
20	刘涵, 李涛, 聂彦鑫, 等. 基于预测滑转率的转矩分配策略研究[J]. 汽车技术, 2020, 540(9): 39-44.
20	LIU H, LI T, NIE Y, et al. Research on torque allocation strategy based on predicted sliding ratio[J]. Automotive Technology, 2020, 540(9): 39-44.
21	李升波, 王建强, 李克强. 软约束线性模型预测控制系统的稳定性方法[J]. 清华大学学报(自然科学版), 2010, 50(11): 1848-1852.
21	LI S, WANG J, LI K. Stability method of soft-constrained linear model predictive control system[J]. Journal of Tsinghua University (Natural Science Edition), 2010, 50(11): 1848-1852.
22	刘勇兰, 顾若波, 王渝. 高地隙自走式喷杆喷雾机的发展趋势及产业化前景分析[J]. 时代农机, 2018, 45(9): 36-37.
22	LIU Y, GU R, WANG Y. Development trend and industrialization prospect analysis of self-propelled boom sprayer with high ground clearance[J]. Times Agricultural Machinery, 2018, 45(9): 36-37.
23	毛家稳, 周俊, 梁洋洋. 电驱动高地隙车辆滑转率滑模控制研究[J]. 中国农业大学学报, 2017, 22(2): 129-134.
23	MAO J, ZHOU J, LIANG Y. Research on sliding mode control of slip ratio of electrically driven vehicles with high ground gap[J]. Journal of China Agricultural University, 2017, 22(2): 129-134.
24	张文春, 徐立友. 汽车理论（第3版）[M]. 北京: 机械工业出版社, 2018.
24	ZHANG W, XU L. Automobile theory(3rd edition)[M]. Beijing: Machinery Industry Press, 2018.
25	沈俊, 宋健. 随机不平路面上的ABS制动研究[J]. 汽车工程, 2007(3): 230-233, 237.
25	SHEN J, SONG J. Research on ABS braking on random uneven roads[J]. Automotive Engineering, 2007(3): 230-233, 237.
26	王麒淦. 高地隙喷雾机行驶稳定性动力学建模与仿真研究[D]. 石河子: 石河子大学, 2020.
26	WANG Q. Research on dynamic modeling and simulation of driving stability of high ground clearance sprayer[D]. Shihezi: Shihezi University, 2020.

[1]	GUO Dafang, DU Yuefeng, WU Xiuheng, HOU Siyu, LI Xiaoyu, ZHANG Yan'an, CHEN Du. Digital Twin for Agricultural Machinery: From Concept to Application [J]. Smart Agriculture, 2023, 5(2): 149-160.
[2]	SONG Shuran, HU Shengyang, SUN Daozong, DAI Qiufang, XUE Xiuyun, XIE Jiaxing, LI Zhen. Automatic Spraying Technology and Facilities for Pipeline Spraying in Mountainous Orchards [J]. Smart Agriculture, 2022, 4(3): 86-94.
[3]	WANG Hui, CHEN Ruipeng, YU Zhixue, HE Yue, ZHANG Fan, XIONG Benhai. Porphyrin and Semiconducting Single Wall Carbon Nanotubes based Semiconductor Field Effect Gas Sensor for Determination of Phytophthora Strawberries [J]. Smart Agriculture, 2022, 4(3): 143-151.
[4]	ZHANG Kai, HAN Shuqing, CHENG Guodong, WU Saisai, LIU Jifang. Gait Phase Recognition of Dairy Cows based on Gaussian Mixture Model and Hidden Markov Model [J]. Smart Agriculture, 2022, 4(2): 53-63.
[5]	GUO Xiuming, ZHU Yeping, LI Shijuan, ZHANG Jie, LYU Chunyang, LIU Shengping. Scale Adaptive Small Objects Detection Method in Complex Agricultural Environment: Taking Bees as Research Object [J]. Smart Agriculture, 2022, 4(1): 140-149.
[6]	WANG Fang, TENG Guifa, YAO Jingfa. Multi-Objective Vegetable Transportation and Distribution Path Optimization with Time Windows [J]. Smart Agriculture, 2021, 3(3): 152-161.
[7]	ZHANG Xiaoqing, SHAO Song, GUO Xinyu, FAN Jiangchuan. High-Throughput Dynamic Monitoring Method of Field Maize Seedling [J]. Smart Agriculture, 2021, 3(2): 88-99.
[8]	HAO Wangli, YU Peiyan, HAO Fei, HAN Meng, HAN Jiwan, SUN Weirong, LI Fuzhong. Foxtail Millet Ear Detection Approach Based on YOLOv4 and Adaptive Anchor Box Adjustment [J]. Smart Agriculture, 2021, 3(1): 63-74.
[9]	ZHU Chao, WU Fan, LIU Changbin, ZHAO Jianxiang, LIN Lili, TIAN Xueying, MIAO Teng. Tassel Segmentation of Maize Point Cloud Based on Super Voxels Clustering and Local Features [J]. Smart Agriculture, 2021, 3(1): 75-85.
[10]	LI Yan, SHEN Jie, XIE Hang, GAO Guangyin, LIU Jianxiong, LIU Jie. Detection and Grading Method of Pomelo Shape Based on Contour Coordinate Transformation and Fitting [J]. Smart Agriculture, 2021, 3(1): 86-95.
[11]	MAO Wenju, LIU Heng, WANG Dongfei, YANG Fuzeng, LIU Zhijie. Improved AODV Routing Protocol for Multi-Robot Communication in Orchard [J]. Smart Agriculture, 2021, 3(1): 96-108.
[12]	ZHU Dengsheng, FANG Hui, HU Shaoming, WANG Wenquan, ZHOU Yansuo, WANG Hongyan, LIU Fei, HE Yong. Development and Application of an Intelligent Remote Management Platform for Agricultural Machinery [J]. Smart Agriculture, 2020, 2(2): 67-81.
[13]	Zhou Chengquan, Ye Hongbao, Yu Guohong, Hu Jun, Xu Zhifu. A fast extraction method of broccoli phenotype based on machine vision and deep learning [J]. Smart Agriculture, 2020, 2(1): 121-132.
[14]	Wan Liang, Cen Haiyan, Zhu Jiangpeng, Zhang Jiafei, Du Xiaoyue, He Yong. Using fusion of texture features and vegetation indices from water concentration in rice crop to UAV remote sensing monitor [J]. Smart Agriculture, 2020, 2(1): 58-67.
[15]	Zhang Haifeng, Li Yang, Zhang Yu, Song Lijuan, Tang Lixin, Bi Hongwen. Design and implementation of intelligent terminal service system for greenhouse vegetables based on cloud service:A case study of Heilongjiang province [J]. Smart Agriculture, 2019, 1(3): 87-99.