[发明专利]面向高速精密作业的混联机器人装置的控制方法

说明书

技术领域

本发明涉及一种能满足LED元器件分拣、插装要求的面向高速精密作业的混联机器人装置的控制方法。

背景技术

目前，LED元器件的分拣、插装一般都使用机器人来执行，比较常见的是通用型五、六自由度多关节型或直角坐标机器人，如瑞典ABB、德国KUKA和日本FUNUC等的机器人，其由于自由度和关节多，所以结构复杂、成本高、作业效率也低，而其控制也复杂。

发明内容

本发明的目的是提供一种控制简单，能满足LED元器件分拣、插装要求的面向高速精密作业的混联机器人装置的控制方法。

实现本发明目的的技术方案是：一种面向高速精密作业的混联机器人装置的控制方法，具有如下的步骤：

第一步：驱动混联机器人装置，使贴片装置移动至料槽上方，然后贴片装置的吸嘴从料槽吸取待贴元件；

第二步：贴片装置携带吸取的待贴元件被驱动至一侧的CCD摄像机的位置，由CCD摄像机监控待贴元件的角度，并对有角度误差的待贴元件进行校正；

第三步：驱动贴片装置把待贴元件运送到基板的待贴位置，贴片装置的吸嘴将元件贴在基板的相应位置，即完成一个待贴元件的贴装过程。

根据数据库中基板的待贴装位置的信息，贴片装置返回至料槽，开始下一循环的元件贴装，直至完成基板的贴装。

其中，所述的贴片装置的吸嘴从料槽吸取待贴元件过程中，贴片装置的吸嘴在气缸的推动下，下降至待贴元件处吸取待贴元件，然后再回升至原来高度。

在对有角度误差的待贴元件进行校正时，根据CCD摄像机测得的误差角度，由贴片装置的电机控制旋转角度，对待贴片元件进行校正。

贴片装置的吸嘴将元件贴在基板的相应位置的过程中，贴片装置的吸嘴在气缸的推动下，下降至基板的相应位置，放开待贴元件并使待贴元件贴装在基板上，然后再回升至原来高度。

完成一个待贴元件的贴装过程后，根据数据库中基板的待贴装位置的信息，贴片装置移动至料槽，开始下一循环的元件贴装，直至完成基板的贴装。

本发明具有积极的效果：本发明的面向高速精密作业的混联机器人装置的控制方法和现有的通用型五、六自由度多关节型或直角坐标机器人相比，其采用串并联混合方式直接驱动，且只有四自由度运动，所以结构简单、控制容易，能满足LED元器件分拣、插装的要求，并且可靠耐用、作业效率高，具有明显的成本优势，能满足用户经济实用要求。

附图说明

为了使本发明的内容更容易被清楚地理解，下面根据具体实施例并结合附图，对本发明作进一步详细的说明，其中

图1为本发明面向高速精密作业的混联机器人装置的控制方法的控制流程图。

图2为本发明面向高速精密作业的混联机器人装置的结构示意图。

图3为本发明面向高速精密作业的混联机器人装置的控制坐标示意图。

具体实施方式

见图2，本发明的面向高速精密作业的混联机器人装置，具有机架15，机架15上设置有一对滑轨12，滑轨12在竖直平面内为一上一下平行设置。滑轨12的相对面上分别可滑动地设置有相互对应的上滑块4和下滑块5，第一连杆6的一端可转动地连接在上滑块4上，下滑块5上可转动地连接有第二连杆7和第三连杆8，第一连杆6的另一端通过联接轴与第二连杆7的中部可转动地连接，第二连杆7和第三连杆8的另一端分别可转动地与第四连杆9的两端连接，第四连杆9上固定有贴片装置13，其中，贴片装置13包括吸嘴13-1，驱动吸嘴13-1在水平方向旋转的电机13-3以及推动吸嘴13-1上下移动的气缸13-2。贴片装置13的下方设有料槽1和LED基板3，料腔1的一侧设有CCD摄像机2。第四连杆9上还固定设置有用于拍摄LED基板3的工业高速相机14，用以监控LED基板3上的每个位置都插装上了LED元件。上滑块4和下滑块5分别由两个伺服电机驱动。

本发明的混联机器人装置采用串并联混合方式直接驱动，基于PMAC来实现对LED元件分拣和插装，达到高速精密化作业。

PMAC，英文为programmable multi-axes controller，即开放式多轴运动控制器。

本发明的上述四个连杆组成的混联机构作为工作平台，在混联机构工作台的贴装环境下作业。由驱动上、下滑块的两个伺服电机，推动吸嘴上下移动的气缸和校正LED元件的步进电机完成系统的四自由度运动。