[发明专利]高地隙植保机的调平控制方法及系统

摘要

本发明公开了一种高地隙植保机的调平控制方法及系统，该方法包括以下步骤：粗调：根据用户设定的底盘离地间隙的目标高度值计算高地隙植保机的各支腿需要上升或下降的距离，分别输出对应的控制信号给各支腿的调节系统，以将各支腿的高度调整到底盘离地间隙的目标高度值的粗调范围内；精调：获取底盘的倾角数据，根据倾角数据判断底盘的最高点和最低点，根据最高点和最低点分别计算对应的最高支腿和最低支腿的高度补偿位移距离，输出对应的控制信号给各支腿的调节系统将底盘的横滚角和俯仰角调整到精调范围内。本发明得出底盘调平后的平均水平误差≤±0.20°，最大误差1.13°，调平精度≤±0.2度。

主权项

1.一种高地隙植保机的调平控制方法，其特征在于，包括以下步骤：粗调：根据用户设定的底盘离地间隙的目标高度值以及通过四个支腿处的对应的第一倾角传感器获取底盘各支腿对应的第一倾角数据而计算得到各支腿的当前高度，计算高地隙植保机的各支腿需要上升或下降的距离，分别输出对应的控制信号给各支腿的调节系统，以将各支腿的高度调整到所述底盘离地间隙的目标高度值的粗调范围内；精调：获取底盘的第二倾角数据，根据所述第二倾角数据判断底盘的最高点和最低点，根据所述最高点和最低点分别计算对应的最高支腿和最低支腿的高度补偿位移距离，输出对应的控制信号给各支腿的调节系统将底盘的横滚角和俯仰角调整到精调范围内。