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

权利要求书

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

在堆高机带载行驶后，获取堆高机工作装置的姿态初值；并在获取所述姿态初值后实时采集所述堆高机工作装置的姿态测量值；

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

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

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

S=C×U(ΔA)；

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

其中，S表示控制信号，C为预设常数，ΔA表示所述堆高机工作装置的姿态测量值与姿态初值的差值，P、I均为预设控制参数，t为获取堆高机工作装置姿态测量值与获取堆高机工作装置姿态初值的时间差，∫ΔAdt为差值在时间域上的积分；

将∫ΔAdt的绝对值与第一预设阈值进行比较；

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

当∫ΔAdt的绝对值大于所述第一预设阈值时，所述方法还包括：实时采集所述堆高机的车速测量值；

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

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

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

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

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

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

检测模块，用于在堆高机带载行驶后，获取堆高机工作装置的姿态初值；并在获取所述姿态初值后实时采集所述堆高机工作装置的姿态测量值；

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

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

所述系统还包括车速传感器，所述车速传感器用于实时采集所述堆高机的车速测量值；所述控制模块具体用于：

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

S=C×U(ΔA)；

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

其中，S表示控制信号，C为预设常数，ΔA表示所述堆高机工作装置的姿态测量值与姿态初值的差值，P、I均为预设控制参数，t为获取堆高机工作装置姿态测量值与获取堆高机工作装置姿态初值的时间差，∫ΔAdt为差值在时间域上的积分；

将∫ΔAdt的绝对值与第一预设阈值进行比较；

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

当∫ΔAdt的绝对值大于所述第一预设阈值时，实时采集所述堆高机的车速测量值；

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

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

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

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