详情

原文传递一种叉车叉臂控制系统及方法

专利名称：	一种叉车叉臂控制系统及方法
摘要：	本发明涉及工业智能控制技术领域，具体地说是一种叉车叉臂控制系统及方法，控制系统包括：计时装置、测量装置、运算装置、存储装置；控制方法包括通过测得小车在测量周期内的偏差值并进行PID控制以求得举升电机电压，并在叉臂即将到达目标高度时持续监测单位偏差值的正负以调节举升电机电压；本发明和现有技术相比，能够控制电机速度平滑下降，最终叉臂精准停在目标位置，从而避免了叉臂抖动的问题，提高运输效率。
专利类型：	发明专利
国家地区组织代码：	安徽;34
申请人：	芜湖智久机器人有限公司
发明人：	李亚
专利状态：	有效
申请日期：	2019-01-11T00:00:00+0800
发布日期：	2019-06-11T00:00:00+0800
申请号：	CN201910025426.5
公开号：	CN109867236A
代理机构：	芜湖众汇知识产权代理事务所(普通合伙)
代理人：	曹宏筠
分类号：	B66F9/24(2006.01);B;B66;B66F;B66F9
申请人地址：	241000 安徽省芜湖市芜湖县安徽新芜经济开发区东区自建厂房B11幢
主权项：	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所述的一种叉车叉臂控制方法，其特征在于，用户通过外部装置向所述存储装置发送指令来设定所述叉臂的最终目标高度。
所属类别：	发明专利