CN107160380A - 一种基于scara机械手的相机标定和坐标变换的方法 - Google Patents
一种基于scara机械手的相机标定和坐标变换的方法 Download PDFInfo
- Publication number
- CN107160380A CN107160380A CN201710535960.1A CN201710535960A CN107160380A CN 107160380 A CN107160380 A CN 107160380A CN 201710535960 A CN201710535960 A CN 201710535960A CN 107160380 A CN107160380 A CN 107160380A
- Authority
- CN
- China
- Prior art keywords
- mrow
- msub
- camera
- joint
- suction nozzle
- 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
- 238000000034 method Methods 0.000 title claims abstract description 24
- 230000008569 process Effects 0.000 claims abstract description 10
- 230000009466 transformation Effects 0.000 claims abstract description 9
- 239000013598 vector Substances 0.000 claims description 17
- 239000011159 matrix material Substances 0.000 claims description 10
- 238000012937 correction Methods 0.000 claims description 4
- 238000003384 imaging method Methods 0.000 claims description 4
- 238000012545 processing Methods 0.000 claims description 3
- 230000033772 system development Effects 0.000 abstract 1
- 238000009966 trimming Methods 0.000 abstract 1
- 238000010586 diagram Methods 0.000 description 4
- 230000008859 change Effects 0.000 description 3
- 238000010521 absorption reaction Methods 0.000 description 2
- 238000006243 chemical reaction Methods 0.000 description 2
- 238000004519 manufacturing process Methods 0.000 description 2
- 241000208340 Araliaceae Species 0.000 description 1
- 235000005035 Panax pseudoginseng ssp. pseudoginseng Nutrition 0.000 description 1
- 235000003140 Panax quinquefolius Nutrition 0.000 description 1
- 150000001875 compounds Chemical class 0.000 description 1
- 210000000245 forearm Anatomy 0.000 description 1
- 235000008434 ginseng Nutrition 0.000 description 1
- 238000009776 industrial production Methods 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 238000009401 outcrossing Methods 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 238000011426 transformation method Methods 0.000 description 1
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1694—Programme controls characterised by use of sensors other than normal servo-feedback from position, speed or acceleration sensors, perception control, multi-sensor controlled systems, sensor fusion
- B25J9/1697—Vision controlled systems
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/02—Programme-controlled manipulators characterised by movement of the arms, e.g. cartesian coordinate type
- B25J9/04—Programme-controlled manipulators characterised by movement of the arms, e.g. cartesian coordinate type by rotating at least one arm, excluding the head movement itself, e.g. cylindrical coordinate type or polar coordinate type
- B25J9/046—Revolute coordinate type
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Manipulator (AREA)
- Supply And Installment Of Electrical Components (AREA)
Abstract
本发明提供了一种基于SCARA机械手的相机标定和坐标变换的方法，该方法包括步骤：上下视相机的联合标定，采用自制的PCB板，利用已标定好的上视相机，进行下视相机的标定；过图校正过程中元件姿态的预处理，先计算目标元件的轮廓，保证元件的姿态与目标轮廓平行；关节旋转坐标变换，计算出关节旋转角度的大小，通过SCARA机械手的U轴来保证元件的姿态符合要求；吸嘴目标点的求取。本发明提供的技术方案可实现SCARA机械手的高精度定位，简化运动算法，降低了SCARA机械手的系统开发难度。
Description
技术领域
本发明涉及四轴机械手控制领域，具体地说是涉及SCARA机械手固定工作平面应用场景下的相机标定及运动过程中的坐标变换。
背景技术
随着工业化的不断发展，生产自动化水平越来越高，工业机器人应用到各个领域，大大提高了生产效率。目前，SCARA机械手在工业相机的视觉引导下和运动控制器的控制下可完成工件的高精度定位及装配。主要应用在工业生产流水线上，比如：PCB板上的具有规则完整平面元器件的贴装或插装、待加工工件的有序拾取并放置等。其主要完成工件的搬运和装配工作，同时，考虑到流水线上的协同作业，SCARA机械手的工作范围还具有可根据实际情况灵活调节的功能。
发明内容
本发明的目的是为了提供一种基于SCARA机械手在固定工作平面应用场景下的相机标定及运动过程中的坐标变换的方法，从而实现SCARA机械手的精确控制。
本发明及其技术问题所采用的技术方案是：
一种基于SCARA机械手的相机标定和坐标变换的方法，包括步骤：
(1)首先将上视相机固定安装在工作平面以下的平台上，然后将下视相机竖直固定安装在SCARA机械手的第二关节末端并与机械手坐标系、即世界坐标系的Z轴平行，此时下视相机可随机械手在工作范围内移动，要求位于机械手第三关节末端的吸嘴能够在上视相机中清晰成像；
(2)采用相机标定技术对上视相机进行标定，得到上视相机的参数矩阵H1；
(3)采用自制的PCB标定板，进行上下视的联合标定，得到下视相机的参数矩阵H2；
(4)计算此时下视相机标定位置的关节角度，通过坐标转换公式计算并记录此时吸嘴的世界坐标；
(5)下视相机成功标定之后，移动下视相机对PCB板上待贴装元件位置进行拍照，计算出待贴装元件的实际目标位置，包括元件中心、元件MARK点的世界坐标；
(6)移动下视相机拍照待贴装元件，通过坐标转换公式，计算待贴装元件的位置，并准确吸取；
(7)在机械手移动吸嘴成功吸取到规则元件(暂定为矩形贴片元件)之后，需要进行上视相机过图校正，运用图像处理算法，准确识别元件中心、元件MARK点并由标定算法获取两点的世界坐标；
(8)由步骤(5)和(7)，经过计算元件中心与元件MARK点组成的向量夹角，旋转U轴，保证元件姿态与目标位置平行；
(9)计算吸嘴在目标位置中的世界坐标，即让待贴装元件和目标位置重合；
(10)此时即可计算出目标位置点Z(xz,yz)的坐标，控制SCARA机械手的吸嘴移动到目标位置点Z(xz,yz)即可完成正确贴装。
进一步地，所述步骤(3)具体包括步骤：上、下相视对PCB标定板的上下两面同一位置拍照，由于上视相机已经标定成功，所以可利用上视相机得到标志点的世界坐标，并和下视相机所拍照图像中的标志点一起完成下视相机的标定，得到其参数矩阵H2。
进一步地，所述步骤(4)具体包括步骤：机械手在控制器的控制下进行移动拍照，由于机械手是关节型，关节的移动轨迹呈扇形，所以要准确获得此时图像中像点的世界坐标(xw,yw)，必须知道第一关节和第二关节的旋转角度α和β，实际使用的旋转角度δ是此时位置和下视相机标定位置时的关节角度之差，并折合到第二关节上，由于下视相机与吸嘴的距离固定，所以不管机械手怎么运动，下视相机所拍图像中同一位置的像点(xp,yp)与吸嘴(xm,ym)的距离也是固定的，并且像点和吸嘴的连线L与机械手第二关节的夹角(实际使用时还需考虑坐标象限)也是固定不变的；上述旋转折合到第二关节上关节角度γ和吸嘴的实时世界坐标(xm,ym)都可由机械手运动控制器的库函数输出得到，并由以下坐标转换公式，可得到机械手移动之后所拍图像中的像点(xp,yp)的世界坐标(xw,yw)：
进一步地，所述步骤(8)中，为了保证准确贴装，则待贴装元件必须和目标位置完全重合，这里首先保证待贴装元件的姿态和目标位置轮廓平行，由步骤(5)和(7)，可以得出由元件中心和元件MARK点的连线组成的两个向量，计算两向量的夹角η之后，控制SCARA机械手的U轴转动η，使待贴装元件的姿态和目标位置轮廓平行。
进一步地，所述步骤(9)中，由于元件吸取点与实际的元件中心有一定偏差，通过步骤(7)，可以得出由元件中心和吸嘴的连线组成的向量通过步骤(8)，已经保证了待贴装元件的姿态和目标位置轮廓平行，现假设有目标位置点Z(xz,yz)，当吸嘴移动到此位置，即可保证待贴装元件和目标位置重合，那么由步骤(5)中的元件中心与目标位置点Z(xz,yz)组成的向量可以使得且
进一步地，所述步骤(10)中，所述SCARA机械手转动关节移动过程中，只要得到了关节旋转折合到第二关节上的旋转角度δ，控制SCARA机械手的U轴反向转动δ即可始终保证待贴装元件的姿态和目标位置轮廓平行，即完成正确贴装。
本发明提出的技术方案具有以下有益效果：
本发明的新颖之处体现在下视相机的标定上，采用自制的PCB标定板，上、下视联合标定，然后SCARA机械手属于多关节型机械手，它的移动过程涉及到关节旋转角度的变化，本技术方案给出了一套完整的坐标转换解决办法。并且针对元件中心的吸取偏差也给出了相应的解决办法。因此本发明可以实现基于SCARA机械手对元件的准确吸取和高精度贴装，可广泛应用在基于SCARA机械手的工件装配、视觉测量、平面定位之中。
附图说明
下面结合附图和实施例对本发明作进一步说明。
图1是本发明的实施例提供的基于SCARA机械手的相机标定和坐标转换方法的流程图。
图2是过图校正的示意图。
图3是下视相机标定在移动过程中的坐标变换示意图。
具体实施方式
下面结合附图和具体实施例对本发明的发明目的作进一步详细地描述，实施例不能在此一一赘述，但本发明的实施方式并不因此限定于以下实施例。
如图1所示，一种基于SCARA机械手的相机标定和坐标变换的方法，包括步骤：
步骤S1：首先将上视相机固定安装在工作平面以下的平台上，然后将下视相机竖直固定安装在SCARA机械手的第二关节末端并与机械手坐标系、即世界坐标系的Z轴平行，此时下视相机可随机械手在工作范围内移动，要求位于机械手第三关节末端的吸嘴能够在上视相机中清晰成像。
步骤S2：采用相机标定技术对上视相机进行标定，得到上视相机的参数矩阵H1。
步骤S3：采用自制的PCB标定板，进行上下视的联合标定，即上、下视相机对着PCB上下两面同一块区域拍照，由于上视相机已标定好，可利用上视相机得到PCB标志点的世界坐标，并和下视相机所拍照图像中的标志点一起完成下视相机的标定，得到下视相机的参数矩阵H2。
步骤S4：计算此时下视相机标定位置的关节角度，并记录此时吸嘴的世界坐标，即机械手在控制器的控制下进行移动拍照，由于机械手是关节型，关节的移动轨迹呈扇形，所以要准确获得此时图像中像点的世界坐标(xw,yw)，必须知道第一关节和第二关节的旋转角度α和β，实际使用的旋转角度δ是此时位置和下视相机标定位置时的关节角度之差，并折合到第二关节上，由于下视相机与吸嘴的距离固定，所以不管机械手怎么运动，下视相机所拍图像中同一位置的像点(xp,yp)与吸嘴(xm,ym)的距离也是固定的，并且像点和吸嘴的连线L与机械手第二关节的夹角(实际使用时还需考虑坐标象限)也是固定不变的；上述旋转折合到第二关节上关节角度γ和吸嘴的实时世界坐标(xm,ym)都可由机械手运动控制器的库函数输出得到，并由以下坐标转换公式(18)，可得到机械手移动之后所拍图像中的像点(xp,yp)的世界坐标(xw,yw)。
步骤S5：获取元件中心、元件MARK点的世界坐标,即下视相机成功标定之后，移动下视相机对PCB板上待贴装元件位置进行拍照，计算出待贴装元件的实际目标位置,包括元件中心、元件MARK点的世界坐标。
步骤S6：移动下视相机拍照待贴装元件，通过坐标转换公式，计算待贴装元件的位置，并准确吸取。
步骤S7：识别元件中心、元件MARK点并由标定算法获取两点的世界坐标，即在机械手移动吸嘴成功吸取到规则元件(暂定为矩形贴片元件)之后，需要进行上视相机过图校正，运用图像处理算法，可以准确识别元件中心、元件MARK点并由标定算法获取两点的世界坐标。
步骤S8：由步骤(5)和(7)，经过计算元件中心与元件MARK点组成的向量夹角，旋转U轴，保证元件姿态与目标位置平行，为了保证准确贴装，则待贴装元件必须和目标位置完全重合。这里首先保证待贴装元件的姿态和目标位置轮廓平行，由步骤(5)和(7)，可以得出由元件中心和元件MARK点的连线组成的两个向量，计算两向量的夹角η之后，控制SCARA机械手的U轴转动η，使待贴装元件的姿态和目标位置轮廓平行。
步骤S9：计算吸嘴在目标位置中的坐标，即让待贴装元件和目标位置重合，由于元件吸取点与实际的元件中心有一定偏差，通过步骤(7)，可以得出由元件中心和吸嘴的连线组成的向量通过步骤(8)，已经保证了待贴装元件的姿态和目标位置轮廓平行，现假设有目标位置点Z(xz,yz)，当吸嘴移动到此位置，即可保证待贴装元件和目标位置重合，那么由步骤(5)中的元件中心与目标位置点Z(xz,yz)组成的向量可以使得且
步骤S10：SCARA机械手移动到目标点Z(xz,yz)，并在后续的SCARA机械手转动关节移动过程中，只要得到了关节旋转折合到第二关节上的旋转角度δ，控制SCARA机械手的U轴反向转动δ即可始终保证待贴装元件的姿态和目标位置轮廓平行，从而完成贴装。
图2是过图校正的示意图，下面对在机械手移动过程中的不同位置涉及到的坐标转换加以阐述：
图2中涉及4个不同位置P0、P1、P2、P3(由元件的角点Mp标识)。
在P3处(目标位置)时：
由摄像头可得坐标并得到向量
在P0处(校准位置)时：
由摄像头可得坐标，吸取点B(xB,yB)，并得到向量
进而求解出与的夹角θ：
然后判断旋转角θ的方向，利用和的向量积，可得
此时：
若式(2)>0，则U轴逆时针旋转θ；
若式(2)<0，则U轴顺时针旋转θ；
在P1处时：
由摄像头可得坐标可得向量和模
由平行且相等可得如下等式：
由(3)，(4)解得B'点坐标：
由上式可得出关于B'点的4组解，对其进行分类讨论：
若的横坐标则xB'取+(“+”指的是xB'表达式中的根式前取“+”)。(下同)
若的横坐标则xB'取-。
若的纵坐标则yB'取+。
若的纵坐标则yB'取-。
在P2处时：
由图2所示，在从P1移动到P2的过程中，由关节转动可得：
α0+α1+α2＝δ (7)
其中关节J1和J2转动的α0，α1，α2，可由机械手本体自带的库函数获得。
图3为下视相机标定在移动过程中的坐标变换示意图。
如图3所示，其中J1和J2为可自由移动的转轴。o-xy为不考虑Z方向时的齐次世界坐标系XY。l1、l2、l3、l4为辅助线，平行于o-xy的x轴。P1和P2为机械臂的两个位置。U1和U2为像素坐标对应的世界坐标的位置。L1和L2分别为U1和U2到吸嘴中心的连线长度。
由摄像机和机器人末端的相对位置X不变，我们可以知道L1和L2对应的直线和J2的夹角应该保持不变即：
β1＝β2 (8)
我们通过分析，工作平面上的点都在同一水平面下，当机器人末端带着摄像机在XY方向上平移运动时，由小孔成像的基本原理我们可知，图像坐标中的两个像素点在对应的世界坐标中的距离是保持不变的。从而由摄像机和机器人末端的相对位置保持不变的条件下，图像坐标中的标志点对应的世界坐标和机器人末端吸嘴中心的距离是恒定不变的即：
L1＝L2 (9)
L1：为U1到吸嘴中心的连线长度；L2：为U2到吸嘴中心的连线长度。
如图3所示，我们在机器人末端的P1位置对小臂相机CCD2进行固定相机的标定。由于工作平面在同一水平面，且摄像机光轴垂直于工作平面，所以在世界坐标系下，任意标志点P的zw＝0。在这种情况下，世界坐标系与摄像机坐标系是平行平面的对应关系，因此其模型可以简化，摄像机外参数矩阵的旋转部分退化为平面旋转，且我们在固定的工作平面内不关心Z向的变化。从而我们可以利用前面固定相机的标定方法，求出图像坐标与不考虑Z方向时的齐次世界坐标的关系矩阵H。
假设当机器人末端带着摄像机在XY方向上平移运动到了P2位置，在拍摄的图像中有一点U2其像素坐标为(u1,v1)，对应在P1位置的相同像素坐标点为U1。我们可以通过关系矩阵H获得在U1处的世界坐标，公式如下：
而吸嘴中心坐标(x1,y1)可以通过控制器获得，这样通过获得U1对应的世界坐标为(xp1,yp1)从而可以算出L1和α1：
其中：
当xp1-x1<0时，
当xp1-x1>0时，
由l1、l2平行，所以可以得到如下公式：
β1＝π-θ1+α1 (13)
而θ1可以通过机械臂获得：
同理可得
β2＝π-θ2+α2 (14)
由(8)式可得：
α2＝θ2-θ1+α1 (15)
在P2位置时吸嘴中心坐标为(x2,y2)可以通过控制器获得，U2对应的世界坐标为(xp2,yp2)。由L2和α2分别为直角三角形中的斜边和夹角可知(xp2,yp2)：
xp2＝x2+L2×sin(α2) (16)
yp2＝y2+L2×cos(α2) (17)
由(15)、(16)和(17)可以得到如下式：
式中：
(x1,y1)：下视相机标定位置时的吸嘴中心坐标；
(x2,y2)：P2位置时的吸嘴中心坐标；
(xp1,yp1)：U1对应的世界坐标；
(xp2,yp2)：U2对应的世界坐标。
本发明的上述实施例仅仅是为清楚地说明本发明所作的举例，而并非是对本发明的实施方式的限定。对于所属领域的普通技术人员来说，在上述说明的基础上还可以做出其它不同形式的变化或变动。这里无需也无法对所有的实施方式予以穷举。凡在本发明的精神和原则之内所作的任何修改、等同替换和改进等，均应包含在本发明权利要求的保护范围之内。
Claims (6)
1.一种基于SCARA机械手的相机标定和坐标变换的方法，其特征在于，包括步骤：
(1)首先将上视相机固定安装在工作平面以下的平台上，然后将下视相机竖直固定安装在SCARA机械手的第二关节末端并与机械手坐标系、即世界坐标系的Z轴平行，此时下视相机可随机械手在工作范围内移动，要求位于机械手第三关节末端的吸嘴能够在上视相机中清晰成像；
(2)采用相机标定技术对上视相机进行标定，得到上视相机的参数矩阵H1；
(3)采用自制的PCB标定板，进行上下视的联合标定，得到下视相机的参数矩阵H2；
(4)计算此时下视相机标定位置的关节角度，通过坐标转换公式计算并记录此时吸嘴的世界坐标；
(5)下视相机成功标定之后，移动下视相机对PCB板上待贴装元件位置进行拍照，计算出待贴装元件的实际目标位置，包括元件中心、元件MARK点的世界坐标；
(6)移动下视相机拍照待贴装元件，通过坐标转换公式，计算待贴装元件的位置，并准确吸取；
(7)在机械手移动吸嘴成功吸取到规则元件之后，需要进行上视相机过图校正，运用图像处理算法，准确识别元件中心、元件MARK点并由标定算法获取两点的世界坐标；
(8)由步骤(5)和(7)，经过计算元件中心与元件MARK点组成的向量夹角，旋转U轴，保证元件姿态与目标位置平行；
(9)计算吸嘴在目标位置中的世界坐标，即让待贴装元件和目标位置重合；
(10)此时即可计算出目标位置点Z(xz,yz)的坐标，控制SCARA机械手的吸嘴移动到目标位置点Z(xz,yz)即可完成正确贴装。
2.根据权利要求1所述的基于SCARA机械手的相机标定和坐标变换的方法，其特征在于：所述步骤(3)具体包括步骤：上、下相视对PCB标定板的上下两面同一位置拍照，由于上视相机已经标定成功，所以可利用上视相机得到标志点的世界坐标，并和下视相机所拍照图像中的标志点一起完成下视相机的标定，得到其参数矩阵H2。
3.根据权利要求1所述的基于SCARA机械手的相机标定和坐标变换的方法，其特征在于：所述步骤(4)具体包括步骤：机械手在控制器的控制下进行移动拍照；由于机械手是关节型，关节的移动轨迹呈扇形，所以要准确获得此时图像中像点的世界坐标(xw,yw)，必须知道第一关节和第二关节的旋转角度α和β，实际使用的旋转角度δ是此时位置和下视相机标定位置时的关节角度之差，并折合到第二关节上，由于下视相机与吸嘴的距离固定，所以不管机械手怎么运动，下视相机所拍图像中同一位置的像点(xp,yp)与吸嘴(xm,ym)的距离也是固定的，并且像点和吸嘴的连线L与机械手第二关节的夹角(实际使用时还需考虑坐标象限)也是固定不变的；上述旋转折合到第二关节上关节角度γ和吸嘴的实时世界坐标(xm,ym)都可由机械手运动控制器的库函数输出得到，并由以下坐标转换公式，可得到机械手移动之后所拍图像中的像点(xp,yp)的世界坐标(xw,yw)：
<mrow>
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>y</mi>
<mrow>
<mi>p</mi>
<mn>2</mn>
</mrow>
</msub>
<mo>=</mo>
<msub>
<mi>y</mi>
<mrow>
<mi>m</mi>
<mn>2</mn>
</mrow>
</msub>
<mo>+</mo>
<msqrt>
<mrow>
<msup>
<mrow>
<mo>(</mo>
<msub>
<mi>x</mi>
<mrow>
<mi>m</mi>
<mn>1</mn>
</mrow>
</msub>
<mo>-</mo>
<msub>
<mi>x</mi>
<mrow>
<mi>p</mi>
<mn>1</mn>
</mrow>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
<mo>+</mo>
<msup>
<mrow>
<mo>(</mo>
<msub>
<mi>y</mi>
<mrow>
<mi>m</mi>
<mn>1</mn>
</mrow>
</msub>
<mo>-</mo>
<msub>
<mi>y</mi>
<mrow>
<mi>p</mi>
<mn>1</mn>
</mrow>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
</mrow>
</msqrt>
<mo>&times;</mo>
<mi>sin</mi>
<mrow>
<mo>(</mo>
<mo>(</mo>
<mrow>
<mi>&gamma;</mi>
<mo>+</mo>
<mi>arctan</mi>
<mrow>
<mo>(</mo>
<mfrac>
<mrow>
<msub>
<mi>x</mi>
<mrow>
<mi>m</mi>
<mn>1</mn>
</mrow>
</msub>
<mo>-</mo>
<msub>
<mi>x</mi>
<mrow>
<mi>p</mi>
<mn>1</mn>
</mrow>
</msub>
</mrow>
<mrow>
<msub>
<mi>y</mi>
<mrow>
<mi>m</mi>
<mn>1</mn>
</mrow>
</msub>
<mo>-</mo>
<msub>
<mi>y</mi>
<mrow>
<mi>p</mi>
<mn>1</mn>
</mrow>
</msub>
</mrow>
</mfrac>
<mo>)</mo>
</mrow>
</mrow>
<mo>)</mo>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>x</mi>
<mrow>
<mi>p</mi>
<mn>2</mn>
</mrow>
</msub>
<mo>=</mo>
<msub>
<mi>x</mi>
<mrow>
<mi>m</mi>
<mn>2</mn>
</mrow>
</msub>
<mo>+</mo>
<msqrt>
<mrow>
<msup>
<mrow>
<mo>(</mo>
<msub>
<mi>x</mi>
<mrow>
<mi>m</mi>
<mn>1</mn>
</mrow>
</msub>
<mo>-</mo>
<msub>
<mi>x</mi>
<mrow>
<mi>p</mi>
<mn>1</mn>
</mrow>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
<mo>+</mo>
<msup>
<mrow>
<mo>(</mo>
<msub>
<mi>y</mi>
<mrow>
<mi>m</mi>
<mn>1</mn>
</mrow>
</msub>
<mo>-</mo>
<msub>
<mi>y</mi>
<mrow>
<mi>p</mi>
<mn>1</mn>
</mrow>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
</mrow>
</msqrt>
<mo>&times;</mo>
<mi>cos</mi>
<mrow>
<mo>(</mo>
<mo>(</mo>
<mrow>
<mi>&gamma;</mi>
<mo>+</mo>
<mi>arctan</mi>
<mrow>
<mo>(</mo>
<mfrac>
<mrow>
<msub>
<mi>x</mi>
<mrow>
<mi>m</mi>
<mn>1</mn>
</mrow>
</msub>
<mo>-</mo>
<msub>
<mi>x</mi>
<mrow>
<mi>p</mi>
<mn>1</mn>
</mrow>
</msub>
</mrow>
<mrow>
<msub>
<mi>y</mi>
<mrow>
<mi>m</mi>
<mn>1</mn>
</mrow>
</msub>
<mo>-</mo>
<msub>
<mi>y</mi>
<mrow>
<mi>p</mi>
<mn>1</mn>
</mrow>
</msub>
</mrow>
</mfrac>
<mo>)</mo>
</mrow>
</mrow>
<mo>)</mo>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
</mtable>
<mo>.</mo>
</mrow>
4.根据权利要求1所述的基于SCARA机械手的相机标定和坐标变换的方法，其特征在于：所述步骤(8)中，为了保证准确贴装，则待贴装元件必须和目标位置完全重合，这里首先保证待贴装元件的姿态和目标位置轮廓平行，由步骤(5)和(7)，可以得出由元件中心和元件MARK点的连线组成的两个向量，计算两向量的夹角η之后，控制SCARA机械手的U轴转动η，使待贴装元件的姿态和目标位置轮廓平行。
5.根据权利要求1所述的基于SCARA机械手的相机标定和坐标变换的方法，其特征在于：所述步骤(9)中，由于元件吸取点与实际的元件中心有一定偏差，通过步骤(7)，可以得出由元件中心和吸嘴的连线组成的向量通过步骤(8)，已经保证了待贴装元件的姿态和目标位置轮廓平行，现假设有目标位置点Z(xz,yz)，当吸嘴移动到此位置，即可保证待贴装元件和目标位置重合，那么由步骤(5)中的元件中心与目标位置点Z(xz,yz)组成的向量可以使得且
6.根据权利要求1所述的基于SCARA机械手的相机标定和坐标变换的方法，其特征在于：所述步骤(10)中，所述SCARA机械手转动关节移动过程中，只要得到了关节旋转折合到第二关节上的旋转角度δ，控制SCARA机械手的U轴反向转动δ即可始终保证待贴装元件的姿态和目标位置轮廓平行，即完成正确贴装。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201710535960.1A CN107160380B (zh) | 2017-07-04 | 2017-07-04 | 一种基于scara机械手的相机标定和坐标变换的方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201710535960.1A CN107160380B (zh) | 2017-07-04 | 2017-07-04 | 一种基于scara机械手的相机标定和坐标变换的方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN107160380A true CN107160380A (zh) | 2017-09-15 |
| CN107160380B CN107160380B (zh) | 2021-01-19 |
Family
ID=59818393
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201710535960.1A Expired - Fee Related CN107160380B (zh) | 2017-07-04 | 2017-07-04 | 一种基于scara机械手的相机标定和坐标变换的方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN107160380B (zh) |
Cited By (16)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN108582037A (zh) * | 2018-04-02 | 2018-09-28 | 深圳市策维科技有限公司 | 一种通过两个相机跟机器人配合实现精密贴合的方法 |
| CN109146979A (zh) * | 2018-08-01 | 2019-01-04 | 苏州乐佰图信息技术有限公司 | 用于补偿机械手走位偏差的方法 |
| CN109287077A (zh) * | 2018-10-17 | 2019-01-29 | 华南理工大学 | 一种电子元件插装方法和装置 |
| CN110614635A (zh) * | 2019-08-31 | 2019-12-27 | 武汉弗雷德斯科技发展有限公司 | 一种scara机器人运动学参数的辨识方法 |
| CN111098306A (zh) * | 2019-12-31 | 2020-05-05 | 广东利元亨智能装备股份有限公司 | 机器人的标定方法、装置、机器人和存储介质 |
| CN111823230A (zh) * | 2020-06-19 | 2020-10-27 | 山东科技大学 | 一种基于Scara机器人的非固定式手眼关系标定方法 |
| WO2020252632A1 (zh) * | 2019-06-17 | 2020-12-24 | 西门子（中国）有限公司 | 一种坐标系校准方法、装置和计算机可读介质 |
| CN112232015A (zh) * | 2020-10-30 | 2021-01-15 | 北京华维国创电子科技有限公司 | 一种基于多点标记的pcb元件坐标精准导入算法 |
| CN112720457A (zh) * | 2020-12-03 | 2021-04-30 | 深圳众为兴技术股份有限公司 | 机器人标定方法、装置、电子设备及存储介质 |
| CN112802122A (zh) * | 2021-01-21 | 2021-05-14 | 珠海市运泰利自动化设备有限公司 | 机器人视觉引导组装方法 |
| CN112967343A (zh) * | 2021-01-20 | 2021-06-15 | 深圳视觉龙智能传感器有限公司 | 一种实现2d相机引导2.5d贴装的算法 |
| CN113610919A (zh) * | 2021-07-30 | 2021-11-05 | 深圳明锐理想科技有限公司 | 一种粘尘装置的姿态校正方法和粘尘装置的姿态校正系统 |
| CN114326739A (zh) * | 2021-12-30 | 2022-04-12 | 杭州蓝芯科技有限公司 | 一种高精度amr下料方法以及amr车 |
| CN114571221A (zh) * | 2020-12-01 | 2022-06-03 | 福建星网元智科技有限公司 | 一种自动校点的自动化系统及其自动校点方法 |
| CN114872038A (zh) * | 2022-04-13 | 2022-08-09 | 欣旺达电子股份有限公司 | 微针扣合视觉自校准系统及其校准方法 |
| CN117103286A (zh) * | 2023-10-25 | 2023-11-24 | 杭州汇萃智能科技有限公司 | 一种机械手手眼标定方法、系统和可读存储介质 |
Citations (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2011177845A (ja) * | 2010-03-02 | 2011-09-15 | Seiko Epson Corp | ロボットのキャリブレーション方法及びロボット用キャリブレーション装置 |
| CN103679693A (zh) * | 2013-01-25 | 2014-03-26 | 杭州先临三维科技股份有限公司 | 一种多相机单视图标定装置及其标定方法 |
| JP2015212000A (ja) * | 2014-05-07 | 2015-11-26 | セイコーエプソン株式会社 | ロボット及びロボットの調整方法 |
| CN105427289A (zh) * | 2015-11-11 | 2016-03-23 | 厦门欣力巨软件有限公司 | 一种机器人贴片应用ccd视觉对位算法 |
| CN105451461A (zh) * | 2015-11-25 | 2016-03-30 | 四川长虹电器股份有限公司 | 基于scara机器人的pcb板定位方法 |
-
2017
- 2017-07-04 CN CN201710535960.1A patent/CN107160380B/zh not_active Expired - Fee Related
Patent Citations (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2011177845A (ja) * | 2010-03-02 | 2011-09-15 | Seiko Epson Corp | ロボットのキャリブレーション方法及びロボット用キャリブレーション装置 |
| CN103679693A (zh) * | 2013-01-25 | 2014-03-26 | 杭州先临三维科技股份有限公司 | 一种多相机单视图标定装置及其标定方法 |
| JP2015212000A (ja) * | 2014-05-07 | 2015-11-26 | セイコーエプソン株式会社 | ロボット及びロボットの調整方法 |
| CN105427289A (zh) * | 2015-11-11 | 2016-03-23 | 厦门欣力巨软件有限公司 | 一种机器人贴片应用ccd视觉对位算法 |
| CN105451461A (zh) * | 2015-11-25 | 2016-03-30 | 四川长虹电器股份有限公司 | 基于scara机器人的pcb板定位方法 |
Non-Patent Citations (1)
| Title |
|---|
| 张皓钧: "SCARA机器人运动学参数与视觉标定研究", 《中国优秀硕士学位论文全文数据库 信息科技辑》 * |
Cited By (28)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN108582037A (zh) * | 2018-04-02 | 2018-09-28 | 深圳市策维科技有限公司 | 一种通过两个相机跟机器人配合实现精密贴合的方法 |
| CN108582037B (zh) * | 2018-04-02 | 2021-08-03 | 深圳市策维软件技术有限公司 | 一种通过两个相机跟机器人配合实现精密贴合的方法 |
| CN109146979A (zh) * | 2018-08-01 | 2019-01-04 | 苏州乐佰图信息技术有限公司 | 用于补偿机械手走位偏差的方法 |
| CN109146979B (zh) * | 2018-08-01 | 2022-02-01 | 苏州乐佰图信息技术有限公司 | 用于补偿机械手走位偏差的方法 |
| CN109287077A (zh) * | 2018-10-17 | 2019-01-29 | 华南理工大学 | 一种电子元件插装方法和装置 |
| CN109287077B (zh) * | 2018-10-17 | 2024-04-05 | 华南理工大学 | 一种电子元件插装方法和装置 |
| US11820024B2 (en) | 2019-06-17 | 2023-11-21 | Siemens Ltd., China | Coordinate system calibration method, device, and computer readable medium |
| WO2020252632A1 (zh) * | 2019-06-17 | 2020-12-24 | 西门子（中国）有限公司 | 一种坐标系校准方法、装置和计算机可读介质 |
| CN113613850B (zh) * | 2019-06-17 | 2022-08-12 | 西门子（中国）有限公司 | 一种坐标系校准方法、装置和计算机可读介质 |
| CN113613850A (zh) * | 2019-06-17 | 2021-11-05 | 西门子（中国）有限公司 | 一种坐标系校准方法、装置和计算机可读介质 |
| CN110614635A (zh) * | 2019-08-31 | 2019-12-27 | 武汉弗雷德斯科技发展有限公司 | 一种scara机器人运动学参数的辨识方法 |
| CN111098306A (zh) * | 2019-12-31 | 2020-05-05 | 广东利元亨智能装备股份有限公司 | 机器人的标定方法、装置、机器人和存储介质 |
| CN111823230A (zh) * | 2020-06-19 | 2020-10-27 | 山东科技大学 | 一种基于Scara机器人的非固定式手眼关系标定方法 |
| CN111823230B (zh) * | 2020-06-19 | 2022-01-07 | 山东科技大学 | 一种基于Scara机器人的非固定式手眼关系标定方法 |
| CN112232015A (zh) * | 2020-10-30 | 2021-01-15 | 北京华维国创电子科技有限公司 | 一种基于多点标记的pcb元件坐标精准导入算法 |
| CN114571221A (zh) * | 2020-12-01 | 2022-06-03 | 福建星网元智科技有限公司 | 一种自动校点的自动化系统及其自动校点方法 |
| CN112720457A (zh) * | 2020-12-03 | 2021-04-30 | 深圳众为兴技术股份有限公司 | 机器人标定方法、装置、电子设备及存储介质 |
| CN112967343A (zh) * | 2021-01-20 | 2021-06-15 | 深圳视觉龙智能传感器有限公司 | 一种实现2d相机引导2.5d贴装的算法 |
| CN112802122B (zh) * | 2021-01-21 | 2023-08-29 | 珠海市运泰利自动化设备有限公司 | 机器人视觉引导组装方法 |
| CN112802122A (zh) * | 2021-01-21 | 2021-05-14 | 珠海市运泰利自动化设备有限公司 | 机器人视觉引导组装方法 |
| CN113610919A (zh) * | 2021-07-30 | 2021-11-05 | 深圳明锐理想科技有限公司 | 一种粘尘装置的姿态校正方法和粘尘装置的姿态校正系统 |
| CN113610919B (zh) * | 2021-07-30 | 2023-10-20 | 深圳明锐理想科技有限公司 | 一种粘尘装置的姿态校正方法和粘尘装置的姿态校正系统 |
| CN114326739A (zh) * | 2021-12-30 | 2022-04-12 | 杭州蓝芯科技有限公司 | 一种高精度amr下料方法以及amr车 |
| CN114326739B (zh) * | 2021-12-30 | 2023-10-31 | 杭州蓝芯科技有限公司 | 一种高精度amr下料方法以及amr车 |
| CN114872038A (zh) * | 2022-04-13 | 2022-08-09 | 欣旺达电子股份有限公司 | 微针扣合视觉自校准系统及其校准方法 |
| CN114872038B (zh) * | 2022-04-13 | 2023-12-01 | 欣旺达电子股份有限公司 | 微针扣合视觉自校准系统及其校准方法 |
| CN117103286B (zh) * | 2023-10-25 | 2024-03-19 | 杭州汇萃智能科技有限公司 | 一种机械手手眼标定方法、系统和可读存储介质 |
| CN117103286A (zh) * | 2023-10-25 | 2023-11-24 | 杭州汇萃智能科技有限公司 | 一种机械手手眼标定方法、系统和可读存储介质 |
Also Published As
| Publication number | Publication date |
|---|---|
| CN107160380B (zh) | 2021-01-19 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN107160380A (zh) | 一种基于scara机械手的相机标定和坐标变换的方法 | |
| CN110276806B (zh) | 用于四自由度并联机器人立体视觉手眼系统的在线手眼标定和抓取位姿计算方法 | |
| CN106426172B (zh) | 一种工业机器人工具坐标系的标定方法与系统 | |
| CN105014677B (zh) | 基于Camshift视觉跟踪和D-H建模算法的视觉机械臂控制方法 | |
| CN109859275B (zh) | 一种基于s-r-s结构的康复机械臂的单目视觉手眼标定方法 | |
| CN111801198B (zh) | 一种手眼标定方法、系统及计算机存储介质 | |
| CN110666798B (zh) | 一种基于透视变换模型的机器人视觉标定方法 | |
| CN107883929B (zh) | 基于多关节机械臂的单目视觉定位装置及方法 | |
| CN111862221B (zh) | Uvw平台标定方法、设备、纠偏方法、装置及对位系统 | |
| CN109658460A (zh) | 一种机械臂末端相机手眼标定方法和系统 | |
| CN109591011A (zh) | 复合材料三维结构件单边缝合激光视觉路径自动跟踪方法 | |
| CN109397249A (zh) | 基于视觉识别的二维码定位抓取机器人系统算法 | |
| CN110253574B (zh) | 一种多任务机械臂位姿检测和误差补偿方法 | |
| CN104552341B (zh) | 移动工业机器人单点多视角挂表位姿误差检测方法 | |
| CN204585232U (zh) | 抓取在线工件的机器人位姿及运动轨迹定位系统 | |
| CN114643578B (zh) | 一种提高机器人视觉引导精度的标定装置及方法 | |
| CN109442171A (zh) | 一种单目立体视觉系统及其使用方法 | |
| CN106737859A (zh) | 基于不变平面的传感器与机器人的外部参数标定方法 | |
| Lopez-Nicolas et al. | Visual control for multirobot organized rendezvous | |
| CN112454366A (zh) | 一种手眼标定方法 | |
| CN112109072B (zh) | 一种大型稀疏特征托盘精确6d位姿测量和抓取方法 | |
| CN114842090A (zh) | 基于精密角度基准的视觉惯性标定系统及其标定方法 | |
| CN110039548A (zh) | 一种拼装机控制方法、装置及设备 | |
| Sato et al. | High-speed catching by multi-vision robot hand | |
| CN114378827B (zh) | 一种基于移动机械臂整体控制的动态目标跟踪抓取方法 |
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 | ||
| CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20210119 |