[发明专利]一种双钟摆喷杆悬架的建模和位置跟踪的控制方法

说明书

一种双钟摆喷杆悬架的建模和位置跟踪的控制方法，第一步：传感器检测喷杆和路面之间的倾斜角度，主控制器控制方法为读取喷杆和路面之间的倾斜角度信号与主控制器给定的控制命令信号，通过作差计算得出误差信号；第二步：根据第一步中的误差信号，主控制器按照预定的控制算法计算出的喷杆的高度以及驱动伺服阀的电流信号的控制量，传递给伺服阀驱动单元，通过伺服阀驱动单元对植保机械喷杆进行角度调节并按照预定高度进行工作，实现对喷杆和路面之间的倾斜角度或植株冠层高度的跟踪。本发明使喷杆悬架在具有干扰的影响和作用下依旧能够保持较好稳定性的能力，从而保证施药的均匀性。对喷杆的位姿控制研究以及农业施药技术的发展具有重要的意义。

技术领域：

本发明涉及智能农业植保机械的控制领域，尤其是关于用于田间工作的大型植保机械的双钟摆喷杆悬架的建模和控制方法。

背景技术：

为了解决病虫草害等农业问题，植保机械对于经济作物高产、面粮稳产上逐渐发挥着不可替代的作用，目前已经在世界上许多国家的植保机械中被广泛研究与使用。大型植保机械的喷杆悬架，主要有双连杆、梯形悬架、摆形悬架等等结构。到目前为止，国内外学者得到了喷杆悬架的频响函数，但是如今并没有对喷杆悬架状态空间形式的研究，除此之外，大多数对植保机械的液压驱动控制器采用较为传统的经典控制策略，然而，在田间的实际长时间连续工作过程中，植保机械极易受到外界环境、传感器特性变化等因素的影响，一些控制策略难以满足对喷杆的角度的控制需求，

发明内容：

发明目的：

为了解决上述问题，本发明提供了一种双钟摆喷杆悬架的建模方法以及一种跟踪控制器的设计方法。

技术方案：

一种植保机械双钟摆喷杆悬架的跟踪控制方法，其特征在于：所述方法步骤如下：

第一步：传感器检测喷杆和路面之间的倾斜角度，主控制器控制方法为读取喷杆和路面之间的倾斜角度信号与主控制器给定的控制命令信号(设定的目标值，根据传感器实时测量得到反馈信号，然后通过控制器作用于执行器上，从而驱动伺服阀带动喷杆的动作)，通过作差计算得出误差信号；

第二步：根据第一步中的误差信号，主控制器按照预定的控制算法计算出的喷杆的高度(是喷杆两侧和地面间的高度。因为在实现跟踪(即喷杆平行于地面)时最终喷杆两侧距离地面的高度是相同的)以及驱动伺服阀的电流信号的控制量，传递给伺服阀驱动单元，通过伺服阀驱动单元对植保机械喷杆进行角度调节并按照预定高度进行工作，实现对喷杆和路面之间的倾斜角度或植株冠层高度的跟踪。

主控制器构建方法如下：

1)、结合第二类Lagrange(拉格朗日)动力学方程(即为第二类Lagrange方程)，建立植保机双钟摆喷杆悬架的非线性模型，并在工作点处线性化得到的双钟摆喷杆悬架的状态方程；

2)、基于所得到的双钟摆喷杆悬架的状态方程，引用一定的不确定参数(这个参数是考虑到了植保机械在工作过程中温度、湿度等环境因素对传感器造成的影响以及元器件老化等因素，悬架的状态方程会发生一定的变化，因此考虑了引入不确定参数。)，选取线性二次型性能指标(最优控制中的线性二次型性能指标)，构建主控制器。通过主控制器实时控制喷杆的位姿，从而使之对地面倾角或作物冠层高度实现渐进跟踪，实现仿形控制。

1)步骤中结合第二类Lagrange动力学方程，建立植保机双钟摆喷杆悬架的非线性模型,并在工作点处线性化得到的双钟摆喷杆悬架的状态方程的步骤如下：

第二类Lagrange动力学方程为：

其中L＝T-V为拉格朗日函数，T为植保机械的总动能，V为植保机械总势能，D_L为所消耗与散失的热能，Q_i(i＝1,2,3...)为广义坐标θ_i(i＝1,2,3...)下的广义力。