改进纯追踪模型的插秧机导航路径跟踪算法

关于纯追踪模型跟踪算法的研究很多,但大都集中在直线路径跟踪方面。由于插秧机田间行驶路径包括直线作业段和地头曲线转弯段,因此需要对传统的纯追踪算法进行改进,使其满足曲线路径跟踪。本研究以约翰迪尔Starfire3000型接收机、GS2630型显示器和ATU200型电动方向盘为主要硬件设备,针对给定的曲线路径,提出了一种路径跟踪控制算法,并通过模型仿真和田间试验相结合的方法,对该导航控制算法进行了验证分析。该导航控制算法的具体步骤如下:首先根据车辆速度和路径弯曲程度来动态调整前视距离,其次在利用预见控制求得车辆目标点的基础上,利用改进的纯追踪算法设计控制器,最后按照插秧机作业时的路径进行仿真和试验。试验结果为:车辆以1m/s的速度行驶且在转弯半径为0.9m时,最大误差可控制在16cm以内。