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

摘要

本发明提供一种堆高机工作装置作业姿态自动调整控制方法及系统，所述方法包括：在堆高机带载行驶后，获取堆高机工作装置的姿态初值；并在获取所述姿态初值后实时采集所述堆高机工作装置的姿态测量值；实时计算出所述堆高机工作装置的姿态测量值与姿态初值的差值，根据所述差值生成所述堆高机工作装置的控制信号；根据所述控制信号实时调整所述堆高机工作装置的姿态，使得所述堆高机工作装置的姿态变化保持在预设范围内。本发明可根据堆高机行驶路面的变化，实时调整堆高机工作装置的姿态，使得堆高机在行驶过程中保持工作装置角度对路面颠簸的跟随控制，以抵消路面颠簸对工作装置姿态的影响。

主权项

1.一种堆高机工作装置作业姿态自动调整控制方法，其特征在于，包括：/n在堆高机带载行驶后，获取堆高机工作装置的姿态初值；并在获取所述姿态初值后实时采集所述堆高机工作装置的姿态测量值；/n实时计算出所述堆高机工作装置的姿态测量值与姿态初值的差值，根据所述差值生成所述堆高机工作装置的控制信号；/n根据所述控制信号实时调整所述堆高机工作装置的姿态，使得所述堆高机工作装置的姿态变化保持在预设范围内；/n根据所述差值生成所述堆高机工作装置的控制信号：/nS＝C×U(ΔA)；/nU(ΔA)＝P×ΔA+I×∫ΔAdt；/n其中，S表示控制信号，C为预设常数，ΔA表示所述堆高机工作装置的姿态测量值与姿态初值的差值，P、I均为预设控制参数，t为获取堆高机工作装置姿态测量值与获取堆高机工作装置姿态初值的时间差，∫ΔAdt为差值在时间域上的积分；/n将∫ΔAdt的绝对值与第一预设阈值进行比较；/n当∫ΔAdt的绝对值不大于第一预设阈值时，按照第三控制方案为P赋值，且I＝0，根据赋值结果计算出U(ΔA)，并根据U(ΔA)计算出控制信号；/n当∫ΔAdt的绝对值大于所述第一预设阈值时，所述方法还包括：实时采集所述堆高机的车速测量值；/n计算出所述差值与所述堆高机相应时刻的车速测量值的比值，并将所述比值的绝对值与第二预设阈值进行比较；/n当所述比值的绝对值大于所述第二预设阈值时，按照第一控制方案为P、I赋值，根据赋值结果计算出U(ΔA)，并根据U(ΔA)计算出控制信号；/n当所述比值的绝对值不大于所述第二预设阈值时，按照第二控制方案为P、I赋值，根据赋值结果计算出U(ΔA)，并根据U(ΔA)计算出控制信号。/n