基于植保机柱塞泵压力的变喷雾系统流量跟踪控制方法与流程

本发明涉及农业智能机械自动化领域，尤其是关于植保机变喷雾系统的智能控制方法。

背景技术：

目前，控制病虫草害最常见的方法是化学治理，然而在防治过程中，大部分药液飘散在空气中、沉积在土壤中，不仅浪费了大量的药剂，而且这些残留的药液成分很可能会进入到生物的体内，严重威胁了人类的生命安全，同时也对环境造成了污染。因此，变喷雾植保机械的研究具有一定的理论意义和非常强的实用价值。

植保机在现代的农作物中具有广泛的应用，关于植保机变喷雾系统流量跟踪控制方法已经有了许多研究成果，然而这些控制方法在考虑流量跟踪控制时都忽略了控制系统中柱塞泵的输出压力问题。如果不考虑柱塞泵的输出压力，会导致植保机变喷雾系统的喷雾流量不连续、不精准、容易造成浪费。因此，基于植保机柱塞泵压力的变喷雾系统流量跟踪控制方法的研究具有重要的意义。本发明所研究的植保机变喷雾系统是强非线性系统，到目前为止，还没有将柱塞泵的模型和比例减压阀的模型相结合控制的流量跟踪控制方法。因此研究植保机柱塞泵压力的变喷雾系统流量跟踪具有重要意义。

技术实现要素：

发明目的：

为了解决上述问题，本发明提供了基于植保机柱塞泵压力的变喷雾系统流量跟踪控制方法。

技术方案：

本发明是通过以下技术方案来实现的：

基于植保机柱塞泵压力的变喷雾系统流量跟踪控制方法，其特征在于：

1)基于植保机变喷雾系统的特征，结合动力学模型和流量特性模型，考虑喷雾系统的非线性因素，建立植保机变喷雾系统输出压力与流量之间的系统状态方程；

2)设计植保机变喷雾系统流量控制器，基于状态方程和动力学及流量特性，使植保机喷雾流量实现渐近跟踪；

3)采用can总线串行通讯协议传输数据，利用stm32单片机对植保机喷雾流量进行控制，实现了对植保机喷雾流量的渐近跟踪。

步骤如下：

步骤1)基于植保机变喷雾系统的特征，结合动力学模型和流量特性模型，考虑变喷雾系统的非线性因素，建立植保机变喷雾系统输出压力与流量之间的系统状态方程，其特征在于：变喷雾系统的动力学模型描述如下

在假设磁路未饱和，而且忽略铁损和磁路中材料的磁阻的条件下，通电后电磁阀的电磁力方程可以表示为

fm为电磁阀的电磁力，δ为线圈与衔铁之间的气隙，n为线圈匝数，sa为有效作用面积，μ0为真空磁导率，i为线圈中的电流。

建立模型时忽略流体动量变化产生的稳态液动力和瞬态液动力以及液体静压力，因此得到阀芯的运动平衡方程可以表示为

其中，为弹簧刚度，m为阀芯的等效质量，c为阀芯的等效阻尼，x为阀芯的位移，x0为预先弹簧压缩量，k为弹簧刚度，kf为比例系数，i为线圈中的电流。

电磁阀的流量方程可以表示为

qf为通过阀口的输出流量，cf为流量系数，sa为有效作用面积，x为阀芯的位移，p为出口压力，ρ为药液密度。

步骤2)变喷雾系统的柱塞泵控制模型描述如下

为了控制柱塞泵的输出压力，对柱塞泵的压力控制系统进行数学建模，直接驱动阀阀芯动力学方程具体表达为

kv是线性电动机的力常数，v是线性电动机的输入电压，xv是直接驱动阀阀芯的位移，c1是阻尼力的系数，c2是弹簧的系数。

对于有泄露的线性方程可以表示为

qc＝kqxv-(kc+cl1)pc(5)

qc是泵的输出流量，kq是阀的流量增益系数，kc是阀的流量压力系数，xv是直接驱动阀阀芯的位移，cl1是阀芯的泄露系数，pc是泵的输出压力。

将连续性方程应用到柱塞泵中，可以表示为

qc是泵的输出流量，pc是泵的输出压力，ac是活塞的截面积，xc是活塞的位移，cl2是泵的泄露系数，vc是泵的容积，βe是药液的弹性模量。

泵的活塞位移和阀芯位移相关具体表示为

ac是活塞的截面积，xc是活塞的位移，xv是直接驱动阀阀芯的位移，keq为等效流量增益。

综上推导可得出

结合式(2)、(3)、(8)、(9)，变量喷药系统模型为

其中，

步骤3)变喷雾系统状态方程描述如下

定义状态变量x1＝a(p)x，x3＝xv，x4＝pc，u＝(i²v)^t作为控制量输入；由式(10)、(11)、(12)、(13)变喷雾系统状态方程为

假设δx＝x-x0，其中x0是系统处在工作点时的状态变量。所以得到：

并且依据线性化理论，得到控制系统线性化模型，将上述方程表述为：

其中

其中，l＝-a2x0+l2，y为输出压力和输出流量。

步骤4)设计植保机变喷雾系统流量控制器，基于状态方程和动力学及流量特性，使植保机喷雾流量实现渐近跟踪，其特征在于：设计最佳的控制器，变喷雾系统的状态空间方程可表示为

其中，不确定矩阵δa主要依赖于不确定向量r，其在一定的范围内发生变化。系统的不确定性δa能满足下述特征

δa＝eθf(18)

其中，矩阵e和f为适维常数矩阵，矩阵θ为适维时变矩阵，受不确定向量r的影响，且满足θθ^t≤i。

为了能够让系统的输出误差向量e(t)＝y(t)-yr收敛到0，需要对误差向量进行积分处理，这样便可消除向量的误差，从而使误差为0，用公式可以表示为：

将公式(17)与本文控制系统中的状态方程(19)联立，得到増广系统为

将上述方程重新整理为一个増广状态方程的形式，如下所示

并且这里满足

为了能够达到控制器使系统稳定这一标准，所设计的性能指标只要满足线性系统是可控的，那么最优鲁棒输出跟踪控制不仅可以使输出流量值跟踪到目标设定的流量值，还能使性能指标达到最小值。系统的性能指标描述如下

由于系统具有不确定性，因此推导出最佳的控制输入为

u^*(t)＝-kz(t)＝-(1+α)kz(t)(23)

在这里α是调节因子，其中满足

那么所提出的控制率是能使线性控制系统具有指定收敛率的鲁棒输出跟踪控制器。

步骤5)采用can总线串行通讯协议传输数据，利用stm32单片机对植保机喷雾流量进行控制。其特征在于：以stm32单片机为主控制器，主控制器的输入接高度检测模块、输出接电机驱动模块；can总线通讯模块；以及电源供电模块。

步骤6)基于stm32单片机将输出信号提供驱动单元，实现了对变喷雾系统输出流量的实时控制。其特征在于：主控制器控制方法为读取高度检测单元的反馈信号与主控制器给定的控制命令信号y和yr，计算得出误差信号。根据误差信号，主控制器按照预定的控制算法计算出的喷雾的流量以及驱动比例减压阀的电流信号的控制量，送给比例减压阀驱动单元，控制植保机喷雾系统的输出流量追踪到参考流量。

优点及效果：

本发明是基于植保机柱塞泵压力的变喷雾系统流量跟踪控制方法，具有如下优点：本发明基于植保机变喷雾系统的特征，结合动力学模型和流量特性模型，考虑喷雾系统的非线性因素，建立植保机变喷雾系统输出压力与流量之间的系统状态方程；设计植保机变喷雾系统的输出流量控制器，使植保机喷雾流量实现渐近跟踪；该控制方法能精确控制植保机喷雾输出流量，提高植保机喷雾效率，能有效地减少农药浪费。

附图说明：

图1为本发明控制器工作框图；

图2为本发明主控制器最小系统；

图3-1，3-2为本发明can总线模块原理电路；

具体实施方式：

下面结合附图对本发明做进一步的说明，但本发明保护范围不受实施例的限制。

.基于植保机柱塞泵压力的变喷雾系统流量跟踪控制方法，其特征在于：

1)基于植保机变喷雾系统的特征，结合动力学模型和流量特性模型，考虑喷雾系统的非线性因素，建立植保机变喷雾系统输出压力与流量之间的系统状态方程；

2)设计植保机变喷雾系统流量控制器，基于状态方程和动力学及流量特性，使植保机喷雾流量实现渐近跟踪；

3)采用can总线串行通讯协议传输数据，利用stm32单片机对植保机喷雾流量进行控制，实现了对植保机喷雾流量的渐近跟踪。

步骤如下：

步骤1)基于植保机变喷雾系统的特征，结合动力学模型和流量特性模型，考虑变喷雾系统的非线性因素，建立植保机变喷雾系统输出压力与流量之间的系统状态方程，其特征在于：变喷雾系统的动力学模型描述如下

在假设磁路未饱和，而且忽略铁损和磁路中材料的磁阻的条件下，通电后电磁阀的电磁力方程可以表示为

fm为电磁阀的电磁力，δ为线圈与衔铁之间的气隙，n为线圈匝数，sa为有效作用面积，μ0为真空磁导率，i为线圈中的电流。

建立模型时忽略流体动量变化产生的稳态液动力和瞬态液动力以及液体静压力，因此得到阀芯的运动平衡方程可以表示为

其中，为弹簧刚度，m为阀芯的等效质量，c为阀芯的等效阻尼，x为阀芯的位移，x0为预先弹簧压缩量，k为弹簧刚度，kf为比例系数，i为线圈中的电流。

电磁阀的流量方程可以表示为

qf为通过阀口的输出流量，cf为流量系数，sa为有效作用面积，x为阀芯的位移，p为出口压力，ρ为药液密度。

步骤2)变喷雾系统的柱塞泵控制模型描述如下

为了控制柱塞泵的输出压力，对柱塞泵的压力控制系统进行数学建模，直接驱动阀阀芯动力学方程具体表达为

kv是线性电动机的力常数，v是线性电动机的输入电压，xv是直接驱动阀阀芯的位移，c1是阻尼力的系数，c2是弹簧的系数。

对于有泄露的线性方程可以表示为

qc＝kqxv-(kc+cl1)pc(5)

qc是泵的输出流量，kq是阀的流量增益系数，kc是阀的流量压力系数，xv是直接驱动阀阀芯的位移，cl1是阀芯的泄露系数，pc是泵的输出压力。

将连续性方程应用到柱塞泵中，可以表示为

qc是泵的输出流量，pc是泵的输出压力，ac是活塞的截面积，xc是活塞的位移，cl2是泵的泄露系数，vc是泵的容积，βe是药液的弹性模量。

泵的活塞位移和阀芯位移相关具体表示为

ac是活塞的截面积，xc是活塞的位移，xv是直接驱动阀阀芯的位移，keq为等效流量增益。

综上推导可得出

结合式(2)、(3)、(8)、(9)，变量喷药系统模型为

其中，

步骤3)变喷雾系统状态方程描述如下

定义状态变量x1＝a(p)x，x3＝xv，x4＝pc，u＝(i²v)^t作为控制量输入；由式(10)、(11)、(12)、(13)变喷雾系统状态方程为

假设δx＝x-x0，其中x0是系统处在工作点时的状态变量。所以得到：

并且依据线性化理论，得到控制系统线性化模型，将上述方程表述为：

其中

其中，l＝-a2x0+l2，y为输出压力和输出流量。

步骤4)设计植保机变喷雾系统流量控制器，基于状态方程和动力学及流量特性，使植保机喷雾流量实现渐近跟踪，其特征在于：设计最佳的控制器，变喷雾系统的状态空间方程可表示为

其中，不确定矩阵δa主要依赖于不确定向量r，其在一定的范围内发生变化。系统的不确定性δa能满足下述特征

δa＝eθf(18)

其中，矩阵e和f为适维常数矩阵，矩阵θ为适维时变矩阵，受不确定向量r的影响，且满足θθ^t≤i。

为了能够让系统的输出误差向量e(t)＝y(t)-yr收敛到0，需要对误差向量进行积分处理，这样便可消除向量的误差，从而使误差为0，用公式可以表示为：

将公式(17)与本文控制系统中的状态方程(19)联立，得到増广系统为

将上述方程重新整理为一个増广状态方程的形式，如下所示

并且这里满足δaz＝ezθfz，fz＝(f0)。

为了能够达到控制器使系统稳定这一标准，所设计的性能指标只要满足线性系统是可控的，那么最优鲁棒输出跟踪控制不仅可以使输出流量值跟踪到目标设定的流量值，还能使性能指标达到最小值。系统的性能指标描述如下

由于系统具有不确定性，因此推导出最佳的控制输入为

u^*(t)＝-kz(t)＝-(1+α)kz(t)(23)

在这里α是调节因子，其中满足

那么所提出的控制率是能使线性控制系统具有指定收敛率的鲁棒输出跟踪控制器。

步骤5)采用can总线串行通讯协议传输数据，利用stm32单片机对植保机喷雾流量进行控制。其特征在于：以stm32单片机为主控制器，主控制器的输入接高度检测模块、输出接电机驱动模块；can总线通讯模块；以及电源供电模块。

步骤6)基于stm32单片机将输出信号提供驱动单元，实现了对变喷雾系统输出流量的实时控制。其特征在于：主控制器控制方法为读取高度检测单元的反馈信号与主控制器给定的控制命令信号y和yr，计算得出误差信号。根据误差信号，主控制器按照预定的控制算法计算出的喷雾的流量以及驱动比例减压阀的电流信号的控制量，送给比例减压阀驱动单元，控制植保机喷雾系统的输出流量追踪到参考流量。

结论：

本发明解决了植保机喷雾流量快速跟踪达到稳定的问题，基于植保机变喷雾系统的特征，结合动力学模型和流量特性模型，考虑喷雾系统的非线性因素，建立植保机变喷雾系统输出压力与流量之间的系统状态方程，使植保机喷雾流量实现渐近跟踪，提高了植保机的喷雾效率，能有效地减少农药浪费。