高级检索+

基于模糊Stanley模型的农机全田块路径跟踪算法研究

Study on Whole Field Path Tracking of Agricultural Machinery Based on Fuzzy Stanley Model

  • 摘要: 为实现农业机械全田块高效自主作业,提出一种增益系数自适应的Stanley模型路径跟踪算法。以横向偏差和航向偏差为输入变量构建隶属度函数,设计模糊推理和解模糊化过程实时确定控制模型增益系数,提高Stanley模型对不同曲率路径的自适应能力。为验证所提算法有效性,以移动小车为平台开展联合收获机回字形全田块自主作业路径跟踪试验,结果表明所提算法显著改善Stanley模型路径跟踪精度,直线作业速度2.5 m/s、转弯速度1 m/s时,直线段和曲线段最大跟踪误差均小于3 cm。大初始横向偏差路径跟踪试验表明,模糊Stanley模型较Stanley模型大幅度减小路径跟踪上线距离,满足农业机械全田块高效自动导航作业要求。

     

    Abstract: The unmanned operation of agricultural machinery in whole field is an important part of unmanned farms. In order to perform high-efficiency autonomous navigation in field, an improved Stanley path tracking control model based on fuzzy algorithm was proposed, where the control gain was adaptively changed according to the tracking error. Base on the kinematics model and Stanley model, the whole field tracking method of agricultural machinery was studied. Firstly, the membership function was constructed by using lateral deviation and heading deviation as the input variables. Fuzzy inference rules were designed by analyzing and summarizing the experimental data. In order to determine the gain coefficient of the control model, the center of gravity method was used as the defuzzification method, which improved the adaptivity of the Stanley model under complicated path condition. In order to verify the effectiveness of proposed algorithm, a mobile vehicle equipped with GNSS navigation system was used as the experimental platform, where the whole field path tracking of combine harvester was tested and discussed. Experiment results indicated that when the operation speed of straight line was at 2.5 m/s, and the turning speed was at 1 m/s, the maximum error of whole field path tracking was less than 3 cm. When the initial lateral deviation was 3 m, the distance of guided trajectory was no more than 5 m, which improved the path tracking accuracy of the conventional Stanly model significantly. The proposed algorithm satisfied the need of efficient automatic navigation operations for agricultural machinery in the whole farmland field.

     

/

返回文章
返回