具体实施方式
请同时参阅图1、图2、图3和图4,一种组装系统100,用于调节并组装工件200。所述工件200包括第一部件202和第二部件204。所述第一部件202包括第一配合部2021,所述第二部件204包括与所述第一配合部2021适配的第二配合部2041。一实施例中,所述第一部件202为一电子终端设备的壳体,所述第二部件204为充电接口用的IO结构,但不限于此。所述第一配合部2021和所述第二配合部2041均为椭圆孔结构,且所述第二配合部2041的孔径小于所述第一配合部2021,但不限于此。可以理解的是,在其他实施例中,所述第二部件204也可以为凸台等结构。
请参阅图3,为后续描述清晰,建立直角坐标系,Z轴平行于所述第一配合部2021的中心轴,X轴平行于所述第一配合部2021的长孔径方向,Y轴平行于所述第一配合部2021的短孔径方向。
组装所述工件200要求所述第一配合部2021和所述第二配合部2041的中心点重合。所述第一配合部2021和所述第二配合部2041在平行于所述X轴和所述Y轴确定的平面内的轮廓的间隙均匀。所述第一配合部2021和所述第二配合部2041沿所述Z轴的间隙均匀。所述第一部件202和所述第二部件204在平行于所述Z轴和所述X轴确定的平面内的间隙均匀。所述工件200包括平行于所述X轴的第一轴线O1和平行于所述Y轴的第二轴线O2,所述第一轴线O1和所述第二轴线O2分别经过所述中心点。
请参阅图1,所述组装系统100包括组装装置、检测器和处理器80。所述处理器80通过I/O接口和总线实现分别与所述组装装置和所述检测器耦接。所述组装装置包括定位机构10、导正机构20、机器人30、驱动机构40和连接机构70。所述检测器包括相机50和测距仪60。所述定位机构10用于承载并定位所述第一部件202。所述导正机构20用于导正所述第二部件204。所述机器人30用于从一上料处抓取所述第二部件204并移送和定位所述第二部件204于设定的位置,且所述机器人30用于调节所述第二部件204相对所述第一部件202的组装位置。所述相机50和所述测距仪60分别设置于所述驱动机构40上。所述驱动机构40用于驱动所述相机50在所述定位机构10的一侧沿直角坐标系的三个坐标轴移动,及驱动所述测距仪60在所述定位机构10的一侧沿直角坐标系的三个坐标轴移动。所述相机50用于拍摄所述工件200的图片。所述测距仪60用于测量所述工件200的距离。所述连接机构70用于连接固定所述第一部件202和所述第二部件204。一实施例中,所述连接机构70为一点胶装置,但不限于此。例如,在其他实施例中,所述连接机构70也可以为一焊接装置。
所述处理器80用于控制所述定位机构10、所述导正机构20、所述机器人30、所述驱动机构40、所述相机50、所述测距仪60和所述连接机构70的运行。所述处理器80包括定位单元81、第一驱动单元82、第二驱动单元84、导正单元83、视觉单元85、测距单元86、处理单元87和判断单元88。
请继续参阅图2、图5和图6,一实施例中,所述工件200的组装方法包括以下步骤:
步骤S10,获取所述工件200组装时的标准模块,获取标准位置坐标及确定预设组装点位坐标。所述标准位置坐标包括第一部件的第一预设坐标及第二部件的第二预设坐标。包括:
步骤S101,提供标准尺寸的第一部件202和标准尺寸的第二部件204。
步骤S102,定位标准尺寸的第一部件202于第一位置。
所述定位单元81用于控制所述定位机构10定位标准尺寸的第一部件202于第一位置。所述第一位置可以为一定位夹具或定位装置上用于定位所述第一部件202的设定位置。
步骤S103,获取所述第一配合部2021在直角坐标系的第一预设坐标。
所述第一驱动单元82用于控制所述驱动机构40驱动所述相机50移至第一拍摄位置。所述第一拍摄位置为所述相机50能够取得所述第一配合部2021图像的任意位置。所述视觉单元85用于控制所述相机50沿Z轴拍摄所述第一配合部2021的图像。所述处理单元87用于分析处理所述第一配合部2021的图像以得出所述第一配合部2021上的第一基点Q10在直角坐标系中X轴和Y轴上的坐标V10(X10,Y10)。一实施例中,所述第一基点Q10为所述第一配合部2021的中心点,但不限于此。
所述第一驱动单元82用于控制所述驱动机构40驱动所述测距单元86分别移动至测量所述第一配合部2021上的第一点Q01和第二点Q02。所述第一点Q01和所述第二点Q02可以为所述第一配合部2021上的任意间隔设置的两个点。一实施例中,所述第一点Q01和第二点Q02关于所述第二轴线O2对称,但不限于此。
所述测距单元86控制所述测距仪60沿Z轴测量所述第一配合部2021上第一点Q01的坐标Z101;所述测距单元86控制所述测距仪60沿Z轴测量所述第一配合部2021上第二点Q02的坐标Z102。
所述第一预设坐标包括V10(X10,Y10)、Z101和Z102。
一实施例中,所述测距仪为激光测距仪,但不限于此。
步骤S104,导正标准尺寸的所述第二部件204。
所述第二驱动单元84用于控制所述机器人30从一上料处抓取所述第二部件204,并移送所述第二部件204至所述导正机构20上且释放所述第二部件204。所述导正单元83用于控制所述导正机构20对所述第二部件204进行导正,使所述机器人30抓取导正后的所述第二部件204的位置状态保持一致。
一实施例中,所述上料处依次层叠设置有多个承载盘(图未示),所述承载盘承载多个所述第二部件204。所述机器人30从所述承载盘依次抓取所述第二部件204进行组装。
可以理解,其他实施例中,所述导正机构20和所述导正单元83也可以省略。或另一实施例中,所述导正机构20设置于所述上料处,所述机器人30直接从所述导正机构20抓取所述第二部件204。
步骤S105,利用所述机器人30抓取标准尺寸的第二部件204并定位于第二位置。
一实施例中,所述第二位置为所述第二部件204未装入所述第一部件202时的一设定位置。
所述第二驱动单元84用于控制所述机器人30从所述导正机构20抓取导正后的所述第二部件204,并控制所述机器人30移送所述第二部件204并停至所述第二位置。
步骤S106,获取所述第二配合部2041在直角坐标系的第二预设坐标。
所述第一驱动单元82用于控制所述驱动机构40驱动所述相机50移至第二拍摄位置。所述第二拍摄位置为所述相机50能够取得所述第二配合部2041图像的任意位置。所述视觉单元85用于控制所述相机50在第二拍摄位置沿Z轴拍摄所述第二配合部2041的图像。所述处理单元87用于分析处理所述第二配合部2041的图像以得出所述第二配合部2041上的第二基点Q20在直角坐标系中X轴和Y轴上的坐标V20(X20,Y20)。一实施例中,所述第二基点Q20为所述第二配合部2041的中心点。
所述第一驱动单元82用于控制所述驱动机构40驱动所述测距单元86分别移动至测量所述第二配合部2041上第七点Q21和第八点Q22,如图6所示。所述第七点Q21和所述第八点Q22可以为所述第二配合部2041上的任意间隔设置的两个点。一实施例中,所述第七点Q21和所述第八点Q22关于所述第二轴线O2对称,但不限于此。
所述测距单元86控制所述测距仪60沿Z轴测量所述第二配合部2041上所述第七点Q21的坐标Z201;所述测距单元86控制所述测距仪60沿Z轴测量所述第二配合部2041上所述第八点Q22的坐标Z202。
所述第二预设坐标包括V20(X20,Y20)、Z201和Z202。
一实施例中,在步骤S105和步骤S106之后还包括:根据所述相机50拍摄所述标准尺寸的第一部件202所得的图片尺寸与所述第一部件202的标准尺寸的比值,分别得出所述第一部件202在X轴的尺寸比例I1x及在Y轴的尺寸比例I1Y;根据相机50拍摄所述标准尺寸的第二部件204的图片尺寸与所述第二部件204的标准尺寸的比值,分别得出所述第二部件204在X轴的尺寸比例I2X及在Y轴的尺寸比例I2Y。所述处理单元87根据所述比例I1x、I1Y、I2X和I2X将图片尺寸换算成直角坐标系中的实际尺寸。
步骤S107,确定所述机器人30将所述标准尺寸的第二部件204装入所述标准尺寸的第一部件202时在六个自由度的预设组装点位P0。
调节所述机器人30在直角坐标系中六个自由度的位置,使所述第一配合部2021和所述第二配合部2041在与Z轴垂直的平面内的中心重合,且使所述第一部件和所述第二部件在Z轴、X轴和Y轴的间隙均匀,记录此时所述机器人30的位姿为所述预设组装点位P0。具体地,所述第一配合部2021和所述第二配合部2041的轮廓在与Z轴垂直的平面内的间隙均匀,以及使所述第一部件202和所述第二部件204在与所述Y轴垂直的平面内贴合均匀。一实施例中,所述第一部件202沿Y轴的方向设有两个间隔的突出部2023,所述第二部件204朝向背离所述第二配合部2041的一侧延伸形成延伸部2043。所述突出部2023和所述延伸部2043在与所述Y轴垂直的平面内贴合均匀。
一实施例中,调节所述测距仪60的位置,使第一点Q01、第二点Q02、第七点Q21和第八点Q22的坐标Z101、Z102、Z201和Z202分别为0,但不限于此。
步骤S20,测量待组装的所述工件200的第一部件202和第二部件204,获取测量坐标。所述测量坐标包括测量第一部件202获得的第一坐标和测量第二部件204获得的第二坐标。包括:
步骤S201,定位待组装的第一部件202于所述第一位置,并拍摄所述待组装的第一部件202。
所述定位单元81用于控制所述定位机构10定位待组装的第一部件202于所述第一位置。
所述视觉单元85用于控制所述相机50在所述第一拍摄位置沿Z轴拍摄所述第一配合部2021的图像。所述处理单元87根据所述图像得出所述第一配合部2021的测量尺寸。
步骤S202,判断所述第一部件202的测量尺寸是否符合尺寸公差要求。
确定所述第一部件202的尺寸允许公差,所述判断单元88用于判断所述第一部件202的测量尺寸与标准尺寸的公差是否满足所述尺寸允许公差。当判断的结果为满足时进入下一步骤;当判断的结果为不满足时,将不满足所述尺寸允许公差的第一部件202移至不良品收集处,所述定位单元81用于控制所述定位机构10定位另一个所述第一部件202,并重复步骤S201和步骤S202,直至所述第一部件202的测量尺寸与标准尺寸的公差满足所述尺寸允许公差时,进入下一步骤。
步骤S203,获取所述第一配合部2021在直角坐标系的第一坐标。
所述处理单元87根据所述待组装的第一部件202的图像得出所述第一配合部2021上的第一基点Q10在直角坐标系中的坐标V11(X13,Y13)。
所述第一驱动单元82用于控制所述驱动机构40驱动所述测距单元86分别移动至测量所述第一点Q01和所述第二点Q02。所述测距单元86控制所述测距仪60沿Z轴测量所述第一配合部2021上第一点Q01的坐标Z11;所述测距单元86控制所述测距仪60沿Z轴测量所述第一配合部2021上第二点Q02的坐标Z12。
所示第一部件202的第一坐标包括V11(X13,Y13)、Z11和Z12。
步骤S204,导正待组装的所述第二部件204。
所述第二驱动单元84用于控制所述机器人30从一上料处抓取一待组装的第二部件204,并移送所述第二部件204至所述导正机构20上且释放所述第二部件204。所述导正单元83用于控制所述导正机构20对所述第二部件204进行导正。
步骤S205,利用所述机器人30抓取待组装的第二部件204并定位于所述第二位置,并拍摄所述待组装的第二部件204。
所述第二驱动单元84用于控制所述机器人30从所述导正机构20抓取导正后的待组装的第二部件204,并控制所述机器人30移送所述第二部件204并停至所述第二位置。
所述视觉单元85用于控制所述相机50在所述第二拍摄位置沿Z轴拍摄所述第二配合部2041的图像。所述处理单元87根据所述图像得出所述第二配合部2041的测量尺寸。
步骤S206,判断所述第二部件204的测量尺寸是否符合尺寸公差要求。
确定所述第二部件204的尺寸允许公差,所述判断单元88用于判断所述第二部件204的测量尺寸与标准尺寸的公差是否满足所述尺寸允许公差。当判断的结果为满足时进入下一步骤;当判断的结果为不满足时,所述第二驱动单元84控制所述机器人30将不满足所述尺寸允许公差的第二部件204移至不良品收集处,所述机器人30抓取另一个待组装的第二部件204,并重复步骤S204、步骤S205和步骤S206,直至所述第二部件204的测量尺寸与标准尺寸的公差满足所述尺寸允许公差。
步骤S207,获取所述第二配合部2041在直角坐标系的第二坐标。
所述处理单元87根据待组装的第二部件204的图像得出所述第二配合部2041上的第二基点Q20在直角坐标系中的坐标V21(X21,Y21)。所述第二基点Q20为所述第二配合部2041的中心点,但不限于此。
所述第一驱动单元82用于控制所述驱动机构40驱动所述测距单元86分别移动至测量所述第七点Q21和所述第八点Q22。所述测距单元86控制所述测距仪60沿Z轴测量得出所述第二配合部2041上第七点Q21的坐标Z21;所述测距单元86控制所述测距仪60沿Z轴测量得出所述第二配合部2041上第八点Q22的坐标Z22。
所述第二部件204的第二坐标包括V21(X21,Y21)、Z21和Z22。
步骤S30,根据标准位置坐标和测量坐标获取位置变化矢量,包括:
步骤S301,根据所述待组装的第一部件202的位置变化矢量,获取所述机器人30在直角坐标系中六个自由度的第一位置变化矢量P1。
所述处理单元87根据所述第一预设坐标和所述第一坐标计算得出所述待组装的第一部件202在直角坐标系中六个自由度的第一位置变化矢量P1。
所述机器人30在所述Z轴的位置变化矢量△Z1为(Z11-Z101+Z12-Z102)/2。所述机器人30在所述X轴的位置变化矢量△X1为(X13-X10)。所述机器人30在所述Y轴的位置变化矢量△Y1为(Y13-Y10)。
在所述相机50拍摄所述第一配合部2021的轮廓上选取第三点Q11和第四点Q12。在其他实施例中,所述第一点Q01也可以与所述第三点Q11相同、所述第二点Q02也可以与所述第四点Q12相同。所述处理单元87分析处理所述相机50拍摄所述第一部件202的图片,获取第三点Q11在所述X轴和所述Y轴的测量坐标V12(X11,Y11),及第四点Q12在所述X轴和所述Y轴的测量坐标V13(X12,Y12)。
所述机器人30绕所述Z轴的转动矢量RZ1为arctan[(Y12-Y11)/(X12-X11)]。所述机器人30绕所述X轴的转动矢量RX1为0。所述机器人30绕所述Y轴的转动矢量RY1为arctan[(Z12-Z102-Z11+Z101)/D1],其中D1为所述第一点Q01和所述第二点Q02沿X轴的距离。
一实施例中,所述机器人30的六个自由度与所述直角坐标系的六个自由度相同,则第一位置变化矢量P1=(△Z1,△X1,△Y1,RZ1,RX1,RY1)。可以理解,其他实施例中,所述机器人30的六个自由度与所述直角坐标系的六个自由度也可以不同,只要获取二者的换算关系即可。
步骤S302,根据所述待组装的第二部件204的位置变化矢量,获取所述机器人30在直角坐标系中六个自由度的第二位置变化矢量P2。
所述处理单元87根据所述第二预设坐标和所述第二坐标计算得出所述待组装的第二部件204在直角坐标系中六个自由度的第二位置变化矢量P2。
所述机器人30在所述Z轴的位置变化矢量△Z2为(Z21-Z201+Z22-Z202)/2。所述机器人30在所述X轴的位置变化矢量△X2为(X21-X10)。所述机器人30在所述Y轴的位置变化矢量△Y2为(Y21-Y10)。
请参阅图6,在所述相机50拍摄所述第二配合部2041的轮廓上第七点Q21和第八点Q22。所述处理单元87分析处理所述相机50拍摄所述第二部件204的图片,获取第七点Q21在所述X轴和所述Y轴的坐标V22(X22,Y22),及第八点Q22在所述X轴和所述Y轴的坐标V23(X23,Y23)。
可以理解,在其他实施例中,步骤S106与步骤S302中的第七点和第八点也可以分别不同。
所述机器人30绕所述Z轴的转动矢量RZ2为arctan[(Y23-Y22)/(X23-X22)]。所述机器人30绕所述X轴的转动矢量RX2为0。所述机器人30绕所述Y轴的转动矢量RY2为arctan[(Z22-Z202-Z21+Z201)/D2],其中D2为第七点Q21和第八点Q22沿X轴的距离。第二位置变化矢量P2=(△Z2,△X2,△Y2,RZ2,RX2,RY2)。
步骤S40,以位置变化矢量补偿预设组装点位坐标P0,组装所述工件200。
所述第二驱动单元84用于控制所述机器人30将所述待组装的第二部件204装入所述待组装的第一部件202,且所述机器人30在六个自由度的组装点位坐标P满足:P=P0+P1+P2。
一实施例中,所述处理器80还包括连接单元89。在所述机器人30移送所述第二部件204至组装点位坐标P之前,所述连接单元89控制所述连接机构70向所述第二部件204点胶。
步骤S50,组装后调整,包括:
步骤S501,获取所述第一配合部2021和所述第二配合部2041分别沿所述Z轴、所述X轴和所述Y轴的多个间隙。
选取关于所述第二轴线O2对称的第一平行线N1和第二平行线N2。第一平行线N1分别与所述第二配合部2041的轮廓相交于第九点Q23和第十点Q24。第二平行线N2分别与所述第二配合部2041的轮廓相交于第十一点Q25和第十二点Q26。所述第一轴线O1分别与所述第二部件204的轮廓相交于第十三点Q27和第十四点Q28。
所述视觉单元85控制所述相机50沿所述Z轴拍摄所述工件200的图片。所述处理单元87根据所述图片得出所述第九点Q23、所述第十点Q24、所述第十一点Q25和所述第十二点Q26分别沿所述Y轴与所述第一配合部2021的轮廓上对应的点之间的间隙E1、E2、E3、E4。所述处理单元87根据所述图片得出所述第十三点Q27和第十四点Q28分别沿所述X轴与所述第一配合部2021的轮廓上对应的点之间的间隙E5和E6。
所述测距单元86控制所述测距仪60分别测量所述第二部件204上对应所述第一点Q01和所述第二点Q02沿所述Z轴的第五点的坐标Z23和第六点的坐标Z24。
步骤S502,根据多个所述间隙驱使所述机器人30调节点位以使所述第一配合部2021和所述第二配合部2041的各间隙均匀。
所述处理单元87根据各间隙计算所述机器人30的位置变化矢量。
所述机器人30在所述Y轴的位置变化矢量△Y3为(E1-E2+E3-E4)/4。所述机器人30绕所述Z轴的转动矢量RZ3为arcsin[(E3-E1)/L1]或arcsin[(E4-E2)/L2],其中L1为所述第九点Q23与所述第十一点Q25的距离,L2为所述第十点Q24与所述第十二点Q26的距离,L1和L2为所述第一平行线N1和所述第二平行线N2沿X轴的距离L。所述机器人30在所述Y轴的位置变化矢量△X3为(E5-E6)/2。所述机器人30的第三位置变化矢量P3为(0,△X3,△Y3,RZ3,0,0)。
所述机器人30在绕所述Y轴的转动矢量RY3为arctan[(Z11-Z101-Z12+Z102+Z24-Z202-Z23+Z201)/D1],其中D1为所述第一点Q01和所述第二点Q02沿X轴的距离。所述机器人30在所述Z轴的位置变化矢量△Z3为(Z11-Z101+Z12-Z102-Z23+Z201-Z24+Z202)/2。所述机器人30的第四位置变化矢量P4为(△Z3,0,0,0,0,RY3)。
所述第二驱动单元84驱动所述机器人30调节其在六个自由度的组装点位坐标P,使其满足:P=P0+P1+P2+P3+P4。
步骤S60,检查所述工件200的组装是否满足间隙允许阈值的要求,包括:
确认所述第一部件202和所述第二部件204在与Z轴垂直的平面内的轮廓的预设阈值,及所述第一部件202和所述第二部件204在与X轴垂直的平面内的轮廓的预设阈值。
按照步骤S501测量组装后的所述第一部件202和所述第二部件204在与Z轴垂直的平面(XY平面)内的轮廓的第一测量间隙组合E1’、E2’、E3’、E4’,及在与X轴垂直的平面(YZ平面)内的轮廓的第二测量间隙E5’、E6’。
当所述判断单元88判断所述第一测量间隙组合E1’、E2’、E3’、E4’满足预设阈值,且所述第二测量间隙组合E5’、E6’满足所述预设阈值时,进入步骤S80或结束组装。
当判断所述第一测量间隙组合E1’、E2’、E3’、E4’不满足预设阈值或所述第二测量间隙组合E5’、E6’不满足所述预设阈值时,进入步骤S70。
步骤S70,判断步骤S50的重复次数是否超过设定的次数。
一实施例中,所述设定次数为五次,但不限于此。
当步骤S50的重复次数小于设定次数时,重复步骤S50和步骤S60,当步骤S60的判断的结果为满足时进入步骤S80或结束组装。
当步骤S50的重复次数达到所述设定次数时,进入步骤S90或结束组装。
步骤S80,固化所述工件200的所述第一部件202和所述第二部件204之间的胶体,并标记所述工件200为良品。
步骤S90,固化所述工件200的所述第一部件202和所述第二部件204之间的胶体,并标记所述工件200为不良品。
可以理解,其他实施例中,步骤S90也可以省略固化所述第一部件202和所述第二部件204之间胶体,仅标记工件200为不良品即可。
可以理解,其他实施例中,点胶也可以在步骤S50之后进行;所述步骤S60也可以省略。
一实施例中,所述组装系统100还包括存储器90,相应地,所述处理器80还包括储存单元810。所述存储器90通过I/O接口和总线实现与所述处理器80耦接。所述储存单元810控制所述存储器90储存所述处理单元87分析计算得出的各间隙值、所述机器人30在六个自由度的位置变化值、所述判断单元88的判断结果等,以根据所述储存单元810储存的数据分析组装良率。
本申请提出的组装方法和组装系统的有益效果在于:通过获取第一部件的第一坐标、第二部件的第二坐标,并根据第一部件的第一预设坐标和第一坐标确定第一位置变化矢量P1,根据第二部件的第二预设坐标和第二坐标确定第二位置变化矢量P2,将位置变化补偿到预设组装点位坐标P0以确定实际组装点位坐标P,即P=P0+P1+P2,实现了调节第一部件和第二部件相对的间隙,使第一部件和第二部件的间隙均匀,组装精度高。
本技术领域的普通技术人员应当认识到,以上的实施方式仅是用来说明本申请,而并非用作为对本申请的限定,只要在本申请的实质精神范围之内,对以上实施例所作的适当改变和变化都落在本申请所公开的范围之内。