[发明专利]一种作业机具自动调平系统及其控制方法

说明书

技术领域

本发明涉及一种自动调平系统，尤其是一种作业机具自动调平系统及其控制方法，属于智能农业机械领域。

背景技术

现代农业机械大都要求作业机具保持与作业对象面平行。目前市场上的大多数农业机械仍为传统的仿形作业方式，只有少量农业机械可实现作业机具高度方向的控制，但还不能做到水平控制。然而，在实际作业中，由于田块不平整、泥脚深浅不一等因素，容易导致左右轮不在同一水平位置，升降仿形装置只能控制作业机具的高低，不能控制整机在左右水平方向的平衡，导致作业达不到预定要求。如大多水田犁底层高低不平，水田平整作业时，激光控制系统仅能保证平地铲高低可调，而不能保证平地铲水平可控，导致泥面平整度难以满足种植要求。

为了实现手扶插秧机水平控制，中国专利号为200820133989.3的实用新型专利公开了一种插秧机自动平衡装置，应用万有引力及天平杠杆原理，传感器重锤自动找平衡，控制液压系统带动相关部件实现插秧机体左右水平，保证秧苗栽植深度一致。为保证挂车水平，中国专利号为201220293588.0的实用新型专利公开了一种挂车水平角度补偿机构，通过调节气囊的充气量来调节角度，使车体保持水平。为实现平地机的水平控制，中国专利号为200810028328.9的发明专利公开了一种平地机的水平控制系统及其控制方法，在平地铲上安装有感应平地铲水平倾角及倾角变化率信号的传感器系统以计算出平地铲的水平倾角，从而控制平地铲水平，实际应用中这种方式受平地铲运动影响导致难以准确检测平地铲倾斜角度，并存在传感器系统安装要求高，传感系统和控制系统易进水问题。

发明内容

本发明的目的是为了解决上述现有技术的缺陷，提供了一种作业机具自动调平系统，该系统适用于现代农业机械，且结构简单，可以保证作业机具的精准、平稳控制，以达到精确作业。

本发明的另一目的在于提供一种上述作业机具自动调平系统的自动调平控制方法。

本发明的目的可以通过采取如下技术方案达到：

一种作业机具自动调平系统，包括倾角检测传感器模块、位移检测传感器、自动调平控制模块以及执行模块，所述执行模块包括作业机具、旋转机构以及伸缩机构，所述作业机具通过旋转机构与农业机械车体连接；所述伸缩机构相对于作业机具倾斜设置，且伸缩的一端与作业机具铰接，通过伸长或缩短驱动作业机具旋转，以调节作业机具相对于农业机械车体的倾斜角度；所述倾角检测传感器模块设置在农业机械车体上，用于检测农业机械车体的倾斜运动信号；所述位移检测传感器设置在伸缩机构上，用于检测伸缩机构所在调节位置的直线位移；所述倾角检测传感器模块、位移检测传感器和伸缩机构分别与自动调平控制模块连接。

作为一种优选方案，所述倾角检测传感器模块包括加速度传感器和角速度传感器，所述加速度传感器和角速度传感器检测到的农业机械车体的倾斜运动信号通过Kalman融合算法计算出农业机械车体的实时倾斜角度。

作为一种优选方案，所述自动调平控制模块包括运算控制器、驱动单元以及人机交互单元，所述驱动单元和人机交互单元分别与运算控制器连接；所述运算控制器用于根据农业机械车体的实时倾斜角度、作业机具和车体结构的几何模型、位移检测传感器数据和通过人机交互单元设定的作业机具相对于农业机械车体的目标倾斜角度，通过驱动单元控制伸缩机构伸长或缩短，以调节作业机具相对于农业机械车体的倾斜角度。

作为一种优选方案，所述作业机具与旋转机构铰接。

作为一种优选方案，所述伸缩机构为液压油缸或电动缸。

本发明的另一目的可以通过采取如下技术方案达到：

S1、倾角检测传感器模块的加速度传感器和角速度传感器检测农业机械车体的倾斜运动信号，并传输给自动调平控制模块的运算控制器；

S2、运算控制器根据农业机械车体的倾斜运动信号，通过Kalman融合算法计算出农业机械车体的实时倾斜角度；

s3、运算控制器读取当前位移检测传感器的信号，并转化为伸缩机构的位移量；

S4、运算控制器根据作业机具和农业机械车体结构的几何模型，以及伸缩机构当前的位移量，通过建立伸缩机构的位移x变化与作业机具相对于农业机械车体的倾斜角度θ变化的关系θ＝f(x)，计算作业机具相对于农业机械车体的倾斜角度；

S5、运算控制器根据农业机械车体的倾斜角度和作业机具相对于农业机械车体的倾斜角度的差值，结合结构的几何模型，将角度的差值代入θ＝f(x)，计算出作业机具调平所需的伸缩机构的控制目标位移值；