[发明专利]一种温室自行式喷灌机行走控制方法和装置

说明书

技术领域

本发明涉及温室灌溉机械的控制方法和装置，尤其是一种温室自行式喷灌机控制方法及装置。

背景技术

随着大型连栋温室的兴建，温室喷灌机械的研发越来越受到重视，一种差速转向控制的自行、整体式喷灌机，工作时，固定输水管入水端，采用两电机分别驱动行走轮来驱动喷灌机前行，同时带动卷盘转动，放出输水管，来进行喷灌作业，回行时，使两驱动轮电机反转，同时单独用电机驱动喷灌机卷盘转动，配合输水管的回收。一个喷灌过程完成后，利用两驱动轮电机的转速差控制喷灌机的转向，将喷灌机转移到下一作业道或温室。但喷灌机前行、回行工作时，两驱动电机分别由两路可调速电机驱动控制器进行转速和力矩控制，会因个体的差异而使两驱动电机实际转速不一致，使得喷灌机工作时，行走路线偏移，无法正常工作，同时两驱动电机的实际转速与工作所需的理论转速不一致，不能按要求工作，影响喷灌均匀度。喷灌机回行，卷盘回收软管时，若回收速度比喷灌机行走速度快，使得输水管拖行喷灌机，造成卷盘电机超载工作，影响使用寿命，若回收速度比喷灌机行走速度慢，造成输水管排管紊乱，无法正常回收。

发明内容

本发明针对现有技术中存在的问题，提供一种温室自行式喷灌机行走控制方法和装置，该种控制方法和装置简单易行，精确度高、可靠性强、自动化程度高。

为了实现上述目的，本发明的控制装置，包括信号接收器、主控制器、驱动电机控制器、卷盘电机控制器、驱动电机速度传感器、卷盘电机速度传感器和距离传感器；信号接收器输出端与主控制器输入端相连，信号接收器、主控制器设置在喷灌机的车架上；主控制器输出端分别与驱动电机控制器、卷盘电机控制器的输入端相连，驱动电机控制器和卷盘电机控制器的输出端分别与对应的驱动电机和卷盘驱动电机的输入端相连，将控制信号输入到驱动电机、卷盘电机，驱动电机控制器、卷盘电机控制器设置在喷灌机的车架上，用于将控制信号输入到电机，驱动电机速度传感器、卷盘电机速度传感器分别设置在驱动电机、卷盘电机上，驱动电机速度传感器、卷盘电机速度传感器连接到主控制器；卷盘距离传感器分别设置在喷灌机卷盘两侧的侧护板上，其输出端与主控制器相连，用于检测控制信号并反馈到主控制器。

控制方法，包括如下步骤：

a.喷灌机前行时，信号接收器将接收的前行速度信号输入主控制器，主控制器根据接受的速度信号计算两驱动电机理论转速，并将该理论转速信号分别输入两驱动电机控制器使两驱动电机等速运转，完成速度初调，此时两驱动电机速度传感器检测两驱动电机的实际转速，将实际转速反馈到主控制器，主控制器比较两驱动电机的实际转速，若一致，主控制器再比较两驱动电机的实际转速与理论转速，若相同，则两驱动电机保持当前状态继续运行，若不同，主控制器对两驱动电机控制器赋值初调速度，依次循环；若两驱动电机的实际转速不一致，主控制器计算两驱动电机实际转速的平均值，将该平均值输入两电机驱动控制器，来均衡两驱动电机的转速，当两驱动电机速度传感器检测转速再次相同时，主控制器比较该平均转速与理论转速，若两转速相同，则两驱动电机保持当前状态继续运行，若不同，主控制器对两驱动电机控制器赋值初调速度，依此循环；确保喷灌机按理论速度直行不偏斜。

b.喷灌机回行时，信号接收器将接收的回收速度信号输入到主控制器，此时两驱动电机运行状态与所述a步骤一致，保证按接收的理论速度直行，主控制器计算卷盘电机理论转速，并将该转速信号输入卷盘电机控制器，驱动卷盘电机运转，完成速度初调，在PE管第1层缠绕过程中，卷盘电机速度传感器检测卷盘电机的实际转速，将该信号输入到主控制器与理论转速相比较，若一致，保持当前状态运行；若不一致，主控制器对卷盘电机控制器赋值初调速度，使卷盘电机按理论转速运行，依此循环；当第一卷盘距离传感器检测到自身和PE管之间距离发生2次改变时，PE管开始第2层缠绕，将此变化信号输入主控制器，主控制器重新计算卷盘电机的理论转速后，重复PE管第1层缠绕的控制方法；当第二卷盘距离传感器检测到自身和PE管之间距离发生两次变化时，PE管开始第3层缠绕，此时重复PE管第2层缠绕的控制方法，当第一卷盘距离传感器再次检测到信号发生变化时，PE管开始第4层缠绕，此时重复PE管第2层缠绕的控制方法，直至完成回收PE管过程。