中国农业机械化科学研究院集团有限公司 主管

北京卓众出版有限公司 主办

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

A fuzzy PID control method of path tracking for agricultural machinery based on preview model

  • 摘要: 为提高农机路径跟踪控制性能,提出一种基于预瞄模型的模糊PID控制方法。以农机预瞄模型中的预瞄航向角偏差为输入、前轮转角为输出构建农机路径跟踪PID控制律,再将预瞄航向角偏差作为航向角变化量的目标值引入农机运动学模型,得到能够适应速度变化的前轮转角基础值,并替换PID控制律中的比例部分,最后使用模糊控制实时动态调整控制参数。CarSim与Simulink联合仿真分析表明,当初始横向偏差3 m时,在作业速度1.5、2.0和3.0 m/s情况下,农机上线时间分别为10.85、8.35和5.15 s。与传统预瞄控制相比,该方法在确保跟踪精度的同时能够显著提高系统的响应速度。

     

    Abstract: To improve path tracking control performance of agricultural machinery, a fuzzy PID control method based on preview model was put forward.Initially, the PID control law of path tracking for agricultural machinery was constructed by taking deviation of preview heading angle in preview model as input and front wheel rotation angle as output.Then, deviation of preview heading angle was incorporated 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 simulations 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.

     

/

返回文章
返回