用于片盒夹持的机械手及自动片盒搬运装置的制作方法

本发明涉及机械技术领域，特别涉及一种用于片盒夹持的机械手及自动片盒搬运装置。

背景技术：

21世纪以来，自动化物流系统已经在工业领域得到广泛应用，在ic行业前道工艺fab厂产线中，特别是12寸产线中，已经普遍采用了自动物料搬送系统(amhs)，具体包括stocker、oht或agv等。例如首先通过mes系统调度amhs，直接将硅片片盒从stocker直接搬送到各机台的接口上，然后命令机台进行自动化生产，改变了之前完全靠人工运输的低效率模式，大大提升先进ic工艺产线的自动化水平，有效地节约人力成本，提高产品产出，增加客户价值。

目前，世界范围内主要在前道工艺12寸半导体产线中已经采用了oht系统进行物料管理，但对于许多后道封装产线来说也面临物料自动化系统更新的问题，而且12寸产品越来越占主导地位，满载荷的片盒重量约为7.5kg，对于操作工来说较吃力，且有一定的风险；同时，劳动力在未来会严重短缺且劳动力成本越来越高，因此片盒运输机器人的需求量将会越来越大；此外，由于封装厂的规模和利润，无法支持诸如前道半导体产线的oht系统投资，因此，研发一种便利、经济的自动片盒搬送方案和设备成为当务之急。

在全球范围内，一些电子厂和半导体厂房已经在用agv小车代替人工搬运，通过在产线上配置搬运机器人，节省大量的体力劳动。但这种自动物料搬送系统产品的不足为：都是主要针对8寸片盒，不能满足12寸片盒的运输需求。

通常12寸片盒搬运设备只能携带一盒片盒，效率较低。此外该片盒搬运设备的片盒抓取方式不能适应从一般性的货架上抓取片盒的功能。其原因在于12寸片盒搬运设备的机械臂的臂长通常比较长，需要较大的搬运空间，而一般为了尽可能提高货架存储量，节省fab内的空间，货架可能会做到3层，层间高度不超过450mm。这对于12寸片盒自动搬运设备而言，留给机械臂的空间非常有限。

为实现自动片盒搬运装置可以准确的搬运片盒，于片盒位置的识别起到至关重要作用。现有的解决方式大体为两种，其中一种，针对oht系统而言，oht设备从stocker内直接装载片盒，通过轨道直接到达机台的负载接口上方，通过伸缩绳索将片盒放置到机台上，由于这一过程是一个结构化的工况，片盒在stocker中的位置通过stocker的机械臂对各存储位置进行示教，oht设备与片盒之间的位置关系通过轨道和机械定位保证，oht设备将片盒放置到机台上时，其余负载接口的位置关系同样通过轨道和机台布局保证。

另一种方式，使用光电探测器探测货架上固定粘贴标记的方法，通过标记识别进行片盒定位。该方案受制于两点：

1.标记在长期使用过程中破损，影响测量精度，导致无法准确抓取片盒；

2.标记必须与放置片盒的定位板存在一定精度关系，增加了货架制造的成本。

技术实现要素：

本发明的目的在于提供一种自动片盒搬运装置及自动片盒搬运装置，以解决现有技术中自动片盒搬运装置存在的不足。

为解决上述技术问题，本发明提供一种用于片盒夹持的机械手，所述用于片盒夹持的机械手包括：机械臂、设置于所述机械臂的末端的末端执行器以及设置于所述末端执行器上的视觉定位组件；

其中，所述视觉定位组件用于定位所述片盒顶部的法兰位置；

所述末端执行器包括一与所述片盒顶部法兰相适配的凹面，根据所述片盒的法兰位置所述末端执行器通过所述凹面夹持片盒顶部的法兰。

可选的，在所述的用于片盒夹持的机械手中，所述视觉定位组件包括：水平定位结构和垂向定位结构，所述水平定位结构用于捕捉所述片盒表面水平方向上的特征，所述垂向定位结构用于捕捉所述片盒表面垂直方向上的特征，根据所述片盒表面水平方向上的特征及所述片盒表面垂直方向上的特征定位所述片盒的法兰位置。

可选的，在所述的用于片盒夹持的机械手中，所述水平定位结构包括第一相机，所述第一相机的镜头垂直朝向所述末端执行器上的任意一侧支撑板。

可选的，在所述的用于片盒夹持的机械手中，所述垂向定位结构包括第二相机及反射镜，所述第二相机和所述反射镜均设置于所述末端执行器的一侧的侧壁上。

可选的，在所述的用于片盒夹持的机械手中，所述末端执行器为两侧带有支撑板的c字形半封闭结构。

可选的，在所述的用于片盒夹持的机械手中，所述末端执行器还包括设置于所述凹面前端的凸台，用于防止片盒滑落。

可选的，在所述的用于片盒夹持的机械手中，所述凹面上至少设有一个在位传感器，用于感知所述凹面是否夹持片盒。

可选的，在所述的用于片盒夹持的机械手中，还包括设置于所述末端执行器上的声呐传感器，用于对片盒搬运行程进行安全检测。

可选的，在所述的用于片盒夹持的机械手中，所述凹面上至少设有两个定位销，所述定位销与所述法兰的切口对位。

可选的，在所述的用于片盒夹持的机械手中，所述末端执行器与所述机械臂的末端呈倒l形。

可选的，在所述的用于片盒夹持的机械手中，所述末端执行器可绕所述机械臂的末端进行360度旋转运动。

可选的，在所述的用于片盒夹持的机械手中，所述机械臂的自由度为6个自由度。

本发明还提供一种自动片盒搬运装置，所述自动片盒搬运装置包括：自动导航小车、架设在所述自动导航小车上的运载框架及设置于所述运载框架上用于片盒夹持的机械手。

可选的，在所述的自动片盒搬运装置中，还包括设置于所述运载框架上的片盒放置机构，所述机械手相对所述片盒放置机构设置于所述运载框架的一角。

在本发明所提供的用于片盒夹持的机械手及自动片盒搬运装置中，所述用于片盒夹持的机械手包括机械臂、设置于所述机械臂的末端的末端执行器以及设置于所述末端执行器上的视觉定位组件。本发明通过视觉定位组件定位所述片盒的法兰位置以实现对片盒的识别，即依据片盒本身特征进行识别，无需额外黏贴标记，提高了测量精度及抓取片盒的精准度；另一方面，末端执行器利用末端执行器上与所述片盒顶部法兰相适配的凹面夹持片盒顶部的法兰实现对片盒的搬运；此外，在凹面夹持法兰的同时，凹面上的定位销与法兰的切口对位实现了片盒的自定心，进一步提高了片盒定位的精准度。

附图说明

图1是本发明一实施例中自动片盒搬运装置的结构示意图；

图2是本发明一实施例中末端执行器的结构示意图；

图3是本发明一实施例中末端执行器的凹面夹持片盒顶部的法兰的结构示意图；

图4是本发明一实施例中在位传感器的结构示意图。

图中：

1-机械臂；2-末端执行器；20-支撑板；21-凹面；22-凸台；23-在位传感器；24-声呐传感器；25-定位销；3-视觉定位组件；30-水平定位结构；300-第一相机；31-垂向定位结构；310-第二相机；311-反射镜；40-法兰；5-运载框架。

具体实施方式

以下结合附图和具体实施例对本发明提出的用于片盒夹持的机械手及自动片盒搬运装置作进一步详细说明。根据下面说明和权利要求书，本发明的优点和特征将更清楚。需说明的是，附图均采用非常简化的形式且均使用非精准的比例，仅用以方便、明晰地辅助说明本发明实施例的目的。

请参考图1，其为本发明的自动片盒搬运装置的结构示意图，如图1所示，所述的自动片盒搬运装置包括：自动导航小车、架设在所述自动导航小车上的运载框架5、设置于所述运载框架5上的用于片盒夹持的机械手以及设置于所述运载框架5上的片盒放置机构；所述机械手相对所述片盒放置机构设置于所述运载框架5的一角。优选的，所述片盒放置机构数量为两个，呈上下层分布。

本实施例中，所述机械手主要包括：机械臂1、设置于所述机械臂1的末端的末端执行器2以及设置于所述末端执行器2上的视觉定位组件3；其中，所述视觉定位组件3用于定位所述片盒顶部的法兰40位置；所述末端执行器2包括一与所述片盒顶部法兰40相适配的凹面21，根据所述片盒的法兰40位置所述末端执行器2通过所述凹面21夹持片盒顶部的法兰40。通过视觉定位组件3定位所述片盒的法兰40位置(属于片盒本身特征)以实现对片盒的识别，由于片盒都有固定的规格，在获取片盒的法兰40的位置后即可获知片盒摆放位置上承载有片盒的位置，无需额外黏贴标记，提高了测量精度及抓取片盒的精准度。接着，通过末端执行器2对片盒进行搬运，主要通过末端执行器2上的凹面21夹持片盒顶部的法兰40实现对片盒的搬运，由此可见，片盒的法兰40不仅起到识别的标定作用，还起到配合末端执行器2搬运片盒的作用。

请参考图1及图3，机械手搬运片盒的具体工程为：在抓取片盒时，末端执行器2从片盒顶部的法兰40与片盒主体之间的空间伸入后至一定位置后，垂直向上将片盒托起；在放置片盒时，将片盒放在自动片盒搬运装置上的片盒放置位置上后，末端执行器2沿垂直向下方向运动与片盒脱离后抽出。优选机械手的机械臂1为6自由度的机械臂1，所述末端执行器2可绕所述机械臂1的末端进行360度旋转运动，末端执行器2在工作时与机械臂1的末端关节呈倒l形，具体来说，伸入货架时，机械臂1最后一个关节位于末端执行器2下方，以最大程度上节省末端执行器2伸入对于货架每层高度空间的占用，同时降低对机械臂1末端的力矩。

本实施例中，所述凹面21上至少设有两个定位销25，所述定位销25与所述法兰40的切口对位，所述法兰40的切口为三角形或圆柱形，相应的，所述定位销25的位置需与片盒顶部法兰40的切口相配合且形状相吻合，所述定位销25的横截面不局限为三角形或圆柱形，只要定位销25能够容置于法兰40的切口中，且定位销25的中心与切口的几何中心重合即可。利用法兰40自身具有的切口与设置于凹面21上的定位销25对位，实现对抓取后的片盒的自定心，从而进一步提高了片盒定位的精准度。使片盒在末端执行器2上的位置在精密可控范围，便于片盒能够被准确放置到搬运车上。

如图2所示，所述末端执行器采用被动式无源方式，所述末端执行器2为两侧带有支撑板20的c字形半封闭结构，利用c字形半封闭结构可起到类似“斜拉桥”拉锁的功能。所述视觉定位组件3包括：水平定位结构30及垂向定位结构31，所述水平定位结构30用于捕捉所述片盒表面水平方向上的特征，所述垂向定位结构用于捕捉所述片盒表面垂直方向上的特征，根据所述片盒表面水平方向上的特征及所述片盒表面垂直方向上的特征定位所述片盒的法兰40位置，即确定法兰40的空间具体位置，以便后续末端执行器2准确执行夹持搬运工作。

其中，所述水平定位结构30包括相机第一相机300，所述第一相机300设置于所述末端执行器2的中间，第一相机300的镜头垂直朝向末端执行器2上的任意一侧支撑板20；所述垂向定位结构31包括第二相机310及反射镜311，所述第二相机310和所述反射镜311均设置于所述末端执行器2的一侧的侧壁上，且安装在垂平向相机的镜头朝向相对一侧的支撑板20上。以实现最大程度上降低第二相机310与待测片盒的法兰40之间的间距，便于末端执行器2进入货架后对片盒顶部法兰40进行测量。

所述末端执行器2还包括凸台22及至少一个在位传感器23，所述凸台22设置于所述凹面21的前端，以避免机械手突然断电时，出现片盒滑落的危险；所述凹面21上至少设置有一个在位传感器23，优选的在位传感器23设置于所述凹面21上与所述法兰40接触的区域上的，用于感知所述凹面21是否夹持片盒。相应的，所述末端执行器2上还包括至少一个机械开关结构，当片盒自定心后，片盒触发触发机械开关，从而产生在位信号，所述机械开关结构具体请参考图4。

较佳的，本实施例中的机械手还包括设置于所述末端执行器2上的声呐传感器24，安装在末端执行器2上的任意一侧支撑板20上，做为搬运执行过程中的安全检测传感器，一旦声呐阈值范围内有物体被探测到，则机械臂1立即停止作业。

自动片盒搬运装置从三层货架(机械臂1末端高度从450mm～1350mm)上抓取片盒，优选的，所述底座为搬运车，在搬运车的两侧设置有垂向激光传感器，以实现对自动片盒搬运装置在高度方向上的障碍探测。

基于以上结构的自动片盒搬运车工作流程，主要包括：

针对货架不同层设置不同的停车位置；从侧面测量与抓取片盒；测量片盒顶部法兰40作为特征，先进行水平测量，通过切口侧面特征获取片盒的x、y、z、rx，将第二相机310带入到顶部法兰40的切口位置，通过切口的俯视特征获取片盒的x、y、rz；从片盒顶部法兰40下方伸入末端执行器进行抓取。

实际工作时，使用自动片盒搬运装置的搬运系统的工作过程如下：

1)远程调度：agvc下发片盒搬运任务，包含：片盒id、起始点、目的地等信息。调度服务器根据全厂区内自动运输车的位置及空闲情况，进行最优化调度，确定具体执行任务的自动片盒搬运装置，并发送片盒id和起始点到该自动片盒搬运装置的控制系统，该步骤执行后，自动片盒搬运装置已经完全清楚将要执行的任务信息。

2)移动至目标位置：底座为每一辆执行搬运任务的车辆规划最优路径，在行进间遇到障碍物时，进行自主避障绕行，自动片盒搬运装置根据所选择的工位位置以及片盒位置，计算出需要到达的地图坐标，抵达目标点后，搬运车调整朝向至设定的方向，将机械臂一侧靠近货架或机台，开始准备执行搬运任务.

3)片盒搬运。片盒搬运任务分为从货架/机台上取片盒，或将片盒放置到货架/机台上。提取片盒的操作如下：

a)由于片盒在货架三层不同的高度，以下简称高、中、低层，抓取片盒时，可采用底座停靠位置不同的策略，以合理的提高系统的稳定性。如：当片盒在上层时，底座停靠在距离货架100mm的距离左右，以尽可能的接近货架，缩短操作臂的运动距离和抓取力矩，减小倾翻的可能，此时片盒在机械臂的安装平面上，具有较大的运动空间，规划末端运动轨迹，不会同底座碰撞或干涉。当片盒在下层时，底座停靠在距离货架400mm的距离左右，距离货架较远，此时片盒在机械臂的安装平面下，运动空间较小，规划末端运动轨迹避免同底座碰撞或干涉。当片盒在中层时，根据片盒在上层方案和片盒在下层方案的策略折中考虑设计。

b)将末端执行器上的第一相机300侧转向货架，使声呐传感器24和第一相机300的镜头面对片盒。在声呐安全范围内如发现有物体出现，应立即停止工作，同时应使第一相机300和第二相机310对准片盒的法兰40位置进行测量。

c)利用第一相机测量片盒距离第一相机的距离x，通过测量镜头的放大倍率可转换到x，其中f为第一相机的镜头焦距。

d)y方向可通过从图像中检测法兰上切口的位置，来进行切口定位。识别切口的方法可以为基于轮廓或灰度的模板匹配算法、基于角点及其描述符的匹配、基于直线检测的算法等。使用hough变换或类似的直线测量算法，检测法兰相对于第一相机的z及rx旋转。

e)机械臂根据所测量到的片盒法兰的x,y,z,rx等姿态，将第二相机310带到片盒顶部法兰的切口的正上方。

f)通过图形匹配的方法测量法兰上两个以上切口，再结合法兰本身的名义尺寸，可以计算出法兰的x，y，rz位置。

g)在正常情况下(必要时可做x-y向搜索)，相机可捕捉到片盒表面的特征点，如片盒的顶部法兰的切口，根据片盒特征点在相机下的位置，换算相机距离片盒顶部法兰的x,y,z向距离与旋转rz，进而求得机械臂的末端执行器距离该法兰的距离。

h)机械臂末端旋转，将末端执行器面向片盒顶部法兰。

i)根据求得的距离，移动末端执行器，使之叉入法兰底部，法兰的切口与末端执行器上定位销配合，将片盒托起并自定心，同时出发片盒在位开关，搬运车感知到片盒已在位。

j)机械臂随后按一定轨迹将片盒放置到期自身的装载位置上，该轨迹应不超过底座宽度方向的空间投影范围。

k)在底座的两侧装有侧向声呐，在进行搬运时，声呐开启，当有感知到移动对象接近时，机械臂减速，以防伤人，并发出警报，提醒人员远离操作现场。

l)放置片盒至搬运车装载位置时，机械手放慢速度下降，直至放置到位。

m)片盒搬运到车载位置后，rfid传感器读取片盒信息，并记录整个片盒的搬运数据。

n)将片盒搬运数据反馈至mes系统。

o)根据定义的任务序列执行下一项任务。

4)放置片盒。放置片盒的操作步骤如下：

a)底座到位：该步骤与提取片盒的步骤a)相同

b)将机械臂末端的相机侧转向货架(面向片盒的facialdatumplane)。

c)机械臂将相机带到机台的装载接口/货架片盒固定板上方，捕捉特征点(如标准机台的装载接口上的pin)，确定其中心位置(用来与片盒的轮廓或固定pin中心进行配合，使片盒定位)。

d)根据机台的装载接口/货架片盒固定板特征点在相机下的位置，换算相机距离其中心的x,y,z，rz向距离，进而求得机械臂的末端执行器相对于放置位置的偏差。

e)根据已知的片盒固定位置，将末端执行器叉入片盒顶部法兰的底部，并将片盒托起，机械臂方可带动片盒上升，即可以与片盒的定位销脱离(做x-y向运动)。

f)根据求得的距离，机械臂随后按一定轨迹将片盒放置到机台的装载接口或货架片盒放置板上，该轨迹不超过底座的空间投影范围。

g)在底座的两侧装有侧向声呐，在进行搬运时，声呐开启，当有感知到移动对象接近时，机械臂减速，以防伤人，并发出警报，提醒人员远离操作现场。

h)放置片盒至机台的装载接口/货架片盒放置机构上方时，机械手放慢速度下降，直至放置稳定。

i)片盒搬运完成后，并记录整个片盒的搬运数据。

j)将片盒搬运数据反馈至mes系统(optional)。

k)根据定义的任务序列执行下一项任务。

综上，在本发明所提供的用于片盒夹持的机械手中，所述用于片盒夹持的机械手包括机械臂、设置于所述机械臂的末端的末端执行器以及设置于所述末端执行器上的视觉定位组件。本发明通过视觉定位组件定位所述片盒的法兰位置以实现对片盒的识别，即依据片盒本身特征进行识别，无需额外黏贴标记，提高了测量精度及抓取片盒的精准度；另一方面，末端执行器利用末端执行器上与所述片盒顶部法兰相适配的凹面夹持片盒顶部的法兰实现对片盒的搬运；此外，在凹面夹持法兰的同时，凹面上的定位销与法兰的切口对位实现了片盒的自定心，进一步提高了片盒定位的精准度。

上述描述仅是对本发明较佳实施例的描述，并非对本发明范围的任何限定，本发明领域的普通技术人员根据上述揭示内容做的任何变更、修饰，均属于权利要求书的保护范围。