CN114800613A - 一种工业机器人装配误差在线检测的精度补偿系统及方法 - Google Patents
一种工业机器人装配误差在线检测的精度补偿系统及方法 Download PDFInfo
- Publication number
- CN114800613A CN114800613A CN202210455441.5A CN202210455441A CN114800613A CN 114800613 A CN114800613 A CN 114800613A CN 202210455441 A CN202210455441 A CN 202210455441A CN 114800613 A CN114800613 A CN 114800613A
- Authority
- CN
- China
- Prior art keywords
- industrial robot
- assembled
- workpiece
- assembly
- coordinate system
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J19/00—Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
- B25J19/007—Means or methods for designing or fabricating manipulators
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02P—CLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
- Y02P90/00—Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
- Y02P90/02—Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]
Abstract
本发明公开了一种工业机器人装配误差在线检测的精度补偿系统及方法,包括用于固定待装配工件Ⅱ的装配平台,装配平台的两侧设有主工业机器人、辅助工业机器人Ⅰ、辅助工业机器人Ⅱ以及L型立柱,L型立柱下方安装有二维云台,二维云台下方安装有大视场双目视觉测量设备,主工业机器人的一端设有主工业机器人末端执行器,辅助工业机器人Ⅰ的一端安装有辅助工业机器人Ⅰ末端执行器,所述辅助工业机器人Ⅱ的一端安装有辅助工业机器人Ⅱ末端执行器,该系统方法简单,精度高,通用性强,能够实现两个待装配工件位姿的精确测量以及装配位姿误差的补偿,并基于装配位姿误差的补偿实现闭环控制。
Description
技术领域
本发明属于工业机器人智能装配领域,具体涉及一种工业机器人装配误差在线检测的精度补偿系统及方法。
背景技术
由于工业机器人具有高柔性、高精度、高效率等特点,广泛应用到航空航天、汽车、电子等装配领域,替代了众多重复性、高强度、高复杂性的人工任务,降低了加工制造成本,提高了产品质量,实现了自动化装配,然而,工业机器人在进行工件对接装配时,由于待装配工件的安装固定误差、工业机器人夹取待装配工件的误差以及工业机器人自身的定位误差,最终导致两个待装配工件的对接装配精度无法满足要求,因此,需要一种工业机器人装配误差在线检测的精度补偿系统及控制方法,双目视觉测量可以得到被测物体的三维信息,被广泛应用于汽车导航、物料抓取、质量检测等领域,将双目视觉检测应用到工业机器人装配领域,可以实现对装配误差的检测。利用力传感器可以使得工业机器人准确的感知到末端力信息,能够精确地完成精密装配、柔性打磨和拖动示教等功能,公布号CN112959364A的专利公开了一种工业机器人装配误差补偿系统及方法,该系统通过工业相机拍摄的图像以及激光传感器对特定点位进行测距计算得到实际装配位置与标准装配位置的误差,从而对实际装配位置进行补偿,该系统可以补偿因第一待装配零件制造及安装固定误差,然而无法补偿工业机器人抓取第二待装配零件的误差和工业机器人装配时的定位误差,装配误差补偿系统没有闭环控制,且需要预先采集待装配零件标准装配位置及信息,操作较为复杂。
发明内容
本发明的目的是为了解决背景技术中提及的问题,提供一种工业机器人装配误差在线检测的精度补偿系统及方法。
为实现上述技术目的,本发明采取的技术方案为:
一种工业机器人装配误差在线检测的精度补偿系统,包括用于固定待装配工件Ⅱ的装配平台,所述装配平台的两侧设有主工业机器人、辅助工业机器人Ⅰ、辅助工业机器人Ⅱ以及 L型立柱,所述L型立柱下方安装有二维云台,所述二维云台下方安装有大视场双目视觉测量设备,所述主工业机器人的一端设有主工业机器人末端执行器,所述辅助工业机器人Ⅰ的一端安装有辅助工业机器人Ⅰ末端执行器,所述辅助工业机器人Ⅱ的一端安装有辅助工业机器人Ⅱ末端执行器;
进一步的,所述主工业机器人的一端设有主工业机器人法兰盘,所述主工业机器人末端执行器包括六维力传感器连接件,六维力传感器,夹爪连接件和夹爪,所述六维力传感器通过六维力传感器连接件与所述主工业机器人法兰盘相连接,所述夹爪通过所述夹爪连接件与所述六维力传感器相连接;
进一步的,所述辅助工业机器人Ⅰ的一端设有连接辅助工业机器人Ⅰ法兰盘,所述辅助工业机器人Ⅰ末端执行器包括辅助光源、辅助光源支架Ⅰ、小视场双目视觉传感器Ⅰ、小视场双目视觉传感器Ⅰ安装板、辅助光源支架Ⅱ、连接件、法兰盘转接件;
所述法兰盘转接件用于连接所述辅助工业机器人Ⅰ法兰盘与所述连接件,所述小视场双目视觉传感器Ⅰ安装板与所述连接件连接;
所述小视场双目视觉传感器Ⅰ安装在所述小视场双目视觉传感器Ⅰ安装板上;
所述辅助光源通过所述辅助光源支架Ⅰ和所述辅助光源支架Ⅱ固定安装在所述小视场双目视觉传感器Ⅰ安装板上,用于为所述小视场双目视觉传感器Ⅰ提供光照。
本发明根据上述的系统提供了一种工业机器人装配误差在线检测的精度补偿方法,包括以下步骤:
步骤a:对辅助工业机器人Ⅰ、辅助工业机器人Ⅱ进行预处理,确定检测待装配工件Ⅰ和待装配工件Ⅱ时的位姿,对主工业机器人进行预处理,确定预测量待装配工件Ⅱ时的主工业机器人位姿。
步骤b:标定主工业机器人基坐标系与小视场双目视觉传感器Ⅰ坐标系、小视场双目视觉传感器Ⅱ坐标系之间的转换矩阵,标定主工业机器人法兰盘坐标系与待装配工件Ⅰ坐标系之间的转换矩阵。
步骤c:确定初次装配待装配工件Ⅰ时的主工业机器人位姿参数。
步骤d:主工业机器人进行正式装配,六维力传感器对待装配工件Ⅰ和待装配工件Ⅱ之间的干涉力进行测量,并进行待装配工件Ⅰ的位姿调整。
步骤e:测量待装配工件Ⅰ和待装配工件Ⅱ之间的对合装配位姿误差,并计算其与理论对合装配位姿的偏差。
步骤f:根据计算出来的装配位姿偏差,进行装配误差补偿。
上述的步骤a包括:
a101:将待装配工件Ⅱ放置在装配平台上,并通过夹紧装置使其固定。
a102:调整辅助工业机器人Ⅰ、辅助工业机器人Ⅱ、主工业机器人的位姿,使得小视场双目视觉传感器Ⅰ可以依次测量待装配工件Ⅰ和待装配工件Ⅱ的对应待检测区域Ⅰ特征,且小视场双目视觉传感器Ⅱ可以依次测量待装配工件Ⅰ和待装配工件Ⅱ的对应待检测区域Ⅱ特征。
上述的步骤b包括:
b101:主工业机器人运动至预测量待装配工件Ⅱ时的位置处,小视场双目视觉传感器Ⅰ和小视场双目视觉传感器Ⅱ分别测量待装配工件Ⅱ的对应待检测区域Ⅰ和对应待检测区域Ⅱ,计算待装配工件Ⅰ坐标系相对于小视场双目视觉传感器Ⅰ坐标系之间的转换矩阵;
b102:根据主工业机器人当前位姿,计算当前主工业机器人法兰盘坐标系与主工业机器人基坐标系之间的转换矩阵;
上述的步骤c包括:
c103:根据主工业机器人基坐标系与小视场双目视觉传感器Ⅰ坐标系之间的转换矩阵,计算主工业机器人法兰盘坐标系与待装配工件Ⅰ坐标系之间的转换矩阵。
c101:小视场双目视觉传感器Ⅰ和小视场双目视觉传感器Ⅱ分别测量待装配工件Ⅱ的对应待检测区域Ⅰ和对应待检测区域Ⅱ,计算待装配工件Ⅱ坐标系相对于小视场双目视觉传感器Ⅰ坐标系之间的转换矩阵;
c102:根据待装配工件Ⅰ和待装配工件Ⅱ数模理论装配关系,计算理论装配时待装配工件Ⅰ坐标系与待装配工件Ⅱ坐标系之间的转换矩阵;
c103:计算实际装配时,待装配工件Ⅰ坐标系与小视场双目视觉传感器Ⅰ坐标系之间的理论转换矩阵;
c104:根据主工业机器人法兰盘坐标系与待装配工件Ⅰ坐标系之间的转换矩阵,计算初次装配待装配工件Ⅰ时的主工业机器人位姿参数。
上述的步骤d包括:
d101:主工业机器人通过夹爪夹持待装配工件Ⅰ移动至初次装配的正上方位置,然后控制主工业机器人使得待装配工件Ⅰ向下移动至初次装配的位置;
d102:待装配工件Ⅰ在移动至初次装配位置的过程中,通过主工业机器人实时调整部分位姿参数,实现待装配工件Ⅰ位姿的实时调整,保证待装配工件Ⅰ和待装配工件Ⅱ装配面贴合,且干涉力不大于所设阈值。
d103:主工业机器人通过六维力传感器实时测量待装配工件Ⅰ和待装配工件Ⅱ之间的干涉力,并确定待装配工件Ⅰ和待装配工件Ⅱ之间的装配干涉状态,若干涉力大于所设阈值,则控制主工业机器人进行待装配工件Ⅰ的位姿调整,直至主工业机器人装配运动完成且装配干涉力不大于所设阈值。
上述的步骤e包括:
e101:小视场双目视觉传感器Ⅰ和小视场双目视觉传感器Ⅱ分别再次测量待装配工件Ⅰ的对应待检测区域Ⅰ和对应待检测区域Ⅱ,计算待装配工件Ⅰ坐标系与小视场双目视觉传感器Ⅰ坐标系之间的实际转换矩阵;
e102:根据实际装配时待装配工件Ⅰ坐标系与小视场双目视觉传感器Ⅰ坐标系之间的理论转换矩阵和实际转换矩阵,计算待装配工件Ⅰ理论位姿与实际位姿的偏差。
上述的步骤f包括:
f101:待装配工件Ⅰ理论位姿与实际位姿的偏差不大于预设阈值,则认为完成装配;
f102:待装配工件Ⅰ理论位姿与实际位姿的偏差大于预设阈值,则通过主工业机器人法兰盘坐标系与待装配工件Ⅰ坐标系之间的转换矩阵、主工业机器人基坐标系与小视场双目视觉传感器Ⅰ坐标系之间的转换矩阵、实际装配时待装配工件Ⅰ坐标系与小视场双目视觉传感器Ⅰ坐标系之间的实际转换矩阵,计算主工业机器人实际位姿参数;
f103:根据初次装配待装配工件Ⅰ时的主工业机器人位姿参数与计算的主工业机器人实际位姿参数,计算主工业机器人装配精度补偿的位姿参数;
f104:主工业机器人根据装配精度补偿计算得到的位姿参数进行运动,运动过程中进行步骤d的控制操作,直至主工业机器人运动完成;
f105:装配过程循环操作步骤d、步骤e和步骤f,直至小视场双目视觉传感器Ⅰ和小视场双目视觉传感器Ⅱ测量待装配工件Ⅰ与待装配工件Ⅱ之间的对合装配位姿误差不大于预设阈值,即完成装配精度补偿。
发明的一种工业机器人装配误差在线检测的精度补偿系统及方法,具有以下优点:
1、本发明提出了一种工业机器人装配误差在线检测的精度补偿系统及控制方法,采用两台小视场双目视觉传感器分别检测待装配工件不同区域,实现了两个待装配工件位姿的精确测量;
2、本系统在装配过程中采用六维力传感器,能够实时采集装配过程中的工件干涉力信息,并确定待装配工件之间的干涉状态,通过实时调整待装配工件部分位姿参数,实现装配位姿误差的部分补偿;
3、本系统采用装配误差在线检测与精度补偿闭环控制,通过循环测量装配误差并进行精度补偿,避免了一次精度补偿不能满足精度要求的问题,且通过检测装配误差不大于所设阈值判断是否完成装配,实现装配精度的闭环高精度控制;
4、本系统可以对待装配工件的安装固定误差、工业机器人夹取待装配工件的误差、工业机器人的定位误差以及各装置坐标系转换误差进行补偿,装配完成信号是以待装配工件装配误差检测结果是否不大于阈值作为评价指标,实现了基于装配误差在线检测的精度补偿闭环控制。
附图说明
图1为本发明一种工业机器人装配误差在线检测的精度补偿系统示意图。
图2为本发明一种工业机器人装配误差在线检测的精度补偿系统的辅助工业机器人Ⅰ末端执行器示意图。
图3为本发明一种工业机器人装配误差在线检测的精度补偿系统的主工业机器人末端执行器示意图。
图4为本发明一种工业机器人装配误差在线检测的精度补偿控制方法的待装配工件待检测位置示意图。
图中标记名称:主工业机器人1;主工业机器人末端执行器2;大视场双目视觉测量设备 3;二维云台4;L型立柱5;辅助工业机器人Ⅰ末端执行器6;辅助工业机器人Ⅰ7;辅助工业机器人Ⅱ末端执行器8;辅助工业机器人Ⅱ9;装配平台10;辅助光源11;辅助光源支架Ⅰ12;小视场双目视觉传感器Ⅰ13;小视场双目视觉传感器Ⅰ安装板14;辅助光源支架Ⅱ15;连接件16;法兰盘转接件17;辅助工业机器人Ⅰ法兰盘18;主工业机器人法兰盘19;六维力传感器连接件20;六维力传感器21;夹爪连接件22;夹爪23;待装配工件Ⅰ24;待装配工件Ⅱ25;小视场双目视觉传感器Ⅱ26。
具体实施方式
以下结合附图对本发明的实施例作进一步详细描述。
如图1-4所示,一种工业机器人装配误差在线检测的精度补偿系统,包括用于固定待装配工件Ⅱ的装配平台,所述装配平台的两侧设有主工业机器人、辅助工业机器人Ⅰ、辅助工业机器人Ⅱ以及L型立柱,所述L型立柱下方安装有二维云台,所述二维云台下方安装有大视场双目视觉测量设备,所述主工业机器人的一端设有主工业机器人末端执行器,所述辅助工业机器人Ⅰ的一端安装有辅助工业机器人Ⅰ末端执行器,所述辅助工业机器人Ⅱ的一端安装有辅助工业机器人Ⅱ末端执行器。
主工业机器人的一端设有主工业机器人法兰盘,所述主工业机器人末端执行器包括六维力传感器连接件,六维力传感器,夹爪连接件和夹爪,所述六维力传感器通过六维力传感器连接件与所述主工业机器人法兰盘相连接,所述夹爪通过所述夹爪连接件与所述六维力传感器相连接。
辅助工业机器人Ⅰ的一端设有连接辅助工业机器人Ⅰ法兰盘,所述辅助工业机器人Ⅰ末端执行器包括辅助光源、辅助光源支架Ⅰ、小视场双目视觉传感器Ⅰ、小视场双目视觉传感器Ⅰ安装板、辅助光源支架Ⅱ、连接件、法兰盘转接件;
法兰盘转接件用于连接所述辅助工业机器人Ⅰ法兰盘与所述连接件,所述小视场双目视觉传感器Ⅰ安装板与所述连接件连接;
小视场双目视觉传感器Ⅰ安装在所述小视场双目视觉传感器Ⅰ安装板上;
辅助光源通过所述辅助光源支架Ⅰ和所述辅助光源支架Ⅱ固定安装在所述小视场双目视觉传感器Ⅰ安装板上,用于为所述小视场双目视觉传感器Ⅰ提供光照。
本发明根据上述的系统提供了一种工业机器人装配误差在线检测的精度补偿方法,包括以下步骤:
步骤a:对辅助工业机器人Ⅰ7、辅助工业机器人Ⅱ9进行预处理,确定检测待装配工件Ⅰ24和待装配工件Ⅱ25时的位姿,对主工业机器人1进行预处理,确定预测量待装配工件Ⅱ25时的主工业机器人1位姿。
步骤b:标定主工业机器人1基坐标系与小视场双目视觉传感器Ⅰ13坐标系、小视场双目视觉传感器Ⅱ26坐标系之间的转换矩阵,标定主工业机器人法兰盘19坐标系与待装配工件Ⅰ24坐标系之间的转换矩阵。
步骤c:确定初次装配待装配工件Ⅰ24时的主工业机器人1位姿参数。
步骤d:主工业机器人1进行正式装配,六维力传感器21对待装配工件Ⅰ24和待装配工件Ⅱ25之间的干涉力进行测量,并进行待装配工件Ⅰ24的位姿调整。
步骤e:测量待装配工件Ⅰ24和待装配工件Ⅱ25之间的对合装配位姿误差,并计算其与理论对合装配位姿的偏差。
步骤f:根据计算出来的装配位姿偏差,进行装配误差补偿。
上述步骤a包括:
a101:将待装配工件Ⅱ25放置并固定在装配平台上。
a102:调整辅助工业机器人Ⅰ7、辅助工业机器人Ⅱ9、主工业机器人1的位姿,使得小视场双目视觉传感器Ⅰ13可以依次测量待装配工件Ⅰ24和待装配工件Ⅱ25的对应待检测区域Ⅰ特征,且小视场双目视觉传感器Ⅱ26可以依次测量待装配工件Ⅰ24和待装配工件Ⅱ25的对应待检测区域Ⅱ特征。
上述步骤b包括:
b101:主工业机器人1运动至预测量待装配工件Ⅱ25时的位置处,小视场双目视觉传感器Ⅰ13和小视场双目视觉传感器Ⅱ26分别测量待装配工件Ⅱ25的对应待检测区域Ⅰ和对应待检测区域Ⅱ,计算待装配工件Ⅰ24坐标系相对于小视场双目视觉传感器Ⅰ13坐标系之间的转换矩阵;
b102:根据主工业机器人1当前位姿,计算当前主工业机器人法兰盘19坐标系与主工业机器人1基坐标系之间的转换矩阵;
b103:根据主工业机器人1基坐标系与小视场双目视觉传感器Ⅰ13坐标系之间的转换矩阵,计算主工业机器人法兰盘19坐标系与待装配工件Ⅰ24坐标系之间的转换矩阵。
上述步骤c包括:
c101:小视场双目视觉传感器Ⅰ13和小视场双目视觉传感器Ⅱ26分别测量待装配工件Ⅱ25的对应待检测区域Ⅰ和对应待检测区域Ⅱ,计算待装配工件Ⅱ25坐标系相对于小视场双目视觉传感器Ⅰ13坐标系之间的转换矩阵;
c102:根据待装配工件Ⅰ24和待装配工件Ⅱ25数模理论装配关系,计算理论装配时待装配工件Ⅰ24坐标系与待装配工件Ⅱ25坐标系之间的转换矩阵;
c103:计算实际装配时,待装配工件Ⅰ24坐标系与小视场双目视觉传感器Ⅰ13坐标系之间的理论转换矩阵;
c104:根据主工业机器人法兰盘19坐标系与待装配工件Ⅰ24坐标系之间的转换矩阵,计算初次装配待装配工件Ⅰ24时的主工业机器人1位姿参数X1、Y1、Z1、RX1、RY1、RZ1。
上述步骤d包括:
d101:主工业机器人1通过夹爪23夹持待装配工件Ⅰ24移动至初次装配的正上方位置,其主工业机器人位姿参数为X1、Y1、RX1、RY1、RZ1,然后控制主工业机器人使得待装配工件Ⅰ24向下移动至初次装配的位置,其主工业机器人1位姿参数为X1、Y1、Z1、RX1、 RY1、RZ1。
d102:主工业机器人1在移动至位姿参数X1、Y1、Z1、RX1、RY1、RZ1的过程中,主工业机器人1通过六维力传感器21实时测量待装配工件Ⅰ24和待装配工件Ⅱ25之间的干涉力,并确定待装配工件Ⅰ24和待装配工件Ⅱ25之间的装配干涉状态,若干涉力大于所设阈值,则通过主工业机器人1实时调整位姿参数Z1、RX1、RY1,实现待装配工件Ⅰ24位姿的实时调整,直至主工业机器人1移动至位姿参数X1、Y1、RZ1,且装配干涉力不大于所设阈值。
上述步骤e包括:
e101:小视场双目视觉传感器Ⅰ13和小视场双目视觉传感器Ⅱ26分别再次测量待装配工件Ⅰ24的对应待检测区域Ⅰ和对应待检测区域Ⅱ,计算待装配工件Ⅰ24坐标系与小视场双目视觉传感器Ⅰ13坐标系之间的实际转换矩阵;
e102:根据实际装配时待装配工件Ⅰ24坐标系与小视场双目视觉传感器Ⅰ13坐标系之间的理论转换矩阵和实际转换矩阵,计算待装配工件Ⅰ24理论位姿与实际位姿的偏差。
上述步骤f包括:
f101:待装配工件Ⅰ24理论位姿与实际位姿的偏差不大于预设阈值,则认为完成装配;
f102:待装配工件Ⅰ24理论位姿与实际位姿的偏差大于预设阈值,则通过主工业机器人法兰盘19坐标系与待装配工件Ⅰ24坐标系之间的转换矩阵、主工业机器人1基坐标系与小视场双目视觉传感器Ⅰ13坐标系之间的转换矩阵、实际装配时待装配工件Ⅰ24坐标系与小视场双目视觉传感器Ⅰ13坐标系之间的实际转换矩阵,计算主工业机器人1实际位姿参数;
f103:根据初次装配待装配工件Ⅰ24时的主工业机器人1位姿参数与计算的主工业机器人 1实际位姿参数,计算主工业机器人1装配精度补偿的位姿参数;
f104:主工业机器人1根据装配精度补偿计算得到的位姿参数进行运动,运动过程中进行步骤d的控制操作,直至主工业机器人1运动完成。
f105:装配过程循环操作步骤d、步骤e和步骤f,直至小视场双目视觉传感器Ⅰ和小视场双目视觉传感器Ⅱ测量待装配工件Ⅰ与待装配工件Ⅱ之间的对合装配位姿误差不大于预设阈值,即完成装配精度补偿。
以下讲解本发明的使用方法:
本发明公开了一种工业机器人装配误差在线检测的精度补偿系统,该系统辅助工业机器人Ⅰ末端执行器6和辅助工业机器人Ⅱ末端执行器8分别设有小视场双目视觉传感器Ⅰ13和小视场双目视觉传感器Ⅱ26,采用两台小视场双目视觉传感器分别检测待装配工件不同区域,实现了两个待装配工件位姿的精确测量,该系统主工业机器人末端执行器2上设有六维力传感器21,能够实时采集装配过程中的工件干涉力信息,并确定待装配工件之间的干涉状态,通过实时调整待装配工件部分位姿参数,实现装配位姿误差的部分补偿;本发明根据上述的系统提供了一种工业机器人装配误差在线检测的精度补偿方法,包括以下步骤,步骤a:对辅助工业机器人Ⅰ7、辅助工业机器人Ⅱ9进行预处理,确定检测待装配工件Ⅰ24和待装配工件Ⅱ25时的位姿,对主工业机器人1进行预处理,确定预测量待装配工件Ⅱ25时的主工业机器人1位姿;步骤b:标定主工业机器人1基坐标系与小视场双目视觉传感器Ⅰ13坐标系、小视场双目视觉传感器Ⅱ26坐标系之间的转换矩阵,标定主工业机器人法兰盘19坐标系与待装配工件Ⅰ24坐标系之间的转换矩阵;步骤c:确定初次装配待装配工件Ⅰ24时的主工业机器人1位姿参数;步骤d:主工业机器人1进行正式装配,六维力传感器21对待装配工件Ⅰ24和待装配工件Ⅱ25之间的干涉力进行测量,并进行待装配工件Ⅰ24的位姿调整;步骤e:测量待装配工件Ⅰ24和待装配工件Ⅱ25之间的对合装配位姿误差,并计算其与理论对合装配位姿的偏差;步骤f:根据计算出来的装配位姿偏差,进行装配误差补偿;装配过程中循环操作步骤d、步骤e和步骤f,直至小视场双目视觉传感器Ⅰ13和小视场双目视觉传感器Ⅱ26 测量待装配工件Ⅰ24与待装配工件Ⅱ25之间的对合装配位姿误差不大于预设阈值,即完成装配精度补偿。
以上仅是本发明的优选实施方式,本发明的保护范围并不仅局限于上述实施例,凡属于本发明思路下的技术方案均属于本发明的保护范围。应当指出,对于本技术领域的普通技术人员来说,在不脱离本发明原理前提下的若干改进和润饰,应视为本发明的保护范围。
Claims (10)
1.一种工业机器人装配误差在线检测的精度补偿系统,其特征在于:包括用于固定待装配工件Ⅱ(25)的装配平台(10),所述装配平台(10)的两侧设有主工业机器人(1)、辅助工业机器人Ⅰ(7)、辅助工业机器人Ⅱ(9)以及L型立柱(5),所述L型立柱(5)下方安装有二维云台(4),所述二维云台(4)下方安装有大视场双目视觉测量设备(3),所述主工业机器人(1)的一端设有主工业机器人末端执行器(2),所述辅助工业机器人Ⅰ(7)的一端安装有辅助工业机器人Ⅰ末端执行器(6),所述辅助工业机器人Ⅱ(9)的一端安装有辅助工业机器人Ⅱ末端执行器(8)。
2.根据权利要求1的一种工业机器人装配误差在线检测的精度补偿系统,其特征在于:所述主工业机器人(1)的一端设有主工业机器人法兰盘(19),所述主工业机器人末端执行器(2)包括六维力传感器连接件(20),六维力传感器(21),夹爪连接件(22)和夹爪(23),所述六维力传感器(21)通过六维力传感器连接件(20)与所述主工业机器人法兰盘(19)相连接,所述夹爪(23)通过所述夹爪连接件(22)与所述六维力传感器(21)相连接。
3.根据权利要求1的一种工业机器人装配误差在线检测的精度补偿系统,其特征在于:所述辅助工业机器人Ⅰ(7)的一端设有连接辅助工业机器人Ⅰ法兰盘(18),所述辅助工业机器人Ⅰ末端执行器(6)包括辅助光源(11)、辅助光源支架Ⅰ(12)、小视场双目视觉传感器Ⅰ(13)、小视场双目视觉传感器Ⅰ安装板(14)、辅助光源支架Ⅱ(15)、连接件(16)、法兰盘转接件(17);
所述法兰盘转接件(17)用于连接所述辅助工业机器人Ⅰ法兰盘(18)与所述连接件(16),所述小视场双目视觉传感器Ⅰ安装板(14)与所述连接件(16)连接;
所述小视场双目视觉传感器Ⅰ(13)安装在所述小视场双目视觉传感器Ⅰ安装板(14)上;
所述辅助光源(11)通过所述辅助光源支架Ⅰ(12)和所述辅助光源支架Ⅱ(15)固定安装在所述小视场双目视觉传感器Ⅰ安装板(14)上,用于为所述小视场双目视觉传感器Ⅰ(13)提供光照。
4.一种工业机器人装配误差在线检测的精度补偿控制方法,其特征在于,包括以下步骤:
步骤a:对辅助工业机器人Ⅰ(7)、辅助工业机器人Ⅱ(9)进行预处理,确定检测待装配工件Ⅰ(24)和待装配工件Ⅱ(25)时的位姿,对主工业机器人(1)进行预处理,确定预测量待装配工件Ⅱ(25)时的主工业机器人(1)位姿;
步骤b:标定主工业机器人(1)基坐标系与小视场双目视觉传感器Ⅰ(13)坐标系、小视场双目视觉传感器Ⅱ(26)坐标系之间的转换矩阵,标定主工业机器人法兰盘(19)坐标系与待装配工件Ⅰ(24)坐标系之间的转换矩阵;
步骤c:确定初次装配待装配工件Ⅰ(24)时的主工业机器人(1)位姿参数;
步骤d:主工业机器人(1)进行正式装配,六维力传感器(21)对待装配工件Ⅰ(24)和待装配工件Ⅱ(25)之间的干涉力进行测量,并进行待装配工件Ⅰ(24)的位姿调整;
步骤e:测量待装配工件Ⅰ(24)和待装配工件Ⅱ(25)之间的对合装配位姿误差,并计算其与理论对合装配位姿的偏差;
步骤f:根据计算出来的装配位姿偏差,进行装配误差补偿。
5.根据权利要求4所述的一种工业机器人装配误差在线检测的精度补偿控制方法,其特征在于,所述步骤a包括:
a101:将待装配工件Ⅱ(25)放置在装配平台(10)上,并通过夹紧装置使其固定;
a102:调整辅助工业机器人Ⅰ(7)、辅助工业机器人Ⅱ(9)、主工业机器人(1)的位姿,使得小视场双目视觉传感器Ⅰ(13)可以依次测量待装配工件Ⅰ(24)和待装配工件Ⅱ(25)的对应待检测区域Ⅰ特征,且小视场双目视觉传感器Ⅱ(26)可以依次测量待装配工件Ⅰ(24)和待装配工件Ⅱ(25)的对应待检测区域Ⅱ特征。
6.根据权利要求5所述的一种工业机器人装配误差在线检测的精度补偿控制方法,其特征在于,所述步骤b包括:
b101:主工业机器人(1)运动至预测量待装配工件Ⅱ(25)时的位置处,小视场双目视觉传感器Ⅰ(13)和小视场双目视觉传感器Ⅱ(26)分别测量待装配工件Ⅱ(25)的对应待检测区域Ⅰ和对应待检测区域Ⅱ,计算待装配工件Ⅰ(24)坐标系相对于小视场双目视觉传感器Ⅰ(13)坐标系之间的转换矩阵;
b102:根据主工业机器人(1)当前位姿,计算当前主工业机器人法兰盘(19)坐标系与主工业机器人(1)基坐标系之间的转换矩阵;
b103:根据主工业机器人(1)基坐标系与小视场双目视觉传感器Ⅰ(13)坐标系之间的转换矩阵,计算主工业机器人法兰盘(19)坐标系与待装配工件Ⅰ(24)坐标系之间的转换矩阵。
7.根据权利要求6所述的一种工业机器人装配误差在线检测的精度补偿控制方法,其特征在于,所述步骤c包括:
c101:小视场双目视觉传感器Ⅰ(13)和小视场双目视觉传感器Ⅱ(26)分别测量待装配工件Ⅱ(25)的对应待检测区域Ⅰ和对应待检测区域Ⅱ,计算待装配工件Ⅱ(25)坐标系相对于小视场双目视觉传感器Ⅰ(13)坐标系之间的转换矩阵;
c102:根据待装配工件Ⅰ(24)和待装配工件Ⅱ(25)数模理论装配关系,计算理论装配时待装配工件Ⅰ(24)坐标系与待装配工件Ⅱ(25)坐标系之间的转换矩阵;
c103:计算实际装配时,待装配工件Ⅰ(24)坐标系与小视场双目视觉传感器Ⅰ(13)坐标系之间的理论转换矩阵;
c104:根据主工业机器人法兰盘(19)坐标系与待装配工件Ⅰ(24)坐标系之间的转换矩阵,计算初次装配待装配工件Ⅰ(24)时的主工业机器人(1)位姿参数。
8.根据权利要求7所述的一种工业机器人装配误差在线检测的精度补偿控制方法,其特征在于,所述步骤d包括:
d101:主工业机器人(1)通过夹爪(23)夹持待装配工件Ⅰ(24)移动至初次装配的正上方位置,然后控制主工业机器人(1)使得待装配工件Ⅰ(24)向下移动至初次装配的位置;
d102:待装配工件Ⅰ(24)在移动至初次装配位置的过程中,通过主工业机器人(1)实时调整部分位姿参数,实现待装配工件Ⅰ(24)位姿的实时调整,保证待装配工件Ⅰ(24)和待装配工件Ⅱ(25)装配面贴合,且干涉力不大于所设阈值。
d103:主工业机器人(1)通过六维力传感器(21)实时测量待装配工件Ⅰ(24)和待装配工件Ⅱ(25)之间的干涉力,并确定待装配工件Ⅰ(24)和待装配工件Ⅱ(25)之间的装配干涉状态,若干涉力大于所设阈值,则控制主工业机器人(1)进行待装配工件Ⅰ(24)的位姿调整,直至主工业机器人(1)装配运动完成且装配干涉力不大于所设阈值。
9.根据权利要求8所述的一种工业机器人装配误差在线检测的精度补偿控制方法,其特征在于,所述步骤e包括:
e101:小视场双目视觉传感器Ⅰ(13)和小视场双目视觉传感器Ⅱ(26)分别再次测量待装配工件Ⅰ(24)的对应待检测区域Ⅰ和对应待检测区域Ⅱ,计算待装配工件Ⅰ(24)坐标系与小视场双目视觉传感器Ⅰ(13)坐标系之间的实际转换矩阵;
e102:根据实际装配时待装配工件Ⅰ(24)坐标系与小视场双目视觉传感器Ⅰ(13)坐标系之间的理论转换矩阵和实际转换矩阵,计算待装配工件Ⅰ(24)理论位姿与实际位姿的偏差。
10.根据权利要求9所述的一种工业机器人装配误差在线检测的精度补偿控制方法,其特征在于,所述步骤f包括:
f101:待装配工件Ⅰ(24)理论位姿与实际位姿的偏差不大于预设阈值,则认为完成装配;
f102:待装配工件Ⅰ(24)理论位姿与实际位姿的偏差大于预设阈值,则通过主工业机器人法兰盘(19)坐标系与待装配工件Ⅰ(24)坐标系之间的转换矩阵、主工业机器人(1)基坐标系与小视场双目视觉传感器Ⅰ(13)坐标系之间的转换矩阵、实际装配时待装配工件Ⅰ(24)坐标系与小视场双目视觉传感器Ⅰ(13)坐标系之间的实际转换矩阵,计算主工业机器人(1)实际位姿参数;
f103:根据初次装配待装配工件Ⅰ(24)时的主工业机器人(1)位姿参数与计算的主工业机器人(1)实际位姿参数,计算主工业机器人(1)装配精度补偿的位姿参数;
f104:主工业机器人(1)根据装配精度补偿计算得到的位姿参数进行运动,运动过程中进行步骤d的控制操作,直至主工业机器人(1)运动完成;
f105:装配过程循环操作步骤d、步骤e和步骤f,直至小视场双目视觉传感器Ⅰ和小视场双目视觉传感器Ⅱ测量待装配工件Ⅰ与待装配工件Ⅱ之间的对合装配位姿误差不大于预设阈值,即完成装配精度补偿。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210455441.5A CN114800613B (zh) | 2022-04-28 | 2022-04-28 | 一种工业机器人装配误差在线检测的精度补偿系统及方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210455441.5A CN114800613B (zh) | 2022-04-28 | 2022-04-28 | 一种工业机器人装配误差在线检测的精度补偿系统及方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114800613A true CN114800613A (zh) | 2022-07-29 |
CN114800613B CN114800613B (zh) | 2023-08-04 |
Family
ID=82509342
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210455441.5A Active CN114800613B (zh) | 2022-04-28 | 2022-04-28 | 一种工业机器人装配误差在线检测的精度补偿系统及方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114800613B (zh) |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP0151417A1 (en) * | 1984-01-19 | 1985-08-14 | Hitachi, Ltd. | Method for correcting systems of coordinates in a robot having visual sensor device and apparatus therefor |
CN103153553A (zh) * | 2010-08-27 | 2013-06-12 | Abb研究有限公司 | 视觉引导对准系统和方法 |
CN105234943A (zh) * | 2015-09-09 | 2016-01-13 | 大族激光科技产业集团股份有限公司 | 一种基于视觉识别的工业机器人示教装置及方法 |
CN106272416A (zh) * | 2016-08-29 | 2017-01-04 | 上海交通大学 | 基于力觉和视觉的机器人细长轴精密装配系统及方法 |
CN110561415A (zh) * | 2019-07-30 | 2019-12-13 | 苏州紫金港智能制造装备有限公司 | 一种基于机器视觉补偿的双机器人协同装配系统及方法 |
CN111590594A (zh) * | 2020-06-22 | 2020-08-28 | 南京航空航天大学 | 基于视觉引导的机器人轨迹跟踪控制方法 |
CN112959364A (zh) * | 2021-03-15 | 2021-06-15 | 北京电子工程总体研究所 | 一种工业机器人装配误差补偿系统及方法 |
CN113052913A (zh) * | 2021-02-08 | 2021-06-29 | 南京航空航天大学 | 一种二级组合视觉测量系统中转位姿高精度标定方法 |
-
2022
- 2022-04-28 CN CN202210455441.5A patent/CN114800613B/zh active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP0151417A1 (en) * | 1984-01-19 | 1985-08-14 | Hitachi, Ltd. | Method for correcting systems of coordinates in a robot having visual sensor device and apparatus therefor |
CN103153553A (zh) * | 2010-08-27 | 2013-06-12 | Abb研究有限公司 | 视觉引导对准系统和方法 |
CN105234943A (zh) * | 2015-09-09 | 2016-01-13 | 大族激光科技产业集团股份有限公司 | 一种基于视觉识别的工业机器人示教装置及方法 |
CN106272416A (zh) * | 2016-08-29 | 2017-01-04 | 上海交通大学 | 基于力觉和视觉的机器人细长轴精密装配系统及方法 |
CN110561415A (zh) * | 2019-07-30 | 2019-12-13 | 苏州紫金港智能制造装备有限公司 | 一种基于机器视觉补偿的双机器人协同装配系统及方法 |
CN111590594A (zh) * | 2020-06-22 | 2020-08-28 | 南京航空航天大学 | 基于视觉引导的机器人轨迹跟踪控制方法 |
CN113052913A (zh) * | 2021-02-08 | 2021-06-29 | 南京航空航天大学 | 一种二级组合视觉测量系统中转位姿高精度标定方法 |
CN112959364A (zh) * | 2021-03-15 | 2021-06-15 | 北京电子工程总体研究所 | 一种工业机器人装配误差补偿系统及方法 |
Also Published As
Publication number | Publication date |
---|---|
CN114800613B (zh) | 2023-08-04 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
WO2021208230A1 (zh) | 智能装配控制系统 | |
CN109822574B (zh) | 一种工业机器人末端六维力传感器标定的方法 | |
EP1607194B1 (en) | Robot system comprising a plurality of robots provided with means for calibrating their relative position | |
US8346392B2 (en) | Method and system for the high-precision positioning of at least one object in a final location in space | |
US6070109A (en) | Robot calibration system | |
CN105945948A (zh) | 一种应用于工业机器人的tcp在线快速标定方法及装置 | |
CN111707189B (zh) | 基于双目视觉的激光位移传感器光束方向标定方法 | |
CN110370316B (zh) | 一种基于垂直反射的机器人tcp标定方法 | |
US11707842B2 (en) | Robot system and coordinate conversion method | |
CN113146613B (zh) | 一种工业机器人d-h参数三维自标定校准装置及方法 | |
CN109895082A (zh) | 一种应用于航天装配设备的控制系统 | |
JP2787891B2 (ja) | レーザロボットの自動教示装置 | |
JPH08272425A (ja) | 非接触でロボットに座標系を教示する方法 | |
KR20190000429A (ko) | 양팔 로봇 시스템 | |
CN114800613B (zh) | 一种工业机器人装配误差在线检测的精度补偿系统及方法 | |
Jian et al. | On-line precision calibration of mobile manipulators based on the multi-level measurement strategy | |
CN111006706A (zh) | 一种基于线激光视觉传感器的旋转轴标定方法 | |
CN115609586A (zh) | 一种基于抓取位姿约束的机器人高精度装配方法 | |
CN112669383B (zh) | 流水线跟踪系统的跟踪方法及相机标定方法 | |
CN115179323A (zh) | 基于远心视觉约束的机器末位姿测量装置及精度提升方法 | |
KR100842088B1 (ko) | 연속컨베이어 기반 차체 위치계측시스템 및 그 방법 | |
CN114012719A (zh) | 一种六轴机器人的零点标定方法及系统 | |
CN113733155A (zh) | 六轴工业机器人标定装置和标定方法 | |
US20230031819A1 (en) | Positioning method and positioning device | |
Roebrock et al. | Offline path correction system for industrial robots |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |