压力稳态与状态反馈结合的植保机精准施药控制方法与流程

技术领域：

本发明涉及农业智能机械自动化领域，尤其是关于植保机作业状态参数的智能控制方法。

背景技术：
：

随着科学农业的高速发展与机械农业的发展需求，种植农业对植保机械的要求也越来越高。现今我国的农药年产量近百万吨，但是对于农药的有效使用率不足40％，其原因正是因为植保机械能力的落后与不足，开发与研制适合现代农业的植保机械已经成为当今发展科学农业的当务之急。

喷药效果作为衡量植保机械优劣的有效指标，良好的喷药效果需要对植保机喷药压力、流量、机械行走速度等达到有效的控制，这其中对植保机械喷药压力的控制成为重中之重。到目前为止，还没有将完整的植保机施药压力系统模型与高级智能控制相结合使植保机施药压力快速准确地克服复杂工况扰动跟踪期望压力的控制方法。因此研究使植保机施药压力快速准确地克服工况扰动跟踪期望压力的控制方法具有重要意义。

技术实现要素：
：

发明目的：

为了解决上述问题，本发明提供了一种压力稳态与状态反馈结合的植保机精准施药控制方法。

技术方案：

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

一种压力稳态与状态反馈结合的植保机精准施药控制方法，其特征在于：

考虑施药压力系统的非线性因素和植保机药液泵与施药管道之间的压力模型，建立植保机药液泵与施药管道之间的压力系统的状态方程；设计压力稳态与状态反馈结合控制的施药压力控制器，基于压力系统状态方程，使施药压力克服复杂工况扰动跟踪参考压力。具体步骤如下：

1)基于植保机药液泵与施药管道之间的压力模型，施药压力系统的非线性因素，建立植保机药液泵与施药管道之间的压力系统的状态方程；

2)设计基于压力系统状态方程的压力稳态与状态反馈结合控制的施药压力控制器，使施药压力克服复杂工况扰动跟踪参考压力；

3)基于stm32系列微控制器和can总线通信方式设计基于can总线植保机压力稳态控制器，使施药压力信号能快速跟踪参考压力信号。

步骤如下：

步骤1)基于植保机药液泵与施药管道之间的压力模型，施药压力系统的非线性因素，建立植保机药液泵与施药管道之间的压力系统的状态方程，施药压力系统的数学模型描述如下

喷药压力系统的药液泵是指具有由轮轴驱动的径向活塞的柱塞泵，当药液从药液箱流入药液泵室，然后被施加到高压后输送到药液管道。施药压力系统的数学模型：

药液泵内药液体积变化根据驱动轴的运动而改变：

pp为药液泵压力，kf为体积模量，vp为药液泵体积，qi是药液的入口流量，可以由压力控制阀调节，q0是药液的泄漏量，通常被认为是恒定值。qpr为药液泵到管道的流量即出口流量，ap药液泵出口面积，ωr为轴转速，具体表达为：

cpr为药液泵出口的药液流量系数，apr为药液泵出口的截面积，ρ为药液密度，pr为药液管道压力。在喷药压力系统中，药液管道可以认为是具有一定体积的连接药液泵和喷嘴组的药液载体。药液管道的压力动态方程可以表示为：

其中vr是管道药液的体积，qri是管道的药液出口流量也等于喷嘴组喷射量总和。确定qri和pr之间的关系。结合式(1)、(2)，喷药压力系统模型为：

其中，η为泄漏系数。

步骤2)基于植保机药液泵与施药管道之间的压力模型，施药压力系统的非线性因素，建立植保机药液泵与施药管道之间的压力系统的状态方程，施药压力系统状态方程描述如下：

定义状态变量x1＝pr，u＝qi作为控制量输入；由式(1)、(2)、(5)喷药压力系统状态方程为:

其中，c＝[1,0]，c为输出矩阵。y为输出压力。

a1,a2,b1,b2为压力系统状态方程的状态矩阵。

步骤3)设计基于压力系统状态方程的压力稳态与状态反馈结合控制的施药压力控制器，使施药压力克服复杂工况扰动跟踪参考压力，具体描述如下

稳态性能控制：根据式(6)，设计稳态控制，

即

为输出压力变化率等于状态变量的变化率。对式(8)求导，得出

为输出压力变化率的导数，为状态变量x2的变化率。为a1对于x1的偏导值，为b1对于x1的偏导值，将式(9)代入

稳态控制中，使参考压力y平稳变化，无激烈变化，令和

fs(x)为稳态控制律。引入压力稳态后，控制律为：

u为现阶段总体控制律，为引入控制律。代入式(11)

其中，y^*为输出压力参考值，为输出压力参考值变化率，为输出压力参考值变化率的导数，b(x)＝b1(x1)b2(x)。

引入压力状态反馈控制，控制律为：

u2为状态反馈控制律。同理，代入式(11)中，推出

控制律：

定义压力误差为：e1＝y^*-y；e2为e1的变化率；e3为e2的误差值。k0,k1,k2为控制律系数。

状态反馈控制的控制律：

其中，∫e1dt为误差e1的积分值。联立式(12)(14)(18)，总体的控制律为：

其中：

步骤4)基于stm32系列微控制器和can总线通信方式设计基于can总线植保机压力稳态控制器，使施药压力信号能快速跟踪参考压力信号。其特征在于：以stm32系列微控制器为主控制器，以can2.0b为总线通信规范，硬件上两路达林顿0.5a输出,两路5a继电器输出，扩展输出可实现,4-20ma模拟量输出，两路交流20a信号输出。

优点及效果：

本发明为一种压力稳态与状态反馈结合的植保机精准施药控制方法，具有如下优点：本发明建立基于植保机药液泵与施药管道之间的压力系统状态方程；设计压力稳态与状态反馈结合的植保机精准施药控制；易于使植保机施药压力克服复杂工况扰动跟踪期望压力，该控制方法能精确控制植保机施药压力，提高植保机的喷施效率，减少农药浪费。

附图说明：

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

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

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

具体实施方式：

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

一种压力稳态与状态反馈结合的植保机精准施药控制方法，其特征在于：

1)基于植保机药液泵与施药管道之间的压力模型，施药压力系统的非线性因素，建立植保机药液泵与施药管道之间的压力系统的状态方程；

2)设计基于压力系统状态方程的压力稳态与状态反馈结合控制的施药压力控制器，使施药压力克服复杂工况扰动跟踪参考压力；

3)基于stm32系列微控制器和can总线通信方式设计基于can总线植保机压力稳态控制器，使施药压力信号能快速跟踪参考压力信号。

步骤如下：

步骤1)基于植保机药液泵与施药管道之间的压力模型，施药压力系统的非线性因素，建立植保机药液泵与施药管道之间的压力系统的状态方程，施药压力系统的数学模型描述如下：

药液泵内药液体积变化根据驱动轴的运动而改变：

pp为药液泵压力，kf为体积模量，vp为药液泵体积，qi是药液的入口流量，可以由压力控制阀调节，q0是药液的泄漏量，通常被认为是恒定值。qpr为药液泵到管道的流量即出口流量，ap药液泵出口面积，ωr为轴转速，具体表达为：

cpr为药液泵出口的药液流量系数，apr为药液泵出口的截面积，ρ为药液密度,pr为药液管道压力。在喷药压力系统中，药液管道可以认为是具有一定体积的连接药液泵和喷嘴组的药液载体。药液管道的压力动态方程可以表示为：

其中vr是管道药液的体积，qri是管道的药液出口流量也等于喷嘴组喷射量总和。确定qri和pr之间的关系。结合式(1)、(2)，喷药压力系统模型为：

其中，η为泄漏系数。

步骤2)基于植保机药液泵与施药管道之间的压力模型，施药压力系统的非线性因素，建立植保机药液泵与施药管道之间的压力系统的状态方程，施药压力系统状态方程描述如下

定义状态变量x1＝pr，u＝qi作为控制量输入；由式(1)、(2)、(5)喷药压力系统状态方程为:

其中，c＝[1,0]，c为输出矩阵。y为输出压力。

a1,a2,b1,b2为压力系统状态方程的状态矩阵。

步骤3)设计基于压力系统状态方程的压力稳态与状态反馈结合控制的施药压力控制器，使施药压力克服复杂工况扰动跟踪参考压力，具体描述如下

稳态性能控制：根据式(6)，设计稳态控制，

即

为输出压力变化率等于状态变量的变化率。对式(8)求导，得出

为输出压力变化率的导数，为状态变量x2的变化率。为a1对于x1的偏导值，为b1对于x1的偏导值，将式(9)代入

稳态控制中，使参考压力y平稳变化，无激烈变化，令和

fs(x)为稳态控制律。引入压力稳态控制后，控制律为：

u为现阶段总体控制律，为引入控制律。代入式(11)

其中，y^*为输出压力参考值，为输出压力参考值变化率，为输出压力参考值变化率的导数，b(x)＝b1(x1)b2(x)。

引入压差状态反馈控制，控制律为：

u2为状态反馈控制律。同理，代入式(11)中，推出

控制律：

定义压力误差为：e1＝y^*-y；e2为e1的变化率；e3为e2的误差值。k0,k1,k2为控制律系数。

状态反馈控制的控制律：

其中，∫e1dt为误差e1的积分值。联立式(12)(14)(18)，总体的控制律为：

其中：

步骤4)基于stm32系列微控制器和can总线通信方式设计基于can总线植保机压力稳态控制器，使施药压力信号能快速跟踪参考压力信号。其特征在于：以stm32系列微控制器为主控制器，以can2.0b为总线通信规范，硬件上两路达林顿0.5a输出,两路5a继电器输出，扩展输出可实现,4-20ma模拟量输出，两路交流20a信号输出。

综上所述：

本发明解决了植保机施药压力快速克服复杂扰动达到稳定的问题，发明一种压力稳态与状态反馈结合的植保机精准施药控制方法，建立基于植保机药液泵与施药管道之间的压力系统状态方程；设计压力稳态与状态反馈结合的植保机精准施药控制；使植保机施药压力克服复杂工况扰动跟踪期望压力，该控制方法能精确控制植保机施药压力，提高植保机的喷施效率，减少农药浪费。