[发明专利]一种吊装货箱的伸缩叉装置及控制方法

权利要求书

1.一种吊装货箱的伸缩叉装置，其特征在于：包括：两根轨道及在轨道上前后移动的小车，移动小车上安装有一个上下升降平台，升降平台下面左右方向吊装一个伸缩叉；其特征在于：移动小车上设有前后方向位移传感器；小车两侧各对称设置四只测距传感器；上下升降平台设有位移传感器测量平台高度；伸缩叉上设有位移传感器测量伸缩叉的位置；伸缩叉的下面吊装吊具；在吊具的左右位置安装向下测距传感器；在吊具的中间安装有下降到位感应传感器；

所述的移动小车上设有前后方向位移传感器，为齿条及与之配合的齿轮和与齿轮同轴的绝对值旋转编码器；上下升降平台设有位移传感器，为丝杆及与之同轴相连的绝对值旋转编码器；伸缩叉上设有位移传感器为与电机同轴相连的绝对值旋转编码器。

2.根据权利要求1所述的一种吊装货箱的伸缩叉装置，其特征在于：小车左右两侧各设有四只测距传感器，左右对称布置，中间两只的中心距小于货箱前后的深度与货箱间距的差值，外侧两只的中心距略大于货箱前后的深度。

3.根据权利要求1所述的一种吊装货箱的伸缩叉装置，其特征在于：吊具下面的吊钩是可以向外旋转的，吊钩同一水平位置安装降到位感应传感器，吊具左右两侧安装的向下测距传感器的中心距略大于货箱左右的宽度。

4.根据权利要求1至3任意一项所述的一种吊装货箱的伸缩叉装置的控制方法，其特征在于：控制方法步骤如下：

步骤一、若干没有使用过的货箱以相同间距依次规则布置在轨道的一侧，小车的原点位置跟这些货箱的中间货箱的中心线在同一直线上，并留一个空位，控制系统采样这侧的四个测距传感器的数据，中间两只测距值的平均值加上小车两侧测距传感器的中心距与货箱左右宽度和的一半的和为这些货箱的y轴坐标，采样外侧两个测距传感器的数据应该都超量程；

步骤二、卡车载已使用过的货箱停在轨道另一侧，中心与小车原点大概在同一条直线上；

步骤三、控制系统采样卡车侧的四个测距传感器的数据，中间两只测距传感器数据都小于一个第一设定值，再比较这侧四个测距传感器中中间两只的测距值的差值，如小于第二设定值，表示卡车在正确位置,两个测距值的平均值加上小车两侧测距传感器的中心距与货箱左右宽度和的一半的和为卡车上货箱的y轴坐标，可以进行下一步操作；

步骤四、在步骤三中如中间两个测距值有任意一个大于第一设定值，或中间两个测距值差值大于等于第二设定值，表示卡车停位不正确，需要重新停车，再转至步骤二；

步骤五、控制系统采样外侧两个测距值，如采样值都大于第一设定值，卡车的x轴坐标为0；

步骤六、在步骤五中如采样值有一个小于第一设定值，小车向大于第一设定值的测距传感器方向慢速移动，至外侧两个测距值都大于第一设定值，x轴的位移值即为卡车货箱的x轴坐标，小车向前移动坐标为正，向后移动坐标为负；

步骤七、伸缩叉向卡车侧方向快速伸出一定距离，改慢速伸出设定慢速距离，并读取吊具下方的伸出方向前面的测距传感器的值为货箱的z轴坐标，向下为正；

步骤八、控制系统比较吊具两侧的向下测距传感器测距值是否都大于第三设定值，如不是则停机报警，转人工处理；

步骤九、吊具快速下降z轴坐标减去慢速下降距离的差值的距离，再转慢速下降一定距离至降到位感应；

步骤十、吊具向外旋转90°，正好转到货箱前后梁的下方；

步骤十一、吊具慢速上升，至z轴原点位置；

步骤十二、伸缩叉收回到中间位置，y轴原点位置；

步骤十三、装置沿x轴方向，向没有使用的货箱侧的空位的x坐标处慢速移动，目前位置的x轴坐标如小于目标位置的x轴坐标，装置就向前移动，否则，向后移动，移动距离为两位置x轴坐标差值的绝对值，到达位移后停止；

步骤十四、控制系统采样小车没有使用货箱侧的四个测距传感器是否都没有测距值或大于第四设定值，如不是则停机报警，转人工处理；

步骤十五、吊具慢速下降一定距离至降到位感应；

步骤十六、吊具向内侧旋转90°，使吊钩离开货箱的横梁；

步骤十七、吊具慢速上升一定距离，再快速上升到z轴原点停止；

步骤十八、伸缩叉收回到中间位置，y轴原点位置；

步骤十九、装置沿x轴方向移动到待取的未使用过的货箱x轴坐标处；

步骤二十、目前位置的x轴坐标如小于目标位置的x轴坐标，装置就向前移动，否则，向后移动，移动距离为两位置x轴坐标差值的绝对值，到达位置后停止；

步骤二十一、控制系统采样小车没有使用货箱侧的外侧两个测距传感器是否都没有测距值或大于第四设定值，如不是则停机报警，转人工处理；

步骤二十二、伸缩叉快速向卡车侧伸出货箱的y轴坐标的绝对值减去慢速距离的差值的距离，改慢速伸出慢速距离，并读取吊具两侧测距传感器的值，都大于第五设定值，如不是则报警停机，转人工处理；

步骤二十三、吊具快速下降z轴坐标减去慢速下降距离差的距离，再转慢速下降一定距离至降到位感应；

步骤二十四、吊具向外旋转90°，正好转到货箱前后梁的下方；

步骤二十五、吊具慢速上升，至z轴原点位置；

步骤二十六、伸缩叉收回到中间位置，y轴原点位置；

步骤二十七、装置沿x轴方向，向卡车的x坐标处慢速移动，目前位置的x轴坐标如小于目标位置的x轴坐标，装置就向前移动，否则，向后移动，移动距离为两位置x轴坐标差值的绝对值，到达位置后停止；

步骤二十八、装置卡车侧的四个测距传感器是否都大于第四设定值？否则报警停机，转人工处理；

步骤二十九、吊具慢速下降一定距离，小于等于卡车货箱的z轴坐标，至降到位感应；

步骤三十、吊具向内侧旋转90°，使吊钩离开货箱的横梁；

步骤三十一、吊具慢速上升一定距离，再快速上升到z轴原点位置停止；

步骤三十二、伸缩叉收回到中间位置，y轴原点；动作结束。