[发明专利]一种桁架机械手圆形料仓放料孔自动定位的计算方法

说明书

一种桁架机械手圆形料仓放料孔自动定位的计算方法，所述方法包括以下步骤：1)通过示教器获取圆形料仓的圆心坐标点、最外层料仓上的任意一个坐标及圆形料仓层数；2)根据圆形料仓的大小进行建模，并根据直角坐标系的四个象限将圆形料仓分为四个部分；3)计算圆形料仓半径及每层放料孔间的大致间距；当圆形料仓为于坐标系的各个象限时，针对各个情况，又可将放料孔位置分成在坐标轴上及在坐标轴外的两种情况，然后通过各自的计算方法分别计算每个放料孔的具体位置。本发明解决了桁架机械手圆形料仓层数各异以及各层放料孔数量不同的放料孔定位示教复杂的问题。

技术领域

本发明涉及一种用于桁架机械手圆形料仓放料孔自动定位的计算方法。

背景技术

随着我国整体经济不断增长，自动化技术在各个行业得到了越来越广泛的应用。机械手作为自动化技术的一个大类，指在自动化生产过程中使用一种代替人类手臂抓取和移动工件的自动化装置。桁架机械手是一种大型的直角坐标机械手，主要用于车间中机床上下料的工作。桁架机械手的运动过程实际上是对上料仓取料，零部件加工，卸料仓卸料的一个大致过程。传统的桁架机械手在实际工业生产中针对圆形料盘放料孔定位中主要以人工示教为主，当料仓放料孔较少时，可通过手动示教完成机头取料定位，但是当放料孔数量过多时手动示教将非常复杂，示教的效率也会受到影响。同理，当用户更换另一种圆形料仓时，所有放料孔需重新进行示教。总体而言，整个料仓的示教过程相对复杂繁琐，极其浪费用户的时间和精力。为了提高桁架机械手料仓示教效率，迫切需要一种圆形料仓放料孔自动定位的计算方法。

发明内容

为了解决现有桁架机械手在料仓放料孔数量过多、圆形料仓层数各异的情况下手动示教复杂的问题，本发明提出了一种用于桁架机械手圆形料仓放料孔自动定位的计算方法，主要实现针对圆形料盘不同层数自动定位各个放料孔位置，该方法是通过获取圆形料仓的圆心坐标点、最外层料仓上的任意一个坐标点及圆形料仓层数进行相应的计算，解决了桁架机械手圆形料仓层数不同、各层放料孔数量不同示教复杂的问题。

本发明解决其技术问题所采用的技术方案如下：

一种桁架机械手圆形料仓放料孔自动定位的计算方法，所述方法包括以下步骤：

1)首先通过示教器获取圆形料仓的圆心坐标点(x₁,y₁)、最外层料仓上的任意一个坐标点(x₂,y₂)及圆形料仓层数(n)，以圆心坐标点(x₁,y₁)为原点，最外层料仓上的任意一个坐标点(x₂,y₂)为Y轴正方向上的点，建立直角坐标系；

2)根据直角坐标系的四个象限将圆形料仓分为四个部分。由于圆形料仓的特点是每一层的放料孔个数都不相同，因此必须针对圆形料仓不同层时的放料孔个数结合每个部分做相应的计算；

3)首先计算出整个圆形料仓的半径(R)，即y₂与y₁的差值，其公式如下：

R＝y₂-y₁ (1)

再将其差值与料仓层数(n)相除，得到的值是每层放料孔间的大致间距(RD)，其公式如下：

RD＝R/(n-1) (2)

然后针对每一层料仓的放料孔个数及所处的不同部分做相应的计算。

进一步，所述步骤3)中，当圆形料仓所使用的放料孔处于直角坐标系第一象限时，又可以将放料孔所处位置分成在X轴正方向上及在坐标轴外的两种情况，当放料孔在X轴正方向上时，根据料仓层数通过循环计算放料孔具体位置的公式如下：

P_x＝x₁+i*RD+0.5(i＝1,2...n-1) (3)