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

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

付小波,韩增德,韩科立,等.基于粒子群算法改进的轮式收获机纯追踪模型路径跟踪研究[J].农业工程,2023,13(7):105-112. DOI: 10.19998/j.cnki.2095-1795.2023.07.015
引用本文: 付小波,韩增德,韩科立,等.基于粒子群算法改进的轮式收获机纯追踪模型路径跟踪研究[J].农业工程,2023,13(7):105-112. DOI: 10.19998/j.cnki.2095-1795.2023.07.015
FU Xiaobo,HAN Zengde,HAN Keli,et al.Path tracking of improved pure pursuit model of wheeled harvester based on PSO algorithm[J].Agricultural Engineering,2023,13(7):105-112. DOI: 10.19998/j.cnki.2095-1795.2023.07.015
Citation: FU Xiaobo,HAN Zengde,HAN Keli,et al.Path tracking of improved pure pursuit model of wheeled harvester based on PSO algorithm[J].Agricultural Engineering,2023,13(7):105-112. DOI: 10.19998/j.cnki.2095-1795.2023.07.015

基于粒子群算法改进的轮式收获机纯追踪模型路径跟踪研究

Path Tracking of Improved Pure Pursuit Model of Wheeled Harvester Based on PSO Algorithm

  • 摘要: 为满足轮式收获机地头收获路径跟踪精度要求,提出了一种基于粒子群改进的带有预测特性的纯追踪路径跟踪算法。建立了轮式收获机运动学模型,推导了基于轮式收获机运动学模型的纯追踪路径跟踪算法。以收获机航向误差和横向误差为基础,构建了带有预测特性的隶属度函数,采用权重系数自适应方法,通过粒子群优化(PSO)算法,实现了实时动态确定最优前视距离。以玉米收获机为试验平台,开展了直线路径跟踪路面试验与“8”字曲线路径跟踪路面试验。试验结果表明,在速度1.5 m/s时,直线路径跟踪的最大横向误差4.39 cm,最大航向误差2.31°;在速度1 m/s时,曲线路径跟踪的最大横向误差5.24 cm,最大航向误差2.41°。改进的路径跟踪算法对直线路径及曲线路径都具有良好的路径跟踪效果,满足轮式收获机田间作业要求。

     

    Abstract: In order to improve path tracking accuracy of wheeled harvester, a pure pursuit path tracking algorithm with prediction characteristics based on particle swarm improvement was proposed.A kinematic model of wheeled harvester was established, and a pure pursuit path tracking algorithm based on kinematic model of wheeled harvester was derived.Based on harvester heading error and lateral error, an affiliation function with prediction characteristics was constructed, and optimal forward-looking distance was determined in real time by particle swarm optimization(PSO)algorithm using adaptive weighting coefficients.A straight path tracking road test and an "8" curve path tracking road test were conducted using a corn harvester as experimental platform.Experimental results showed that at a speed of 1.5 m/s, the maximum lateral error of linear path tracking was 4.39 cm, and the maximum heading error was 2.31 °; at a speed of 1 m/s, the maximum lateral error of curve path tracking was 5.24 cm, and the maximum heading error was 2.41 °.The improved path tracking algorithm has good path tracking performance for both straight and curved paths, meeting requirements of field operation of wheeled harvesters.

     

/

返回文章
返回