[发明专利]一种机械手的自动码垛方法及系统

权利要求书

1.一种机械手的自动码垛方法，用于履带板的自动码垛，其特征在于，所述机械手的自动码垛方法，包括：

步骤1、计算履带板的平整度，得到该履带板对应的类型，所述履带板的类型包括上弯、下弯、正常、不合格；

步骤2、对履带板进行码垛：

步骤2.1、根据履带板的类型，确定履带板对应的垛仓；

步骤2.2、采用奇数层堆垛和偶数层堆垛交替的码垛方式进行码垛，所述奇数层堆垛和偶数层堆垛两者均为1块纵向放置、n-1块横向放置的方式，且奇数层堆垛中纵向放置的履带板和横向放置的履带板的相对位置，与偶数层堆垛中纵向放置的履带板和横向放置的履带板的相对位置相反，n为一层堆垛履带板的数量；

步骤2.3、判断该垛仓中当前堆垛的层数，若为奇数层则按照奇数层堆垛的方式进行码垛，即获取当前层中堆垛的履带板的数量，将奇数层中预设的下一履带板的坐标作为当前待堆垛的履带板的坐标，并执行步骤2.5；否则执行步骤2.4；

步骤2.4、按照偶数层堆垛的方式进行码垛，获取当前层中堆垛的履带板的数量i，令当前待堆垛的履带板对应码垛的垛仓为垛仓A，则按照以下公式计算当前待堆垛的履带板的坐标：

已知奇数层堆垛中预设的第i+1块履带板的坐标如下：

A[1][i+1].XPoint＝A.Position(i+1).XPoint；

A[1][i+1].YPoint＝A.Position(i+1).YPoint；

其中，A[1][i+1].XPoint表示垛仓A中奇数层的第i+1块履带板的x轴坐标，A[1][i+1].YPoint表示垛仓A中奇数层的第i+1块履带板的y轴坐标；

则计算偶数层堆垛中第i+1块履带板的坐标如下：

A[2][i+1].XPoint＝A.PositionX1+A.PositionX2-A[1][i+1].XPoint；

A[2][i+1].YPoint＝A.PositionY1+A.PositionY2-A[1][i+1].YPoint；

其中，A[2][i+1].XPoint表示垛仓A中偶数层的第i+1块履带板堆垛的x轴坐标，A[2][i+1].YPoint表示垛仓A中偶数层的第i+1块履带板堆垛的y轴坐标，A.PositionX1表示垛仓A中参考位置1的x轴坐标，A.PositionY1表示垛仓A中参考位置1的y轴坐标，A.PositionX2表示垛仓A中参考位置2的x轴坐标，A.PositionY2表示垛仓A中参考位置2的y轴坐标，所述参考位置1和参考位置2为每个垛仓任意斜对角的两个点的位置；

将偶数层堆垛中第i+1块履带板的坐标作为当前待堆垛的履带板的坐标；

步骤2.5、按照得到的当前待堆垛的履带板的坐标，通过机械手将履带板移动至对应位置进行堆垛。

2.如权利要求1所述的机械手的自动码垛方法，其特征在于，所述机械手的自动码垛方法还包括，在垛仓码垛完第二层后计算该垛仓的码垛高度，计算步骤如下：

取第一层履带板的高度O_PositionS，取第二层履带板的高度O_PositionE；

计算堆垛状态下一层履带板的高度OD＝O_PositionS-O_PositionE；

计算垛仓码垛生产完成需要堆垛的层数ODL＝(Pile_SC_Num/n)，其中Pile_SC_Num为垛仓码垛生产完成需要堆垛的履带板总数；

获得该垛仓的码垛高度H＝O_PositionS-ODL*OD，其中高度相对于垛仓码垛为深度。

3.如权利要求1所述的机械手的自动码垛方法，其特征在于，用于运输履带板至码垛的通道共有多个，各通道口设有接近开关，履带板加工完成后，机械手通过接收接近开关的信号移动至对应通道抓取履带板；

并且各通道设有编号，并根据编号设置对应的优先级，当机械手同时接收到多个接近开关的信号时，根据优先级依次处理履带板。