山地履带拖拉机与农具姿态协同控制系统设计与试验

摘要

针对山地履带拖拉机(简称山地拖拉机)等高线作业时,车身调平和农具仿形作业不同的姿态调整需求,在建立车身及农具运动学模型的基础之上,构建了整个系统的控制策略,设计了车身与农具姿态协同控制系统,其中,对车身和农具的控制分别采用PID算法和双闭环模糊PID算法。基于Simulink对控制算法进行了仿真分析,结果表明:采用PID算法实现车身调平可以满足其基本调平要求;采用双闭环模糊PID算法实现农具姿态调整的控制效果优于PID算法。最后,进行了机组姿态协同调整的静态试验和动态试验,结果表明,采用所设计的姿态协同控制系统:在坡度±15°的坡地上静态调整时,车身横向倾角最大误差为1.10°,农具横向倾角最大误差为0.46°;在坡度14°~16°的坡地上动态作业时,车身横向倾角最大误差为1.90°,农具横向倾角最大误差为0.93°。该姿态协同控制系统精度和稳定性能够满足丘陵山区坡地等高线作业需求。