KR20190099123A - Method for adjusting industrial robot - Google Patents

Method for adjusting industrial robot Download PDF

Info

Publication number
KR20190099123A
KR20190099123A KR1020190014722A KR20190014722A KR20190099123A KR 20190099123 A KR20190099123 A KR 20190099123A KR 1020190014722 A KR1020190014722 A KR 1020190014722A KR 20190014722 A KR20190014722 A KR 20190014722A KR 20190099123 A KR20190099123 A KR 20190099123A
Authority
KR
South Korea
Prior art keywords
hand
arm
reference position
fork
positioning
Prior art date
Application number
KR1020190014722A
Other languages
Korean (ko)
Other versions
KR102210025B1 (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 니혼 덴산 산쿄 가부시키가이샤
Publication of KR20190099123A publication Critical patent/KR20190099123A/en
Application granted granted Critical
Publication of KR102210025B1 publication Critical patent/KR102210025B1/en

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B65CONVEYING; PACKING; STORING; HANDLING THIN OR FILAMENTARY MATERIAL
    • B65GTRANSPORT OR STORAGE DEVICES, e.g. CONVEYORS FOR LOADING OR TIPPING, SHOP CONVEYOR SYSTEMS OR PNEUMATIC TUBE CONVEYORS
    • B65G49/00Conveying systems characterised by their application for specified purposes not otherwise provided for
    • B65G49/05Conveying systems characterised by their application for specified purposes not otherwise provided for for fragile or damageable materials or articles
    • B65G49/06Conveying systems characterised by their application for specified purposes not otherwise provided for for fragile or damageable materials or articles for fragile sheets, e.g. glass
    • B65G49/063Transporting devices for sheet glass
    • B65G49/064Transporting devices for sheet glass in a horizontal position
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J15/00Gripping heads and other end effectors
    • B25J15/0014Gripping heads and other end effectors having fork, comb or plate shaped means for engaging the lower surface on a object to be transported
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/0009Constructional details, e.g. manipulator supports, bases
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/0081Programme-controlled manipulators with master teach-in means
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/02Programme-controlled manipulators characterised by movement of the arms, e.g. cartesian coordinate type
    • B25J9/04Programme-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/041Cylindrical coordinate type
    • B25J9/042Cylindrical coordinate type comprising an articulated arm
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1602Programme controls characterised by the control system, structure, architecture
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1656Programme controls characterised by programming, planning systems for manipulators
    • B25J9/1664Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1679Programme controls characterised by the tasks executed
    • B25J9/1692Calibration of manipulator
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B65CONVEYING; PACKING; STORING; HANDLING THIN OR FILAMENTARY MATERIAL
    • B65GTRANSPORT OR STORAGE DEVICES, e.g. CONVEYORS FOR LOADING OR TIPPING, SHOP CONVEYOR SYSTEMS OR PNEUMATIC TUBE CONVEYORS
    • B65G47/00Article or material-handling devices associated with conveyors; Methods employing such devices
    • B65G47/74Feeding, transfer, or discharging devices of particular kinds or types
    • B65G47/90Devices for picking-up and depositing articles or materials
    • B65G47/904Devices for picking-up and depositing articles or materials provided with rotary movements only
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B65CONVEYING; PACKING; STORING; HANDLING THIN OR FILAMENTARY MATERIAL
    • B65GTRANSPORT OR STORAGE DEVICES, e.g. CONVEYORS FOR LOADING OR TIPPING, SHOP CONVEYOR SYSTEMS OR PNEUMATIC TUBE CONVEYORS
    • B65G47/00Article or material-handling devices associated with conveyors; Methods employing such devices
    • B65G47/74Feeding, transfer, or discharging devices of particular kinds or types
    • B65G47/90Devices for picking-up and depositing articles or materials
    • B65G47/905Control arrangements
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B65CONVEYING; PACKING; STORING; HANDLING THIN OR FILAMENTARY MATERIAL
    • B65GTRANSPORT OR STORAGE DEVICES, e.g. CONVEYORS FOR LOADING OR TIPPING, SHOP CONVEYOR SYSTEMS OR PNEUMATIC TUBE CONVEYORS
    • B65G2201/00Indexing codes relating to handling devices, e.g. conveyors, characterised by the type of product or load being conveyed or handled
    • B65G2201/02Articles
    • B65G2201/0214Articles of special size, shape or weigh
    • B65G2201/022Flat

Abstract

Provided is a method for adjusting an industrial robot, capable of adjusting a second arm part accurately to a predetermined reference position, adjusting a band base part accurately to a predetermined reference position and adjusting a hand fork accurately to a predetermined reference position. The method for adjusting an industrial robot includes: a first reference position specification process for specifying a first reference position, which is a reference position of a second arm part (16) in a rotating direction of the second arm part (16) with respect to a first arm part (15), by using a position determination jig (36); a second reference position specification process for specifying a second reference position, which is a reference position of a hand base part (17) in a rotating direction of the hand base part (17) with respect to the second arm part (16), by using a position determination jig (37); and a hand fork position determination process for determining the position of a hand fork (18) with a position determination jig (38) on a third reference position which is a reference position of the hand fork (18) in a direction orthogonal to a long side direction of the hand fork (18) with respect to the hand base part (17).

Description

산업용 로봇의 조정 방법{METHOD FOR ADJUSTING INDUSTRIAL ROBOT}How to adjust industrial robots {METHOD FOR ADJUSTING INDUSTRIAL ROBOT}

본 발명은, 반송 대상물을 반송하는 산업용 로봇의 조정 방법에 관한 것이다.This invention relates to the adjustment method of the industrial robot which conveys a conveyance object.

종래, 유리 기판을 반송하는 산업용 로봇이 알려져 있다(예를 들어, 특허문헌 1 참조). 특허문헌 1에 기재된 산업용 로봇은, 유기 EL(유기 일렉트로루미네선스) 디스플레이의 제조 시스템에 내장되어서 사용되는 수평 다관절 로봇이고, 유리 기판이 탑재되는 핸드와, 핸드가 선단부측에 회동 가능하게 연결되는 암과, 암의 기단부측이 회동 가능하게 연결되는 본체부를 구비하고 있다.Conventionally, the industrial robot which conveys a glass substrate is known (for example, refer patent document 1). The industrial robot described in Patent Literature 1 is a horizontal articulated robot used in a manufacturing system for an organic EL (organic electroluminescent) display, and is connected to the hand on which the glass substrate is mounted so that the hand is rotatable on the tip end side. And a main body portion to which the base end side of the arm is rotatably connected.

암은, 기단부측이 본체부에 회동 가능하게 연결되는 제1 암부와, 제1 암부의 선단부측에 기단부측이 회동 가능하게 연결되는 제2 암부를 구비하고 있다. 핸드는, 제2 암부의 선단부측에 회동 가능하게 연결되는 핸드 기초부와, 핸드 기초부에 고정됨과 함께 유리 기판이 탑재되는 핸드 포크를 구비하고 있다. 또한, 특허문헌 1에 기재된 산업용 로봇은, 본체부에 대하여 제1 암부를 회동시키기 위한 모터와, 제1 암부에 대하여 제2 암부를 회동시키기 위한 모터와, 제2 암부에 대하여 핸드 기초부를 회동시키기 위한 모터를 구비하고 있다.The arm includes a first arm portion whose proximal end is rotatably connected to the main body, and a second arm portion whose proximal end is rotatably connected to the distal end of the first arm. The hand is provided with the hand base part rotatably connected to the front-end | tip part side of a 2nd arm part, and the hand fork to which the glass substrate is mounted while being fixed to the hand base part. Further, the industrial robot described in Patent Document 1 includes a motor for rotating the first arm portion with respect to the main body portion, a motor for rotating the second arm portion with respect to the first arm portion, and a hand base portion with respect to the second arm portion. For the motor.

일본 특허 공개 제2015-139854호 공보Japanese Patent Publication No. 2015-139854

특허문헌 1에 기재된 산업용 로봇이 유기 EL 디스플레이 등의 제조 시스템에 설치되면, 산업용 로봇의 동작 프로그램을 작성하기 위해서, 일반적으로, 산업용 로봇의 교시 작업이 행해지고 있다. 또한, 예를 들어 제조 시스템에 설치되는 산업용 로봇이 교환되거나, 산업용 로봇의 모터가 교환되거나 하면, 교환 전의 산업용 로봇의 교시 작업에서 교시되었던 교시 위치의 좌표에 대하여, 교환 후의 산업용 로봇의 로봇 좌표계가 어긋난다. 그 때문에, 산업용 로봇이 교환되거나, 산업용 로봇의 모터가 교환되거나 하는 경우에도, 일반적으로, 산업용 로봇의 교시 작업이 다시 행해지고 있다.When the industrial robot of patent document 1 is installed in manufacturing systems, such as an organic electroluminescent display, in order to create the operation program of an industrial robot, the teaching operation of an industrial robot is generally performed. For example, when an industrial robot installed in a manufacturing system is replaced or a motor of an industrial robot is exchanged, the robot coordinate system of the industrial robot after replacement is performed with respect to the coordinates of the teaching position taught in the teaching operation of the industrial robot before replacement. Disagree Therefore, even when the industrial robot is replaced or the motor of the industrial robot is replaced, the teaching work of the industrial robot is generally performed again.

한편, 교환 전의 산업용 로봇의 교시 작업에서 교시되었던 교시 위치의 좌표에 대한 교환 후의 산업용 로봇의 로봇 좌표계의 어긋남을 보정하면, 번잡한 교시 작업을 다시 행할 필요가 없어진다. 그 때문에, 본원 발명자는, 교환 전의 산업용 로봇의 교시 작업에서 교시되었던 교시 위치의 좌표에 대한 교환 후의 산업용 로봇의 로봇 좌표계의 어긋남을 보정하기 위한 보정값을 산출하여, 어긋남을 보정하는 것을 검토하고 있다. 어긋남을 보정하기 위한 보정값을 산출할 때는, 보정값을 용이하게 산출할 수 있는 것이 바람직하다.On the other hand, if the deviation of the robot coordinate system of the industrial robot after the exchange with respect to the coordinates of the teaching position taught in the industrial robot's teaching work before the replacement is corrected, it becomes unnecessary to perform complicated teaching work again. Therefore, the inventor of the present application considers correcting the deviation by calculating a correction value for correcting the deviation of the robot coordinate system of the industrial robot after the exchange with respect to the coordinate of the teaching position taught in the teaching operation of the industrial robot before replacement. . When calculating the correction value for correcting a deviation, it is preferable that the correction value can be easily calculated.

보정값을 용이하게 산출하기 위해서, 본원 발명자는, 제1 암부에 대한 제2 암부의 회동 방향에 있어서의 제2 암부의 소정의 기준 위치에 제2 암부를 정확히 맞추고, 또한, 제2 암부에 대한 핸드 기초부의 회동 방향에 있어서의 핸드 기초부의 소정의 기준 위치에 핸드 기초부를 정확히 맞춤과 함께, 핸드 기초부에 대한 핸드 포크의 긴 변 방향에 직교하는 방향에 있어서의 핸드 포크의 소정의 기준 위치에 핸드 포크를 정확히 맞춘 후에, 산업용 로봇에 소정의 동작을 행하게 하여, 본체부에 대한 제1 암부의 회동 방향에 있어서의 산업용 로봇의 어긋남양을 구함으로써, 본체부에 대한 제1 암부의 회동 방향에 있어서의 어긋남양에만 기초하여 보정값을 산출하는 것을 검토하고 있다.In order to easily calculate the correction value, the inventor of the present invention accurately aligns the second arm portion to a predetermined reference position of the second arm portion in the rotational direction of the second arm portion with respect to the first arm portion, and further, At the predetermined reference position of the hand fork in the direction orthogonal to the long side direction of the hand fork, with the hand base accurately aligned to the predetermined reference position of the hand base in the rotational direction of the hand base. After the hand fork is correctly aligned, the industrial robot is subjected to a predetermined operation, and the displacement amount of the industrial robot in the rotational direction of the first arm portion relative to the main body portion is determined so that the rotational direction of the first arm portion relative to the main body portion is determined. The calculation of a correction value based only on the amount of misalignment in this case is examined.

그래서, 본 발명의 과제는, 제1 암부에 대한 제2 암부의 회동 방향에 있어서의 제2 암부의 소정의 기준 위치에 제2 암부를 정확히 맞추는 것, 제2 암부에 대한 핸드 기초부의 회동 방향에 있어서의 핸드 기초부의 소정의 기준 위치에 핸드 기초부를 정확히 맞추는 것, 및, 핸드 기초부에 대한 핸드 포크의 긴 변 방향에 직교하는 방향에 있어서의 핸드 포크의 소정의 기준 위치에 핸드 포크를 정확히 맞추는 것이 가능한 산업용 로봇의 조정 방법을 제공하는 데 있다.Therefore, the subject of this invention is to align the 2nd arm part exactly to the predetermined reference position of the 2nd arm part in the rotational direction of the 2nd arm part with respect to a 1st arm part, and to the rotational direction of the hand base part with respect to a 2nd arm part. To correctly align the hand base to a predetermined reference position of the hand base in the hand base, and to accurately align the hand fork to the predetermined reference position of the hand fork in a direction orthogonal to the long side direction of the hand fork relative to the hand base. It is possible to provide a method of adjusting the industrial robot.

상기의 과제를 해결하기 위해, 본 발명은, 산업용 로봇의 조정 방법이며, 산업용 로봇은, 본체부와, 본체부에 기단부측이 회동 가능하게 연결되는 제1 암부와 제1 암부의 선단부측에 기단부측이 회동 가능하게 연결되는 제2 암부를 갖는 암과, 제2 암부의 선단부측에 회동 가능하게 연결되는 핸드 기초부와 핸드 기초부로부터 수평 방향의 일방향으로 연장됨과 함께 반송 대상물이 탑재되는 핸드 포크를 갖는 핸드와, 본체부에 대하여 제1 암부를 회동시키기 위한 제1 모터와, 제1 암부에 대하여 제2 암부를 회동시키기 위한 제2 모터와, 제2 암부에 대하여 핸드 기초부를 회동시키기 위한 제3 모터와, 제1 모터의 회전량을 검지하기 위한 제1 인코더와, 제2 모터의 회전량을 검지하기 위한 제2 인코더와, 제3 모터의 회전량을 검지하기 위한 제3 인코더와, 본체부에 대한 제1 암부의 회동 방향에 있어서의 제1 암부의 원점 위치를 검지하기 위한 제1 원점 센서와, 제1 암부에 대한 제2 암부의 회동 방향에 있어서의 제2 암부의 원점 위치를 검지하기 위한 제2 원점 센서와, 제2 암부에 대한 핸드 기초부의 회동 방향에 있어서의 핸드 기초부의 원점 위치를 검지하기 위한 제3 원점 센서를 구비하고, 제1 암부에 대한 제2 암부의 회동 방향에 있어서의 제2 암부의 소정의 기준 위치를 제1 기준 위치라 하고, 제2 암부에 대한 핸드 기초부의 회동 방향에 있어서의 핸드 기초부의 소정의 기준 위치를 제2 기준 위치라 하고, 핸드 기초부에 대한 핸드 포크의 긴 변 방향에 직교하는 방향에 있어서의 핸드 포크의 소정의 기준 위치를 제3 기준 위치라 하면, 산업용 로봇의 조정 방법은, 제1 기준 위치에서 제2 암부가 정지하도록 제2 원점 센서의 검지 결과에 기초하여 또는 제2 원점 센서의 검지 결과와 제2 인코더의 검지 결과에 기초하여 제2 암부를 정지시켰을 때의 제2 암부의 정지 위치인 제1 정지 위치로부터, 제1 기준 위치에 제2 암부를 위치 결정하기 위한 제1 위치 결정 지그에 의해 제2 암부가 위치 결정되는 위치까지 제2 암부를 회동시켰을 때의 제2 인코더의 검지 결과와, 제1 정지 위치에 제2 암부가 정지해 있을 때의 제2 인코더의 값에 기초하여 제1 기준 위치를 특정하는 제1 기준 위치 특정 공정과, 제1 기준 위치 특정 공정 후, 제1 기준 위치 특정 공정에서 특정된 제1 기준 위치에 제2 암부가 배치되어 있는 상태에서, 제2 기준 위치에서 핸드 기초부가 정지하도록 제3 원점 센서의 검지 결과에 기초하여 또는 제3 원점 센서의 검지 결과와 제3 인코더의 검지 결과에 기초하여 핸드 기초부를 정지시켰을 때의 핸드 기초부의 정지 위치인 제2 정지 위치로부터, 제2 기준 위치에 핸드 기초부를 위치 결정하기 위한 제2 위치 결정 지그에 의해 핸드 기초부가 위치 결정되는 위치까지 핸드 기초부를 회동시켰을 때의 제3 인코더의 검지 결과와, 제2 정지 위치에 핸드 기초부가 정지해 있을 때의 제3 인코더의 값에 기초하여 제2 기준 위치를 특정하는 제2 기준 위치 특정 공정과, 제2 기준 위치 특정 공정 후, 제1 기준 위치 특정 공정에서 특정된 제1 기준 위치에 제2 암부가 배치되고, 또한, 제2 기준 위치 특정 공정에서 특정된 제2 기준 위치에 핸드 기초부가 배치되어 있는 상태에서, 제3 기준 위치에 핸드 포크를 위치 결정하기 위한 제3 위치 결정 지그에 의해 핸드 포크를 위치 결정하는 핸드 포크 위치 결정 공정을 구비하는 것을 특징으로 한다.MEANS TO SOLVE THE PROBLEM In order to solve the said subject, this invention is the adjustment method of an industrial robot, The industrial robot is a base end part in the front end part side of the main arm part and the 1st arm part and the 1st arm part to which the base end side is rotatably connected to a main body part. A hand fork on which a conveying object is mounted while extending in one direction in a horizontal direction from an arm having a second arm portion, the side of which is rotatably connected, and a hand base portion and a hand base portion rotatably connected to the tip end side of the second arm portion. And a first motor for rotating the first arm with respect to the main body, a second motor for rotating the second arm with respect to the first arm, and a hand for rotating the hand base with respect to the second arm. A third motor, a first encoder for detecting a rotation amount of the first motor, a second encoder for detecting a rotation amount of the second motor, a third encoder for detecting a rotation amount of the third motor, a main body part Detecting the home position of the first arm in the rotational direction of the first arm with respect to the first home sensor and the home position of the second arm in the rotational direction of the second arm with respect to the first arm. And a second origin sensor for detecting the home position of the hand base part in the rotational direction of the hand base part with respect to the second arm part, and in a rotational direction of the second arm part with respect to the first arm part. The predetermined reference position of the second arm portion of the first base position is referred to as the first reference position, and the predetermined reference position of the hand base portion in the rotational direction of the hand base portion relative to the second arm portion is referred to as the second reference position. When the predetermined reference position of the hand fork in the direction orthogonal to the long side direction of the hand fork is the third reference position, the adjustment method of the industrial robot includes the second circle so that the second arm stops at the first reference position. From a 1st stop position which is the stop position of a 2nd arm part when a 2nd arm part is stopped based on the detection result of a point sensor, or based on the detection result of a 2nd origin sensor, and the detection result of a 2nd encoder. Detection result of the second encoder when the second arm is rotated to the position where the second arm is positioned by the first positioning jig for positioning the second arm at the position, and the second arm at the first stop position. The first reference position specifying step of specifying the first reference position based on the value of the second encoder when is stopped, and the first reference position specified in the first reference position specifying step after the first reference position specifying step. On the basis of the detection result of the third origin sensor or the detection result of the third encoder and the third encoder to cause the hand base to stop at the second reference position. The hand base is rotated from the second stop position, which is the stop position of the hand base when the base is stopped, to the position where the hand base is positioned by the second positioning jig for positioning the hand base at the second reference position. A second reference position specifying step of specifying a second reference position based on the detection result of the third encoder at the time and the value of the third encoder when the hand base is stopped at the second stop position, and the second reference position After the specific process, in a state where the second arm portion is disposed at the first reference position specified in the first reference position specifying process, and the hand base is disposed at the second reference position specified in the second reference position specifying process, And a hand fork positioning process of positioning the hand fork by a third positioning jig for positioning the hand fork at a third reference position. The.

본 발명의 산업용 로봇의 조정 방법에서는, 제1 기준 위치 특정 공정에 있어서, 제1 암부에 대한 제2 암부의 회동 방향에 있어서의 제2 암부의 기준 위치인 제1 기준 위치에 제2 암부를 위치 결정하기 위한 제1 위치 결정 지그를 사용하여 제1 기준 위치를 특정하고 있다. 그 때문에, 본 발명에서는, 제1 위치 결정 지그를 사용하여 고정밀도로 특정된 제1 기준 위치에 제2 암부를 맞추는 것이 가능해진다. 즉, 본 발명에서는, 제1 기준 위치에 제2 암부를 정확히 맞추는 것이 가능해진다.In the adjustment method of the industrial robot of this invention, in a 1st reference position specification process, a 2nd arm part is located in the 1st reference position which is a reference position of the 2nd arm part in the rotational direction of the 2nd arm part with respect to a 1st arm part. The first reference position is specified using the first positioning jig for determining. Therefore, in this invention, it becomes possible to match a 2nd arm part to the 1st reference position specified with high precision using a 1st positioning jig. That is, in this invention, it becomes possible to match a 2nd arm part exactly to a 1st reference position.

또한, 본 발명에서는, 제2 기준 위치 특정 공정에 있어서, 제2 암부에 대한 핸드 기초부의 회동 방향에 있어서의 핸드 기초부의 기준 위치인 제2 기준 위치에 핸드 기초부를 위치 결정하기 위한 제2 위치 결정 지그를 사용하여 제2 기준 위치를 특정하고 있다. 그 때문에, 본 발명에서는, 제2 위치 결정 지그를 사용하여 고정밀도로 특정된 제2 기준 위치에 핸드 기초부를 맞추는 것이 가능해진다. 즉, 본 발명에서는, 제2 기준 위치에 핸드 기초부를 정확히 맞추는 것이 가능해진다.Moreover, in this invention, in a 2nd reference position specification process, 2nd position determination for positioning a hand base part in the 2nd reference position which is a reference position of the hand base part in the rotation direction of the hand base part with respect to a 2nd arm part. The second reference position is specified using the jig. Therefore, in this invention, it becomes possible to match a hand base part to the 2nd reference position specified with high precision using a 2nd positioning jig. That is, in this invention, it becomes possible to match a hand base part correctly with a 2nd reference position.

또한, 본 발명에서는, 핸드 포크 위치 결정 공정에 있어서, 핸드 기초부에 대한 핸드 포크의 긴 변 방향에 직교하는 방향에 있어서의 핸드 포크의 기준 위치인 제3 기준 위치에 핸드 포크를 위치 결정하기 위한 제3 위치 결정 지그를 사용하여 제3 기준 위치에 핸드 포크를 위치 결정하고 있다. 그 때문에, 본 발명에서는, 제3 기준 위치에 핸드 포크를 정확히 맞추는 것이 가능해진다.Moreover, in this invention, in a hand fork positioning process, for positioning a hand fork to the 3rd reference position which is a reference position of the hand fork in the direction orthogonal to the long side direction of the hand fork with respect to a hand base part, The hand fork is positioned at the third reference position using the third positioning jig. Therefore, in this invention, it becomes possible to exactly match a hand fork to a 3rd reference position.

본 발명에 있어서, 예를 들어 제2 암부가 제1 기준 위치에 있을 때는, 제1 암부와 제2 암부가 상하 방향에서 겹치고, 핸드 기초부가 제2 기준 위치에 있을 때는, 제2 암부와 핸드 포크가 상하 방향에서 겹쳐 있다.In the present invention, for example, when the second arm portion is in the first reference position, when the first arm portion and the second arm portion overlap in the vertical direction, and when the hand base portion is in the second reference position, the second arm portion and the hand fork Overlap in the vertical direction.

본 발명에 있어서, 제1 위치 결정 지그는, 예를 들어 제1 암부 및 제2 암부 중 어느 한쪽에 고정되는 제1 고정 부재와, 제1 암부 및 제2 암부 중 어느 다른 쪽에 형성되는 제1 삽입 구멍과 제1 고정 부재에 형성되는 제1 관통 구멍에 삽입되는 제1 핀을 구비하고 있다. 이 경우에는, 비교적 간이한 구성으로, 제2 암부를 제1 기준 위치에 위치 결정하는 것이 가능해진다.In the present invention, the first positioning jig includes, for example, a first fixing member fixed to either one of the first arm portion and the second arm portion, and a first insertion formed on any one of the first arm portion and the second arm portion. A first pin is inserted into the hole and the first through hole formed in the first fixing member. In this case, it becomes possible to position a 2nd arm part in a 1st reference position with a comparatively simple structure.

본 발명에 있어서, 제2 위치 결정 지그는, 예를 들어 제1 암부 및 핸드 기초부 중 어느 한쪽에 고정되는 제2 고정 부재와, 제1 암부 및 핸드 기초부 중 어느 다른 쪽에 형성되는 제2 삽입 구멍과 제2 고정 부재에 형성되는 제2 관통 구멍에 삽입되는 제2 핀을 구비하고 있다. 이 경우에는, 비교적 간이한 구성으로, 핸드 기초부를 제2 기준 위치에 위치 결정하는 것이 가능해진다.In the present invention, the second positioning jig includes, for example, a second fixing member fixed to either one of the first arm part and the hand base part, and the second insertion member formed on any one of the first arm part and the hand base part. A second pin is inserted into the hole and the second through hole formed in the second fixing member. In this case, it becomes possible to position the hand base part in a 2nd reference position with a comparatively simple structure.

본 발명에 있어서, 핸드는, 2개의 핸드 포크를 구비하고, 제3 위치 결정 지그는, 예를 들어 2개의 핸드 포크 및 제2 암부 중 어느 한쪽에 고정되는 제3 고정 부재와, 2개의 핸드 포크 및 제2 암부 중 어느 다른 쪽에 형성되는 제3 삽입 구멍과 제3 고정 부재에 형성되는 제3 관통 구멍에 삽입되는 제3 핀을 구비하고 있다. 이 경우에는, 비교적 간이한 구성으로, 2개의 핸드 포크를 제3 기준 위치에 위치 결정하는 것이 가능해진다.In the present invention, the hand includes two hand forks, and the third positioning jig includes, for example, a third fixing member fixed to either one of the two hand forks and the second arm portion, and the two hand forks. And a third pin inserted into the third insertion hole formed in the other of the second arm portions and the third through hole formed in the third fixing member. In this case, it becomes possible to position two hand forks in a 3rd reference position with a comparatively simple structure.

본 발명에 있어서, 예를 들어 핸드는, 핸드 기초부로부터 핸드 포크와 역방향으로 연장되는 2개의 제2 핸드 포크를 구비하고, 산업용 로봇의 조정 방법은, 핸드 포크 위치 결정 공정 후, 핸드 기초부를 180° 회동시킴과 함께, 제3 위치 결정 지그에 의해, 핸드 기초부에 대한 제2 핸드 포크의 긴 변 방향에 직교하는 방향에 있어서의 제2 핸드 포크의 소정의 기준 위치에 2개의 제2 핸드 포크를 위치 결정하는 제2 핸드 포크 위치 결정 공정을 구비하고 있다. 이 경우에는, 공통의 제3 위치 결정 지그를 사용하여, 핸드 포크의 위치 결정과 제2 핸드 포크의 위치 결정을 행하는 것이 가능해진다.In the present invention, for example, the hand includes two second hand forks extending in the opposite direction from the hand base to the hand fork, and the adjustment method of the industrial robot includes a hand base 180 after the hand fork positioning process. With the rotation, two second hand forks at a predetermined reference position of the second hand fork in the direction orthogonal to the long side direction of the second hand fork with respect to the hand base by the third positioning jig. And a second hand fork positioning process for positioning the position. In this case, it becomes possible to perform positioning of the hand fork and positioning of the second hand fork using a common third positioning jig.

이상과 같이, 본 발명의 산업용 로봇의 조정 방법에서는, 제1 암부에 대한 제2 암부의 회동 방향에 있어서의 제2 암부의 소정의 기준 위치에 제2 암부를 정확히 맞추는 것, 제2 암부에 대한 핸드 기초부의 회동 방향에 있어서의 핸드 기초부의 소정의 기준 위치에 핸드 기초부를 정확히 맞추는 것, 및, 핸드 기초부에 대한 핸드 포크의 긴 변 방향에 직교하는 방향에 있어서의 핸드 포크의 소정의 기준 위치에 핸드 포크를 정확히 맞추는 것이 가능해진다.As described above, in the adjustment method of the industrial robot of the present invention, the second arm part is accurately aligned to a predetermined reference position of the second arm part in the rotational direction of the second arm part relative to the first arm part. Aligning a hand base part exactly with the predetermined reference position of the hand base part in the rotation direction of a hand base part, and the predetermined reference position of the hand fork in the direction orthogonal to the long side direction of the hand fork with respect to the hand base part. It becomes possible to fit the hand fork exactly.

도 1은, 본 발명의 실시 형태에 관한 산업용 로봇의 조정 방법으로 조정되는 산업용 로봇의 도면이고, (A)는 평면도, (B)는 측면도이다.
도 2는, 도 1에 나타내는 산업용 로봇이 유기 EL 디스플레이의 제조 시스템에 내장된 상태를 나타내는 평면도이다.
도 3은, 도 1에 나타내는 산업용 로봇의 구성을 설명하기 위한 블록도이다.
도 4는, 도 1에 나타내는 산업용 로봇에 제1 위치 결정 지그, 제2 위치 결정 지그 및 제3 위치 결정 지그가 설치된 상태의 도면이고, (A)는 평면도, (B)는 측면도이다.
도 5의 (A)는, 도 4의 (B)의 E부의 확대도이고, (B)는, (A)의 F-F 방향으로부터 제1 위치 결정 지그 등을 나타내는 도면이고, (C)는, (A)의 G부의 확대도이다.
도 6의 (A)는, 도 4의 (B)의 H부의 확대도이고, (B)는, (A)의 J-J 방향으로부터 제2 위치 결정 지그 등을 나타내는 도면이고, (C)는, (A)의 K부의 확대도이다.
도 7의 (A)는, 도 4의 (A)의 L부의 확대도이고, (B)는, 도 4의 (B)의 M부의 확대도이고, (C)는, (B)의 N-N 방향으로부터 제3 위치 결정 지그 등을 나타내는 도면이고, (D)는, (B)의 P부의 확대도이다.
도 8은, 도 1에 나타내는 산업용 로봇의 보정값을 산출하는 보정값 산출 공정에서의 산업용 로봇의 동작을 설명하기 위한 도면이다.
도 9는, 본 발명의 다른 실시 형태에 관한 보정값 산출 공정에서의 산업용 로봇의 동작을 설명하기 위한 도면이다.
BRIEF DESCRIPTION OF THE DRAWINGS It is a figure of the industrial robot adjusted by the adjustment method of the industrial robot which concerns on embodiment of this invention, (A) is a top view, (B) is a side view.
FIG. 2 is a plan view showing a state in which the industrial robot shown in FIG. 1 is incorporated in a manufacturing system of an organic EL display.
FIG. 3 is a block diagram for explaining the configuration of the industrial robot shown in FIG. 1.
FIG. 4 is a view in which the first positioning jig, the second positioning jig, and the third positioning jig are installed in the industrial robot shown in FIG. 1, (A) is a plan view, and (B) is a side view.
FIG. 5A is an enlarged view of an E portion in FIG. 4B, (B) is a diagram illustrating a first positioning jig and the like from the FF direction of (A), and (C) is ( It is an enlarged view of G section of A).
FIG. 6A is an enlarged view of an H portion in FIG. 4B, (B) is a diagram illustrating a second positioning jig and the like from the JJ direction of (A), and (C) is ( It is an enlarged view of K part of A).
FIG. 7A is an enlarged view of the L portion of FIG. 4A, (B) is an enlarged view of the M portion of FIG. 4B, and (C) is the NN direction of (B). It is a figure which shows a 3rd positioning jig | tool, etc., (D) is an enlarged view of the P part of (B).
FIG. 8 is a view for explaining the operation of the industrial robot in the correction value calculating step of calculating the correction value of the industrial robot shown in FIG. 1.
It is a figure for demonstrating operation | movement of the industrial robot in the correction value calculation process which concerns on other embodiment of this invention.

이하, 도면을 참조하면서, 본 발명의 실시 형태를 설명한다.EMBODIMENT OF THE INVENTION Hereinafter, embodiment of this invention is described, referring drawings.

(산업용 로봇의 구성)(Configuration of Industrial Robot)

도 1은, 본 발명의 실시 형태에 관한 산업용 로봇의 조정 방법에서 조정되는 산업용 로봇(1)의 도면이고, (A)는 평면도, (B)는 측면도이다. 도 2는, 도 1에 나타내는 산업용 로봇(1)이 유기 EL 디스플레이의 제조 시스템(3)에 내장된 상태를 나타내는 평면도이다. 도 3은, 도 1에 나타내는 산업용 로봇(1)의 구성을 설명하기 위한 블록도이다.1: is a figure of the industrial robot 1 adjusted by the industrial robot adjustment method which concerns on embodiment of this invention, (A) is a top view, (B) is a side view. FIG. 2 is a plan view showing a state where the industrial robot 1 shown in FIG. 1 is incorporated in the manufacturing system 3 of the organic EL display. FIG. 3 is a block diagram for explaining the configuration of the industrial robot 1 shown in FIG. 1.

본 형태의 산업용 로봇(1)(이하, 「로봇(1)」이라 한다.)은, 반송 대상물인 유기 EL 디스플레이용 유리 기판(2)(이하, 「기판(2)」이라 한다.)을 반송하기 위한 로봇이다. 이 로봇(1)은, 도 2에 나타내는 바와 같이, 유기 EL 디스플레이의 제조 시스템(3)에 내장되어서 사용되는 수평 다관절 로봇이다. 제조 시스템(3)은, 중심에 배치되는 트랜스퍼 챔버(4)(이하, 「챔버(4)」라 한다.)와, 챔버(4)를 둘러싸도록 배치되는 복수의 챔버(5 내지 7)를 구비하고 있다.The industrial robot 1 (henceforth "robot 1") of this form conveys the glass substrate 2 for organic electroluminescent displays (henceforth "substrate 2") which is a conveyance object. It is a robot. This robot 1 is a horizontal articulated robot used in the manufacturing system 3 of organic electroluminescent display, as shown in FIG. The manufacturing system 3 is provided with the transfer chamber 4 (henceforth "chamber 4") arrange | positioned at the center, and the some chamber 5-7 arrange | positioned so that the chamber 4 may be enclosed. Doing.

챔버(5)는, 기판(2)에 대하여 소정의 처리를 행하기 위한 프로세스 챔버이다. 또한, 챔버(6)는, 예를 들어 제조 시스템(3)에 공급되는 기판(2)이 수용되는 공급용의 챔버(로더)이고, 챔버(7)는, 예를 들어 제조 시스템(3)으로부터 배출되는 기판(2)이 수용되는 배출용의 챔버(언로더)이다. 챔버(4 내지 7)의 내부는, 진공으로 되어 있다. 챔버(4)의 내부에는, 로봇(1)의 일부가 배치되어 있다. 로봇(1)을 구성하는 후술하는 핸드 포크(18, 19)가 챔버(5 내지 7) 내로 들어감으로써, 로봇(1)은, 복수의 챔버(5 내지 7)의 사이에서 기판(2)을 반송한다.The chamber 5 is a process chamber for performing a predetermined process on the substrate 2. In addition, the chamber 6 is a chamber (loader) for supply in which the board | substrate 2 supplied to the manufacturing system 3 is accommodated, for example, and the chamber 7 is, for example, from the manufacturing system 3. A discharge chamber (unloader) in which the discharged substrate 2 is accommodated. The interior of the chambers 4 to 7 is a vacuum. A part of the robot 1 is arrange | positioned inside the chamber 4. The hand fork 18 and 19 which comprise the robot 1 mentioned later enter into the chambers 5-7, and the robot 1 conveys the board | substrate 2 between the some chambers 5-7. do.

도 1에 나타내는 바와 같이, 로봇(1)은, 기판(2)이 탑재되는 핸드(8)와, 핸드(8)가 선단부측에 회동 가능하게 연결되는 암(9)과, 암(9)의 기단부측이 회동 가능하게 연결되는 본체부(10)를 구비하고 있다. 핸드(8) 및 암(9)은, 본체부(10)의 상측에 배치되어 있다. 본체부(10)는, 암(9)을 승강시키는 승강 기구와, 승강 기구가 수용되는 케이스체(13)를 구비하고 있다. 케이스체(13)는, 대략 바닥이 있는 원통형으로 형성되어 있다. 케이스체(13)의 상단부에는, 원판형으로 형성된 플랜지(14)가 고정되어 있다.As shown in FIG. 1, the robot 1 includes a hand 8 on which the substrate 2 is mounted, an arm 9 on which the hand 8 is pivotally connected to the distal end side, and an arm 9. The base end side is provided with the main-body part 10 connected so that rotation is possible. The hand 8 and the arm 9 are disposed above the main body 10. The main body part 10 is equipped with the lifting mechanism which raises and lowers the arm 9, and the case body 13 in which the lifting mechanism is accommodated. The case body 13 is formed in the substantially cylindrical shape with a bottom. The flange 14 formed in disk shape is being fixed to the upper end part of the case body 13. As shown in FIG.

상술한 바와 같이, 로봇(1)의 일부는, 챔버(4)의 내부에 배치되어 있다. 구체적으로는, 로봇(1)의, 플랜지(14)의 하단부면보다도 상측의 부분이 챔버(4)의 내부에 배치되어 있다. 즉, 로봇(1)의, 플랜지(14)의 하단부면보다도 상측의 부분은, 진공 영역(VR) 내에 배치되어 있고, 핸드(8) 및 암(9)은, 진공 챔버 내(진공 중)에 배치되어 있다. 한편, 로봇(1)의, 플랜지(14)의 하단부면보다도 하측의 부분은, 대기 영역(AR) 내(대기 중)에 배치되어 있다.As described above, a part of the robot 1 is disposed inside the chamber 4. Specifically, the upper part of the robot 1 than the lower end surface of the flange 14 is arrange | positioned inside the chamber 4. That is, the part of the robot 1 above the lower end surface of the flange 14 is arrange | positioned in the vacuum area VR, and the hand 8 and the arm 9 are in the vacuum chamber (in vacuum). It is arranged. On the other hand, the part below the lower end surface of the flange 14 of the robot 1 is arrange | positioned in the standby area AR (in air | atmosphere).

암(9)은, 서로 회동 가능하게 연결되는 제1 암부(15)와 제2 암부(16)를 구비하고 있다. 본 형태의 암(9)은, 제1 암부(15)와 제2 암부(16)의 2개의 암부에 의해 구성되어 있다. 제1 암부(15)의 기단부측은, 본체부(10)에 회동 가능하게 연결되어 있다. 제1 암부(15)의 선단부측에는, 제2 암부(16)의 기단부측이 회동 가능하게 연결되어 있다. 제2 암부(16)의 선단부측에는, 핸드(8)가 회동 가능하게 연결되어 있다.The arm 9 is provided with the 1st arm part 15 and the 2nd arm part 16 mutually rotatably connected. The arm 9 of this embodiment is comprised by two arm parts, the 1st arm part 15 and the 2nd arm part 16. As shown in FIG. The proximal end of the first arm 15 is rotatably connected to the main body 10. The proximal end of the second arm 16 is rotatably connected to the distal end of the first arm 15. The hand 8 is rotatably connected to the tip end side of the second arm 16.

제2 암부(16)는, 제1 암부(15)보다도 상측에 배치되어 있다. 또한, 핸드(8)는, 제2 암부(16)보다도 상측에 배치되어 있다. 본체부(10)에 대한 제1 암부(15)의 회동 중심과 제1 암부(15)에 대한 제2 암부(16)의 회동 중심의 거리는, 제1 암부(15)에 대한 제2 암부(16)의 회동 중심과 제2 암부(16)에 대한 핸드(8)의 회동 중심의 거리와 동등하게 되어 있다.The second arm portion 16 is disposed above the first arm portion 15. In addition, the hand 8 is disposed above the second arm 16. The distance between the center of rotation of the first arm 15 with respect to the main body 10 and the center of rotation of the second arm 16 with respect to the first arm 15 is the second arm 16 with respect to the first arm 15. ) Is equal to the distance between the center of rotation of the center of rotation and the center of rotation of the hand 8 with respect to the second arm 16.

핸드(8)는, 제2 암부(16)의 선단부측에 회동 가능하게 연결되는 핸드 기초부(17)와, 기판(2)이 탑재되는 핸드 포크(18, 19)를 구비하고 있다. 본 형태의 핸드(8)는, 2개의 핸드 포크(18)와, 2개의 핸드 포크(19)를 구비하고 있다. 핸드 포크(18, 19)는, 직선형으로 형성되어 있다. 핸드 포크(18)와 핸드 포크(19)는 동일 형상으로 형성되어 있다. 2개의 핸드 포크(18)는, 서로 소정의 간격을 둔 상태에서 평행하게 배치되어 있다. 핸드 포크(18)는, 핸드 기초부(17)로부터 수평 방향의 일방향으로 연장되어 있다. 2개의 핸드 포크(19)는, 서로 소정의 간격을 둔 상태에서 평행하게 배치되어 있다. 핸드 포크(19)는, 핸드 기초부(17)로부터 핸드 포크(18)와 역방향으로 연장되어 있다. 본 형태의 핸드 포크(19)는, 제2 핸드 포크이다.The hand 8 is provided with the hand base part 17 connected to the front end side of the 2nd arm part 16 so that rotation is possible, and the hand forks 18 and 19 on which the board | substrate 2 is mounted. The hand 8 of this embodiment is provided with two hand forks 18 and two hand forks 19. The hand forks 18 and 19 are formed linearly. The hand fork 18 and the hand fork 19 are formed in the same shape. The two hand forks 18 are arranged in parallel with each other at predetermined intervals. The hand fork 18 extends from the hand base 17 in one direction in the horizontal direction. The two hand forks 19 are arranged in parallel with each other at a predetermined interval. The hand fork 19 extends in the reverse direction from the hand base 17 to the hand fork 18. The hand fork 19 of this form is a 2nd hand fork.

핸드 포크(18, 19)는, 핸드 기초부(17)에 고정되어 있다. 구체적으로는, 핸드 포크(18, 19)는, 고정용 나사에 의해 핸드 기초부(17)에 고정되어 있다. 핸드 포크(18, 19)에는, 고정용 나사가 삽입 관통되는 삽입 관통 구멍이 형성되어 있다. 이 삽입 관통 구멍은, 핸드 포크(18, 19)의 긴 변 방향에 직교하는 방향을 긴 변 방향으로 하는 긴 구멍이고, 핸드 포크(18, 19)의 긴 변 방향에 직교하는 방향에 있어서, 핸드 기초부(17)에 대한 핸드 포크(18, 19)의 고정 위치를 조정하는 것이 가능하게 되어 있다.The hand forks 18 and 19 are fixed to the hand base 17. Specifically, the hand forks 18 and 19 are fixed to the hand base part 17 with the screw for fixing. In the hand forks 18 and 19, insertion through holes through which fixing screws are inserted are formed. This insertion through hole is a long hole which makes the direction orthogonal to the long side direction of the hand forks 18 and 19 a long side direction, and is a hand in the direction orthogonal to the long side direction of the hand forks 18 and 19. It is possible to adjust the fixing positions of the hand forks 18 and 19 with respect to the base 17.

본 형태에서는, 1매의 기판(2)이 2개의 핸드 포크(18)에 탑재된다. 또한, 1매의 기판(2)이 2개의 핸드 포크(19)에 탑재된다. 핸드 포크(18)의 상면에는, 탑재되는 기판(2)을 위치 결정하기 위한 위치 결정 부재가 설치되어 있다. 핸드 포크(19)의 상면에도, 탑재되는 기판(2)을 위치 결정하기 위한 위치 결정 부재가 설치되어 있다.In this embodiment, one substrate 2 is mounted on two hand forks 18. In addition, one substrate 2 is mounted on two hand forks 19. On the upper surface of the hand fork 18, a positioning member for positioning the substrate 2 to be mounted is provided. The positioning member for positioning the board | substrate 2 to be mounted is also provided in the upper surface of the hand fork 19. As shown in FIG.

또한, 로봇(1)은, 본체부(10)에 대하여 제1 암부(15)를 회동시키기 위한 모터(21)와, 제1 암부(15)에 대하여 제2 암부(16)를 회동시키기 위한 모터(22)와, 제2 암부(16)에 대하여 핸드 기초부(17)를 회동시키기 위한 모터(23)와, 모터(21)의 회전량을 검지하기 위한 인코더(24)와, 모터(22)의 회전량을 검지하기 위한 인코더(25)와, 모터(23)의 회전량을 검지하기 위한 인코더(26)를 구비하고 있다(도 3 참조).The robot 1 also includes a motor 21 for rotating the first arm 15 with respect to the main body 10 and a motor for rotating the second arm 16 with respect to the first arm 15. (22), a motor (23) for rotating the hand base portion (17) with respect to the second arm portion (16), an encoder (24) for detecting the amount of rotation of the motor (21), and a motor (22). The encoder 25 for detecting the rotation amount of the motor and the encoder 26 for detecting the rotation amount of the motor 23 are provided (see FIG. 3).

인코더(24)는, 모터(21)에 설치되어 있다. 인코더(25)는, 모터(22)에 설치되고, 인코더(26)는, 모터(23)에 설치되어 있다. 모터(21) 및 인코더(24)는, 예를 들어 본체부(10)의 내부에 배치되어 있다. 또한, 모터(22, 23) 및 인코더(25, 26)는, 예를 들어 제1 암부(15)의 내부에 배치되어 있다. 모터(21 내지 23)는, 로봇(1)의 제어부(27)에 전기적으로 접속되어 있다. 인코더(24 내지 26)도, 제어부(27)에 전기적으로 접속되어 있다. 본 형태의 모터(21)는 제1 모터이고, 모터(22)는 제2 모터이고, 모터(23)는 제3 모터이다. 또한, 인코더(24)는 제1 인코더이고, 인코더(25)는 제2 인코더이고, 인코더(26)는 제3 인코더이다.The encoder 24 is provided in the motor 21. The encoder 25 is provided in the motor 22, and the encoder 26 is provided in the motor 23. The motor 21 and the encoder 24 are arrange | positioned inside the main-body part 10, for example. In addition, the motors 22 and 23 and the encoders 25 and 26 are disposed inside the first arm 15, for example. The motors 21 to 23 are electrically connected to the control unit 27 of the robot 1. The encoders 24 to 26 are also electrically connected to the control unit 27. The motor 21 of this form is a 1st motor, the motor 22 is a 2nd motor, and the motor 23 is a 3rd motor. In addition, encoder 24 is a first encoder, encoder 25 is a second encoder, and encoder 26 is a third encoder.

또한, 로봇(1)은, 본체부(10)에 대한 제1 암부(15)의 회동 방향에 있어서의 제1 암부(15)의 원점 위치를 검지하기 위한 원점 센서(31)와, 제1 암부(15)에 대한 제2 암부(16)의 회동 방향에 있어서의 제2 암부(16)의 원점 위치를 검지하기 위한 원점 센서(32)와, 제2 암부(16)에 대한 핸드 기초부(17)의 회동 방향에 있어서의 핸드 기초부(17)의 원점 위치를 검지하기 위한 원점 센서(33)를 구비하고 있다. 본 형태의 원점 센서(31)는 제1 원점 센서이고, 원점 센서(32)는 제2 원점 센서이고, 원점 센서(33)는 제3 원점 센서이다.The robot 1 further includes an origin sensor 31 for detecting the home position of the first arm 15 in the rotational direction of the first arm 15 with respect to the main body 10, and the first arm. Home sensor 32 for detecting the home position of the second arm 16 in the rotational direction of the second arm 16 with respect to 15 and the hand base 17 for the second arm 16. Is provided with an origin sensor 33 for detecting the origin position of the hand base portion 17 in the rotational direction. The home sensor 31 of this embodiment is a first home sensor, the home sensor 32 is a second home sensor, and the home sensor 33 is a third home sensor.

원점 센서(31 내지 33)는, 예를 들어 근접 센서이다. 혹은, 원점 센서(31 내지 33)는, 예를 들어 발광 소자와 수광 소자를 갖는 광학식 센서이다. 원점 센서(31 내지 33)는, 제어부(27)에 전기적으로 접속되어 있다. 본체부(10)와 제1 암부(15)의 연결부인 관절부에 있어서, 원점 센서(31)는, 본체부(10) 및 제1 암부(15) 중 어느 한쪽에 고정되고, 본체부(10) 및 제1 암(15) 중 어느 다른 쪽에는, 제1 암부(15)가 원점 위치에 있을 때 원점 센서(31)에 검지되는 검지 부재가 고정되어 있다.The home sensors 31 to 33 are proximity sensors, for example. Or the origin sensors 31-33 are optical sensors which have a light emitting element and a light receiving element, for example. The origin sensors 31 to 33 are electrically connected to the control unit 27. In the joint part which is a connection part of the main-body part 10 and the 1st arm part 15, the origin sensor 31 is fixed to either one of the main-body part 10 and the 1st arm part 15, and the main-body part 10 And the detection member detected by the origin sensor 31 when the first arm portion 15 is at the origin position is fixed to any one of the first arms 15.

마찬가지로, 제1 암부(15)와 제2 암부(16)의 연결부인 관절부에 있어서, 원점 센서(32)는, 제1 암부(15) 및 제2 암부(16) 중 어느 한쪽에 고정되고, 제1 암부(15) 및 제2 암(16) 중 어느 다른 쪽에는, 제2 암부(16)가 원점 위치에 있을 때 원점 센서(32)에 검지되는 검지 부재가 고정되어 있다. 또한, 제2 암부(16)와 핸드 기초부(17)의 연결부인 관절부에 있어서, 원점 센서(33)는, 제2 암부(16) 및 핸드 기초부(17) 중 어느 한쪽에 고정되고, 제2 암부(16) 및 핸드 기초부(17) 중 어느 다른 쪽에는, 핸드 기초부(17)가 원점 위치에 있을 때 원점 센서(33)에 검지되는 검지 부재가 고정되어 있다.Similarly, in the joint part which is the connection part of the 1st arm part 15 and the 2nd arm part 16, the origin sensor 32 is fixed to either one of the 1st arm part 15 and the 2nd arm part 16, and The detection member detected by the origin sensor 32 is fixed to any one of the 1st arm part 15 and the 2nd arm 16 when the 2nd arm part 16 is in an origin position. Moreover, in the joint part which is the connection part of the 2nd arm part 16 and the hand base part 17, the origin sensor 33 is fixed to either one of the 2nd arm part 16 and the hand base part 17, and The detection member detected by the origin sensor 33 is fixed to any one of the 2 arm part 16 and the hand base part 17 when the hand base part 17 is in an origin position.

(산업용 로봇의 보정값의 산출 방법)(Calculation method of correction value of industrial robot)

도 4는, 도 1에 나타내는 로봇(1)에 위치 결정 지그(36 내지 38)가 설치된 상태의 도면이고, (A)는 평면도, (B)는 측면도이다. 도 5의 (A)는, 도 4의 (B)의 E부의 확대도이고, 도 5의 (B)는, 도 5의 (A)의 F-F 방향으로부터 위치 결정 지그(36) 등을 나타내는 도면이고, 도 5의 (C)는, 도 5의 (A)의 G부의 확대도이다. 도 6의 (A)는, 도 4의 (B)의 H부의 확대도이고, 도 6의 (B)는, 도 6의 (A)의 J-J 방향으로부터 위치 결정 지그(37) 등을 나타내는 도면이고, 도 6의 (C)는, 도 6의 (A)의 K부의 확대도이다. 도 7의 (A)는, 도 4의 (A)의 L부의 확대도이고, 도 7의 (B)는, 도 4의 (B)의 M부의 확대도이고, 도 7의 (C)는, 도 7의 (B)의 N-N 방향으로부터 위치 결정 지그(38) 등을 나타내는 도면이고, 도 7의 (D)는, 도 7의 (B)의 P부의 확대도이다. 도 8은, 도 1에 나타내는 로봇(1)의 보정값을 산출하는 보정값 산출 공정에서의 로봇(1)의 동작을 설명하기 위한 도면이다.FIG. 4 is a view in which the positioning jigs 36 to 38 are installed in the robot 1 shown in FIG. 1, (A) is a plan view, and (B) is a side view. FIG. 5A is an enlarged view of an E portion in FIG. 4B, and FIG. 5B is a view showing the positioning jig 36 and the like from the FF direction in FIG. 5A. 5C is an enlarged view of a portion G of FIG. 5A. FIG. 6A is an enlarged view of the H portion in FIG. 4B, and FIG. 6B is a view showing the positioning jig 37 and the like from the JJ direction in FIG. 6A. 6C is an enlarged view of the K portion of FIG. 6A. FIG. 7A is an enlarged view of the L portion of FIG. 4A, FIG. 7B is an enlarged view of the M portion of FIG. 4B, and FIG. 7C is It is a figure which shows the positioning jig 38 etc. from the NN direction of FIG. 7B, and FIG. 7D is an enlarged view of the P part of FIG. FIG. 8: is a figure for demonstrating operation | movement of the robot 1 in the correction value calculation process which calculates the correction value of the robot 1 shown in FIG.

로봇(1)이 제조 시스템(3)에 설치되면, 로봇(1)의 동작 프로그램을 작성하기 위해서, 로봇(1)의 교시 작업이 행해진다. 또한, 예를 들어 제조 시스템(3)에 설치되는 로봇(1)이 교환되면, 교환 전의 로봇(1)의 교시 작업에서 교시되었던 교시 위치의 좌표에 대하여 교환 후의 로봇(1)의 로봇 좌표계가 어긋나기 때문에, 로봇(1)의 교시 작업을 다시 행할 필요가 발생한다.When the robot 1 is installed in the manufacturing system 3, the teaching operation of the robot 1 is performed in order to create an operation program of the robot 1. For example, when the robot 1 installed in the manufacturing system 3 is exchanged, the robot coordinate system of the robot 1 after the exchange is shifted with respect to the coordinates of the teaching position taught in the teaching operation of the robot 1 before the exchange. For this reason, it is necessary to perform the teaching work of the robot 1 again.

한편, 교환 전의 로봇(1)의 교시 작업에서 교시되었던 교시 위치의 좌표에 대한 교환 후의 로봇(1)의 로봇 좌표계의 어긋남을 보정하면, 번잡한 교시 작업을 다시 행할 필요가 없어진다. 본 형태에서는, 로봇(1)을 교환한 후에 번잡한 교시 작업을 다시 행하지 않아도 되게, 제조 시스템(3)에 설치되는 로봇(1)이 교환되면, 교환 전의 로봇(1)의 교시 작업에서 교시되었던 교시 위치의 좌표에 대한 교환 후의 로봇(1)의 로봇 좌표계의 어긋남을 보정하기 위한 보정값을 산출한다. 즉, 교환 후의 로봇(1)의 동작을 보정하기 위한 보정값을 산출한다. 이하, 이 보정값의 산출 방법을 설명한다.On the other hand, if the misalignment of the robot coordinate system of the robot 1 after the exchange with respect to the coordinates of the teaching position taught in the teaching operation of the robot 1 before the replacement is corrected, it becomes unnecessary to perform the complicated teaching operation again. In this embodiment, when the robot 1 installed in the manufacturing system 3 is replaced so that it is not necessary to perform the complicated teaching work again after replacing the robot 1, the teaching work of the robot 1 before replacement is performed. A correction value for correcting the deviation of the robot coordinate system of the robot 1 after the exchange with respect to the coordinates of the teaching position is calculated. That is, a correction value for correcting the operation of the robot 1 after replacement is calculated. Hereinafter, the calculation method of this correction value is demonstrated.

이하의 설명에서는, 제1 암부(15)에 대한 제2 암부(16)의 회동 방향에 있어서의 제2 암부(16)의 소정의 기준 위치를 제1 기준 위치라 하고, 제2 암부(16)에 대한 핸드 기초부(17)의 회동 방향에 있어서의 핸드 기초부(17)의 소정의 기준 위치를 제2 기준 위치라 하고, 핸드 기초부(17)에 대한 핸드 포크(18)의 긴 변 방향에 직교하는 방향에 있어서의 핸드 포크(18)의 소정의 기준 위치를 제3 기준 위치라 하고, 본체부(10)에 대한 제1 암부(15)의 회동 방향에 있어서의 제1 암부(15)의 소정의 기준 위치를 제4 기준 위치라 한다.In the following description, the predetermined reference position of the second arm portion 16 in the rotational direction of the second arm portion 16 with respect to the first arm portion 15 is referred to as the first reference position, and the second arm portion 16 The predetermined reference position of the hand base 17 in the rotational direction of the hand base 17 relative to the second base position is referred to as the long side direction of the hand fork 18 with respect to the hand base 17. The predetermined reference position of the hand fork 18 in the direction orthogonal to the third reference position is referred to as the first arm 15 in the rotational direction of the first arm 15 relative to the main body 10. The predetermined reference position of is referred to as a fourth reference position.

본 형태에서는, 제2 암부(16)가 제1 기준 위치에 있을 때는, 도 4에 나타내는 바와 같이, 제1 암부(15)와 제2 암부(16)가 상하 방향에서 겹쳐 있다. 구체적으로는, 제2 암부(16)가 제1 기준 위치에 있을 때는, 상하 방향에서부터 보았을 때 제1 암부(15)의 긴 변 방향과 제2 암부(16)의 긴 변 방향이 일치하도록, 제1 암부(15)와 제2 암부(16)가 상하 방향에서 겹쳐 있다. 또한, 본 형태에서는, 제1 암부(15)에 대한 제2 암부(16)의 회동 방향에 있어서의 제2 암부(16)의 원점 위치와 제1 기준 위치가 일치되어 있다.In this embodiment, when the 2nd arm part 16 is in a 1st reference position, as shown in FIG. 4, the 1st arm part 15 and the 2nd arm part 16 overlap in an up-down direction. Specifically, when the second arm portion 16 is in the first reference position, the long side direction of the first arm portion 15 and the long side direction of the second arm portion 16 coincide with each other when viewed from the vertical direction. The 1st arm part 15 and the 2nd arm part 16 overlap in the up-down direction. In addition, in this form, the origin position of the 2nd arm part 16 and the 1st reference position in the rotation direction of the 2nd arm part 16 with respect to the 1st arm part 15 correspond.

또한, 핸드 기초부(17)가 제2 기준 위치에 있을 때는, 도 4에 나타내는 바와 같이, 제2 암부(16)와 핸드 포크(18)가 상하 방향에서 겹쳐 있다. 구체적으로는, 핸드 기초부(17)가 제2 기준 위치에 있을 때는, 상하 방향에서부터 보았을 때 제2 암부(16)의 긴 변 방향과 핸드 포크(18)의 긴 변 방향이 일치하도록, 제2 암부(16)와 핸드 포크(18)가 상하 방향에서 겹쳐 있다. 또한, 본 형태에서는, 제2 암부(16)에 대한 핸드 기초부(17)의 회동 방향에 있어서의 핸드 기초부(17)의 원점 위치로부터 핸드 기초부(17)가 90° 회동한 위치가 제2 기준 위치로 되어 있다.In addition, when the hand base part 17 is in a 2nd reference position, as shown in FIG. 4, the 2nd arm part 16 and the hand fork 18 overlap in an up-down direction. Specifically, when the hand base part 17 is in a 2nd reference position, when it sees from the up-down direction, the 2nd so that the long side direction of the 2nd arm part 16 and the long side direction of the hand fork 18 may correspond, The arm part 16 and the hand fork 18 overlap in an up-down direction. In addition, in this form, the position where the hand base part 17 rotated 90 degrees from the origin position of the hand base part 17 in the rotation direction of the hand base part 17 with respect to the 2nd arm part 16 is a 1st position. 2 is the reference position.

또한, 제4 기준 위치는, 본체부(10)에 대한 제1 암부(15)의 회동 방향에 있어서의 제1 암부(15)의 원점 위치와 일치되어 있어도 되고, 본체부(10)에 대한 제1 암부(15)의 회동 방향에 있어서의 제1 암부(15)의 원점 위치로부터 제1 암부(15)가 소정 각도 회동한 위치가 제4 기준 위치로 되어 있어도 된다.In addition, the 4th reference position may correspond with the origin position of the 1st arm part 15 in the rotation direction of the 1st arm part 15 with respect to the main body part 10, and The position where the 1st arm part 15 rotated predetermined angle from the origin position of the 1st arm part 15 in the rotation direction of the 1st arm part 15 may be set as 4th reference position.

또한, 본 형태에서는, 제1 기준 위치에 제2 암부(16)를 위치 결정하기 위한 위치 결정 지그(36)와, 제2 기준 위치에 핸드 기초부(17)를 위치 결정하기 위한 위치 결정 지그(37)와, 제3 기준 위치에 핸드 포크(18)를 위치 결정하기 위한 위치 결정 지그(38)가 사용된다. 본 형태의 위치 결정 지그(36)는 제1 위치 결정 지그이고, 위치 결정 지그(37)는 제2 위치 결정 지그이고, 위치 결정 지그(38)는 제3 위치 결정 지그이다. 또한, 위치 결정 지그(38)는, 핸드 포크(19)의 긴 변 방향에 직교하는 방향에 있어서의 핸드 기초부(17)에 대한 핸드 포크(19)의 소정의 기준 위치에 핸드 포크(19)를 위치 결정할 때도 사용된다.Moreover, in this form, the positioning jig 36 for positioning the 2nd arm part 16 in a 1st reference position, and the positioning jig (for positioning the hand base part 17 in a 2nd reference position) 37 and a positioning jig 38 for positioning the hand fork 18 at the third reference position is used. The positioning jig 36 of this embodiment is a first positioning jig, the positioning jig 37 is a second positioning jig, and the positioning jig 38 is a third positioning jig. Moreover, the positioning jig 38 has the hand fork 19 in the predetermined reference position of the hand fork 19 with respect to the hand base 17 in the direction orthogonal to the long side direction of the hand fork 19. It is also used for positioning.

도 5에 나타내는 바와 같이, 위치 결정 지그(36)는, 제1 암부(15)에 고정되는 고정 부재(41)와, 핀(42)을 구비하고 있다. 고정 부재(41)는, 제1 암부(15)의 기단부의 측면에 고정되어 있다. 고정 부재(41)에는, 핀(42)이 삽입되는 관통 구멍(41a)이 형성되어 있다. 또한, 제2 암부(16)의 선단의 측면에는, 핀(42)이 삽입되는 삽입 구멍(16a)이 형성되어 있다. 고정 부재(41)의 관통 구멍(41a)에 삽입된 핀(42)이 삽입 구멍(16a)에 삽입되면, 제2 암부(16)가 제1 기준 위치에 엄밀하게 위치 결정된다. 본 형태의 고정 부재(41)는 제1 고정 부재이고, 핀(42)은 제1 핀이고, 삽입 구멍(16a)은 제1 삽입 구멍이고, 관통 구멍(41a)은 제1 관통 구멍이다.As shown in FIG. 5, the positioning jig 36 includes a fixing member 41 fixed to the first arm 15 and a pin 42. The fixing member 41 is fixed to the side surface of the base end of the first arm 15. In the fixing member 41, a through hole 41a into which the pin 42 is inserted is formed. Moreover, the insertion hole 16a in which the pin 42 is inserted is formed in the side surface of the front-end | tip of the 2nd arm part 16. As shown in FIG. When the pin 42 inserted into the through hole 41a of the fixing member 41 is inserted into the insertion hole 16a, the second arm portion 16 is precisely positioned at the first reference position. The fixing member 41 of this embodiment is a first fixing member, the pin 42 is a first pin, the insertion hole 16a is a first insertion hole, and the through hole 41a is a first through hole.

도 6에 나타내는 바와 같이, 위치 결정 지그(37)는, 제1 암부(15)에 고정되는 고정 부재(43, 44)와, 핀(45)을 구비하고 있다. 고정 부재(43)는, 제1 암부(15)의 기단부의 측면에 고정되어 있다. 고정 부재(44)는, 고정 부재(43)의 측면에 고정되어 있다. 고정 부재(43)에는, 고정 부재(41)와의 간섭을 방지하기 위한 홈부가 형성되어 있다. 고정 부재(44)의 저면에는, 고정 부재(43)에 대한 고정 부재(44)의 상하 방향의 위치를 조정하기 위한 나사(46)의 선단면이 접촉하고 있다. 나사(46)는, 고정 부재(43)의 하단부면에 고정되는 나사 보유 지지 부재(47)에 나사 결합하고 있다.As shown in FIG. 6, the positioning jig 37 includes fixing members 43 and 44 fixed to the first arm 15, and a pin 45. The fixing member 43 is fixed to the side surface of the base end of the first arm 15. The fixing member 44 is fixed to the side surface of the fixing member 43. The fixing member 43 is provided with a groove portion for preventing interference with the fixing member 41. The bottom surface of the fixing member 44 is in contact with the distal end surface of the screw 46 for adjusting the vertical position of the fixing member 44 with respect to the fixing member 43. The screw 46 is screwed to the screw holding member 47 fixed to the lower end surface of the fixing member 43.

고정 부재(44)에는, 핀(45)이 삽입되는 관통 구멍(44a)이 형성되어 있다. 또한, 핸드 기초부(17)의 측면에는, 핀(45)이 삽입되는 삽입 구멍(17a)이 형성되어 있다. 고정 부재(44)의 관통 구멍(44a)에 삽입된 핀(45)이 삽입 구멍(17a)에 삽입되면, 핸드 기초부(17)가 제2 기준 위치에 엄밀하게 위치 결정된다. 본 형태의 고정 부재(43, 44)는 제2 고정 부재이고, 핀(45)은 제2 핀이고, 삽입 구멍(17a)은 제2 삽입 구멍이고, 관통 구멍(44a)은 제2 관통 구멍이다.In the fixing member 44, a through hole 44a into which the pin 45 is inserted is formed. Moreover, the insertion hole 17a in which the pin 45 is inserted is formed in the side surface of the hand base part 17. As shown in FIG. When the pin 45 inserted into the through hole 44a of the fixing member 44 is inserted into the insertion hole 17a, the hand base 17 is precisely positioned at the second reference position. The fixing members 43 and 44 of this form are a 2nd fixing member, the pin 45 is a 2nd pin, the insertion hole 17a is a 2nd insertion hole, and the through hole 44a is a 2nd through hole. .

도 7에 나타내는 바와 같이, 위치 결정 지그(38)는, 2개의 핸드 포크(18)에 고정되는 고정 부재(48, 49)와, 핀(50)을 구비하고 있다. 고정 부재(48)는, 2개의 핸드 포크(18)의 상면에 고정되어 있다. 고정 부재(49)는, 고정 부재(48)의 하면에 고정되어 있다. 고정 부재(49)에는, 핀(50)이 삽입되는 관통 구멍(49a)이 형성되어 있다. 또한, 제2 암부(16)의 기단부의 측면에는, 핀(50)이 삽입되는 삽입 구멍(16b)이 형성되어 있다. 고정 부재(49)의 관통 구멍(49a)에 삽입된 핀(50)이 삽입 구멍(16b)에 삽입되면, 2개의 핸드 포크(18)가 제3 기준 위치에 엄밀하게 위치 결정된다. 본 형태의 고정 부재(48, 49)는 제3 고정 부재이고, 핀(50)은 제3 핀이고, 삽입 구멍(16b)은 제3 삽입 구멍이고, 관통 구멍(49a)은 제3 관통 구멍이다.As shown in FIG. 7, the positioning jig 38 is provided with the fixing members 48 and 49 and the pin 50 which are fixed to the two hand forks 18. As shown in FIG. The fixing member 48 is fixed to the upper surfaces of the two hand forks 18. The fixing member 49 is fixed to the lower surface of the fixing member 48. In the fixing member 49, a through hole 49a into which the pin 50 is inserted is formed. Moreover, the insertion hole 16b in which the pin 50 is inserted is formed in the side surface of the base end part of the 2nd arm part 16. As shown in FIG. When the pin 50 inserted into the through hole 49a of the fixing member 49 is inserted into the insertion hole 16b, the two hand forks 18 are precisely positioned at the third reference position. The fixing members 48 and 49 of this embodiment are the third fixing members, the pin 50 is the third pin, the insertion hole 16b is the third insertion hole, and the through hole 49a is the third through hole. .

예를 들어, 제조 시스템(3)에 설치되는 로봇(1)이 교환되면, 먼저, 로봇(1)의 조정이 행해진다. 구체적으로는, 먼저, 원점 센서(32)의 검지 결과에 기초하여 제2 암부(16)를 제1 기준 위치(원점 위치)로 회동시킨다. 즉, 제1 기준 위치에서 제2 암부(16)가 정지하도록 원점 센서(32)의 검지 결과에 기초하여 제2 암부(16)를 회동시켜서 정지시킨다.For example, when the robot 1 installed in the manufacturing system 3 is replaced, first, the robot 1 is adjusted. Specifically, first, the second arm 16 is rotated to the first reference position (origin position) based on the detection result of the origin sensor 32. That is, based on the detection result of the origin sensor 32, the 2nd arm part 16 is rotated and stopped so that the 2nd arm part 16 may stop at a 1st reference position.

또한, 원점 센서(33)의 검지 결과와 인코더(26)의 검지 결과에 기초하여 핸드 기초부(17)를 제2 기준 위치(원점 위치에서 90° 회동한 위치)로 회동시킨다. 예를 들어, 원점 센서(33)의 검지 결과에 기초하여 핸드 기초부(17)를 원점 위치로 회동시킨 후, 인코더(26)의 검지 결과에 기초하여 핸드 기초부(17)를 원점 위치로부터 제2 기준 위치로 회동시킨다. 즉, 제2 기준 위치에서 핸드 기초부(17)가 정지하도록 원점 센서(33)의 검지 결과와 인코더(26)의 검지 결과에 기초하여 핸드 기초부(17)를 회동시켜서 정지시킨다.Further, based on the detection result of the origin sensor 33 and the detection result of the encoder 26, the hand base 17 is rotated to the second reference position (the position rotated by 90 ° from the origin position). For example, after rotating the hand base 17 to the home position based on the detection result of the home sensor 33, the hand base 17 is removed from the home position based on the detection result of the encoder 26. 2 Rotate to the reference position. That is, the hand base 17 is rotated and stopped based on the detection result of the origin sensor 33 and the encoder 26 so that the hand base 17 stops at the second reference position.

그 후, 고정 부재(41, 43, 44)를 제1 암부(15)에 고정하고, 고정 부재(48, 49)를 2개의 핸드 포크(18)에 고정한다. 또한, 원점 센서(32)의 검지 결과에 기초하여 제1 기준 위치에 회동한 제2 암부(16)는, 엄밀하게는 제1 기준 위치로부터 약간 어긋나 있다. 마찬가지로, 원점 센서(33)의 검지 결과와 인코더(26)의 검지 결과에 기초하여 제2 기준 위치에 회동한 핸드 기초부(17)는, 엄밀하게는 제2 기준 위치로부터 약간 어긋나 있다.Thereafter, the fixing members 41, 43, 44 are fixed to the first arm 15, and the fixing members 48, 49 are fixed to the two hand forks 18. In addition, the 2nd arm part 16 which rotated to the 1st reference position based on the detection result of the origin sensor 32 is strictly shifted | deviated slightly from the 1st reference position. Similarly, the hand base part 17 which rotated to the 2nd reference position based on the detection result of the origin sensor 33 and the detection result of the encoder 26 is slightly shift | deviated from the 2nd reference position strictly.

그 후, 고정 부재(41)의 관통 구멍(41a)에 삽입된 핀(42)이 삽입 구멍(16a)에 끼워지는 위치까지 제1 암부(15)에 대하여 제2 암부(16)를 회동시켜서 삽입 구멍(16a)에 핀(42)을 삽입하고, 제1 기준 위치에 제2 암부(16)를 엄밀하게 위치 결정한다. 또한, 그때의 모터(22)의 회동량을 인코더(25)에서 검지하고, 제어부(27)는, 인코더(25)에서의 검지 결과를 사용하여 제2 암부(16)의 제1 기준 위치를 특정한다.After that, the second arm 16 is rotated with respect to the first arm 15 to the position where the pin 42 inserted into the through hole 41a of the fixing member 41 is fitted into the insertion hole 16a. The pin 42 is inserted into the hole 16a and the second arm 16 is precisely positioned at the first reference position. In addition, the rotation amount of the motor 22 at that time is detected by the encoder 25, and the control unit 27 specifies the first reference position of the second arm unit 16 using the detection result of the encoder 25. do.

즉, 제1 기준 위치에서 제2 암부(16)가 정지하도록 원점 센서(32)의 검지 결과에 기초하여 제2 암부(16)를 정지시켰을 때의 제2 암부(16)의 정지 위치인 제1 정지 위치로부터, 위치 결정 지그(36)에 의해 제1 기준 위치에 제2 암부(16)가 위치 결정되는 위치까지 제2 암부(16)를 회동시켰을 때의 인코더(25)의 검지 결과와, 제1 정지 위치에 제2 암부(16)가 정지해 있을 때의 인코더(25)의 값에 기초하여 제1 기준 위치를 특정한다(제1 기준 위치 특정 공정).That is, the 1st which is the stop position of the 2nd arm part 16 when the 2nd arm part 16 is stopped based on the detection result of the origin sensor 32 so that the 2nd arm part 16 may stop in a 1st reference position. The detection result of the encoder 25 at the time of rotating the 2nd arm part 16 from the stop position to the position where the 2nd arm part 16 is positioned by the positioning jig 36 to a 1st reference position, and The first reference position is specified based on the value of the encoder 25 when the second arm 16 is stopped at the first stop position (first reference position specifying step).

그 후, 제1 기준 위치 특정 공정에서 특정된 제1 기준 위치에 제2 암부(16)가 배치되어 있는 상태에서, 고정 부재(44)의 관통 구멍(44a)에 삽입된 핀(45)이 삽입 구멍(17a)에 끼워지는 위치까지 제2 암부(16)에 대하여 핸드 기초부(17)를 회동시켜서 삽입 구멍(17a)에 핀(45)을 삽입하고, 제2 기준 위치에 핸드 기초부(17)를 엄밀하게 위치 결정한다. 또한, 그때의 모터(23)의 회동량을 인코더(26)에서 검지하고, 제어부(27)는, 인코더(26)에서의 검지 결과를 사용하여 핸드 기초부(17)의 제2 기준 위치를 특정한다.Thereafter, the pin 45 inserted into the through hole 44a of the fixing member 44 is inserted while the second arm 16 is disposed at the first reference position specified in the first reference position specifying step. The hand base part 17 is inserted in the insertion hole 17a by rotating the hand base part 17 with respect to the 2nd arm part 16 to the position which fits into the hole 17a, and the hand base part 17 in a 2nd reference position. )). Moreover, the rotation amount of the motor 23 at that time is detected by the encoder 26, and the control part 27 specifies the 2nd reference position of the hand base part 17 using the detection result by the encoder 26. do.

즉, 제1 기준 위치 특정 공정에서 특정된 제1 기준 위치에 제2 암부(16)가 배치되어 있는 상태에서, 제2 기준 위치에서 핸드 기초부(17)가 정지하도록 원점 센서(33)의 검지 결과와 인코더(26)의 검지 결과에 기초하여 핸드 기초부(17)를 정지시켰을 때의 핸드 기초부(17)의 정지 위치인 제2 정지 위치로부터, 위치 결정 지그(37)에 의해 핸드 기초부(17)가 위치 결정되는 위치까지 핸드 기초부(17)를 회동시켰을 때의 인코더(26)의 검지 결과와, 제2 정지 위치에 핸드 기초부(17)가 정지해 있을 때의 인코더(26)의 값에 기초하여 제2 기준 위치를 특정한다(제2 기준 위치 특정 공정).That is, in the state in which the 2nd arm part 16 is arrange | positioned in the 1st reference position specified in the 1st reference position specification process, the origin sensor 33 is detected so that the hand base part 17 may stop in a 2nd reference position. Based on the result and the detection result of the encoder 26, the hand base portion is determined by the positioning jig 37 from the second stop position which is the stop position of the hand base portion 17 when the hand base portion 17 is stopped. The detection result of the encoder 26 when the hand base part 17 was rotated to the position where 17 is positioned, and the encoder 26 when the hand base part 17 is stopped in the 2nd stop position. A second reference position is specified based on the value of (second reference position specifying process).

그 후, 제1 기준 위치 특정 공정에서 특정된 제1 기준 위치에 제2 암부(16)가 배치되고, 또한, 제2 기준 위치 특정 공정에서 특정된 제2 기준 위치에 핸드 기초부(17)가 배치되어 있는 상태에서, 고정 부재(49)의 관통 구멍(49a)에 삽입된 핀(50)이 삽입 구멍(16b)에 끼워지는 위치까지, 핸드 포크(18)의 긴 변 방향에 직교하는 방향으로 핸드 기초부(17)에 대하여 2개의 핸드 포크(18)를 이동시켜서 삽입 구멍(16b)에 핀(50)을 삽입하고, 제3 기준 위치에 2개의 핸드 포크(18)를 위치 결정한다.Thereafter, the second arm portion 16 is disposed at the first reference position specified in the first reference position specifying process, and the hand base portion 17 is placed at the second reference position specified in the second reference position specifying process. In the state arranged, in the direction orthogonal to the long side direction of the hand fork 18 to the position where the pin 50 inserted in the through-hole 49a of the fixing member 49 fits in the insertion hole 16b. The two hand forks 18 are moved relative to the hand base 17 to insert the pin 50 into the insertion hole 16b, and the two hand forks 18 are positioned at the third reference position.

즉, 제1 기준 위치 특정 공정에서 특정된 제1 기준 위치에 제2 암부(16)가 배치되고, 또한, 제2 기준 위치 특정 공정에서 특정된 제2 기준 위치에 핸드 기초부(17)가 배치되어 있는 상태에서, 위치 결정 지그(38)에 의해 2개의 핸드 포크(18)를 위치 결정한다(핸드 포크 위치 결정 공정). 위치 결정된 핸드 포크(18)는, 나사에 의해 핸드 기초부(17)에 고정된다.That is, the second arm 16 is disposed at the first reference position specified in the first reference position specifying process, and the hand base 17 is disposed at the second reference position specified in the second reference position specifying process. In this state, the two hand forks 18 are positioned by the positioning jig 38 (hand fork positioning process). The positioned hand fork 18 is fixed to the hand base 17 by screws.

그 후, 적어도 위치 결정 지그(37, 38)를 분리함과 함께, 제2 암부(16)에 대하여 핸드 기초부(17)를 180° 회동시킨다. 이 상태에서, 고정 부재(48, 49)를 2개의 핸드 포크(19)에 고정한다. 또한, 고정 부재(49)의 관통 구멍(49a)에 삽입된 핀(50)이 삽입 구멍(16b)에 끼워지는 위치까지, 핸드 포크(19)의 긴 변 방향에 직교하는 방향으로 핸드 기초부(17)에 대하여 2개의 핸드 포크(19)를 이동시켜서 삽입 구멍(16b)에 핀(50)을 삽입하고, 소정의 기준 위치에 2개의 핸드 포크(19)를 위치 결정한다.Thereafter, at least the positioning jigs 37 and 38 are separated, and the hand base 17 is rotated 180 degrees with respect to the second arm 16. In this state, the fixing members 48 and 49 are fixed to the two hand forks 19. Moreover, the hand base part (in the direction orthogonal to the long side direction of the hand fork 19 to the position which the pin 50 inserted in the through-hole 49a of the fixing member 49 fits in the insertion hole 16b) is carried out. The two hand forks 19 are moved with respect to 17, the pin 50 is inserted into the insertion hole 16b, and the two hand forks 19 are positioned at a predetermined reference position.

즉, 핸드 기초부(17)를 180° 회동시킴과 함께, 위치 결정 지그(38)에 의해, 핸드 기초부(17)에 대한 핸드 포크(19)의 긴 변 방향에 직교하는 방향에 있어서의 핸드 포크(19)의 소정의 기준 위치에 2개의 핸드 포크(19)를 위치 결정한다(제2 핸드 포크 위치 결정 공정). 위치 결정된 핸드 포크(19)는, 나사에 의해 핸드 기초부(17)에 고정된다. 또한, 제2 핸드 포크 위치 결정 공정이 끝나면, 로봇(1)의 사전 조정이 종료된다.That is, the hand base part 17 is rotated 180 degrees and the positioning jig 38 makes the hand in the direction orthogonal to the long side direction of the hand fork 19 with respect to the hand base part 17. The two hand forks 19 are positioned at the predetermined reference positions of the forks 19 (second hand fork positioning process). The positioned hand fork 19 is fixed to the hand base 17 by a screw. Moreover, when the 2nd hand fork positioning process is complete | finished, the preconditioning of the robot 1 is complete | finished.

그 후, 2개의 핸드 포크(18)에 검지용 패널(52)(도 8 참조)을 탑재한다(패널 탑재 공정). 검지용 패널(52)은, 후술하는 보정값 산출 공정에 있어서 보정값을 산출할 때 사용되는 패널이고, 예를 들어 직사각형의 평판형으로 형성되어 있다. 검지용 패널(52)은, 핸드 포크(18)의 상면에 설치된 위치 결정 부재에 의해 위치 결정된 상태에서, 2개의 핸드 포크(18)에 탑재되어 있다.Thereafter, the detection panel 52 (see FIG. 8) is mounted on the two hand forks 18 (panel mounting step). The detection panel 52 is a panel used when calculating the correction value in the correction value calculating step described later, and is formed in a rectangular flat plate shape, for example. The detection panel 52 is mounted on the two hand forks 18 in a state of being positioned by the positioning member provided on the upper surface of the hand fork 18.

그 후, 제4 기준 위치에서 제1 암부(15)가 정지하도록 원점 센서(31)의 검지 결과에 기초하여 또는 원점 센서(31)의 검지 결과와 인코더(24)의 검지 결과에 기초하여 제1 암부(15)를 정지시켰을 때의 제1 암부(15)의 정지 위치인 제3 정지 위치를 기준으로 하여 모터(21)를 구동 제어하고, 제1 기준 위치 특정 공정에서 특정된 제1 기준 위치를 기준으로 하여 모터(22)를 구동 제어함과 함께, 제2 기준 위치 특정 공정에서 특정된 제2 기준 위치를 기준으로 하여 모터(23)를 구동 제어하여, 로봇(1)을 가상의 기준 자세로 한다(로봇 동작 공정).Thereafter, the first arm 15 stops at the fourth reference position based on the detection result of the origin sensor 31 or the detection result of the origin sensor 31 and the detection result of the encoder 24. The motor 21 is driven and controlled on the basis of the third stop position, which is the stop position of the first arm portion 15 when the arm portion 15 is stopped, and the first reference position specified in the first reference position specifying step is determined. Drive control of the motor 22 on the basis of the reference, drive control of the motor 23 on the basis of the second reference position specified in the second reference position specifying process, the robot 1 to the virtual reference attitude (Robot operation process).

즉, 제3 정지 위치를 기준으로 하여 모터(21)를 구동 제어하고, 제1 기준 위치 특정 공정에서 특정된 제1 기준 위치를 기준으로 하여 모터(22)를 구동 제어함과 함께, 제2 기준 위치 특정 공정에서 특정된 제2 기준 위치를 기준으로 하여 모터(23)를 구동 제어하여, 로봇(1)을 가상의 동작 개시 위치까지 동작시킨다. 본 형태에서는, 예를 들어 제1 암(15)이 제3 정지 위치에 정지하고, 제2 암부(16)가 제1 기준 위치에 정지하고, 핸드 기초부(17)가 제2 기준 위치로부터 90° 회동한 위치에 정지해 있는 상태가 로봇(1)의 가상의 동작 개시 위치로 되어 있다. 또한, 본 형태에서는, 로봇(1)의 동작 개시 위치와 로봇(1)의 홈 포지션이 일치되어 있다. 단, 로봇(1)의 동작 개시 위치와 로봇(1)의 홈 포지션이 어긋나 있어도 된다.That is, driving control of the motor 21 is performed on the basis of the third stop position, drive control of the motor 22 on the basis of the first reference position specified in the first reference position specifying process, and the second reference. The motor 23 is driven and controlled based on the second reference position specified in the position specifying process, and the robot 1 is operated to the virtual operation start position. In this embodiment, for example, the first arm 15 stops at the third stop position, the second arm portion 16 stops at the first reference position, and the hand base 17 moves 90 degrees from the second reference position. The state stopped at the rotated position is the virtual operation start position of the robot 1. In addition, in this form, the operation start position of the robot 1 and the home position of the robot 1 correspond. However, the operation start position of the robot 1 and the home position of the robot 1 may be shifted.

또한, 본체부(10)에 대한 제1 암부(15)의 회동 방향에 있어서의 제1 암부(15)의 원점 위치와 제4 기준 위치가 일치되어 있는 경우에는, 로봇 동작 공정에 있어서, 제4 기준 위치에서 제1 암부(15)가 정지하도록 원점 센서(31)의 검지 결과에 기초하여 제1 암부(15)를 회동시켜서 정지시킨다. 또한, 본체부(10)에 대한 제1 암부(15)의 회동 방향에 있어서의 제1 암부(15)의 원점 위치로부터 제1 암부(15)가 소정 각도 회동한 위치가 제4 기준 위치로 되어 있는 경우에는, 로봇 동작 공정에 있어서, 제4 기준 위치에서 제1 암부(15)가 정지하도록, 원점 센서(31)의 검지 결과와 인코더(24)의 검지 결과에 기초하여 제1 암부(15)를 회동시켜서 정지시킨다. 또한, 제3 정지 위치는, 엄밀하게는 제4 기준 위치로부터 약간 어긋나 있다. 또한, 로봇 동작 공정 전까지, 위치 결정 지그(36, 38)는 분리되어 있다.In addition, when the origin position of the 1st arm part 15 and the 4th reference | standard position in the rotation direction of the 1st arm part 15 with respect to the main-body part 10 correspond, it is a 4th robot operation process. The first arm 15 is rotated and stopped based on the detection result of the origin sensor 31 so that the first arm 15 stops at the reference position. Moreover, the position where the 1st arm part 15 rotated predetermined angle from the origin position of the 1st arm part 15 in the rotation direction of the 1st arm part 15 with respect to the main body part 10 turns into a 4th reference position. If there is, in the robot operation process, the first arm 15 is based on the detection result of the origin sensor 31 and the encoder 24 so that the first arm 15 stops at the fourth reference position. Rotate to stop. In addition, the 3rd stop position is strictly shifted | deviated slightly from the 4th reference position. In addition, until the robot operation process, the positioning jig 36 and 38 are isolate | separated.

그 후, 로봇(1)을 동작시켜서 기판(2)의 전달 위치로 핸드 포크(18)를 이동시킨다(핸드 이동 공정). 예를 들어, 도 8의 (A)에 나타내는 바와 같이, 챔버(6) 내의 기판(2)의 전달 위치로 핸드 포크(18)를 이동시킨다. 구체적으로는, 암(9)을 연장시키고, 챔버(6) 내의 기판(2)의 전달 위치로 핸드 포크(18)를 이동시킨다. 그 후, 소정의 기준 위치인 제5 기준 위치와 검지용 패널(52)의 에지의, 본체부(10)에 대한 제1 암부(15)의 회동 방향에 있어서의 어긋남양에 기초하여 모터(21)를 제어하기 위한 보정값을 산출한다(보정값 산출 공정).Thereafter, the robot 1 is operated to move the hand fork 18 to the transfer position of the substrate 2 (hand movement step). For example, as shown in FIG. 8A, the hand fork 18 is moved to the transfer position of the substrate 2 in the chamber 6. Specifically, the arm 9 is extended and the hand fork 18 is moved to the transfer position of the substrate 2 in the chamber 6. Then, the motor 21 is based on the shift amount of the 5th reference position which is a predetermined reference position, and the edge of the detection panel 52 in the rotation direction of the 1st arm part 15 with respect to the main-body part 10. ) Is calculated (correction value calculating step).

구체적으로는, 핸드 포크(18)에 검지용 패널(52)이 탑재된 교환 전의 로봇(1)을 동작시켜서 기판(2)의 전달 위치로 핸드 포크(18)를 이동시켰을 때, 본체부(10)에 대한 제1 암부(15)의 회동 방향에 있어서 검지용 패널(52)의 에지가 배치되는 위치가 제5 기준 위치로 되어 있다. 또한, 제5 기준 위치에는, 1개의 센서(53)가 배치되어 있다. 센서(53)는, 예를 들어 발광 소자와 수광 소자를 갖는 광학식 센서 또는, 근접 센서이다. 센서(53)는, 챔버(6)의 내부에 설치되어 있다.Specifically, when the hand fork 18 is moved to the transfer position of the board | substrate 2 by operating the robot 1 before the exchange in which the detection panel 52 was mounted in the hand fork 18, the main-body part 10 The position where the edge of the detection panel 52 is arrange | positioned in the rotation direction of the 1st arm part 15 with respect to) is set as a 5th reference position. In addition, one sensor 53 is disposed at the fifth reference position. The sensor 53 is, for example, an optical sensor having a light emitting element and a light receiving element or a proximity sensor. The sensor 53 is provided inside the chamber 6.

보정값 산출 공정에서는, 센서(53)에서 검지용 패널(52)의 에지가 검지될 때까지(즉, 본체부(10)에 대한 제1 암부(15)의 회동 방향에 있어서, 제5 기준 위치와 검지용 패널(52)의 에지가 일치할 때까지) 제1 암부(15)를 회동시켰을 때의 인코더(24)의 검지 결과에 기초하여 제어부(27)가 보정값을 산출한다.In the correction value calculating step, the fifth reference position in the rotational direction of the first arm 15 with respect to the main body 10 is detected until the edge of the detection panel 52 is detected by the sensor 53. The control unit 27 calculates a correction value based on the detection result of the encoder 24 when the first arm unit 15 is rotated until the edges of the detection panel 52 coincide with each other.

예를 들어, 도 8의 (A)에 나타내는 바와 같이, 챔버(6) 내의 기판(2)의 전달 위치로 핸드 포크(18)를 이동시켰을 때, 제5 기준 위치에 배치되는 센서(53)와 검지용 패널(52)의 에지가, 본체부(10)에 대한 제1 암부(15)의 회동 방향에 있어서 어긋나 있는 경우에는, 보정값 산출 공정에 있어서, 도 8의 (B)에 나타내는 바와 같이, 센서(53)에서 검지용 패널(52)의 에지가 검지될 때까지 제1 암부(15)를 회동시킨다. 또한, 그때의 인코더(24)의 검지 결과에 기초하여 보정값을 산출한다. 또한, 검지용 패널(52)의 에지는, 센서(53)의 온/오프가 전환될 때 센서(53)에서 검지된다.For example, as shown to FIG. 8A, when the hand fork 18 is moved to the delivery position of the board | substrate 2 in the chamber 6, the sensor 53 arrange | positioned at a 5th reference position, and When the edge of the detection panel 52 is shift | deviated in the rotation direction of the 1st arm part 15 with respect to the main-body part 10, as shown in FIG. 8B in a correction value calculation process. The first arm 15 is rotated until the edge of the detection panel 52 is detected by the sensor 53. Further, a correction value is calculated based on the detection result of the encoder 24 at that time. In addition, the edge of the detection panel 52 is detected by the sensor 53 when the on / off of the sensor 53 is switched.

그 후, 보정값 산출 공정에서 산출된 보정값을 반영시켜서 모터(21)를 구동 제어하고, 제1 기준 위치 특정 공정에서 특정된 제1 기준 위치를 기준으로 하여 모터(22)를 구동 제어함과 함께, 제2 기준 위치 특정 공정에서 특정된 제2 기준 위치를 기준으로 하여 모터(23)를 구동 제어하여, 로봇(1)을 정규의 동작 개시 위치로 복귀시킨다.Thereafter, driving control of the motor 21 is performed by reflecting the correction value calculated in the correction value calculating step, and the drive control of the motor 22 is performed based on the first reference position specified in the first reference position specifying step; At the same time, drive control of the motor 23 is performed on the basis of the second reference position specified in the second reference position specifying step, and the robot 1 is returned to the normal operation start position.

또한, 본 형태에서는, 그 후, 핸드 기초부(17)를 180° 회동시킴과 함께 2개의 핸드 포크(19)에 검지용 패널(52)를 바꿔싣고 나서, 챔버(6) 내의 기판(2)의 전달 위치로 핸드 포크(19)를 이동시킨다. 이때, 핸드 포크(19)에 탑재된 검지용 패널(52)의 에지가 센서(53)에서 검지되지 않는 경우에는, 핸드 포크(19)에 탑재된 검지용 패널(52)의 에지가 센서(53)에서 검지되도록, 위치 결정 지그(38)를 사용하여, 핸드 포크(19)의 긴 변 방향에 직교하는 방향에 있어서의 핸드 기초부(17)에 대한 핸드 포크(19)의 고정 위치를 조정한다.In addition, in this embodiment, after rotating the hand base part 17 by 180 degrees, the detection panel 52 is replaced with two hand forks 19, and then the board | substrate 2 in the chamber 6 is carried out. Move the hand fork 19 to the delivery position of. At this time, when the edge of the detection panel 52 mounted on the hand fork 19 is not detected by the sensor 53, the edge of the detection panel 52 mounted on the hand fork 19 is the sensor 53. ), The fixed position of the hand fork 19 relative to the hand base 17 in the direction orthogonal to the long side direction of the hand fork 19 is adjusted using the positioning jig 38. .

(본 형태의 주된 효과)(Main effect of this form)

이상 설명한 바와 같이, 본 형태에서는, 제1 기준 위치 특정 공정에 있어서, 제1 암부(15)에 대한 제2 암부(16)의 회동 방향에 있어서의 제2 암부(16)의 기준 위치인 제1 기준 위치에 제2 암부(16)를 위치 결정하기 위한 위치 결정 지그(36)를 사용하여 제1 기준 위치를 특정하고 있다. 그 때문에, 본 형태에서는, 위치 결정 지그(36)를 사용하여 고정밀도로 특정된 제1 기준 위치에 제2 암부(16)를 맞추는 것이 가능해진다. 즉, 본 형태에서는, 제1 기준 위치에 제2 암부(16)를 정확히 맞추는 것이 가능해진다.As described above, in this embodiment, in the first reference position specifying step, the first position is the reference position of the second arm portion 16 in the rotational direction of the second arm portion 16 with respect to the first arm portion 15. The 1st reference position is specified using the positioning jig 36 for positioning the 2nd arm part 16 in a reference position. Therefore, in this embodiment, it becomes possible to match the 2nd arm part 16 to the 1st reference position specified with high precision using the positioning jig 36. As shown in FIG. That is, in this form, it becomes possible to match the 2nd arm part 16 exactly to a 1st reference position.

또한, 본 형태에서는, 제2 기준 위치 특정 공정에 있어서, 제2 암부(16)에 대한 핸드 기초부(17)의 회동 방향에 있어서의 핸드 기초부(17)의 기준 위치인 제2 기준 위치에 핸드 기초부(17)를 위치 결정하기 위한 위치 결정 지그(37)를 사용하여 제2 기준 위치를 특정하고 있다. 그 때문에, 본 형태에서는, 위치 결정 지그(37)를 사용하여 고정밀도로 특정된 제2 기준 위치에 핸드 기초부(17)를 맞추는 것이 가능해진다. 즉, 본 형태에서는, 제2 기준 위치에 핸드 기초부(17)를 정확히 맞추는 것이 가능해진다.Moreover, in this form, in the 2nd reference position specification process, it is located in the 2nd reference position which is the reference position of the hand base part 17 in the rotational direction of the hand base part 17 with respect to the 2nd arm part 16. In addition, in FIG. The second reference position is specified using the positioning jig 37 for positioning the hand base 17. Therefore, in this embodiment, it becomes possible to match the hand base part 17 to the 2nd reference position specified with high precision using the positioning jig 37. As shown in FIG. That is, in this form, it becomes possible to match the hand base part 17 correctly to a 2nd reference position.

또한, 본 형태에서는, 핸드 포크 위치 결정 공정에 있어서, 핸드 기초부(17)에 대한 핸드 포크(18)의 긴 변 방향에 직교하는 방향에 있어서의 핸드 포크(18)의 기준 위치인 제3 기준 위치에 핸드 포크(18)를 위치 결정하기 위한 위치 결정 지그(38)에 의해 제3 기준 위치에 핸드 포크(18)를 위치 결정하고 있다. 그 때문에, 본 형태에서는, 제3 기준 위치에 핸드 포크(18)를 정확히 맞출 수 있다.In addition, in this embodiment, in the hand fork positioning process, the third reference is the reference position of the hand fork 18 in the direction orthogonal to the long side direction of the hand fork 18 with respect to the hand base 17. The hand fork 18 is positioned at the third reference position by the positioning jig 38 for positioning the hand fork 18 at the position. Therefore, in this embodiment, the hand fork 18 can be correctly matched to a 3rd reference position.

또한, 본 형태에서는, 제1 기준 위치 특정 공정 후에 제1 기준 위치에 제2 암부(16)를 정확히 맞추는 것이 가능해지고, 또한, 제2 기준 위치 특정 공정 후에 제2 기준 위치에 핸드 기초부(17)를 정확히 맞추는 것이 가능해짐과 함께, 핸드 포크 위치 결정 공정에서 제3 기준 위치에 핸드 포크(18)를 정확히 맞출 수 있기 때문에, 제1 기준 위치에 제2 암부(16)를 정확에 맞추고, 또한, 제2 기준 위치에 핸드 기초부(17)를 정확히 맞춤과 함께, 제3 기준 위치에 핸드 포크(18)를 정확히 맞춘 후에, 로봇 동작 공정에 있어서, 로봇(1)을 가상의 기준 자세로 하고 나서, 핸드 이동 공정에 있어서, 기판(2)의 전달 위치로 핸드 포크(18)를 이동시키는 것이 가능해진다.In addition, in this embodiment, it becomes possible to exactly match the 2nd arm part 16 to a 1st reference position after a 1st reference position specification process, and also the hand base part 17 to a 2nd reference position after a 2nd reference position specification process. In addition to this, the hand fork 18 can be precisely aligned with the third reference position in the hand fork positioning process, and the second arm 16 is precisely aligned with the first reference position. After accurately fitting the hand base 17 to the second reference position and accurately fitting the hand fork 18 to the third reference position, the robot 1 is assumed to be a virtual reference posture in the robot operation step. Then, in the hand movement step, it becomes possible to move the hand fork 18 to the transfer position of the substrate 2.

또한, 본 형태에서는, 그 후의 보정값 산출 공정에 있어서, 제5 기준 위치와 검지용 패널(52)의 에지의, 본체부(10)에 대한 제1 암부(15)의 회동 방향에 있어서의 어긋남양에 기초하여 모터(21)를 제어하기 위한 보정값을 산출하고 있지만, 본 형태에서는, 핸드 포크(18)에 검지용 패널(52)이 탑재된 교환 전의 로봇(1)을 동작시켜서 기판(2)의 전달 위치로 핸드 포크(18)를 이동시켰을 때, 본체부(10)에 대한 제1 암부(15)의 회동 방향에 있어서 검지용 패널(52)의 에지가 배치되는 위치가 제5 기준 위치로 되어 있기 때문에, 보정값 산출 공정에 있어서, 모터(21)를 제어하기 위한 보정값을 산출함으로써, 교환 전의 로봇(1)의 교시 작업에서 교시되었던 교시 위치의 좌표에 대한 교환 후의 로봇(1)의 로봇 좌표계의 어긋남을 보정하기 위한 보정값을 산출하는 것이 가능해진다.In addition, in this form, in the subsequent correction value calculation process, the shift | offset | difference in the rotation direction of the 1st arm part 15 with respect to the main-body part 10 of the 5th reference position and the edge of the detection panel 52 is carried out. Although a correction value for controlling the motor 21 is calculated based on the quantity, in this embodiment, the robot 1 before replacement in which the detection panel 52 is mounted on the hand fork 18 is operated to operate the substrate 2. When the hand fork 18 is moved to the transfer position at the position of (), the position where the edge of the detecting panel 52 is arranged in the rotational direction of the first arm 15 with respect to the main body 10 is the fifth reference position. Since the correction value for controlling the motor 21 is calculated in the correction value calculating step, the robot 1 after the exchange with respect to the coordinates of the teaching position taught in the teaching operation of the robot 1 before the replacement. It is now possible to calculate the correction value for correcting the deviation of the robot coordinate system. All.

즉, 본 형태에서는, 제5 기준 위치와 검지용 패널(52)의 에지의, 본체부(10)에 대한 제1 암부(15)의 회동 방향에 있어서의 어긋남양에 기초하여 보정값을 산출함으로써, 교환 전의 로봇(1)의 교시 작업에서 교시되었던 교시 위치의 좌표에 대한 교환 후의 로봇(1)의 로봇 좌표계의 어긋남을 보정하기 위한 보정값을 산출하는 것이 가능해진다. 즉, 본체부(10)에 대한 제1 암부(15)의 회동 방향에 있어서의 로봇(1)의 어긋남양에만 기초하여 보정값을 산출하는 것이 가능해진다. 따라서, 본 형태에서는, 교환 전의 로봇(1)의 교시 작업에서 교시되었던 교시 위치의 좌표에 대한 교환 후의 로봇(1)의 로봇 좌표계의 어긋남을 보정하기 위한 보정값을 비교적 용이하게 산출하는 것이 가능해진다.In other words, in this embodiment, the correction value is calculated based on the amount of deviation in the rotational direction of the first arm 15 with respect to the main body 10 of the fifth reference position and the edge of the detection panel 52. It is possible to calculate a correction value for correcting the deviation of the robot coordinate system of the robot 1 after the exchange with respect to the coordinates of the teaching position taught in the teaching operation of the robot 1 before the replacement. That is, it becomes possible to calculate a correction value based only on the shift amount of the robot 1 in the rotation direction of the 1st arm part 15 with respect to the main-body part 10. FIG. Therefore, in this embodiment, the correction value for correcting the deviation of the robot coordinate system of the robot 1 after the exchange with respect to the coordinates of the teaching position taught in the teaching operation of the robot 1 before the exchange can be relatively easily calculated. .

또한, 본 형태에서는, 보정값 산출 공정에 있어서, 제5 기준 위치와 검지용 패널(52)의 에지의, 본체부(10)에 대한 제1 암부(15)의 회동 방향에 있어서의 어긋남양에 기초하여 보정값을 산출하면 되기 때문에, 1개의 센서(53)를 사용하여 보정값을 산출하는 것이 가능해진다. 또한, 본 형태에서는, 제2 핸드 포크 위치 결정 공정에 있어서, 핸드 기초부(17)를 180° 회동시킴과 함께, 위치 결정 지그(38)에 의해 소정의 기준 위치에 2개의 핸드 포크(19)를 위치 결정하고 있기 때문에, 공통의 위치 결정 지그(38)를 사용하여, 핸드 포크(18)의 위치 결정과 핸드 포크(19)의 위치 결정을 행하는 것이 가능해진다.Moreover, in this form, in the correction value calculation process, in the shift amount in the rotation direction of the 1st arm part 15 with respect to the main-body part 10 of the 5th reference position and the edge of the detection panel 52. Since it is only necessary to calculate the correction value on the basis, it becomes possible to calculate the correction value using one sensor 53. In addition, in this form, in the 2nd hand fork positioning process, the hand base part 17 is rotated 180 degrees, and the two hand forks 19 are predetermined by the positioning jig 38 at a predetermined reference position. Since positioning is performed, the positioning of the hand fork 18 and the positioning of the hand fork 19 can be performed using the common positioning jig 38.

(보정값 산출 공정의 변형예 1)(Modification 1 of the correction value calculating step)

상술한 형태에 있어서, 센서(53) 대신에 1개의 카메라를 사용하여, 제5 기준 위치와 검지용 패널(52)의 에지의, 본체부(10)에 대한 제1 암부(15)의 회동 방향에 있어서의 어긋남양을 구해도 된다. 이 경우에는, 예를 들어 챔버(6)의 내부 제5 기준 위치에 대응하는 개소에 소정의 마킹이 형성되어 있고, 카메라로 촬영된 마킹의 위치와 검지용 패널(52)의 에지의 어긋남양을 구함으로써, 제5 기준 위치와 검지용 패널(52)의 에지의 어긋남양을 구한다. 또한, 예를 들어 제5 기준 위치의 좌표가 제어부(27)에 미리 기억되어 있어, 카메라로 촬영된 검지용 패널(52)의 에지 좌표와 제5 기준 위치의 좌표에 기초하여, 제5 기준 위치와 검지용 패널(52)의 에지의 어긋남양을 구한다.In the above-described aspect, the rotation direction of the first arm 15 relative to the main body 10 of the fifth reference position and the edge of the panel 52 for detection is used by using one camera instead of the sensor 53. You may obtain the amount of deviation in the. In this case, for example, a predetermined marking is formed at a location corresponding to the fifth internal reference position of the chamber 6, and the deviation amount between the position of the marking taken by the camera and the edge of the detection panel 52 is adjusted. By calculating | required, the deviation amount of the 5th reference position and the edge of the detection panel 52 is calculated | required. In addition, for example, the coordinates of the fifth reference position are stored in advance in the control unit 27, and are based on the edge coordinates of the detection panel 52 captured by the camera and the coordinates of the fifth reference position. And the deviation amount of the edge of the detection panel 52 is calculated | required.

이 경우에는, 본체부(10)에 대하여 제1 암부(15)를 회동시키지 않아도, 제5 기준 위치와 검지용 패널(52)의 에지의 어긋남양을 구하는 것이 가능해진다. 또한, 이 경우에는, 예를 들어 카메라를 사용하여, 제5 기준 위치와 검지용 패널(52)의 에지의 어긋남양을 구한 후, 구한 어긋남양만큼, 본체부(10)에 대하여 제1 암부(15)를 회동시켰을 때의 인코더(24)의 검지 결과에 기초하여 보정값을 산출한다.In this case, even if the 1st arm part 15 is not rotated with respect to the main-body part 10, the shift amount of the 5th reference position and the edge of the detection panel 52 can be calculated | required. In this case, for example, a camera is used to determine the deviation amount between the fifth reference position and the edge of the detection panel 52, and then the first arm portion (1) is compared with the body portion 10 by the calculated deviation amount. The correction value is calculated based on the detection result of the encoder 24 when rotating 15).

또한, 이 경우라도, 제5 기준 위치와 검지용 패널(52)의 에지의, 본체부(10)에 대한 제1 암부(15)의 회동 방향에 있어서의 어긋남양에 기초하여 보정값을 산출하면 되기 때문에, 1개의 카메라를 사용하여 보정값을 산출하는 것이 가능해진다. 또한, 카메라 대신에 광학식 라인 센서를 사용하여, 제5 기준 위치와 검지용 패널(52)의 에지의, 본체부(10)에 대한 제1 암부(15)의 회동 방향에 있어서의 어긋남양을 구해도 된다. 이 경우라도, 본체부(10)에 대하여 제1 암부(15)를 회동시키지 않아도, 제5 기준 위치와 검지용 패널(52)의 에지의 어긋남양을 구하는 것이 가능해진다.Moreover, even in this case, if a correction value is calculated based on the shift amount in the rotation direction of the 1st arm part 15 with respect to the main-body part 10 of the 5th reference position and the edge of the detection panel 52, Therefore, the correction value can be calculated using one camera. Moreover, even if an optical line sensor is used instead of a camera, the shift amount in the rotational direction of the 1st arm part 15 with respect to the main-body part 10 of the 5th reference position and the edge of the detection panel 52 is calculated | required. do. Even in this case, the shift amount between the fifth reference position and the edge of the detection panel 52 can be obtained without rotating the first arm 15 with respect to the main body 10.

(보정값 산출 공정의 변형예 2)(Modification 2 of the correction value calculation step)

도 9는, 본 발명의 다른 실시 형태에 관한 보정값 산출 공정에서의 로봇(1)의 동작을 설명하기 위한 도면이다.9 is a view for explaining the operation of the robot 1 in the correction value calculating step according to another embodiment of the present invention.

상술한 형태에서는, 보정값 산출 공정에 있어서, 센서(53)를 사용하여, 본체부(10)에 대한 제1 암부(15)의 회동 방향으로 제5 기준 위치와 검지용 패널(52)의 에지가 일치하는 위치까지 제1 암부(15)를 회동시키고 있지만, 본체부(10)에 대한 제1 암부(15)의 회동 방향에 있어서 제5 기준 위치와 검지용 패널(52)의 에지가 일치하는 위치에서 검지용 패널(52)(핸드 포크(18)에 탑재된 검지용 패널(52))을 위치 결정하기 위한 제4 위치 결정 지그를 사용하여, 본체부(10)에 대한 제1 암부(15)의 회동 방향으로 제5 기준 위치와 검지용 패널(52)의 에지가 일치하는 위치까지 제1 암부(15)를 회동시켜도 된다.In the above-mentioned form, in the correction value calculation process, the 5th reference position and the edge of the detection panel 52 in the rotation direction of the 1st arm part 15 with respect to the main-body part 10 using the sensor 53 are used. Although the 1st arm part 15 is rotated to the position which coincides, the 5th reference position and the edge of the detection panel 52 match in the rotational direction of the 1st arm part 15 with respect to the main body part 10. First arm 15 relative to body portion 10 using a fourth positioning jig for positioning the detection panel 52 (detection panel 52 mounted on hand fork 18) at the position. You may rotate the 1st arm part 15 to the position which the 5th reference position and the edge of the detection panel 52 correspond to in the rotation direction of (circle).

이 경우, 제4 위치 결정 지그는, 예를 들어 핀(55)과, 핀(55)이 삽입되는 삽입 구멍(56a)이 형성되는 핀 보유 지지 부재(56)를 구비하고 있다. 핀 보유 지지 부재(56)는, 챔버(6)의 내부에 설치되어 있다. 검지용 패널(52)에는, 핀(55)이 삽입되는 관통 구멍(52a)이 형성되어 있다. 검지용 패널(52)의 관통 구멍(52a)에 삽입된 핀(55)이 핀 보유 지지 부재(56)의 삽입 구멍(56a)에 삽입되면, 본체부(10)에 대한 제1 암부(15)의 회동 방향에 있어서, 제5 기준 위치와 검지용 패널(52)의 에지가 일치하는 위치에서, 핸드 포크(18)에 탑재된 검지용 패널(52)이 위치 결정된다.In this case, the 4th positioning jig is equipped with the pin holding member 56 by which the pin 55 and the insertion hole 56a into which the pin 55 is inserted are formed, for example. The pin holding member 56 is provided inside the chamber 6. The detection panel 52 is formed with a through hole 52a into which the pin 55 is inserted. When the pin 55 inserted into the through hole 52a of the detecting panel 52 is inserted into the insertion hole 56a of the pin holding member 56, the first arm 15 with respect to the body portion 10 is provided. In the rotation direction of, the detection panel 52 mounted on the hand fork 18 is positioned at a position where the fifth reference position and the edge of the detection panel 52 coincide.

이 경우의 보정값 산출 공정에서는, 제4 위치 결정 지그에 의해 검지용 패널(52)이 위치 결정되는 위치까지 제1 암부(15)를 회동시켰을 때의 인코더(24)의 검지 결과에 기초하여 보정값을 산출한다. 예를 들어, 도 9의 (A)에 나타내는 바와 같이, 챔버(6) 내의 기판(2)의 전달 위치로 핸드 포크(18)를 이동시켰을 때, 핀 보유 지지 부재(56)의 삽입 구멍(56a)과 검지용 패널(52)의 관통 구멍(52a)이, 본체부(10)에 대한 제1 암부(15)의 회동 방향에 있어서 어긋나 있는 경우에는, 보정값 산출 공정에 있어서, 도 9의 (B)에 나타내는 바와 같이, 제4 위치 결정 지그에 의해 검지용 패널(52)이 위치 결정되는 위치까지 제1 암부(15)를 회동시킨다. 또한, 그때의 인코더(24)의 검지 결과에 기초하여 보정값을 산출한다.In the correction value calculation step in this case, the correction is performed based on the detection result of the encoder 24 when the first arm 15 is rotated to the position where the panel 52 for detection is positioned by the fourth positioning jig. Calculate the value. For example, as shown in FIG. 9A, when the hand fork 18 is moved to the transfer position of the substrate 2 in the chamber 6, the insertion hole 56a of the pin holding member 56 is moved. ) And the through-hole 52a of the detection panel 52 are shifted in the rotational direction of the first arm 15 with respect to the main body 10, in the correction value calculating step, As shown in B), the 1st arm part 15 is rotated to the position where the detection panel 52 is positioned by a 4th positioning jig. Further, a correction value is calculated based on the detection result of the encoder 24 at that time.

(다른 실시 형태)(Other embodiment)

상술한 형태는, 본 발명의 적합한 형태의 일례이기는 하지만, 이것으로 한정되는 것이 아니고, 본 발명의 요지를 변경하지 않는 범위에 있어서 여러가지 변형 실시가 가능하다.Although the form mentioned above is an example of the suitable form of this invention, it is not limited to this, A various deformation | transformation is possible in the range which does not change the summary of this invention.

상술한 형태에 있어서, 제1 암부(15)에 대한 제2 암부(16)의 회동 방향에 있어서의 제2 암부(16)의 원점 위치로부터 제2 암부(16)가 소정 각도 회동한 위치가 제1 기준 위치로 되어 있어도 된다. 이 경우에는, 제조 시스템(3)에 설치되는 로봇(1)이 교환되면, 제1 기준 위치에서 제2 암부(16)가 정지하도록 원점 센서(32)의 검지 결과와 인코더(25)의 검지 결과에 기초하여 제2 암부(16)를 회동시켜서 정지시킨다.In the above-mentioned form, the position where the 2nd arm part 16 rotated predetermined angle from the origin position of the 2nd arm part 16 in the rotation direction of the 2nd arm part 16 with respect to the 1st arm part 15 is made into the 1st arm part. It may be set to one reference position. In this case, when the robot 1 installed in the manufacturing system 3 is replaced, the detection result of the origin sensor 32 and the detection result of the encoder 25 so that the second arm 16 stops at the first reference position. On the basis of this, the second arm 16 is rotated to stop.

또한, 상술한 형태에 있어서, 제2 암부(16)에 대한 핸드 기초부(17)의 회동 방향에 있어서의 핸드 기초부(17)의 원점 위치와 제2 기준 위치가 일치되어 있어도 된다. 이 경우에는, 제조 시스템(3)에 설치되는 로봇(1)이 교환되면, 제2 기준 위치에서 핸드 기초부(17)가 정지하도록 원점 센서(33)의 검지 결과에 기초하여 핸드 기초부(17)를 회동시켜서 정지시킨다. 또한, 상술한 형태에 있어서, 로봇 동작 공정 후에 패널 탑재 공정이 행해져도 된다.Moreover, in the form mentioned above, the origin position of the hand base part 17 and the 2nd reference position in the rotation direction of the hand base part 17 with respect to the 2nd arm part 16 may correspond. In this case, when the robot 1 installed in the manufacturing system 3 is replaced, the hand base part 17 is based on the detection result of the origin sensor 33 so that the hand base part 17 stops at a 2nd reference position. To stop. In the above-described aspect, the panel mounting step may be performed after the robot operation step.

상술한 형태에서는, 제조 시스템(3)에 설치된 로봇(1)에 대하여, 제1 기준 위치 특정 공정과 제2 기준 위치 특정 공정과 핸드 포크 위치 결정 공정을 행하고 있지만, 제조 시스템(3)에 설치되기 전의 로봇(1)에 대하여, 제1 기준 위치 특정 공정과 제2 기준 위치 특정 공정과 핸드 포크 위치 결정 공정을 행해도 된다. 예를 들어, 로봇(1)의 조립 공장에 있어서, 로봇(1)에 대하여, 제1 기준 위치 특정 공정과 제2 기준 위치 특정 공정과 핸드 포크 위치 결정 공정을 행해도 된다.In the above-mentioned aspect, although the 1st reference position specification process, the 2nd reference position specification process, and the hand fork positioning process are performed with respect to the robot 1 installed in the manufacturing system 3, it is provided in the manufacturing system 3 You may perform the 1st reference position specification process, the 2nd reference position specification process, and the hand fork positioning process with respect to the previous robot 1. For example, in the assembly plant of the robot 1, the robot 1 may be subjected to a first reference position specifying step, a second reference position specifying step, and a hand fork positioning step.

또한, 조립 공장으로부터 제조 시스템(3)까지 로봇(1)을 반송할 때, 길이가 긴 핸드 포크(18, 19)가 반송의 지장이 되지 않도록, 핸드 포크(18, 19)를 분리한 상태에서, 조립 공장으로부터 제조 시스템(3)까지 로봇(1)을 반송하는 경우에는, 조립 공장에 있어서, 로봇(1)에 대하여, 제1 기준 위치 특정 공정과 제2 기준 위치 특정 공정을 행하고, 제조 시스템(3)에 설치된 후의 로봇(1)에 대하여 핸드 포크 위치 결정 공정을 행해도 된다.Moreover, when conveying the robot 1 from an assembly plant to the manufacturing system 3, in the state which removed the hand forks 18 and 19 so that long hand forks 18 and 19 may not interfere with conveyance. In the case of conveying the robot 1 from the assembly plant to the manufacturing system 3, in the assembly plant, the first reference position specifying step and the second reference position specifying step are performed on the robot 1 to produce the manufacturing system. You may perform the hand fork positioning process with respect to the robot 1 after installed in (3).

상술한 형태에 있어서, 고정 부재(41)는, 제2 암부(16)에 고정되어 있어도 된다. 이 경우에는, 제1 암부(15)의 기단부의 측면에, 핀(42)이 삽입되는 제1 삽입 구멍으로서의 삽입 구멍이 형성되어 있다. 또한, 상술한 형태에 있어서, 고정 부재(44)는, 핸드 기초부(17)에 고정되어 있어도 된다. 이 경우에는, 제1 암부(15)의 기단부의 측면에, 핀(45)이 삽입되는 제2 삽입 구멍으로서의 삽입 구멍이 형성되어 있다. 또한, 상술한 형태에 있어서, 고정 부재(48, 49)는, 제2 암부(16)에 고정되어 있어도 된다. 이 경우에는, 2개의 핸드 포크(18)에, 핀(50)이 삽입되는 제3 삽입 구멍으로서의 삽입 구멍이 형성되어 있다.In the above-described form, the fixing member 41 may be fixed to the second arm portion 16. In this case, the insertion hole as a 1st insertion hole into which the pin 42 is inserted is formed in the side surface of the base end part of the 1st arm part 15. As shown in FIG. In addition, in the form mentioned above, the fixing member 44 may be fixed to the hand base 17. In this case, the insertion hole as a 2nd insertion hole into which the pin 45 is inserted is formed in the side surface of the base end part of the 1st arm part 15. As shown in FIG. In addition, in the form mentioned above, the fixing members 48 and 49 may be fixed to the 2nd arm part 16. As shown in FIG. In this case, the insertion holes as the third insertion holes into which the pins 50 are inserted are formed in the two hand forks 18.

상술한 형태에 있어서, 핸드(8)는, 핸드 포크(19)를 구비하지 않아도 된다. 또한, 상술한 형태에서는, 로봇(1)에 의해 반송되는 반송 대상물은 유기 EL 디스플레이용 기판(2)이지만, 로봇(1)에 의해 반송되는 반송 대상물은, 액정 디스플레이용 유리 기판이어도 되고, 반도체 웨이퍼 등 이어도 된다. 또한, 상술한 형태에 있어서, 로봇(1)은, 대기압으로 되어 있는 공간 내에 배치되어 있어도 된다.In the form mentioned above, the hand 8 does not need to be provided with the hand fork 19. In addition, in the above-mentioned aspect, although the conveyed object conveyed by the robot 1 is the organic electroluminescent display board | substrate 2, the conveyed object conveyed by the robot 1 may be a liquid crystal display glass substrate, and a semiconductor wafer Or the like. Moreover, in the form mentioned above, the robot 1 may be arrange | positioned in the space which becomes atmospheric pressure.

1: 로봇(산업용 로봇)
2: 기판(반송 대상물)
8: 핸드
9: 암
10: 본체부
15: 제1 암부
16: 제2 암부
16a: 삽입 구멍(제1 삽입 구멍)
16b: 삽입 구멍(제3 삽입 구멍)
17: 핸드 기초부
17a: 삽입 구멍(제2 삽입 구멍)
18: 핸드 포크
19: 핸드 포크(제2 핸드 포크)
21: 모터(제1 모터)
22: 모터(제2 모터)
23: 모터(제3 모터)
24: 인코더(제1 인코더)
25: 인코더(제2 인코더)
26: 인코더(제3 인코더)
31: 원점 센서(제1 원점 센서)
32: 원점 센서(제2 원점 센서)
33: 원점 센서(제3 원점 센서)
36: 위치 결정 지그(제1 위치 결정 지그)
37: 위치 결정 지그(제2 위치 결정 지그)
38: 위치 결정 지그(제3 위치 결정 지그)
41: 고정 부재(제1 고정 부재)
41a: 관통 구멍(제1 관통 구멍)
42: 핀(제1 핀)
43, 44: 고정 부재(제2 고정 부재)
44a: 관통 구멍(제2 관통 구멍)
45: 핀(제2 핀)
48, 49: 고정 부재(제3 고정 부재)
49a: 관통 구멍(제3 관통 구멍)
50: 핀(제3 핀)
1: Robot (Industrial Robot)
2: substrate (return object)
8: hand
9: cancer
10: main body
15: first dark
16: second arm
16a: insertion hole (first insertion hole)
16b: insertion hole (third insertion hole)
17: Hand Foundation
17a: insertion hole (second insertion hole)
18: hand fork
19: hand fork (second hand fork)
21: motor (first motor)
22: motor (second motor)
23: motor (third motor)
24: encoder (first encoder)
25: encoder (second encoder)
26: encoder (third encoder)
31: origin sensor (first origin sensor)
32: home sensor (second home sensor)
33: home sensor (third home sensor)
36: positioning jig (first positioning jig)
37: positioning jig (second positioning jig)
38: positioning jig (third positioning jig)
41: fixing member (first fixing member)
41a: through hole (first through hole)
42: pin (first pin)
43, 44: fixing member (second fixing member)
44a: through hole (second through hole)
45: pin (second pin)
48, 49: fixing member (third fixing member)
49a: through hole (third through hole)
50: pin (third pin)

Claims (8)

산업용 로봇의 조정 방법이며,
상기 산업용 로봇은, 본체부와, 상기 본체부에 기단부측이 회동 가능하게 연결되는 제1 암부와 상기 제1 암부의 선단부측에 기단부측이 회동 가능하게 연결되는 제2 암부를 갖는 암과, 상기 제2 암부의 선단부측에 회동 가능하게 연결되는 핸드 기초부와 상기 핸드 기초부로부터 수평 방향의 일방향으로 연장됨과 함께 반송 대상물이 탑재되는 핸드 포크를 갖는 핸드와, 상기 본체부에 대하여 상기 제1 암부를 회동시키기 위한 제1 모터와, 상기 제1 암부에 대하여 상기 제2 암부를 회동시키기 위한 제2 모터와, 상기 제2 암부에 대하여 상기 핸드 기초부를 회동시키기 위한 제3 모터와, 상기 제1 모터의 회전량을 검지하기 위한 제1 인코더와, 상기 제2 모터의 회전량을 검지하기 위한 제2 인코더와, 상기 제3 모터의 회전량을 검지하기 위한 제3 인코더와, 상기 본체부에 대한 상기 제1 암부의 회동 방향에 있어서의 상기 제1 암부의 원점 위치를 검지하기 위한 제1 원점 센서와, 상기 제1 암부에 대한 상기 제2 암부의 회동 방향에 있어서의 상기 제2 암부의 원점 위치를 검지하기 위한 제2 원점 센서와, 상기 제2 암부에 대한 상기 핸드 기초부의 회동 방향에 있어서의 상기 핸드 기초부의 원점 위치를 검지하기 위한 제3 원점 센서를 구비하고,
상기 제1 암부에 대한 상기 제2 암부의 회동 방향에 있어서의 상기 제2 암부의 소정의 기준 위치를 제1 기준 위치라 하고, 상기 제2 암부에 대한 상기 핸드 기초부의 회동 방향에 있어서의 상기 핸드 기초부의 소정의 기준 위치를 제2 기준 위치라 하고, 상기 핸드 기초부에 대한 상기 핸드 포크의 긴 변 방향에 직교하는 방향에 있어서의 상기 핸드 포크의 소정의 기준 위치를 제3 기준 위치라 하면,
상기 산업용 로봇의 조정 방법은,
상기 제1 기준 위치에서 상기 제2 암부가 정지하도록 상기 제2 원점 센서의 검지 결과에 기초하여 또는 상기 제2 원점 센서의 검지 결과와 상기 제2 인코더의 검지 결과에 기초하여 상기 제2 암부를 정지시켰을 때의 상기 제2 암부의 정지 위치인 제1 정지 위치로부터, 상기 제1 기준 위치에 상기 제2 암부를 위치 결정하기 위한 제1 위치 결정 지그에 의해 상기 제2 암부가 위치 결정되는 위치까지 상기 제2 암부를 회동시켰을 때의 상기 제2 인코더의 검지 결과와, 상기 제1 정지 위치에 상기 제2 암부가 정지해 있을 때의 상기 제2 인코더의 값에 기초하여 상기 제1 기준 위치를 특정하는 제1 기준 위치 특정 공정과,
상기 제1 기준 위치 특정 공정 후, 상기 제1 기준 위치 특정 공정에서 특정된 상기 제1 기준 위치에 상기 제2 암부가 배치되어 있는 상태에서, 상기 제2 기준 위치에서 상기 핸드 기초부가 정지하도록 상기 제3 원점 센서의 검지 결과에 기초하여 또는 상기 제3 원점 센서의 검지 결과와 상기 제3 인코더의 검지 결과에 기초하여 상기 핸드 기초부를 정지시켰을 때의 상기 핸드 기초부의 정지 위치인 제2 정지 위치로부터, 상기 제2 기준 위치에 상기 핸드 기초부를 위치 결정하기 위한 제2 위치 결정 지그에 의해 상기 핸드 기초부가 위치 결정되는 위치까지 상기 핸드 기초부를 회동시켰을 때의 상기 제3 인코더의 검지 결과와, 상기 제2 정지 위치에 상기 핸드 기초부가 정지해 있을 때의 상기 제3 인코더의 값에 기초하여 상기 제2 기준 위치를 특정하는 제2 기준 위치 특정 공정과,
상기 제2 기준 위치 특정 공정 후, 상기 제1 기준 위치 특정 공정에서 특정된 상기 제1 기준 위치에 상기 제2 암부가 배치되고, 또한, 상기 제2 기준 위치 특정 공정에서 특정된 상기 제2 기준 위치에 상기 핸드 기초부가 배치되어 있는 상태에서, 상기 제3 기준 위치에 상기 핸드 포크를 위치 결정하기 위한 제3 위치 결정 지그에 의해 상기 핸드 포크를 위치 결정하는 핸드 포크 위치 결정 공정을 구비하는 것을 특징으로 하는 산업용 로봇의 조정 방법.
How to adjust the industrial robot,
The industrial robot includes an arm having a main body portion, a first arm portion on which a proximal end side is rotatably connected to the main body, and a second arm portion on which a proximal end is rotatably connected to a distal end side of the first arm portion; A hand having a hand base portion rotatably connected to the distal end side of the second arm portion and a hand fork extending from the hand base portion in one direction in the horizontal direction and on which a conveying object is mounted; and the first arm portion with respect to the main body portion. A first motor for rotating the motor, a second motor for rotating the second arm with respect to the first arm, a third motor for rotating the hand base with respect to the second arm, and the first motor. A first encoder for detecting an amount of rotation of the second encoder, a second encoder for detecting an amount of rotation of the second motor, a third encoder for detecting an amount of rotation of the third motor, and A first origin sensor for detecting an origin position of the first arm part in a rotational direction of the first arm part relative to the body part, and the second arm part in a rotational direction of the second arm part relative to the first arm part; A second home sensor for detecting the home position of the second home sensor; and a third home sensor for detecting the home position of the hand base in the rotational direction of the hand base with respect to the second arm;
The predetermined reference position of the second arm portion in the rotational direction of the second arm portion relative to the first arm portion is called a first reference position, and the hand in the rotational direction of the hand base portion relative to the second arm portion. If the predetermined reference position of the base portion is a second reference position, and the predetermined reference position of the hand fork in the direction orthogonal to the long side direction of the hand fork relative to the hand base portion is a third reference position,
The adjustment method of the industrial robot,
Stop the second arm part based on a detection result of the second origin sensor or based on a detection result of the second origin sensor and a detection result of the second encoder such that the second arm part stops at the first reference position. From the first stop position which is the stop position of the said 2nd arm part at the time of making it into a position to the position where the said 2nd arm part is positioned by the 1st positioning jig for positioning the said 2nd arm part to the said 1st reference position. The first reference position is specified based on a detection result of the second encoder when the second arm is rotated and a value of the second encoder when the second arm is stopped at the first stop position. A first reference position specifying process,
The first base position stops at the second reference position in the state where the second arm portion is disposed at the first reference position specified in the first reference position specifying process; From the second stop position which is the stop position of the hand base part when the hand base part is stopped based on the detection result of the three origin sensors or based on the detection result of the third origin sensor and the detection result of the third encoder, A detection result of the third encoder when the hand base is rotated to a position where the hand base is positioned by a second positioning jig for positioning the hand base at the second reference position, and the second A second device specifying the second reference position based on the value of the third encoder when the hand base is at a stop position; Position specifying step and,
After the second reference position specifying process, the second arm portion is disposed at the first reference position specified in the first reference position specifying process, and further, the second reference position specified in the second reference position specifying process. And a hand fork positioning process of positioning the hand fork by a third positioning jig for positioning the hand fork at the third reference position in a state where the hand base is arranged at. Adjustment method of industrial robot.
제1항에 있어서,
상기 제2 암부가 상기 제1 기준 위치에 있을 때는, 상기 제1 암부와 상기 제2 암부가 상하 방향에서 겹치고,
상기 핸드 기초부가 상기 제2 기준 위치에 있을 때는, 상기 제2 암부와 상기 핸드 포크가 상하 방향에서 겹쳐 있는 것을 특징으로 하는 산업용 로봇의 조정 방법.
The method of claim 1,
When the second arm portion is in the first reference position, the first arm portion and the second arm portion overlap in the vertical direction,
And the second arm portion and the hand fork overlap each other in the vertical direction when the hand base portion is in the second reference position.
제2항에 있어서,
상기 제1 위치 결정 지그는, 상기 제1 암부 및 상기 제2 암부 중 어느 한쪽에 고정되는 제1 고정 부재와, 상기 제1 암부 및 상기 제2 암부 중 어느 다른 쪽에 형성되는 제1 삽입 구멍과 상기 제1 고정 부재에 형성되는 제1 관통 구멍에 삽입되는 제1 핀을 구비하는 것을 특징으로 하는 산업용 로봇의 조정 방법.
The method of claim 2,
The first positioning jig includes a first fixing member fixed to either one of the first arm portion and the second arm portion, a first insertion hole formed in any one of the first arm portion and the second arm portion, and the And a first pin inserted into a first through hole formed in the first fixing member.
제2항 또는 제3항에 있어서,
상기 제2 위치 결정 지그는, 상기 제1 암부 및 상기 핸드 기초부 중 어느 한쪽에 고정되는 제2 고정 부재와, 상기 제1 암부 및 상기 핸드 기초부 중 어느 다른 쪽에 형성되는 제2 삽입 구멍과 상기 제2 고정 부재에 형성되는 제2 관통 구멍에 삽입되는 제2 핀을 구비하는 것을 특징으로 하는 산업용 로봇의 조정 방법.
The method according to claim 2 or 3,
The second positioning jig includes a second fixing member fixed to either one of the first arm portion and the hand base portion, a second insertion hole formed in any one of the first arm portion and the hand base portion, and the And a second pin inserted into a second through hole formed in the second fixing member.
제2항 또는 제3항에 있어서,
상기 핸드는, 2개의 상기 핸드 포크를 구비하고,
상기 제3 위치 결정 지그는, 2개의 상기 핸드 포크 및 상기 제2 암부 중 어느 한쪽에 고정되는 제3 고정 부재와, 2개의 상기 핸드 포크 및 상기 제2 암부 중 어느 다른 쪽에 형성되는 제3 삽입 구멍과 상기 제3 고정 부재에 형성되는 제3 관통 구멍에 삽입되는 제3 핀을 구비하는 것을 특징으로 하는 산업용 로봇의 조정 방법.
The method according to claim 2 or 3,
The hand has two said hand forks,
The third positioning jig includes a third fixing member fixed to either one of the two hand forks and the second arm, and a third insertion hole formed in any one of the two hand forks and the second arm. And a third pin inserted into a third through hole formed in the third fixing member.
제5항에 있어서,
상기 핸드는, 상기 핸드 기초부로부터 상기 핸드 포크와 역방향으로 연장되는 2개의 제2 핸드 포크를 구비하고,
산업용 로봇의 조정 방법은, 상기 핸드 포크 위치 결정 공정 후, 상기 핸드 기초부를 180° 회동시킴과 함께, 상기 제3 위치 결정 지그에 의해, 상기 핸드 기초부에 대한 상기 제2 핸드 포크의 긴 변 방향에 직교하는 방향에 있어서의 상기 제2 핸드 포크의 소정의 기준 위치에 2개의 상기 제2 핸드 포크를 위치 결정하는 제2 핸드 포크 위치 결정 공정을 구비하는 것을 특징으로 하는 산업용 로봇의 조정 방법.
The method of claim 5,
The hand has two second hand forks extending from the hand base in the opposite direction to the hand fork,
In the adjustment method of an industrial robot, after the said hand fork positioning process, the said hand base part rotates 180 degrees, and the 3rd positioning jig makes the long side direction of the said 2nd hand fork with respect to the hand base part. And a second hand fork positioning step of positioning the two second hand forks at a predetermined reference position of the second hand fork in a direction orthogonal to.
제4항에 있어서,
상기 핸드는, 2개의 상기 핸드 포크를 구비하고,
상기 제3 위치 결정 지그는, 2개의 상기 핸드 포크 및 상기 제2 암부 중 어느 한쪽에 고정되는 제3 고정 부재와, 2개의 상기 핸드 포크 및 상기 제2 암부 중 어느 다른 쪽에 형성되는 제3 삽입 구멍과 상기 제3 고정 부재에 형성되는 제3 관통 구멍에 삽입되는 제3 핀을 구비하는 것을 특징으로 하는 산업용 로봇의 조정 방법.
The method of claim 4, wherein
The hand has two said hand forks,
The third positioning jig includes a third fixing member fixed to either one of the two hand forks and the second arm, and a third insertion hole formed in any one of the two hand forks and the second arm. And a third pin inserted into a third through hole formed in the third fixing member.
제7항에 있어서,
상기 핸드는, 상기 핸드 기초부로부터 상기 핸드 포크와 역방향으로 연장되는 2개의 제2 핸드 포크를 구비하고,
산업용 로봇의 조정 방법은, 상기 핸드 포크 위치 결정 공정 후, 상기 핸드 기초부를 180° 회동시킴과 함께, 상기 제3 위치 결정 지그에 의해, 상기 핸드 기초부에 대한 상기 제2 핸드 포크의 긴 변 방향에 직교하는 방향에 있어서의 상기 제2 핸드 포크의 소정의 기준 위치에 2개의 상기 제2 핸드 포크를 위치 결정하는 제2 핸드 포크 위치 결정 공정을 구비하는 것을 특징으로 하는 산업용 로봇의 조정 방법.
The method of claim 7, wherein
The hand has two second hand forks extending from the hand base in the opposite direction to the hand fork,
In the adjustment method of an industrial robot, after the said hand fork positioning process, the said hand base part rotates 180 degrees, and the 3rd positioning jig makes the long side direction of the said 2nd hand fork with respect to the hand base part. And a second hand fork positioning step of positioning the two second hand forks at a predetermined reference position of the second hand fork in a direction orthogonal to.
KR1020190014722A 2018-02-16 2019-02-08 Method for adjusting industrial robot KR102210025B1 (en)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JPJP-P-2018-025687 2018-02-16
JP2018025687A JP6998790B2 (en) 2018-02-16 2018-02-16 How to adjust an industrial robot

Publications (2)

Publication Number Publication Date
KR20190099123A true KR20190099123A (en) 2019-08-26
KR102210025B1 KR102210025B1 (en) 2021-02-01

Family

ID=67645352

Family Applications (1)

Application Number Title Priority Date Filing Date
KR1020190014722A KR102210025B1 (en) 2018-02-16 2019-02-08 Method for adjusting industrial robot

Country Status (3)

Country Link
JP (1) JP6998790B2 (en)
KR (1) KR102210025B1 (en)
CN (1) CN110153991B (en)

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP4090444B2 (en) * 2004-03-05 2008-05-28 株式会社Taiyo Arm check device for robot
JP2014233773A (en) * 2013-05-31 2014-12-15 シンフォニアテクノロジー株式会社 Articulated robot
JP2015139854A (en) 2014-01-29 2015-08-03 日本電産サンキョー株式会社 industrial robot

Family Cites Families (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS60178590U (en) * 1984-05-08 1985-11-27 富士電機株式会社 Robot arm positioning device
JPS62175810A (en) * 1986-01-29 1987-08-01 Omron Tateisi Electronics Co Industrial robot controller
US4868473A (en) * 1987-02-24 1989-09-19 Mitsubishi Denki Kabushiki Kaisha Industrial robot device including a robot and a processing machine
JPH0641823Y2 (en) * 1988-03-25 1994-11-02 新明和工業株式会社 Jig arm origin adjustment jig
JP2803399B2 (en) * 1991-07-29 1998-09-24 株式会社デンソー Robot home position correction amount detection method and jig
JP2007061920A (en) * 2005-08-29 2007-03-15 Toshiba Mach Co Ltd Industrial robot
JP6295037B2 (en) * 2013-08-08 2018-03-14 日本電産サンキョー株式会社 Industrial robot
JP6235881B2 (en) * 2013-08-09 2017-11-22 日本電産サンキョー株式会社 Industrial robot
US9857786B2 (en) * 2015-03-31 2018-01-02 Recognition Robotics, Inc. System and method for aligning a coordinated movement machine reference frame with a measurement system reference frame

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP4090444B2 (en) * 2004-03-05 2008-05-28 株式会社Taiyo Arm check device for robot
JP2014233773A (en) * 2013-05-31 2014-12-15 シンフォニアテクノロジー株式会社 Articulated robot
JP2015139854A (en) 2014-01-29 2015-08-03 日本電産サンキョー株式会社 industrial robot

Also Published As

Publication number Publication date
CN110153991A (en) 2019-08-23
CN110153991B (en) 2022-06-28
JP6998790B2 (en) 2022-01-18
KR102210025B1 (en) 2021-02-01
JP2019141920A (en) 2019-08-29

Similar Documents

Publication Publication Date Title
JP5597536B2 (en) Teaching method for transfer robot
US20130123982A1 (en) Calibration method for tool center point of a robot manipulator
WO2009145082A1 (en) Carrier device, position-teaching method, and sensor jig
TWI406748B (en) Automatic operation machine
JP4865414B2 (en) Alignment method
JP2011183492A (en) Automatic positional dislocation correcting method and automatic position teaching method
JP2002118162A (en) Method for transfer alignment in object processing system and object processing system
KR101971824B1 (en) Robot, Robot system, Manufacturing apparatus of device, Manufacturing method of device and Method for adjusting teaching positions
CN110303505B (en) Position information recovery method for robot
CN110154038B (en) Method for recovering position information of robot
CN110153994B (en) Method for calculating correction value of industrial robot
CN110153995B (en) Method for calculating correction value of industrial robot
KR20190099123A (en) Method for adjusting industrial robot
JP5471131B2 (en) Electronic component mounting apparatus and camera position correction method in electronic component mounting apparatus
KR20190099138A (en) Method of calculating correction value of industrial robot
KR102213545B1 (en) Method of calculating correcting value of industrial robot
KR102192561B1 (en) Method of calculating correcting value of industrial robot
JP6478168B2 (en) Substrate transfer device
JP2009164277A (en) Device and method for correcting head movement position in component mounting device
CN113905859B (en) Robot control system and robot control method
KR102003659B1 (en) Robot system, manufacturing apparatus of device, manufacturing method of device, method for adjusting teaching positions, and computer-readable recording medium
WO2022091241A1 (en) Offset value setting method and robot control device
JPH02180580A (en) Origin adjusting device for industrial robot
KR20230040575A (en) Teaching system of robot assembly provided in vacuum chamber

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