KR20110019011A - Calibration method and calibration jig between robot tcp and lvs - Google Patents

Calibration method and calibration jig between robot tcp and lvs Download PDF

Info

Publication number
KR20110019011A
KR20110019011A KR1020090076543A KR20090076543A KR20110019011A KR 20110019011 A KR20110019011 A KR 20110019011A KR 1020090076543 A KR1020090076543 A KR 1020090076543A KR 20090076543 A KR20090076543 A KR 20090076543A KR 20110019011 A KR20110019011 A KR 20110019011A
Authority
KR
South Korea
Prior art keywords
lvs
tcp
calibration jig
calibration
laser
Prior art date
Application number
KR1020090076543A
Other languages
Korean (ko)
Other versions
KR101094313B1 (en
Inventor
조영식
민지호
김동호
최성
김수호
강계형
Original Assignee
대우조선해양 주식회사
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by 대우조선해양 주식회사 filed Critical 대우조선해양 주식회사
Priority to KR1020090076543A priority Critical patent/KR101094313B1/en
Publication of KR20110019011A publication Critical patent/KR20110019011A/en
Application granted granted Critical
Publication of KR101094313B1 publication Critical patent/KR101094313B1/en

Links

Images

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/10—Programme-controlled manipulators characterised by positioning means for manipulator elements
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J13/00—Controls for manipulators
    • B25J13/08—Controls for manipulators by means of sensing devices, e.g. viewing or touching devices
    • 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/0025—Means for supplying energy to the end effector
    • 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/02—Sensing devices
    • B25J19/021—Optical sensing devices
    • B25J19/022—Optical sensing devices using lasers
    • 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
    • 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/1602—Programme controls characterised by the control system, structure, architecture
    • B25J9/161—Hardware, e.g. neural networks, fuzzy logic, interfaces, processor
    • 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/1679—Programme controls characterised by the tasks executed
    • B25J9/1692—Calibration of manipulator
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01R—MEASURING ELECTRIC VARIABLES; MEASURING MAGNETIC VARIABLES
    • G01R35/00—Testing or calibrating of apparatus covered by the other groups of this subclass
    • G01R35/005—Calibrating; Standards or reference devices, e.g. voltage or resistance standards, "golden" references
    • G01R35/007—Standards or reference devices, e.g. voltage or resistance standards, "golden references"
    • G—PHYSICS
    • G06—COMPUTING; CALCULATING OR COUNTING
    • G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T7/00—Image analysis
    • G06T7/80—Analysis of captured images to determine intrinsic or extrinsic camera parameters, i.e. camera calibration
    • H—ELECTRICITY
    • H04—ELECTRIC COMMUNICATION TECHNIQUE
    • H04W—WIRELESS COMMUNICATION NETWORKS
    • H04W24/00—Supervisory, monitoring or testing arrangements
    • H04W24/06—Testing, supervising or monitoring using simulated traffic

Abstract

PURPOSE: A calibration method and calibration jig between robot TCP and LVS is provided to reduce the cost and time for calibration by performing precision calibration regardless of the mechanical deformation of a LVS or a LVS jig. CONSTITUTION: A calibration jig between robot TCP and LVS comprises a laser flat angle measurement plate(1), a scale(2), a height control lever(3), a joint(4) and a LVS monitor(5). The laser flat angle measurement plate is vertically formed on the bottom surface of a calibration jig. The height control lever controls the height of the calibration jig.

Description

로봇 ＴＣＰ와 ＬＶＳ 사이의 캘리브레이션 방법 및 캘리브레이션 지그{Calibration Method and Calibration Jig Between Robot TCP and LVS}Calibration Method and Calibration Jig Between Robot TCP and LVS}

본 발명은 로봇과 LVS(Laser Vision System) 사이의 캘리브레이션 방법 및 캘리브레이션 지그에 관한 것으로서, 특히, 기존의 캘리브레이션을 수행할 경우에는 로봇 좌표계와 LVS 좌표계 사이의 회전 각도를 가정하게 되는데, 가정값의 오차로 인해 캘리브레이션이 오차를 가지게 되고, 로봇 추적 성능이 저하된다. 따라서 오차를 적게 유지하기 위해 LVS 혹은 LVS 지그의 제작 및 유지 보수에 많은 비용을 들이거나, 발생한 오차를 보정하기 위해 반복적인 시행착오 과정을 거치게 되는데, 본 발명에서는 로봇 좌표계와 LVS 좌표계 사이의 위치 정보와 함께 회전 각도를 측정할 수 있는 캘리브레이션 지그와 방법을 제공하여, LVS나 LVS 지그의 정밀도나 사용 중에 발생한 기구적 변형에 무관하게 정밀한 캘리브레이션을 수행할 수 있도록 함으로써 캘리브레이션에 소요되는 비용과 시간을 줄일 수 있도록 한 로봇 TCP(Tool Center Point)와 LVS 사이의 캘리브레이션 방법 및 캘리브레이션 지그에 관한 것이다. The present invention relates to a calibration method and a calibration jig between a robot and a laser vision system (LVS). In particular, when performing an existing calibration, a rotation angle between the robot coordinate system and the LVS coordinate system is assumed. This results in calibration errors and reduces robot tracking performance. Therefore, in order to keep the error small, the LVS or LVS jig is expensive to manufacture and maintain, or iterative trial and error process to correct the error, the present invention, the position information between the robot coordinate system and LVS coordinate system And the calibration jig and method to measure the angle of rotation, enabling precise calibration regardless of the accuracy of the LVS or LVS jig or mechanical deformation during use, reducing the cost and time required for calibration. The present invention relates to a calibration method and a calibration jig between a robot Tool Center Point (TCP) and LVS.

로봇이 비정규화된 작업라인을 추적하기 위해 LVS를 로봇에 부착하여 사용할 수 있다. LVS가 측정한 위치를 로봇이 추적하기 위해서는 LVS 기준의 값을 로봇 기준으로 변환하는 과정이 필요한데, 이를 위해 로봇 좌표계와 LVS 좌표계 사이의 각도 관계와 위치 관계가 정의되어 있어야 한다. 이와 같이 로봇 좌표계와 LVS 좌표계사이의 회전 각도(△α, △β, △γ)와 위치(△x, △y, △z)를 정의하는 과정을 로봇과 LVS사이의 캘리브레이션이라고 한다. LVS can be attached to the robot and used to track denormalized worklines. In order for the robot to track the position measured by the LVS, a process of converting the LVS reference value to the robot reference is required. For this purpose, an angle relationship and a position relationship between the robot coordinate system and the LVS coordinate system must be defined. As such, the process of defining the rotation angles (Δα, Δβ, Δγ) and positions (Δx, Δy, Δz) between the robot coordinate system and the LVS coordinate system is called calibration between the robot and the LVS.

기존의 캘리브레이션 방법에서는 위치와 관련된 정보만을 측정할 수 있는 지그를 사용한다. 회전 각도는 가정하고, 이 가정 값과 지그를 이용해 획득한 정보를 이용하여 두 좌표계 사이의 위치를 계산하게 된다. 따라서 가정한 회전 각도에 오차가 있을 경우에는 정밀한 캘리브레이션을 수행할 수 없고 오차를 보정하기 위해 많은 시행착오를 거쳐야 하는 단점이 있다. Conventional calibration methods use jigs that can only measure location-related information. The rotation angle is assumed, and the position between the two coordinate systems is calculated using the assumption value and the information obtained using the jig. Therefore, if there is an error in the assumed rotation angle, it is impossible to perform a precise calibration, and there is a disadvantage in that a large number of trial and error are required to correct the error.

도 1은 종래의 캘리브레이션 지그를 이용한 캘리브레이션 모습을 도시한다. 캘리브레이션 지그는 직선 조인트(4)가 포함된 평판(10)으로 구성된다. TCP 진행 방향(x축)은 조인트 방향과 동일하고, TCP는 조인트(4) 상에 위치하여야 하며, 레이저는 조인트 위를 조사하고 있어야 한다. 이러한 상태에서 LAD(TCP로부터 레이저까지의 선행거리, Look Ahead Distance)를 측정한 후, LAD와 가정한 TCP 좌표계와 LVS 좌표계 사이의 회전 각도 (△α, △β, △γ)를 이용하여 두 좌표계 사이의 위치(△x, △y, △z)를 계산한다. 1 shows a calibration state using a conventional calibration jig. The calibration jig consists of a flat plate 10 with a straight joint 4. The TCP advancing direction (x axis) is the same as the joint direction, TCP should be located on the joint 4 and the laser should be looking over the joint. After measuring LAD (Look Ahead Distance from TCP to Laser) in this state, the two coordinate systems are used using the rotation angles (△ α, Δβ, Δγ) between the LAD and the assumed TCP coordinate system and LVS coordinate system. Calculate the position (Δx, Δy, Δz) between them.

종래의 캘리브레이션 지그로는 TCP 좌표계와 LVS 좌표계 사이의 회전각도를 측정할 수 없으며, 회전각도를 가정한 후 위치관계를 계산할 수밖에 없는 문제가 있었다. Conventional calibration jig can not measure the rotation angle between the TCP coordinate system and LVS coordinate system, there is a problem that can only calculate the position relationship after assuming the rotation angle.

본 발명은 상기와 같은 배경하에서 안출된 것으로서, 본 발명에서는 로봇 좌표계와 LVS 좌표계 사이의 위치에 대한 정보와 더불어 회전 각도에 관한 정보를 측정할 수 있는 지그를 제안하고 이를 이용하여 캘리브레이션을 수행한다. 따라서 LVS나 LVS 지그의 정밀도, 혹은 사용 중에 발생한 기구적 변형과 무관하게 정밀한 캘리브레이션을 수행할 수 있도록 한 로봇 TCP와 LVS 사이의 캘리브레이션 방법 및 캘리브레이션 지그를 제공하는데 그 목적이 있다. The present invention has been made under the above-described background, the present invention proposes a jig that can measure the information on the rotation angle as well as information on the position between the robot coordinate system and LVS coordinate system and performs the calibration by using the jig. Therefore, the object of the present invention is to provide a calibration method and a calibration jig between the robot TCP and the LVS to perform a precise calibration regardless of the LVS or LVS jig precision or mechanical deformation during use.

본 발명은 상기 목적을 달성하기 위해 본 발명의 일 특징에 따르면, 본 발명은 TCP 좌표계와 LVS 좌표계 사이의 회전 각도를 측정하여 두 좌표계 사이의 위치를 측정하는 캘리브레이션 장치에 있어서, According to an aspect of the present invention to achieve the above object, the present invention is a calibration device for measuring the position between the two coordinate systems by measuring the rotation angle between the TCP coordinate system and LVS coordinate system,

캘리브레이션 지그의 바닥면과 수직이며 조인트 방향과 동일한 방향을 이루는 레이저 평면 각도 측정판;A laser plane angle measuring plate perpendicular to the bottom surface of the calibration jig and forming the same direction as the joint direction;

상기 캘리브레이션 지그의 바닥면과 상기 레이저 각도 측정판 사이에 그어져 있는 수직, 수평의 눈금;Vertical and horizontal scales drawn between the bottom surface of the calibration jig and the laser angle measuring plate;

로봇의 자유도가 부족하여 회전 운동이 불가능한 경우 상기 캘리브레이션 지그의 높이를 조절하는 높이 조절 레버;A height adjustment lever for adjusting the height of the calibration jig when the robot lacks freedom of rotation and a rotational movement is not possible;

상기 TCP와 캘리브레이션 지그 사이의 회전 각도를 측정하고 측정점을 제공하는 데에 사용되는 조인트; 및A joint used to measure the angle of rotation between the TCP and the calibration jig and to provide a measuring point; And

LVS에서 취득한 영상을 디스플레이하며, LVS의 y축과 캘리브레이션 지그의 바닥면에 조사된 레이저의 방향이 일치하는 지를 조사하는데 사용되는 LVS 영상 모니터를 포함하는 것을 특징으로 한다. And an LVS image monitor used to display an image obtained from the LVS and to check whether the y-axis of the LVS and the direction of the laser irradiated on the bottom surface of the calibration jig match.

본 발명의 다른 특징에 따르면, 본 발명은 레이저 평면 각도 측정판, 레이저 눈금, 높이 조절 레버, 조인트 및 LVS영상 모니터를 이용하여 캘리브레이션을 수행하는 방법에 있어서, According to another feature of the present invention, the present invention provides a calibration method using a laser plane angle measuring plate, laser scale, height adjustment lever, joint and LVS image monitor,

TCP의 진행 방향과 상기 조인트를 일치시키는 단계;Matching the joint with the advancing direction of TCP;

TCP의 x축을 기준으로 TCP를 회전시키거나 혹은 상기 높이 조절 레버로 캘리브레이션 지그를 회전시켜 LVS 영상 모니터의 레이저 프로파일이 모니터에 수평을 유지하도록 하는 단계;Rotating the TCP about the x-axis of the TCP or rotating the calibration jig with the height adjustment lever so that the laser profile of the LVS video monitor is level with the monitor;

캘리브레이션 지그의 바닥면과 상기 레이저 평면 각도 측정판에 생성된 레이저 조사선의 각도 ω와 Φ를 측정하는 단계;Measuring angles ω and Φ of the bottom surface of the calibration jig and the laser radiation generated on the laser plane angle measuring plate;

상기 조인트상에 위치하는 TCP를 이동시켜 캘리브레이션 지그의 바닥면 상에 위치시키는 단계; Moving the TCP located on the joint and positioning it on the bottom surface of the calibration jig;

LVS와 캘리브레이션 지그 사이의 회전 각도와 TCP와 캘리브레이션 지그 사이의 회전 각도를 이용하여 TCP와 LVS 사이의 회전 각도 △α, △β, △γ를 계산하는 단계; Calculating rotation angles Δα, Δβ, Δγ between the TCP and the LVS using the rotation angle between the LVS and the calibration jig and the rotation angle between the TCP and the calibration jig;

TCP를 조인트 상에 위치시키고 레이저는 조인트를 조사하여 측정점을 생성하도록 로봇을 이동시킨 후, LAD를 측정하여 로봇 좌표계 기준의 측정점 좌표를 구하고, LVS에서 측정점을 관측하여 LVS 좌표계 기준의 측정점 좌표를 구하는 단계; 및Position the TCP on the joint and move the robot to generate a measuring point by irradiating the joint, and then measure the LAD to obtain the measuring point coordinates based on the robot coordinate system. step; And

계산된 TCP와 LVS 사이의 회전 각도, 로봇 좌표계 기준의 측정점 좌표 그리고 LVS 좌표계 기준의 측정점 좌표를 이용하여 TCP와 LVS 사이의 위치 △x, △y, △z를 계산하는 단계를 포함하는 것을 특징으로 한다. Calculating positions Δx, Δy, and Δz between TCP and LVS using the calculated rotation angle between TCP and LVS, measuring point coordinates based on robot coordinate system, and measuring point coordinates based on LVS coordinate system. do.

본 발명에서는 로봇 좌표계와 LVS 좌표계 사이의 회전 각도 정보를 실측할 수 있는 지그와 방법을 제공하여 LVS나 LVS 지그의 정밀도나 사용중에 발생한 기구적 변형에 무관하게 정밀한 캘리브레이션을 수행할 수 있고, 시행착오를 줄임으로써 소요되는 비용과 시간을 절약할 수 있는 효과를 얻을 수 있다. In the present invention, by providing a jig and a method that can measure the rotation angle information between the robot coordinate system and LVS coordinate system, it is possible to perform precise calibration regardless of the precision of the LVS or LVS jig or mechanical deformation during use, trial and error By reducing the cost and time required, the effect can be saved.

이하, 본 발명의 일 실시예를 도면을 참조로 하여 구체적으로 설명한다. Hereinafter, an embodiment of the present invention will be described in detail with reference to the drawings.

도 2는 TCP 좌표계와 LVS 좌표계 사이의 회전 각도를 측정할 수 있는 캘리브레이션 지그와 이를 이용한 캘리브레이션 모습을 도시한다. 2 illustrates a calibration jig capable of measuring a rotation angle between a TCP coordinate system and an LVS coordinate system and a calibration state using the calibration jig.

캘리브레이션 지그에는 레이저 평면 각도를 측정할 수 있도록 레이저 평면 각도 측정판(1)이 설치되어 있다. 레이저 평면 각도 측정판과 지그면에는 조사된 레이저의 각도를 용이하게 측정할 수 있도록 눈금(2)이 그어져 있고, TCP의 진행방향과 캘리브레이션 조인트(4)의 방향을 일치시킨 채 LVS 영상 모니터(5)에 레이저 프로파일을 수평으로 조절할 수 있게 지그 높이 조절 레버(3)가 부착되어 있다. 캘리브레이션 지그(10)의 직선 조인트(4)는 TCP의 진행방향과 상기 직선 조인트(4)의 방향을 정렬할 수 있게 하고, 측정점을 제공한다. 아울러 LVS의 가로 방향(y축)과 지그 바닥면에 조사된 레이저의 방향이 평행하도록 조절하는 역할의 LVS 영 상 모니터(5)가 설치되어 있다. The laser jig angle measuring plate 1 is provided in the calibration jig so that the laser plane angle can be measured. A scale 2 is drawn on the laser plane angle measuring plate and the jig surface so that the angle of the irradiated laser can be easily measured, and the LVS image monitor (5) is made to match the progress direction of TCP and the direction of the calibration joint 4. The jig height adjustment lever 3 is attached to adjust the laser profile horizontally. The straight joint 4 of the calibration jig 10 makes it possible to align the advancing direction of TCP with the direction of the straight joint 4 and to provide a measuring point. In addition, the LVS image monitor (5) is installed to adjust the horizontal direction (y-axis) of the LVS and the direction of the laser irradiated on the jig bottom surface is parallel.

레이저 평면 각도 측정판(1)은 캘리브레이션 지그(10)의 바닥면과 수직이며, 조인트(4) 방향과 동일한 방향을 이룬다. 상기 레이저 평면 각도 측정판(1)을 이용하여 LVS(6)가 생성하는 레이저 평면(7)과 캘리브레이션 지그(10) 사이의 각도를 측정할 수 있다. The laser plane angle measuring plate 1 is perpendicular to the bottom surface of the calibration jig 10 and forms the same direction as the joint 4 direction. The angle between the laser plane 7 generated by the LVS 6 and the calibration jig 10 may be measured using the laser plane angle measuring plate 1.

레이저가 캘리브레이션 지그(10)에 조사되면 캘리브레이션 지그(10) 바닥면뿐만 아니라 각도 측정판(1)에도 레이저 조사선이 생성된다. 두 조사선과 캘리브레이션 지그(10) 사이의 각도(캘리브레이션 지그에 대한 레이저 평면의 각도), 그리고 LVS(6)의 y 축이 캘리브레이션 지그(10) 바닥에 생성된 레이저 조사선과 평행한 조건을 이용하여 LVS와 캘리브레이션 지그 사이의 회전 각도를 구할 수 있다. When the laser is irradiated to the calibration jig 10, the laser irradiation line is generated not only on the bottom surface of the calibration jig 10 but also on the angle measuring plate 1. LVS using a condition between the two irradiation lines and the calibration jig 10 (the angle of the laser plane relative to the calibration jig), and the y axis of the LVS 6 is parallel to the laser radiation generated at the bottom of the calibration jig 10. The angle of rotation between and the calibration jig can be obtained.

도 2에 도시한 바와 같이 캘리브레이션 지그(10)의 바닥면과 레이저 각도 측정판에는 수평의 눈금(2)이 그어져 있다. 이 눈금(2)을 이용하여 캘리브레이션 지그(10)에 대한 레이저 조사선들의 각도를 측정할 수 있다. 또한, TCP의 진행 방향과 캘리브레이션 지그(10)의 조인트(4) 방향을 일치시킨 채 LVS 영상 모니터(5)의 레이저 프로파일을 수평으로 조정하기 위해서는 로봇을 TCP의 x축을 기준으로 회전운동을 하여야 한다. 로봇의 자유도가 부족하여 회전운동이 불가능한 경우, 캘리브레이션 지그(10)의 높이조절 레버(3)를 이용하여 요구사항을 만족시킬 수 있다. As shown in FIG. 2, a horizontal scale 2 is drawn on the bottom surface of the calibration jig 10 and the laser angle measuring plate. The scale 2 can be used to measure the angle of the laser irradiation lines with respect to the calibration jig 10. In addition, in order to horizontally adjust the laser profile of the LVS image monitor 5 while keeping the advancing direction of the TCP and the direction of the joint 4 of the calibration jig 10, the robot must be rotated about the x axis of the TCP. . When the rotational movement is impossible due to the lack of freedom of the robot, it is possible to meet the requirements by using the height adjustment lever 3 of the calibration jig 10.

조인트(4)는 종래의 방법에서 TCP 좌표계의 x축과 캘리브레이션 지그를 정렬하고, LVS에 측정점을 제공하는 것에 더하여 본 발명의 캘리브레이션 방법에서는 TCP와 캘리브레이션 지그(10) 사이의 회전각도를 측정하는데 사용된다. LVS 영상 모니터(5)는 LVS에서 취득한 영상을 디스플레이하는 장치로서, LVS의 y축과 캘리브레이션 지그(10)의 바닥면에 조사된 레이저 방향이 일치하는지를 확인하는데 사용한다. 모니터(5)에 보이는 레이저 프로파일이 평행할 경우 LVS의 y축과 캘리브레이션 지그에 조사된 레이저의 방향이 일치하는 것으로 볼 수 있다. The joint 4 is used to measure the angle of rotation between the TCP and the calibration jig 10 in the calibration method of the present invention, in addition to aligning the x-axis and the calibration jig of the TCP coordinate system in the conventional method and providing a measuring point to the LVS. do. The LVS image monitor 5 is a device for displaying an image acquired from the LVS and is used to confirm whether the y-axis of the LVS and the laser direction irradiated on the bottom surface of the calibration jig 10 coincide. When the laser profile shown on the monitor 5 is parallel, it can be seen that the y-axis of the LVS and the direction of the laser irradiated on the calibration jig coincide.

이하에서는 본 발명의 캘리브레이션 방법에 대하여 설명한다. Hereinafter, the calibration method of the present invention will be described.

먼저 TCP의 진행방향(x축)과 조인트 방향을 일치시키고, TCP를 조인트 상에 위치시킨다. 이때 레이저는 레이저 평면 각도 측정판(1)을 조사하고 있어야 한다. 이어서 TCP의 x축을 기준으로 TCP를 회전시키거나 혹은 회전 높이 조절 레버(3)로 캘리브레이션 지그(10)를 회전시켜 LVS영상 모니터(5)의 레이저 프로파일이 모니터(5)에 수평을 유지하도록 한다. 이를 통해 지그의 바닥면에 생성된 레이저 조사선의 방향과 LVS의 y축 방향이 일치한다고 볼 수 있다. 캘리브레이션 지그(10)의 바닥면과 레이저 평면각도 측정판(1)에 생성된 레이저 조사선의 각도 ω와 Φ(켈리브레이션 지그에 대한 레이저 평면의 각도)를 측정한다. ω와 Φ를 측정하기 위해 상기 캘리브레이션 지그(10)에 그어진 눈금(2)을 이용할 수 있다. LVS의 y축과 캘리브레이션 지그(10)의 바닥면에 생성된 레이저 조사선의 방향이 일치한다는 조건과 두 레이저 조사선의 각도를 이용하여 LVS와 캘리브레이션 지그 사이의 회전 각도를 계산한다. First, the direction of the joint (x-axis) and the joint direction of the TCP are matched, and the TCP is placed on the joint. At this time, the laser should be irradiating the laser plane angle measuring plate (1). Subsequently, the TCP is rotated with respect to the x-axis of the TCP or the calibration jig 10 is rotated by the rotation height adjusting lever 3 so that the laser profile of the LVS image monitor 5 is horizontal to the monitor 5. Through this, it can be seen that the direction of the laser radiation generated on the bottom surface of the jig coincides with the y-axis direction of the LVS. The angle ω and Φ (the angle of the laser plane relative to the calibration jig) of the laser irradiation line generated on the bottom surface of the calibration jig 10 and the laser plane angle measurement plate 1 are measured. The scale 2 drawn on the calibration jig 10 can be used to measure ω and Φ. The rotation angle between the LVS and the calibration jig is calculated using the condition that the y-axis of the LVS and the direction of the laser irradiation line generated on the bottom surface of the calibration jig 10 coincide with each other.

이어서 조인트 상에 위치하는 TCP를 평행 이동시켜 캘리브레이션 지그의 바닥면에 위치시킨다. 이때 TCP의 가로 방향(y축)과 높이 방향(z축)의 이동거리를 이용하여 TCP의 진행방향(x축)에 대한 TCP와 캘리브레이션 지그(10) 사이의 회전각 도 θ를 계산하고, TCP의 진행방향과 조인트의 방향이 평행한 조건과 θ를 이용하여 TCP와 캘리브레이션 지그 사이의 회전 각도를 계산한다. 측정한 LVS와 캘리브레이션 지그(10) 사이의 회전각도와 TCP와 캘리브레이션 지그 사이의 회전 각도를 이용하여 TCP와 LVS 사이의 회전 각도 (△α, △β, △γ)를 계산한다. The TCP located on the joint is then moved in parallel and placed on the bottom of the calibration jig. At this time, the rotation angle θ between TCP and the calibration jig 10 with respect to TCP's advancing direction (x-axis) is calculated using the moving distances in the horizontal (y-axis) and height (z-axis) directions of TCP. Calculate the angle of rotation between TCP and the calibration jig using the condition that the direction of travel and the direction of the joint are parallel and θ. Using the measured rotation angle between the LVS and the calibration jig 10 and the rotation angle between the TCP and the calibration jig, the rotation angles Δα, Δβ, and Δγ between the TCP and the LVS are calculated.

이어서, TCP를 조인트(4) 상에 위치시키고, 레이저는 조인트(4)를 조사하여 측정점을 생성하도록 로봇(도시 않음)을 평행 이동시킨 후, LAD를 측정하여 로봇 좌표계 기준의 측정점 좌표를 구하고, LVS에서 측정점을 관측하여 LVS 좌표계 기준의 측정점 좌표를 구한다. Subsequently, the TCP is placed on the joint 4, the laser irradiates the joint 4 to move the robot (not shown) in parallel to generate a measuring point, and then measures the LAD to obtain the measuring point coordinates based on the robot coordinate system, Observe the measuring point in the LVS to find the measuring point coordinates based on the LVS coordinate system.

이어서, 로봇 좌표계 기준의 측정점 좌표, LVS 좌표계 기준의 측정점 좌표 그리고 이미 계산한 TCP와 LVS 사이의 회전 각도를 이용하여 TCP와 LVS 사이의 위치(△x, △y, △z)를 계산하여 LVS와 TCP 사이의 회전 각도 및 이들 사이의 위치를 계산할 수 있다.Subsequently, the position (Δx, Δy, Δz) between TCP and LVS is calculated by using the coordinates of the coordinates of the robot coordinate system, the coordinates of the LVS coordinate system, and the rotation angle between TCP and LVS. The angle of rotation between TCP and the position between them can be calculated.

본 발명에서는 로봇 좌표계와 LVS 좌표계 사이의 회전 각도 정보를 실측할 수 있는 지그와 방법을 제공하여 LVS나 LVS 지그의 정밀도나 사용중에 발생한 기구적 변형에 무관하게 정밀한 캘리브레이션을 수행할 수 있고, 시행착오를 줄임으로써 소요되는 비용과 시간을 절약할 수 있는 효과를 얻을 수 있다. In the present invention, by providing a jig and a method that can measure the rotation angle information between the robot coordinate system and LVS coordinate system, it is possible to perform precise calibration regardless of the precision of the LVS or LVS jig or mechanical deformation during use, trial and error By reducing the cost and time required, the effect can be saved.

지금까지 본 발명의 일 실시예를 도면을 참조로 하여 설명하였으나, 본 발명은 이에 한정되지 않으며, 본 발명의 영역 및 사상을 일탈하지 않는 범위 내에서 당업자에 의해 여러 가지로 수정 및 변형 실시될 수 있으며, 이러한 수정 및 변형을 본 발명의 영역에 속하는 것으로 이해되어야 할 것이다. One embodiment of the present invention has been described with reference to the drawings, but the present invention is not limited thereto, and various modifications and variations can be made by those skilled in the art without departing from the scope and spirit of the present invention. It is to be understood that such modifications and variations are intended to fall within the scope of the present invention.

도 1은 도 1은 종래의 캘리브레이션 지그를 이용한 캘리브레이션 모습을 도시한다. 1 is a view illustrating a calibration using a conventional calibration jig.

도 2는 TCP 좌표계와 LVS 좌표계 사이의 회전 각도를 측정할 수 있는 캘리브레이션 지그와 이를 이용한 캘리브레이션 모습을 도시한다. 2 illustrates a calibration jig capable of measuring a rotation angle between a TCP coordinate system and an LVS coordinate system and a calibration state using the calibration jig.

*도면의 주요 부분에 대한 설명* * Description of the main parts of the drawings *

1: 레이저 평면 각도 측정판 2: 눈금1: laser plane angle measuring plate 2: graduation

3: 높이 조절 레버 4: 조인트3: height adjustment lever 4: joint

5: LVS 영상 모니터 6: LVS 5: LVS Video Monitor 6: LVS

7: 레이저 평면 10: 캘리브레이션 지그7: laser plane 10: calibration jig

Claims (8)

TCP 좌표계와 LVS 좌표계 사이의 회전 각도와 위치를 측정하는 캘리브레이션 장치에 있어서, In the calibration device for measuring the rotation angle and position between the TCP coordinate system and LVS coordinate system, 캘리브레이션 지그의 바닥면과 수직이며 조인트 방향과 동일한 방향을 이루는 레이저 평면 각도 측정판;A laser plane angle measuring plate perpendicular to the bottom surface of the calibration jig and forming the same direction as the joint direction; 상기 캘리브레이션 지그의 바닥면과 상기 레이저 각도 측정판 사이에 그어져 있는 수직, 수평의 눈금;Vertical and horizontal scales drawn between the bottom surface of the calibration jig and the laser angle measuring plate; 로봇의 자유도가 부족하여 회전 운동이 불가능한 경우 상기 캘리브레이션 지그의 높이를 조절하는 높이 조절 레버;A height adjustment lever for adjusting the height of the calibration jig when the robot lacks freedom of rotation and a rotational movement is not possible; 상기 TCP와 캘리브레이션 지그 사이의 회전 각도를 측정하고 측정점을 제공하는 데에 사용되는 조인트; 및A joint used to measure the angle of rotation between the TCP and the calibration jig and to provide a measuring point; And LVS에서 취득한 영상을 디스플레이하며, LVS의 y축과 캘리브레이션 지그의 바닥면에 조사된 레이저의 방향이 일치하는 지를 조사하는데 사용되는 LVS 영상 모니터를 포함하는 것을 특징으로 하는 캘리브레이션 지그. And a LVS image monitor for displaying an image obtained from the LVS and for checking whether the y-axis of the LVS and the direction of the laser irradiated on the bottom surface of the calibration jig match. 제1항에 있어서, The method of claim 1, 상기 높이 조절 레버는 TCP의 진행방향과 캘리브레이션 지그의 조인트 방향을 일치시킨 채 LVS 영상 모니터의 레이저 프로파일을 수평으로 조정할 수 있는 것을 특징으로 하는 캘리브레이션 지그. And the height adjustment lever adjusts the laser profile of the LVS video monitor horizontally while matching the advancing direction of the TCP and the joint direction of the calibration jig. 제1항에 있어서, The method of claim 1, 상기 레이저 측정판을 이용하여 LVS가 생성하는 레이저 평면과 캘리브레이션 지그 사이의 각도를 측정하는 것을 특징으로 하는 캘리브레이션 지그. Calibration jig, characterized in that for measuring the angle between the laser plane and the calibration jig generated by the LVS using the laser measuring plate. 제1항에 있어서, The method of claim 1, 상기 조인트는 TCP와 캘리브레이션 지그 사이의 회전 각도를 측정하고 측정점을 제공하는 데에 사용되는 것을 특징으로 하는 캘리브레이션 지그. And the joint is used to measure the angle of rotation between the TCP and the calibration jig and to provide a measuring point. 레이저 평면 각도 측정판, 레이저 눈금, 높이 조절 레버, 조인트 및 LVS영상 모니터를 이용하여 캘리브레이션을 수행하는 방법에 있어서, In the calibration method using a laser plane angle measuring plate, laser scale, height adjustment lever, joint and LVS image monitor, TCP의 진행 방향과 상기 조인트를 일치시키는 단계;Matching the joint with the advancing direction of TCP; TCP의 x축을 기준으로 TCP를 회전시키거나 혹은 상기 높이 조절 레버로 캘리브레이션 지그를 회전시켜 LVS 영상 모니터의 레이저 프로파일이 모니터에 수평을 유지하도록 하는 단계;Rotating the TCP about the x-axis of the TCP or rotating the calibration jig with the height adjustment lever so that the laser profile of the LVS video monitor is level with the monitor; 캘리브레이션 지그의 바닥면과 상기 레이저 평면 각도 측정판에 생성된 레이저 조사선의 각도 ω와 Φ를 측정하는 단계;Measuring angles ω and Φ of the bottom surface of the calibration jig and the laser radiation generated on the laser plane angle measuring plate; 상기 조인트상에 위치하는 TCP를 평행 이동시켜 캘리브레이션 지그의 바닥면 상에 위치시키는 단계; Moving the TCP located on the joint in parallel and positioning it on the bottom surface of the calibration jig; LVS와 캘리브레이션 지그 사이의 회전 각도와 TCP와 캘리브레이션 지그 사이 의 회전 각도를 이용하여 TCP와 LVS 사이의 회전 각도 △α, △β, △γ를 계산하는 단계; Calculating rotation angles Δα, Δβ, Δγ between the TCP and the LVS using the rotation angle between the LVS and the calibration jig and the rotation angle between the TCP and the calibration jig; TCP를 조인트 상에 위치시키고 레이저는 조인트를 조사하여 측정점을 생성하도록 로봇을 이동시킨 후, LAD를 측정하여 로봇 좌표계 기준의 측정점 좌표를 구하고, LVS에서 측정점을 관측하여 LVS 좌표계 기준의 측정점 좌표를 구하는 단계; 및Position the TCP on the joint and move the robot to generate a measuring point by irradiating the joint, and then measure the LAD to obtain the measuring point coordinates based on the robot coordinate system. step; And 계산된 TCP와 LVS 사이의 회전 각도, 로봇 좌표계 기준의 측정점 좌표 그리고 LVS 좌표계 기준의 측정점 좌표를 이용하여 TCP와 LVS 사이의 위치 △x, △y, △z를 계산하는 단계를 포함하는 것을 특징으로 하는 캘리브레이션 방법. Calculating positions Δx, Δy, and Δz between TCP and LVS using the calculated rotation angle between TCP and LVS, measuring point coordinates based on robot coordinate system, and measuring point coordinates based on LVS coordinate system. How to calibrate. 제5항에 있어서, The method of claim 5, 상기 TCP의 진행 방향과 조인트 방향을 일치시키고 TCP를 조인트 상에 위치시키는 단계에서 레이저는 레이저 평면 각도 측정판을 조사하고 있는 것을 특징으로 하는 캘리브레이션 방법. And the laser is irradiating a laser plane angle measuring plate in the step of matching the advancing direction of the TCP with the joint direction and positioning the TCP on the joint. 제5항에 있어서,The method of claim 5, 상기 ω와 Φ를 측정하는 단계에서 ω와 Φ를 측정하기 위해 상기 레이저 눈금을 이용하고, LVS의 y축과 캘리브레이션 지그 바닥면에 생성된 레이저 조사선이 일치한다는 조건과 두 레이저 조사선의 각도를 이용하여 LVS와 캘리브레이션 지그 사이의 회전 각도를 계산하는 것을 특징으로 하는 캘리브레이션 방법. In the step of measuring ω and Φ, the laser scale is used to measure ω and Φ, and the condition that the y-axis of the LVS coincides with the laser radiation generated on the bottom of the calibration jig and the angle of the two laser radiation A calibration method, characterized by calculating the angle of rotation between the LVS and the calibration jig. 제5항에 있어서,The method of claim 5, 상기 조인트상에 위치하는 TCP를 평행 이동시켜 캘리브레이션 지그의 바닥면 상에 위치시키는 단계에서, TCP의 y축 방향과 z축 방향의 이동거리를 이용하여 TCP의 진행방향에 대한 TCP와 캘리브레이션 지그 사이의 회전 각도 θ를 계산하고, TCP의 진행방향과 조인트의 방향이 평행한 조건과 θ를 이용하여 TCP와 캘리브레이션 지그 사이의 회전 각도를 계산하는 것을 특징으로 하는 캘리브레이션 방법. In the step of moving the TCP located on the joint in parallel on the bottom surface of the calibration jig, the distance between the TCP and the calibration jig relative to the advancing direction of TCP using the movement distance in the y-axis direction and z-axis direction of TCP And a rotation angle between the TCP and the calibration jig, using a condition in which the advancing direction of the TCP and the direction of the joint are parallel and θ.
KR1020090076543A 2009-08-19 2009-08-19 Calibration Method and Calibration Jig Between Robot TCP and LVS KR101094313B1 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
KR1020090076543A KR101094313B1 (en) 2009-08-19 2009-08-19 Calibration Method and Calibration Jig Between Robot TCP and LVS

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
KR1020090076543A KR101094313B1 (en) 2009-08-19 2009-08-19 Calibration Method and Calibration Jig Between Robot TCP and LVS

Publications (2)

Publication Number Publication Date
KR20110019011A true KR20110019011A (en) 2011-02-25
KR101094313B1 KR101094313B1 (en) 2011-12-19

Family

ID=43776450

Family Applications (1)

Application Number Title Priority Date Filing Date
KR1020090076543A KR101094313B1 (en) 2009-08-19 2009-08-19 Calibration Method and Calibration Jig Between Robot TCP and LVS

Country Status (1)

Country Link
KR (1) KR101094313B1 (en)

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR20130045557A (en) * 2011-10-26 2013-05-06 현대중공업 주식회사 Method of calibrating coordinate system in laser vision sensor
KR101359642B1 (en) * 2012-01-10 2014-02-07 삼성중공업 주식회사 Calibration device and method for calibrating Laser vision system
US10449676B2 (en) 2015-03-23 2019-10-22 National Research Council Of Canada Multi-jointed robot deviation under load determination
CN115597504A (en) * 2022-12-15 2023-01-13 杭州百子尖科技股份有限公司（Cn） Laser coaxiality calibration device and method for machine vision measurement
CN117073582A (en) * 2023-09-12 2023-11-17 梅卡曼德（北京）机器人科技有限公司 Calibration method and device of line laser profilometer system and electronic equipment

Family Cites Families (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE4437284A1 (en) 1994-10-18 1996-04-25 Eos Electro Optical Syst Method for calibrating a controller to deflect a laser beam
KR100214676B1 (en) 1996-12-23 1999-08-02 이종수 Horizontal positioning apparatus and the method for industrial robot
SG152090A1 (en) 2007-10-23 2009-05-29 Hypertronics Pte Ltd Scan head calibration system and method

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR20130045557A (en) * 2011-10-26 2013-05-06 현대중공업 주식회사 Method of calibrating coordinate system in laser vision sensor
KR101359642B1 (en) * 2012-01-10 2014-02-07 삼성중공업 주식회사 Calibration device and method for calibrating Laser vision system
US10449676B2 (en) 2015-03-23 2019-10-22 National Research Council Of Canada Multi-jointed robot deviation under load determination
CN115597504A (en) * 2022-12-15 2023-01-13 杭州百子尖科技股份有限公司（Cn） Laser coaxiality calibration device and method for machine vision measurement
CN117073582A (en) * 2023-09-12 2023-11-17 梅卡曼德（北京）机器人科技有限公司 Calibration method and device of line laser profilometer system and electronic equipment
CN117073582B (en) * 2023-09-12 2024-01-26 梅卡曼德（北京）机器人科技有限公司 Calibration method and device of line laser profilometer system and electronic equipment

Also Published As

Publication number Publication date
KR101094313B1 (en) 2011-12-19

Similar Documents

Publication Publication Date Title
CN104759945B (en) Mobile hole-making robot standard alignment method based on high precision industrial camera
CN108917604B (en) Normal measuring device and calibration method thereof
CN107883884B (en) A kind of optical measuring device and method
KR101094313B1 (en) Calibration Method and Calibration Jig Between Robot TCP and LVS
CN104816307A (en) Four-point normal leveling method for precise hole manufacturing of industrial robot
CN110926365B (en) Line structure-based optical detector marking method
WO2019047938A1 (en) Galvanometer correction system and method
US8924176B2 (en) Industrial machine
KR20070070733A (en) 3d self-measurement system for the curved surface
CN106643643A (en) Non-contact target coordinate measuring method
JP2019063955A (en) Robot system, operation control method and operation control program
TW201514441A (en) System and method for adjusting line laser probes of measurement machine
JP6794536B2 (en) Optical measuring device and method
TW201518888A (en) System and method for compensating step mismatch in a processing machine
KR102035334B1 (en) Method for measuring geometric errors of 4-axis machine tools
JP2014092489A (en) Inspection device and inspection method
CN110640546B (en) Measured gear rotation axis measuring method for large gear measurement beside machine
CN102129176B (en) Method for eliminating oblique error caused by surface shape of elongated lens
JP2016078173A (en) Method for detecting installation state of working robot
CN107978540B (en) Automatic adjusting method and system for measuring machine
JP6205727B2 (en) Shape measuring method, structure manufacturing method, shape measuring program, optical shape measuring apparatus, and structure manufacturing system
JP2012200463A (en) Alignment adjustment method, alignment measurement method, alignment tool, and x-ray ct apparatus
KR101418462B1 (en) Stage Calibration Method using 3-D coordinate measuring machine
JP5351083B2 (en) Teaching point correction apparatus and teaching point correction method
JP5483554B2 (en) Tool coordinate system calibration apparatus and calibration method

Legal Events

Date Code Title Description
A201 Request for examination
E902 Notification of reason for refusal
E701 Decision to grant or registration of patent right
GRNT Written decision to grant
FPAY Annual fee payment

Payment date: 20141201

Year of fee payment: 4

FPAY Annual fee payment

Payment date: 20151126

Year of fee payment: 5

FPAY Annual fee payment

Payment date: 20161205

Year of fee payment: 6

FPAY Annual fee payment

Payment date: 20171204

Year of fee payment: 7

FPAY Annual fee payment

Payment date: 20181206

Year of fee payment: 8