基于模糊PID算法的农机自动转向控制方法技术

本发明专利技术的基于模糊PID算法的农机自动转向控制方法，通过以下步骤来实现：a).PID算法离散化；b).获取增量型PID控制算法；c).定义转向角偏差变化率；d).模糊化处理变量；e).建立模糊控制规则表；f).控制输出。本发明专利技术的农机自动转向控制方法，利用获取的ΔKP、ΔKI和ΔKD对比例系数KP、积分系数KI和微分系数KD进行修正，使得转向控制系统更加稳定，在满足农机控制要求的基础上，使得农机的转向控制具有更好的快速性和准确性，相应时间更快、稳态误差更小。

【技术实现步骤摘要】
基于模糊PID算法的农机自动转向控制方法
本专利技术涉及一种农机自动转向控制方法，更具体的说，尤其涉及一种基于模糊PID算法的农机自动转向控制方法。
技术介绍
我国是一个农业大国，农业人口众多，但是我国的农业发展水平与西方的一些发达国家还有着很大差距。随着科学技术的迅速发展，现代农业的发展也在日益兴起，一个国家的农业机械化程度体现了其农业发展水平，发展智慧的农业机械是实现农业现代化的关键。发展精准农业是实现现代农业的前提，农机的自动导航系统又是精准农业的重要一步，自动转向控制系统又是自动导航系统中的关键一环。在自动转向控制系统中，控制算法的选择、设计以及优化的好坏，将直接影响农机的作业精度。PID控制算法是一种最为常用的控制算法，它可以从根本上摆脱系统建模，只需要依据被控对象的一些响应特征来组合控制模块，控制过程简单且稳态性好。模糊控制亦不依赖于控制模型，而是根据人们的工作经验，对于被控对象进行简单的模糊处理，但与此同时影响了控制精度。在此基础上，将算法与模糊控制巧妙地结合起来，能够互补利弊，会使整个控制系统获得更加良好的性能，增加系统的灵活性和精确性，可以在农机播种或者农机收割等这种路线比较简单的工程中加以应用。
技术实现思路
本专利技术为了克服上述技术问题的缺点，提供了一种基于模糊PID算法的农机自动转向控制方法。本专利技术的基于模糊PID算法的农机自动转向控制方法，农机上设置有导航控制器、转向控制器、转向驱动器、农机转向系统以及转角测量模块，导航控制器用于获取农机的方位信息并输出目标转向角至转向控制器，转向驱动器由液压驱动器和比例换向阀组成，转角测量模块用于获取农机转向系统的实际转向角并将其传输至转向控制器；其特征在于，农机自动转向控制方法通过以下步骤来实现：a).PID算法离散化，采用公式(1)中的PID控制算法对农机的转向进行控制：式中，u(t)为转向控制器的输出信号，e(t)为转向控制器的输入信号，即目标转向角与实际转向角的差值，记为转向角偏差；KP为比例系数，TI为积分系数，为积分控制项；TD为微分系数，为微分控制项；由于需要通过目标转向角与农机的实际转向角的差值来计算控制量，需要对公式(1)进行离散化处理，得到离散的PID控制算法如公式(2)所示：式中，k为采样次数，u(k)为第k次采样后转向控制器输出的控制值，e(k)为第k次采样时输入的转向偏差值，T为调节系数；b).获取增量型PID控制算法，通过公式(2)可推导出：Δu(k)＝u(k)-u(k-1)＝KP[e(k)-e(k-1)]+KIe(k)-KD[e(k)-2e(k-1)+e(k-2)](3)＝KPΔe(k)+KIe(k)+KD[Δe(k)-Δe(k-1)]得到的Δu(k)就是增量型PID控制算法的表达式，式中：Δe(k)＝e(k)-e(k-1)，Δe(k-1)＝e(k-1)-e(k-2)；c).定义转向角偏差变化率，在对农机的转向控制过程中，要保证农机转向控制系统的相应速度和稳定性，还应考虑转向角偏差变化率，定义转向角偏差变化率ec(k)如下：d).模糊化处理变量，转向控制器按照一定的采样频率对转向偏差e(k)进行采集，获取3次以上的转向角偏差，并通过公式(4)计算转向角偏差变化率ec(k)；然后，对输入量e(k)、ec(k)和输出量KP、KI和KD都进行模糊化处理，其模糊子集均为：{NB(负大)，NM(负中)，NS(负小)，ZO(零)，PS(正小)，PS(正中)，PB(正大)}，各个子集的隶属函数均选取为高斯型隶属函数，其中心点分别为：{-6，-4，-2，0，2，4，6}；e).建立模糊控制规则表，根据KP、KI和KD三个参数各自的作用以及它们之间的相互影响，建立ΔKP、ΔKI和ΔKD的模糊控制规则表，分别如表1、表2和表3所示：表1表2表3利用公式(5)更新比例系数KP、积分系数TI和微分系数TD：f).控制输出，将利用公式(5)求取的比例系数KP、积分系数KI和微分系数KD，带入公式(2)中求出第k次采样后转向控制器输出的控制值u(k)，u(k)输入至液压控制器中，用于控制比例换向阀的方向和开度，以实现对农机转向的控制。本专利技术的基于模糊PID算法的农机自动转向控制方法，步骤a)中所述调节系数T的取值范围为[1,2]。本专利技术的基于模糊PID算法的农机自动转向控制方法，步骤d)中所述转向控制器的采样周期为0.1s。本专利技术的基于模糊PID算法的农机自动转向控制方法，步骤e)中，比例系数KP、积分系数TI和微分系数TD的初始值分别为3.9、16.5和0.5。本专利技术的有益效果是：本专利技术的基于模糊PID算法的农机自动转向控制方法，首先获取离散的PID控制算法的计算公式，并推导出增量型PID控制算法的计算公式，然后根据采集的数据实时地计算出转向偏差及其变化率，利用建立的模糊控制规则表，利用获取的ΔKP、ΔKI和ΔKD对比例系数KP、积分系数KI和微分系数KD进行修正，获取最终的比例系数、积分系数和微分系数，以计算转向控制器输出的控制值，用于控制比例换向阀的方向和开度，以实现对农机转向的控制。本专利技术的农机自动转向控制方法，良好地结合了PID算法和模糊控制算法的优势，使得转向控制系统更加稳定，在满足农机控制要求的基础上，使得农机的转向控制具有更好的快速性和准确性，相应时间更快、稳态误差更小，为农机转向的精准控制提供了一种行之有效的控制方法。附图说明图1为本专利技术中设置于农机上的自动转向控制系统的结构图；图2为本专利技术的农机自动转向控制方法的系统结构图；图3为农机的自动转向控制系统的响应输出曲线；图4为本专利技术中输入输出变量的隶属度函数。具体实施方式下面结合附图与实施例对本专利技术作进一步说明。如图1所示，给出了本专利技术中设置于农机上的自动转向控制系统的结构图，其由导航控制器、转向控制器、转向驱动器、农机转向系统以及转角测量模块组成，导航控制器用于获取农机的方位信息并输出目标转向角至转向控制器，转向驱动器由液压驱动器和比例换向阀组成，转角测量模块用于获取农机转向系统的实际转向角并将其传输至转向控制器。转向控制器根据输入的目标转向角与实际转向角的差值，以及转向角偏差值的变化率，采用模糊控制算法，对PID调节的比例系数、积分系数和微分系数进行修正，求出更加符合农机当前转向状态的转向控制量。如图2所示，给出了本专利技术的农机自动转向控制方法的系统结构图，模糊PID控制系统的原理就是运用模糊数学的理论和方法，把模糊控制规则以模糊集的形式表示出来，根据被控对象的实际响应情况运用模糊推理，实现对PID参数在不同时间不同状态下的最佳调整，实现最优控制。将模糊PID控制器的输入定为转向角偏差e(k)和偏差变化率ec(k)，输出则为模糊控制器经过模糊规则推理得到的ΔKP、ΔKI和ΔKD。系统在线实时改变的参数的值为KP+ΔKP、KI+ΔKI、KD+ΔKD，这样就实现了PID控制算法中参数的自整定环节，使得被控对象的动、静态性能得到提高。如图3所示，给出了农机的自动转向控制系统的响应输出曲线，当农机在田间行走时，控制器会不断地检测e(t)和ec(t)的值，并且不断地对检测到的值和PID的三个参数进行在线修改，而满足在不同环境中的e(t)和ec(t)对PID控制器的不同要求。分本文档来自技高网...

【技术保护点】
一种基于模糊PID算法的农机自动转向控制方法，农机上设置有导航控制器、转向控制器、转向驱动器、农机转向系统以及转角测量模块，导航控制器用于获取农机的方位信息并输出目标转向角至转向控制器，转向驱动器由液压驱动器和比例换向阀组成，转角测量模块用于获取农机转向系统的实际转向角并将其传输至转向控制器；其特征在于，农机自动转向控制方法通过以下步骤来实现：a).PID算法离散化，采用公式(1)中的PID控制算法对农机的转向进行控制：

【技术特征摘要】
1.一种基于模糊PID算法的农机自动转向控制方法，农机上设置有导航控制器、转向控制器、转向驱动器、农机转向系统以及转角测量模块，导航控制器用于获取农机的方位信息并输出目标转向角至转向控制器，转向驱动器由液压驱动器和比例换向阀组成，转角测量模块用于获取农机转向系统的实际转向角并将其传输至转向控制器；其特征在于，农机自动转向控制方法通过以下步骤来实现：a).PID算法离散化，采用公式(1)中的PID控制算法对农机的转向进行控制：式中，u(t)为转向控制器的输出信号，e(t)为转向控制器的输入信号，即目标转向角与实际转向角的差值，记为转向角偏差；KP为比例系数，TI为积分系数，为积分控制项；TD为微分系数，为微分控制项；由于需要通过目标转向角与农机的实际转向角的差值来计算控制量，需要对公式(1)进行离散化处理，得到离散的PID控制算法如公式(2)所示：式中，k为采样次数，u(k)为第k次采样后转向控制器输出的控制值，e(k)为第k次采样时输入的转向偏差值，T为调节系数；b).获取增量型PID控制算法，通过公式(2)可推导出：得到的Δu(k)就是增量型PID控制算法的表达式，式中：Δe(k)＝e(k)-e(k-1)，Δe(k-1)＝e...

【专利技术属性】
技术研发人员：唐勇伟，王茂励，郝慧娟，段杰，赵晓杰，孙瑞瑞，郝凤琦，李成攻，程广河，姜岩，
申请(专利权)人：山东省计算中心国家超级计算济南中心，
类型：发明
国别省市：山东,37