[发明专利]一种叉车叉臂控制系统及方法

权利要求书

1.一种叉车叉臂控制系统，包括叉臂，其特征在于，还包括：

计时装置；

测量装置，用于按照固定测量周期测量所述叉臂高度值；

运算装置，包括速度计算单元、PID控制单元；所述速度计算单元用于接收所述测量装置测得的所述叉臂高度和所述计时装置测得的时间，并计算出所述叉臂在垂直方向上的移动速度；所述PID控制单元用于对所述叉臂高度进行PID控制，并向所述叉臂举升电机发出控制指令；

存储装置，用于存储所述叉臂的速度信息、位置信息。

2.根据权利要求1所述的一种叉车叉臂控制系统，其特征在于，所述测量装置采用拉线编码器。

3.一种叉车叉臂控制方法，包括权利要求1或2所述的控制系统，其特征在于，还包括以下步骤：

1)设置所述叉臂的最终目标高度；

2)计算当前所述固定测量周期结束时所述叉臂的预期周期位移，并将其减去当前所述固定测量周期结束时所述叉臂的实际位移，得到单位位置偏差；

3)在所述运算装置中对所述单位位置偏差进行PID控制，得到所述叉臂的举升电机的电压参考值，并根据所述电压参考值设定所述叉臂的举升电机的电压；

4)当所述叉臂距离所述最终目标高度的差值小于第一目标差值时，采集所述叉臂的所述单位位置偏差；若所述单位位置偏差为负，则将所述叉臂举升电机的电压降低一步长值；否则判断下一个所述固定测量周期中单位偏差的正负，若连续若干个所述固定测量周期中，所述单位偏差均为正，则将所述叉臂举升电机的电压升高一步长值。

4.根据权利要求3所述的一种叉车叉臂控制方法，其特征在于，还需根据所述叉臂垂直方向上的移动速度测算出所述叉臂的负载重量，并根据其负载重量的大小将所述叉臂分为若干工作模式，所述PID控制中设有若干组PID参数，每组所述PID参数分别与所述工作模式一一对应。

5.根据权利要求3所述的一种叉车叉臂控制方法，其特征在于，步骤3)中所述PID控制的输出值需进行一阶低通滤波处理。

6.根据权利要求3所述的一种叉车叉臂控制方法，其特征在于，步骤3)中所述PID控制采用位置式PID控制。

7.根据权利要求3所述的一种叉车叉臂控制方法，其特征在于，步骤4)中所述连续若干个所述固定测量周期具体为连续三个所述固定测量周期。

8.根据权利要求4所述的一种叉车叉臂控制方法，其特征在于，所述将所述叉臂分为若干工作模式具体为：所述叉臂负载每上升0.5吨即切换至下一工作模式。

9.根据权利要求3所述的一种叉车叉臂控制方法，其特征在于，步骤2)中所述预期周期位移为根据所述叉臂垂直方向上的移动速度与所述固定测量周期相乘得到。

10.根据权利要求3所述的一种叉车叉臂控制方法，其特征在于，用户通过外部装置向所述存储装置发送指令来设定所述叉臂的最终目标高度。