[发明专利]一种旋耕机工作装置作业姿态自动调整控制方法及系统

权利要求书

1.一种旋耕机工作装置作业姿态自动调整控制方法，其特征在于，包括：

在旋耕机开始工作后，获取旋耕机工作装置的姿态初值；并在获取所述姿态初值后实时采集所述旋耕机工作装置的姿态测量值；

实时计算出所述旋耕机工作装置的姿态测量值与姿态初值的差值，并根据所述差值生成所述旋耕机工作装置的控制信号；

根据所述控制信号实时调整所述旋耕机工作装置的姿态，使得所述旋耕机工作装置的姿态变化保持在预设范围内；

根据所述差值生成所述旋耕机工作装置的控制信号：

S＝C×U(ΔA)；

U(ΔA)＝P×ΔA+I×∫ΔAdt；

其中，S表示控制信号，C为预设常数，ΔA表示所述旋耕机工作装置的姿态测量值与姿态初值的差值，P、I均为预设控制参数，t为获取旋耕机工作装置姿态测量值与获取旋耕机工作装置姿态初值的时间差。

2.如权利要求1所述的旋耕机工作装置作业姿态自动调整控制方法，其特征在于，所述获取旋耕机工作装置的姿态初值，具体为：

当所述旋耕机工作装置的直接或间接驱动油缸没有动作，所述旋耕机有行驶或转向动作，且保持预设时间时，获取所述旋耕机工作装置的姿态初值。

3.如权利要求1所述的旋耕机工作装置作业姿态自动调整控制方法，其特征在于，

将所述差值的绝对值与第一预设阈值进行比较；

当所述差值的绝对值不大于第一预设阈值时，按照第三控制方案为P赋值，且I＝0，根据赋值结果计算出U(ΔA)，并根据U(ΔA)计算出控制信号；

当所述差值的绝对值大于第一预设阈值时，所述方法还包括：实时采集所述旋耕机的车速测量值；

计算出所述差值与所述旋耕机相应时刻的车速测量值的比值，并将所述比值的绝对值与第二预设阈值进行比较；

当所述比值的绝对值大于所述第二预设阈值时，按照第一控制方案为P、I赋值，根据赋值结果计算出U(ΔA)，并根据U(ΔA)计算出控制信号；

当所述比值的绝对值不大于所述第二预设阈值时，按照第二控制方案为P赋值，且I＝0，根据赋值结果计算出U(ΔA)，并根据U(ΔA)计算出控制信号。

4.一种旋耕机工作装置作业姿态自动调整控制系统，其特征在于，包括：

检测模块，用于在旋耕机开始工作后，获取旋耕机工作装置的姿态初值；并在获取所述姿态初值后实时采集所述旋耕机工作装置的姿态测量值；

控制模块，用于实时计算出所述旋耕机工作装置的姿态测量值与姿态初值的差值，并根据所述差值生成所述旋耕机工作装置的控制信号；

执行机构，用于根据所述控制信号实时调整所述旋耕机工作装置的姿态，使得所述旋耕机工作装置的姿态变化保持在预设范围内；

所述控制模块具体用于：

根据所述差值生成所述旋耕机工作装置的控制信号：

S＝C×U(ΔA)；

U(ΔA)＝P×ΔA+I×∫ΔAdt；

其中，S表示控制信号，C为预设常数，ΔA表示所述旋耕机工作装置的姿态测量值与姿态初值的差值，P、I均为预设控制参数，t为获取旋耕机工作装置姿态测量值与获取旋耕机工作装置姿态初值的时间差。

5.如权利要求4所述的旋耕机工作装置作业姿态自动调整控制系统，其特征在于，所述检测模块包括旋耕机具角度传感器或旋耕机具油缸长度传感器。

6.如权利要求4所述的旋耕机工作装置作业姿态自动调整控制系统，其特征在于，所述控制模块包括集中式控制器、分布式控制器或远程控制器。

7.如权利要求4所述的旋耕机工作装置作业姿态自动调整控制系统，其特征在于，所述执行机构包括旋耕机具油缸或动臂油缸。

8.如权利要求4所述的旋耕机工作装置作业姿态自动调整控制方法，其特征在于，所述系统还包括车速传感器，所述车速传感器用于实时采集所述旋耕机的车速测量值；所述控制模块还用于：

将所述差值的绝对值与第一预设阈值进行比较；

当所述差值的绝对值不大于第一预设阈值时，按照第三控制方案为P赋值，且I＝0，根据赋值结果计算出U(ΔA)，并根据U(ΔA)计算出控制信号；

当所述差值的绝对值大于第一预设阈值时，计算出所述差值与所述旋耕机相应时刻的车速测量值的比值，并将所述比值的绝对值与第二预设阈值进行比较；

当所述比值的绝对值大于所述第二预设阈值时，按照第一控制方案为P、I赋值，根据赋值结果计算出U(ΔA)，并根据U(ΔA)计算出控制信号；

当所述比值的绝对值不大于所述第二预设阈值时，按照第二控制方案为P赋值，且I＝0，根据赋值结果计算出U(ΔA)，并根据U(ΔA)计算出控制信号。