高地隙四轮独立驱动喷雾机路径跟踪模型预测控制

doi:10.12133/j.smartag.2021.3.3.202105-SA006

Smart Agriculture ›› 2021, Vol. 3 ›› Issue (3): 82-93.doi: 10.12133/j.smartag.2021.3.3.202105-SA006

• 专题--智能植保机械与施药技术 • 上一篇下一篇

高地隙四轮独立驱动喷雾机路径跟踪模型预测控制

王子杰(), 刘国海(), 张多, 沈跃, 姚震, 张贺

江苏大学电气信息工程学院，江苏镇江，212013

收稿日期:2021-05-15 修回日期:2021-06-07 出版日期:2021-09-30
基金资助:
国家自然科学基金项目(51975260)
作者简介:王子杰（1997－），男，硕士研究生，研究方向为四轮独立驱动喷雾机控制。E-mail：2221907035@stmail.ujs.edu.cn。
通信作者: 刘国海（1964－），男，博士，教授，研究方向为智能农机装备控制和复杂非线性系统控制。电话：13505288982。E-mail：ghliu@ujs.edu.cn

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

WANG Zijie(), LIU Guohai(), ZHANG Duo, SHEN Yue, YAO Zhen, ZHANG He

School of Electrical and Information Engineering, Jiangsu University, Zhenjiang, 212013, China

Received:2021-05-15 Revised:2021-06-07 Online:2021-09-30
corresponding author: LIU Guohai, E-mail：ghliu@ujs.edu.cn
About author:WANG Zijie, E-mail：2221907035@stmail.ujs.edu.cn
Supported by:
National Natural Science Foundation of China(51975260)

摘要/Abstract

摘要：

针对传统燃油驱动、前轮转向的高地隙喷雾机传动效率低、碳排放高、环境污染、智能化水平低、灵活性差等问题，本研究提出了一种适用于无人驾驶的高地隙四轮独立驱动（Four Wheel Independent Drive，4WID）喷雾机。其采用混合动力、前后双转向桥的4WID，转向半径小，前后轮的运行轨迹高度一致，能够减少田间植保作业时的压苗现象。考虑水田极端作业环境下驱动轮的滑移、陷坑等问题，基于喷雾机线性时变的运动学模型（LTV），构建了考虑驱动轮滑移的分层路径跟踪控制。上层模型预测控制（Model Predictive Control，MPC）器根据预期路径、车辆当前位置，获得喷雾机的转向角和运动速度，实现路径跟踪。下层以模糊控制和积分分离PID控制构建驱动轮滑移控制器，从而实现路径跟踪、运动速度、驱动轮滑移的有效控制，提高了喷雾机在复杂作业环境中的稳定性和路径跟踪精度。采用Adams/Matlab的联合仿真结果表明，在复杂的工况条件下，喷雾机驱动轮的滑移率依然控制在±20%之内，防止驱动轮发生过度滑移对车速和转向角产生不良影响，有利于喷雾机稳定性的提升。本喷雾机能够快速准确地跟踪期望路径，与未考虑驱动轮滑移的控制相比，能够适应更加复杂的工作环境，跟踪精度有明显提升。

关键词: 前后双转向桥, 四轮独立驱动, 模型预测控制, 模糊控制, 滑移, 路径跟踪

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

中图分类号:

王子杰, 刘国海, 张多, 沈跃, 姚震, 张贺. 高地隙四轮独立驱动喷雾机路径跟踪模型预测控制[J]. 智慧农业(中英文), 2021, 3(3): 82-93.

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.

参考文献

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]	贺庆, 冀杰, 冯伟, 赵立军, 张博涵. 割草机器人自适应时域MPC路径跟踪控制方法[J]. 智慧农业(中英文), 2024, 6(3): 82-93.
[2]	刘智勇, 温昌凯, 肖跃进, 付卫强, 王昊, 孟志军. 拖拉机-牵引式农机具路径跟踪控制算法研究[J]. 智慧农业(中英文), 2023, 5(4): 58-67.

高地隙四轮独立驱动喷雾机路径跟踪模型预测控制

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

在线阅读

知网下载

本地下载

可视化

摘要/Abstract

引用本文

使用本文

参考文献

相关文章 2

编辑推荐

Metrics

本文评价