首页|基于预瞄模型的农机路径跟踪模糊PID控制方法

基于预瞄模型的农机路径跟踪模糊PID控制方法

扫码查看
为提高农机路径跟踪控制性能,提出一种基于预瞄模型的模糊PID控制方法.以农机预瞄模型中的预瞄航向角偏差为输入、前轮转角为输出构建农机路径跟踪PID控制律,再将预瞄航向角偏差作为航向角变化量的目标值引入农机运动学模型,得到能够适应速度变化的前轮转角基础值,并替换PID控制律中的比例部分,最后使用模糊控制实时动态调整控制参数.CarSim与Simulink联合仿真分析表明,当初始横向偏差 3 m时,在作业速度 1.5、2.0和 3.0 m/s情况下,农机上线时间分别为 10.85、8.35和 5.15 s.与传统预瞄控制相比,该方法在确保跟踪精度的同时能够显著提高系统的响应速度.
A fuzzy PID control method of path tracking for agricultural machinery based on preview model
To improve path tracking control performance of agricultural machinery,a fuzzy PID control method based on preview mod-el was put forward.Initially,the PID control law of path tracking for agricultural machinery was constructed by taking deviation of pre-view heading angle in preview model as input and front wheel rotation angle as output.Then,deviation of preview heading angle was in-corporated into agricultural machinery kinematics model as target value of heading angle change.Baseline value of front wheel angle which could adapt to speed change was obtained,and proportional part of PID control law was replaced by baseline value.Ultimately,fuzzy logic was employed to set PID control parameters in real time.Effectiveness of proposed method was confirmed through joint sim-ulations carried out on CarSim and Simulink platform.Test results demonstrated that,once operating speed of agricultural machinery was 1.5,2.0 and 3.0 m/s,respectively,average online time was 10.85,8.35 and 5.15 s,when initial lateral deviation was 3 m.In comparison to traditional preview control,this method effectively could improve response speed of system while ensuring tracking accuracy.

automatic navigationpath trackingpreview modelfuzzy PIDpath optimizationagricultural machinery navigation

刘文龙、王晨旭、徐伟东

展开 >

东北石油大学秦皇岛校区电气信息工程系,河北 秦皇岛 066004

自动导航 路径跟踪 预瞄模型 模糊PID 路径优化 农机导航

2024

农业工程
北京卓众出版有限公司

农业工程

CSTPCD
影响因子:0.422
ISSN:2095-1795
年,卷(期):2024.14(7)