KR101952766B1 - 로봇 시스템 및 엔드 이펙터의 변형 검출 방법 - Google Patents

로봇 시스템 및 엔드 이펙터의 변형 검출 방법 Download PDF

Info

Publication number
KR101952766B1
KR101952766B1 KR1020177018115A KR20177018115A KR101952766B1 KR 101952766 B1 KR101952766 B1 KR 101952766B1 KR 1020177018115 A KR1020177018115 A KR 1020177018115A KR 20177018115 A KR20177018115 A KR 20177018115A KR 101952766 B1 KR101952766 B1 KR 101952766B1
Authority
KR
South Korea
Prior art keywords
target
site
detection
deformation
end effector
Prior art date
Application number
KR1020177018115A
Other languages
English (en)
Other versions
KR20170091705A (ko
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 KR20170091705A publication Critical patent/KR20170091705A/ko
Application granted granted Critical
Publication of KR101952766B1 publication Critical patent/KR101952766B1/ko

Links

Images

Classifications

    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J15/00—Gripping heads and other end effectors
    • B25J15/08—Gripping heads and other end effectors having finger members
    • B25J15/10—Gripping heads and other end effectors having finger members with three or more finger members
    • B25J15/106—Gripping heads and other end effectors having finger members with three or more finger members moving in parallel relationship
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J19/00—Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
    • B25J19/06—Safety devices
    • B25J19/063—Safety devices working only upon contact with an outside object
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J11/00—Manipulators not otherwise provided for
    • B25J11/0095—Manipulators transporting wafers
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J15/00—Gripping heads and other end effectors
    • B25J15/08—Gripping heads and other end effectors having finger members
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B25J9/16—Programme controls
    • B25J9/1674—Programme controls characterised by safety, monitoring, diagnostic
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B25J9/16—Programme controls
    • B25J9/1679—Programme controls characterised by the tasks executed
    • B25J9/1692—Calibration of manipulator
    • H—ELECTRICITY
    • H01—ELECTRIC ELEMENTS
    • H01L—SEMICONDUCTOR DEVICES NOT COVERED BY CLASS H10
    • H01L21/00—Processes or apparatus adapted for the manufacture or treatment of semiconductor or solid state devices or of parts thereof
    • H01L21/67—Apparatus specially adapted for handling semiconductor or electric solid state devices during manufacture or treatment thereof; Apparatus specially adapted for handling wafers during manufacture or treatment of semiconductor or electric solid state devices or components ; Apparatus not specifically provided for elsewhere
    • H01L21/67005—Apparatus not specifically provided for elsewhere
    • H01L21/67242—Apparatus for monitoring, sorting or marking
    • H01L21/67259—Position monitoring, e.g. misposition detection or presence detection
    • H—ELECTRICITY
    • H01—ELECTRIC ELEMENTS
    • H01L—SEMICONDUCTOR DEVICES NOT COVERED BY CLASS H10
    • H01L21/00—Processes or apparatus adapted for the manufacture or treatment of semiconductor or solid state devices or of parts thereof
    • H01L21/67—Apparatus specially adapted for handling semiconductor or electric solid state devices during manufacture or treatment thereof; Apparatus specially adapted for handling wafers during manufacture or treatment of semiconductor or electric solid state devices or components ; Apparatus not specifically provided for elsewhere
    • H01L21/67005—Apparatus not specifically provided for elsewhere
    • H01L21/67242—Apparatus for monitoring, sorting or marking
    • H01L21/67288—Monitoring of warpage, curvature, damage, defects or the like
    • H—ELECTRICITY
    • H01—ELECTRIC ELEMENTS
    • H01L—SEMICONDUCTOR DEVICES NOT COVERED BY CLASS H10
    • H01L21/00—Processes or apparatus adapted for the manufacture or treatment of semiconductor or solid state devices or of parts thereof
    • H01L21/67—Apparatus specially adapted for handling semiconductor or electric solid state devices during manufacture or treatment thereof; Apparatus specially adapted for handling wafers during manufacture or treatment of semiconductor or electric solid state devices or components ; Apparatus not specifically provided for elsewhere
    • H01L21/677—Apparatus specially adapted for handling semiconductor or electric solid state devices during manufacture or treatment thereof; Apparatus specially adapted for handling wafers during manufacture or treatment of semiconductor or electric solid state devices or components ; Apparatus not specifically provided for elsewhere for conveying, e.g. between different workstations
    • H01L21/67739—Apparatus specially adapted for handling semiconductor or electric solid state devices during manufacture or treatment thereof; Apparatus specially adapted for handling wafers during manufacture or treatment of semiconductor or electric solid state devices or components ; Apparatus not specifically provided for elsewhere for conveying, e.g. between different workstations into and out of processing chamber
    • H01L21/67742—Mechanical parts of transfer devices
    • H—ELECTRICITY
    • H01—ELECTRIC ELEMENTS
    • H01L—SEMICONDUCTOR DEVICES NOT COVERED BY CLASS H10
    • H01L21/00—Processes or apparatus adapted for the manufacture or treatment of semiconductor or solid state devices or of parts thereof
    • H01L21/67—Apparatus specially adapted for handling semiconductor or electric solid state devices during manufacture or treatment thereof; Apparatus specially adapted for handling wafers during manufacture or treatment of semiconductor or electric solid state devices or components ; Apparatus not specifically provided for elsewhere
    • H01L21/677—Apparatus specially adapted for handling semiconductor or electric solid state devices during manufacture or treatment thereof; Apparatus specially adapted for handling wafers during manufacture or treatment of semiconductor or electric solid state devices or components ; Apparatus not specifically provided for elsewhere for conveying, e.g. between different workstations
    • H01L21/67703—Apparatus specially adapted for handling semiconductor or electric solid state devices during manufacture or treatment thereof; Apparatus specially adapted for handling wafers during manufacture or treatment of semiconductor or electric solid state devices or components ; Apparatus not specifically provided for elsewhere for conveying, e.g. between different workstations between different workstations
    • H01L21/67736—Loading to or unloading from a conveyor

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Physics & Mathematics (AREA)
  • Condensed Matter Physics & Semiconductors (AREA)
  • General Physics & Mathematics (AREA)
  • Manufacturing & Machinery (AREA)
  • Computer Hardware Design (AREA)
  • Microelectronics & Electronic Packaging (AREA)
  • Power Engineering (AREA)
  • Manipulator (AREA)
  • Container, Conveyance, Adherence, Positioning, Of Wafer (AREA)

Abstract

로봇 시스템은, 선단부에 소정 방향으로 연장되는 회동축을 중심으로 하여 회동이 자유로운 손목을 가지는 로봇 암과, 손목에 장착된 엔드 이펙터와, 엔드 이펙터의 소정의 검출부위가 도달할 목표부위를 가지는 타깃 핀을 이용하여 해당 엔드 이펙터의 변형을 검출하는 변형검출장치를 구비하고 있다. 목표부위는, 검출부위가 해당 목표부위에 도달하였음을 나타내는 표시기능을 가지고 있다. 변형검출장치는, 검출부위를 타깃 핀에 접촉시키도록 로봇 암을 제어하여 목표부위를 탐색하고, 목표부위의 표시기능에 의거하여 검출부위가 목표부위에 도달한 것을 검출하는 탐색부와, 검출부위가 목표부위에 도달했을 때의 검출부위의 상정위치와 소정의 참조위치를 비교하여, 엔드 이펙터의 변형을 검출하는 변형 검출부를 구비하고 있다.

Description

로봇 시스템 및 엔드 이펙터의 변형 검출 방법{ROBOT SYSTEM AND END-EFFECTOR DEFORMATION DETECTION METHOD}
본 발명은 엔드 이펙터의 변형 검출 방법 및 그것을 실현하는 로봇 시스템에 관한 것이다.
종래, 반도체 디바이스의 기판 재료인 웨이퍼를 반송하기 위하여, 로봇 암의 선단에 포크 형상의 엔드 이펙터를 구비한 웨이퍼 반송 로봇이 사용되고 있다. 이 엔드 이펙터는, 박판 형태의 로봇 핸드로서, 엔드 이펙터의 뿌리부는 로봇 암(arm)의 손목에 외팔보 형태로 지지 되어 있다. 그 때문에, 엔드 이펙터의 자중이나 적재되는 기판의 무게에 의해서 엔드 이펙터에 휨이 생길 수가 있다.
또한, 특히 웨이퍼 반송 로봇에서는, 엔드 이펙터의 작업 공간이 좁고 한정되어 있을 수 있고, 엔드 이펙터가 다른 물체와 간섭을 일으킬 수가 있다. 또한, 예를 들면, 기어의 백 래시, 벨트의 늘어남, 기어 이빨의 튀어오름(tooth jumping) 등의 기계적 트러블이 로봇 암이나 엔드 이펙터에 생길 수가 있다. 이러한 원인에 의해 엔드 이펙터에 진동이나 충격이 가해지면, 엔드 이펙터의 수준(水準) 위치 편차나 왜곡이 생길 수 있다.
상기와 같이 변형된 엔드 이펙터는 웨이퍼를 확실하게 반송하지 못할 우려가 있다. 그 때문에, 반송 작업을 시작하기 전에 엔드 이펙터의 변형을 검출하는 것이 바람직하다. 종래는, 작업자에 의해서, 장치의 해체에 동반하여 엔드 이펙터의 변형 검출 작업이 정기적으로 이루어지고 있었지만, 최근에는 엔드 이펙터의 변형을 자동으로 검출하는 다양한 기술이 제안되어 있다.
예를 들어, 특허문헌 1에는, 로봇 핸드의 선단부에 설치되어 상기 로봇 핸드의 연장 방향과 평행하게 광선을 조사하는 조사부와, 광선을 수광 하여 수광위치와 기준위치의 차이를 검출하는 편차량 검출부를 구비한 기판 반송 장치가 제시되어 있다.
예를 들어, 특허문헌 2에는, 로봇 핸드에 4개의 거리 측정 센서를 설치하고, 이 거리 측정 센서에 의해 측정된 정반(定盤) 표면과의 사이 거리를 기준 크기와 비교하는 것에 의해 구해진 평행도에 의거하여, 로봇 핸드의 왜곡을 구하도록 구성된 로봇이 제시되어 있다.
또한, 예를 들어, 특허문헌 3에는, 기준 좌표에 있는 로봇 핸드의 선단부의 바로 옆에 배치된 광센서에서, 로봇 핸드로 검출 광을 조사함과 더불어 수광 하여, 광센서의 출력에 이상이 있을 경우에 핸드가 변형하고 있다고 간주하여 로봇의 동작을 정지시키도록 구성된 로봇이 제시되어 있다.
국제공개 WO2009/072199호 일본 특개2010-1888437호 공보 일본 특개평11-179692호 공보
상기 특허 문헌 1 ~ 3의 기술에서는, 엔드 이펙터의 변형을 검출하기 위하여 전용(즉, 그것 이외에 용도가 없는)의 복수의 비접촉식 센서가 설치되어 있다. 이러한 기술에서는, 다수의 센서가 필요하기 때문에, 센서의 배선이나 유지보수가 번잡해진다.
따라서, 본 발명은, 종래 구조의 로봇 암을 이용하여 엔드 이펙터의 변형을 검출하는 기술로서, 전용의 비접촉식 센서를 이용하지 않는 것을 제안한다.
본 발명의 한 형태에 따른 로봇 시스템은, 선단부에 소정 방향으로 연장되는 회동축을 중심으로 회동이 자유로운 손목을 가지는 로봇 암과, 상기 손목에 장착된 엔드 이펙터와, 상기 엔드 이펙터의 소정의 검출부위가 도달할 목표부위를 가지는 타깃 핀을 이용하여 해당 엔드 이펙터의 변형을 검출하는 변형검출장치를 구비한 로봇 시스템으로서,
상기 목표부위는, 상기 검출부위가 해당 목표부위에 도달한 것을 나타내는 표시기능을 가지고 있으며,
상기 변형검출장치가,
상기 검출부위를 상기 타깃 핀에 접촉시키도록 상기 로봇 암을 제어하여 상기 목표부위를 탐색하고, 상기 표시기능에 의거하여 상기 검출부위가 상기 목표부위에 도달한 것을 검출하는 탐색부와,
상기 검출부위가 상기 목표부위에 도달했을 때의 상기 검출부위의 상정위치와 소정의 참조위치를 비교하여, 상기 엔드 이펙터의 변형을 검출하는 변형 검출부를 구비하는 것을 특징으로 한다.
또한, 본 발명의 다른 형태에 따른 엔드 이펙터의 변형 검출 방법은,
선단부에 소정 방향으로 연장되는 회동축을 중심으로 회동이 자유로운 손목을 가지는 로봇 암과, 상기 손목에 장착된 엔드 이펙터와, 변형검출장치를 구비한 로봇 시스템에서, 상기 엔드 이펙터의 소정의 검출부위가 도달할 목표부위가 마련된 타깃 핀을 이용하여 상기 변형검출장치가 상기 엔드 이펙터의 변형을 검출하는 방법으로서,
상기 검출부위를 상기 타깃 핀에 접촉시키도록 상기 로봇 암을 제어하여 상기 목표부위를 탐색하는 것과,
상기 검출부위가 상기 목표부위에 도달한 것을 나타내는 해당 목표부위 표시기능에 의거하여, 상기 검출부위가 상기 목표부위에 도달한 것을 검출하는 것과,
상기 검출부위가 상기 목표부위에 도달했을 때의 상기 검출부위의 상정위치와 소정의 참조위치를 비교하여, 상기 엔드 이펙터의 변형을 검출하는 것,
을 포함하는 것을 특징으로 한다.
본 발명에 의하면, 타깃 핀과 종래 구조의 로봇 암을 이용하여 엔드 이펙터의 변형을 검출할 수가 있다.
도 1은 본 발명의 일 실시형태에 따른 로봇 시스템의 개략 구성을 나타내는 평면도이다.
도 2는, 도 1에 도시된 로봇 시스템의 개략 구성을 나타내는 측면도이다.
도 3은, 도 1에 도시된 로봇 시스템의 제어계통의 구성을 나타내는 도면이다.
도 4는 일 실시형태에 따른 타깃 핀의 측면도이다.
도 5는 탐색처리 시의 타깃 핀과 엔드 이펙터의 상태를 나타내는 평면도이다.
도 6은 본 발명의 일 실시형태에 따른 엔드 이펙터의 변형 검출 처리의 흐름도이다.
도 7은 탐색처리의 흐름도이다.
도 8은 변형의 평가처리의 흐름도이다.
도 9는 본 발명의 다른 실시형태에 따른 타깃 핀의 측면도이다.
다음으로, 도면을 참조하여 본 발명의 실시형태를 설명한다. 이하에서는, 본 발명을 원형 평판 형태의 웨이퍼를 반송하기 위한 웨이퍼 반송 로봇 시스템에 적용시켜서 설명한다. 다만, 본 발명을 적용할 수 있는 로봇 시스템은 웨이퍼 반송 로봇 시스템에 한정되지 않는다. 도 1은 본 발명의 일 실시형태에 따른 로봇 시스템(1)의 개략 구성을 나타내는 평면도, 도 2는 도 1에 도시된 로봇 시스템(1)의 개략 구성을 나타내는 측면도, 도 3은 도 1에 도시된 로봇 시스템(1)의 제어계통의 구성을 나타내는 도면이다. 본 명세서 및 청구 범위에서는, 어느 한 수평 방향을 'X' 방향, 'X' 방향과 대략 직교하는 수평 방향을 'Y' 방향, 연직 방향을 'Z' 방향이라고 한다.
도 1 및 2에 도시된 바와 같이, 본 발명의 일 실시형태에 따른 로봇 시스템(1)은, 로봇 암(4)과, 로봇 암(4)의 손끝부에 장착된 엔드 이펙터의 일례인 로봇 핸드(5)(이하, 간략히 '핸드(5)'라고 한다)와, 로봇 암(4)의 동작을 제어하는 제어 장치(6)와, 핸드(5)의 변형을 검출하는 변형검출장치(8)를 구비하고 있다. 또한, 로봇 시스템(1)에 의한 핸드(5)의 변형검출에는, 목표부위(TG)를 가지는 타깃 핀(9)이 이용된다. 이하, 로봇 시스템(1)의 각 구성요소에 대해서 상세하게 설명한다.
먼저, 로봇 암(4)에 대하여 설명한다. 본 실시형태에 따른 로봇 암(4)은, 기대(21)에 지지 된 수평 다관절 형 로봇으로 구성되어 있다. 단, 로봇 암(4)은 수평 다관절형 로봇에 한정되지 않고, 수직 다관절형 로봇이어도 좋다.
로봇 암(4)은, 기대(21)에 세워 설치된 승강축(40)과, 승강축(40)과 제1 관절(J1)을 통해 연결된 제1 링크(41)와, 제1 링크(41)의 선단부와 제2 관절(J2) 을 통해 연결된 제2 링크(42)와, 제2 링크(42)의 선단부와 제3 관절(J3)을 통해 연결된 제3 링크(43)와, 제3 링크(43)의 선단부와 제4 관절(J4)을 통해 연결된 제4 링크(44)를 구비하고 있다. 제1 관절(J1)의 회동축인 제1 축(L1), 제2 관절(J2)의 회동축인 제2 축(L2), 및 제3 관절(J3)의 회동축인 제3 축(L3)의 각 축의 연장 방향은 'Z' 방향이다. 또한, 제4 관절(J4)의 회동축인 제4 축(L4)은, 제3 링크(43)를 그 연장 방향으로 관통하고 'Z' 방향과 대략 직교하고 있다.
상기 구성의 로봇 암(4)에서, 제3 관절(J3), 제3 링크(43), 제4 관절(J4) 및 제4 링크(44)의 상호 결합체에 의해서 손목이 형성되어 있다. 제4 링크(44)에는 기계적인 인터페이스가 설치되어 있고, 여기에 핸드(5)가 착탈 가능하게 장착되어 있다. 본 실시형태에 따른 엔드 이펙터인 핸드(5)는, 원형 평판 형태의 웨이퍼(W)를 얹어놓기 위한 포크형 평판을 가지는 로봇 핸드이다. 이 핸드(5)에는, 도시되지 않았지만, 포크형 평판 위에 얹힌 웨이퍼(W)를 파지하기 위한 파지 조(爪) 및 그 구동기구가 설치되어 있다.
승강축(40)은, 승강 구동장치(60)에 의해, 'Z' 방향으로 승강 또는 신축하도록 구동된다. 승강 구동장치(60)는, 서보 모터(M0), 위치 검출기(E0) 및 서보 모터(M0)의 동력을 승강축(40)으로 전달하는 동력전달기구(D0) 등에 의해 구성되어 있다.
제1 ~ 제4 관절(J1 ~ J4)에는, 각 관절(J1 ~ J4)을 그 회동축 주위로 회전시키는 제1 ~ 제4 관절 구동장치(61 ~ 64)가 설치되어 있다. 관절 구동장치(61 ~ 64)는, 서보 모터(M1 ~ M4), 위치 검출기(E1 ~ E4), 그리고 서보 모터(M1 ~ M4)의 동력을 대응하는 링크에 전달하는 동력전달기구(D1 ~ D4) 등에 의해 구성되어 있다. 상기 동력전달기구(D1 ~ D4)는, 예를 들면, 감속기를 구비하는 기어 동력전달기구이다. 상기 각각의 위치 검출기(E0 ~ E4)는, 예를 들면, 로터리 인코더로 구성되어 있다. 각 서보 모터(M0 ~ M4)는 서로 독립하여 구동하는 것이 가능하다. 그리고 상기 각각의 서보 모터(M0 ~ M4)가 구동되면, 상기 각각의 위치 검출기(E0 ~ E4)에 의해서 상기 각각의 서보 모터(M0 ~ M4)의 출력축의 회전 위치의 검출이 수행된다.
로봇 암(4)은, 제어 장치(6)에 의해 그 동작이 제어된다. 도 3에 도시된 바와 같이, 제어 장치(6)는, 컨트롤러(30)와, 서보 모터(M0 ~ M4)와 대응한 서보 앰프(A0 ~ A4)를 구비하고 있다. 제어 장치(6)에서는, 로봇 암(4)의 손목에 장착된 핸드(5)를 임의의 포즈(pose, 공간에서의 위치 및 자세)로 임의의 경로를 따라서 이동시키는 서보 제어가 수행된다.
컨트롤러(30)는, 이른바 '컴퓨터'로서, 예를 들면, 마이크로 컨트롤러, CPU, MPU, PLC, DSP, ASIC 또는 FPGA 등의 연산 처리부와, ROM, RAM 등의 기억부를 가지고 있다(모두 도시되지 않음). 기억부에는, 연산 처리부가 실행할 프로그램, 각종 고정 데이터 등이 기억되어 있다. 또한, 기억부에는, 로봇 암(4)의 동작을 제어하기 위한 교시점(敎示点) 데이터, 로봇 핸드(5)의 형상ㆍ치수에 관한 데이터, 로봇 핸드(5)에 지지 된 웨이퍼(W)의 형상ㆍ치수에 관한 데이터 등이 저장되어 있다. 컨트롤러(30)에서는, 기억부에 기억된 프로그램 등의 소프트웨어를 연산 처리부가 독출 하여 실행하는 것에 의해, 로봇 시스템(1)의 동작을 제어하기 위한 처리(process)가 수행된다. 또한, 컨트롤러(30)는 단일 컴퓨터에 의한 집중 제어에 의해 각 처리를 실행하여도 좋고, 복수의 컴퓨터의 협동에 의한 분산 제어에 의해 각 처리를 실행하여도 좋다.
컨트롤러(30)는, 위치 검출기(E0 ~ E4) 각각에서 검출된 회전 위치에 대응하는 핸드(5)의 포즈와 기억부에 기억된 교시점 데이터에 의거하여, 소정의 제어시간 후의 목표자세를 연산한다. 컨트롤러(30)는, 소정의 제어시간 후에 핸드(5)가 목표자세가 되도록, 서보 앰프(A0 ~ A4)에 제어 지령(위치 지령)을 출력한다. 서보 앰프(A0 ~ A4)에서는, 제어 지령에 의거하여 각 서보 모터(M0 ~ M4)에 대해서 구동 전력을 공급한다. 이것에 의해, 핸드(5)를 원하는 포즈로 움직일 수가 있다.
이어서, 변형검출장치(8)에 대해 설명한다. 변형검출장치(8)는, 이른바 '컴퓨터'로서, 연산 처리부와 기억부를 가지고 있다(모두 도시하지 않음). 기억부에는, 연산 처리부가 실행할 프로그램, 각종 고정 데이터 등이 기억되어 있다. 또한, 기억부에는, 후술하는 초기 시작위치 등의 변형 검출 처리에 이용되는 교시점 데이터, 핸드(5)의 형상ㆍ치수나 후술하는 검출부위(SP)에 관한 데이터, 타깃 핀(9)의 형상ㆍ치수나 목표부위(TG)에 관한 데이터 등이 저장되어 있다. 변형검출장치(8)는, 제어 장치(6)와 정보의 송수신이 가능하게 접속되어 있다. 또한, 본 실시형태에서는, 로봇 암(4)의 제어 장치(6)와 변형검출장치(8)가 독립적인 연산 장치로서 설치되어 있으나, 제어 장치(6)가 변형검출장치(8)로서의 기능을 함께 갖추고 있어도 좋다.
상기 구성의 변형검출장치(8)는, 기억부에 기억된 프로그램 등의 소프트웨어를 연산 처리부가 독출 하여 실행하는 것에 의해, 탐색부(81), 위치정보 격납부(82), 변형 검출부(83) 및 변형 보정부(84)로서의 기능을 수행할 수가 있다. 탐색부(81)는, 핸드(5)의 소정의 검출부위(SP)를 타깃 핀(9)에 접촉시키도록 로봇 암(4)을 제어하여 목표부위(TG)를 탐색하고, 목표부위(TG)의 표시(indication) 기능에 의거하여 검출부위(SP)가 목표부위(TG)에 도달하였음을 검출하는 처리를 수행한다. 위치정보 격납부(82)는, 검출부위(SP)가 목표부위(TG)에 도달했을 때의 검출부위(SP)의 위치정보(상정(想定) 위치)를 취득하여 기억하는 처리를 수행한다. 변형 검출부(83)는, 위치정보 격납부(82)에 기억된 'Z' 방향 위치정보와, 위치정보 격납부(82)에 미리 기억된 참조 위치정보를 독출 하여 비교하고, 핸드(5)의 변형을 검출하는 처리를 수행한다. 변형 보정부(84)는, 변형 검출부(83)에서 핸드(5)의 변형이 검출되었을 때, 그 변형이 로봇 암(4)의 위치 및 자세 중 적어도 어느 한쪽의 조정으로 보정이 가능한지를 판단하고, 보정이 가능한 경우에 변형을 보정하는 처리를 수행한다.
여기서, 상기 구성의 로봇 시스템(1)을 이용한 엔드 이펙터인 핸드(5)의 변형 검출 처리(변형 검출 방법)에 대해 설명한다. 또한, 변형 검출 처리는 변형검출장치(8)가 수행하며, 이하에서는, 특별히 명기하지 않지만, 변형검출장치(8)에 의한 로봇 암(4)의 제어는 컨트롤러(30)(제어 장치(6))를 통해 수행된다.
핸드(5)의 변형 검출 처리를 시작하기에 즈음하여, 미리 타깃 핀(9)이 핸드(5)의 가동범위 내에 설치된다. 도 4는 일 실시형태에 따른 타깃 핀(9)의 측면도이다. 도 4에 도시된 바와 같이, 일 실시형태에 따른 타깃 핀(9)은, 'Z' 방향으로 연장되는 기둥형 몸체로서, 전체적으로 연필 형상을 갖추고 있다. 타깃 핀(9)에는, 지름이 일정한 원기둥 형상의 제1 동일 지름부(91)와, 지름이 변화하는 원뿔대 형상의 변화 지름부(92)와, 지름이 일정한 원기둥 형상의 제2 동일 지름부(93)가 일체적으로 형성되어 있고, 제1 동일 지름부(91), 변화 지름부(92), 제2 동일 지름부(93)의 순서대로 'Z' 방향으로 늘어서 있다. 제1 동일 지름부(91)의 지름은 제2 동일 지름부(93)의 지름보다 크고, 제1 동일 지름부(91)와 제2 동일 지름부(93) 사이는 변화 지름부(92)에 의해서 지름이 점차 축소되면서 매끄럽게 이어져 있다. 또한, 타깃 핀(9)은, 제2 동일 지름부(93)가 생략된, 제1 동일 지름부(91) 및 변화 지름부(92)로 이루어지는 형상이어도 좋다.
상기 형상의 타깃 핀(9)은, 핸드(5)를 타깃 핀(9)의 표면에 접촉시키면서 타깃 핀(9)을 따라서 'Z' 방향으로 이동시킨 경우에, 타깃 핀(9)에 대한 핸드(5)의 접촉 위치가 국부적으로 변화하는 형상을 갖추고 있고, 이 형상 부위를 목표부위(TG)로 하고 있다. 이 목표부위(TG)는, 후술하는 핸드(5)의 검출부위가 목표부위(TG)에 도달했음을 나타내는 표시기능을 가지고 있다. 즉, 핸드(5)의 검출부위가 목표부위(TG)에 접촉하면, 핸드(5)의 검출부위가 목표부위(TG)에 도달한 것을 알게 되어 있다.
타깃 핀(9)의 제1 동일 지름부(91)와 변화 지름부(92) 사이에는 고리 모양의 경계선(95)이 존재하고, 변화 지름부(92)와 제2 동일 지름부(93) 사이에도 고리 모양의 경계선(96)이 존재한다. 이러한 경계선(95, 96)을 통하여, 타깃 핀(9)에 대한 핸드(5)의 접촉 위치가 X-Y 방향에서 국부적으로 변화한다. 그래서, 본 실시형태에서는, 타깃 핀(9)의 경계선(95, 96) 중 한쪽(경계선(95))을 목표부위(TG)로 하고 있다.
도 6은 본 발명의 일 실시형태에 따른 엔드 이펙터의 변형 검출 처리의 흐름도이다. 도 6에 도시된 바와 같이, 변형 검출 처리가 시작되면, 변형검출장치(8)는 먼저 탐색 처리를 수행한다(단계 S1).
도 5는 탐색처리 시의 타깃 핀(9)과 로봇 핸드(5)의 상태를 나타내는 평면도이다. 도 5에 도시된 바와 같이, 평판형 핸드(5)는, 'Z' 방향에서 바라볼 때, 뿌리 측이 한줄기이고 선단 측이 두 갈래로 갈라진 포크 형상으로서, 핸드 중심선(C)을 중심으로 하여 대칭인 외형 형상을 갖추고 있다. 이하, 설명의 편의를 위하여, 핸드(5)의 외형 형상을 형성하고 있는 상기 핸드(5)의 외주면 중, 핸드 중심선(C)을 사이에 두고 한쪽의 측면을 '제1 측면(51)' 이라고 하고, 다른 쪽의 측면을 '제2 측면(52)' 이라고 한다. 제1 검출부위(SP1)는, 핸드(5)의 선단 측의 제1 측면(51)에 규정되어 있다. 또한, 제2 검출부위(SP2)는, 핸드(5)의 선단 측의 제2 측면(52)에 규정되어 있다. 제1 검출부위(SP1)와 제2 검출부위(SP2)는, 핸드 중심선(C)을 사이에 두고 대칭인 위치에 배치되는 것이 바람직하다. 또한, 제1 검출부위(SP1)와 제2 검출부위(SP2)는, 핸드(5)의 허벅지 부분에 규정되어 있어도 좋다. 제3 검출부위(SP3)는, 핸드(5)의 뿌리 측의 제1 측면(51)에 규정되어 있다. 제4 검출부위(SP4)는, 제1 측면(51)에서 제1 검출부위(SP1)와 제3 검출부위(SP3) 사이에 규정되어 있다.
탐색 처리(단계 S1)에서는, 핸드(5)의 제1 ~ 4 검출부위(SP1 ~ SP4) 각각에 대해서 동일한 처리가 반복된다. 그래서, 핸드(5)의 제1 검출부위(SP1)를 검출부위(SP)라고 하였을 때의 탐색처리에 대해서 자세히 설명하고, 제2 ~ 4 검출부위(SP2 ~ SP4)를 검출부위(SP)라고 하였을 때의 탐색 처리의 상세한 설명을 생략한다.
도 7은 탐색 처리의 흐름도이다. 도 7에 도시된 바와 같이, 탐색 처리가 시작되면, 변형검출장치(8)는, 핸드(5)의 검출부위(SP)가 미리 교시된 초기 시작 위치로 이동하도록, 로봇 암(4)을 제어한다(단계 S11). 초기 시작 위치는, 'Z' 방향 위치가 목표부위(TG)(경계선(95))보다 제1 동일 지름부(91) 쪽에 있고, X-Y 위치가 타깃 핀(9)의 제1 동일 지름부(91)의 표면으로부터 미소한 거리만큼 떨어진 곳에 있다. 이 초기 시작 위치로 검출부위(SP)가 이동했을 때, 원칙적으로, 핸드(5)는 타깃 핀(9)과 접촉하지 않는다.
다음으로, 변형검출장치(8)는, 제3 관절 구동장치(63)의 제어 루프 게인(gain)을 소정 값 이하로 낮춘다(단계 S12). 이 소정 값은, 웨이퍼(W)의 반송 동작 시의 제어 루프 게인보다 작은 값으로부터 선택된다. 제어 루프 게인에는, 위치 루프 게인과 속도 루프 게인이 포함된다. 제어 루프 게인을 낮춤으로써, 서보 제어 루프의 수정력(修正力)이 약해지고, 응답성이 늦어진다. 그 결과, 적은 미는 힘으로 핸드(5)를 타깃 핀(9)에 접촉시킬 수가 있다.
상기에서, 바람직하게는, 제3 관절 구동장치(63)의 제어 루프 게인을 실질적으로 제로(zero)로 한다. 제3 관절 구동장치(63)의 제어 루프 게인을 '실질적으로 제로로 한다'란, 상기 제어 루프 게인을, 통상 작동의 서보 게인으로부터 제로를 포함하는 작은 값으로 변경하여, 제3 관절 구동장치(63)에 대해 외력이 가해졌을 때, 즉, 핸드(5)와 타깃 핀(9)이 접촉했을 때의 접촉 반력을 극소화하여, 제3 관절 구동장치(63)의 서보 모터(M3)가, 이 접촉 반력에 대해서 실질적으로 저항하지 않고, 그 각도 위치가 실질적으로 자유롭게 변위 할 수 있는 상태로 만드는 것을 말한다. 제어 루프 게인을 끊어 제로로 만드는 경우도 여기에 포함된다.
상기의 제3 관절 구동장치(63)의 제어 루프 게인의 저하에 더하여, 구동 전류의 상한(즉, 구동 토크의 상한)을 감소시키는 것에 의해 핸드(5)의 타깃 핀(9)으로의 미는 힘을 낮추어도 좋다. 또한, 핸드(5)가 초기 시작 위치에 이르기 전에, 상기 제어 루프 게인의 줄이기나, 상기 구동 전류의 상한의 낮추기가 수행되어도 좋다.
이어서, 변형검출장치(8)는, 초기 시작 위치에서 이하에 설명하는 일련의 접촉 위치 취득 동작(단계 S13 ~ S15)을 수행하도록 로봇 암(4)을 제어한다. 일련의 접촉 위치 취득 동작에서, 먼저 핸드(5)가 수평으로 요동한다(단계 S13). 구체적으로는, 로봇 암(4)의 제3 관절(J3) 및 제4 관절(J4)을 움직이지 않고, 제1 관절(J1) 및 제2 관절(J2)을 동작시킴으로써, 핸드(5)를 미소한 진폭으로 요동시킨다(단계 S13).
핸드(5)가 요동하면, 핸드(5)의 검출부위(SP)가 타깃 핀(9)에 접촉한다. 핸드(5)가 타깃 핀(9)에 접촉하면, 제3 관절 구동장치(63)의 제어 루프 게인이 실질적으로 제로로 되어 있기 때문에, 핸드(5)가 제3 축(L3) 주위로 각변위 한다. 이 각변위가 동력전달기구(D3)를 통해 서보 모터(M3)에 전달되어, 이 서보 모터(M3)를 각변위 시킨다. 그래서, 서보 모터(M3)가 각변위를 시작한 것에 의거하여, 핸드(5)가 타깃 핀(9)에 접촉했다는 것이 검출된다.
그리고 변형검출장치(8)는, 핸드(5)가 타깃 핀(9)에 접촉한 것이 검출되면(단계 S14에서 '예'), 핸드(5)가 타깃 핀(9)에 접촉했을 때의 검출부위(SP)의 위치정보(접촉 위치 정보)를 취득한다(단계 S15). 접촉 위치 정보에는, 예를 들면, 로봇 암(4)의 손목 기준점(제3 축(L3) 상의 소정의 점)의 위치 및 손목의 방향이 포함된다. 로봇 암(4)의 손목 기준점의 위치정보는, 승강 구동장치(60), 제1 관절 구동장치(61), 제2 관절 구동장치(62)의 각각의 서보 모터(M0, M1, M2)의 각각의 위치 검출기(E0, E1, E2)로부터 취득할 수 있다. 로봇 암(4의) 손목의 방향에 관한 정보는, 제3 관절 구동장치(63), 제4 관절 구동장치(64)의 각각의 서보 모터(M3, M4)의 각각의 위치 검출기(E3, E4)로부터 얻을 수 있다.
이어서, 변형검출장치(8)는, 접촉 위치 취득 동작이 1회차이면(단계 S16에서 '예'), 핸드(5)의 검출부위(SP)를 '다음의 시작 위치'로 이동시키도록, 로봇 암(4)을 제어한다(단계 S20). 핸드(5)의 검출부위(SP)의 '다음의 시작 위치'는, 초기 시작 위치로부터 변화 지름부(92)를 향해서 'Z' 방향으로 미소한 소정 값만큼 이동시킨 곳에 존재한다. 그리고 변형검출장치(8)는, 다음의 시작 위치로부터 일련의 접촉 위치 취득 동작(단계 S13 ~ S15)을 수행하도록 로봇 암(4)을 제어한다.
단계 S16에서, 변형검출장치(8)는, 접촉 위치 취득 동작이 2회차 이후라면(단계 S16에서 '아니오'), 이번 회차의 접촉 위치 취득 동작에서 취득한 접촉 위치 정보와, 전회의 접촉 위치 취득 동작에서 취득한 접촉 위치 정보로부터, 검출부위(SP)가 목표부위(TG)에 도달했는지를 판단한다. 목표부위(TG)에서는, 타깃 핀(9)에 대한 핸드(5)의 접촉 위치가 X-Y 방향에서 국부적으로 변화한다. 그래서, 변형검출장치(8)는, 이번 회차에서 취득한 접촉 위치 정보와 이전 회차에서 취득한 접촉 위치 정보의 X-Y 방향의 국부적 변화에 의거하여, 검출부위(SP)가 목표부위(TG)에 도달했는지를 판단한다.
구체적으로는, 변형검출장치(8)는, 타깃 핀(9)에 대한 핸드(5)의 접촉 위치가 X-Y 방향에서 국부적으로 변화한 경우는(단계 S17에서 '예'), 검출부위(SP)가 목표부위(TG)에 도달했음을 검출하였다고 판정한다(단계 S18). 구체적으로는, 변형검출장치(8)는, 이번 회차에서 취득한 접촉 위치정보와 이전 회차에서 취득한 접촉 위치 정보로부터 도출되는 제3 축(L3) 주위의 각변위가 소정의 임계값을 초과하는 경우에, 검출부위(SP)가 목표부위(TG)에 도달했음을 검출하였다고 판정한다. 그리고 변형검출장치(8)는, 이번 회차에서 취득한 접촉 위치 정보를 목표부위(TG)의 위치정보로서 기억하고(단계 S19), 탐색 처리를 종료한다. 또한, 목표부위(TG)의 위치정보는, 검출부위(SP)가 목표부위(TG)에 도달했을 때의 검출부위(SP)의 상정위치이다.
한편, 변형검출장치(8)는, 타깃 핀(9)에 대한 핸드(5)의 접촉 위치가 X-Y 방향에서 국부적으로 변화하지 않는 경우(단계 S17에서 '아니오')는, 검출부위(SP)가 목표부위(TG)에 도달하지 않았다고 판정하고, 핸드(5)가 그 다음의 시작 위치로 이동하도록 로봇 암(4)을 제어한다(단계 S20). '그 다음의 시작 위치'는, 전술한 '다음의 시작 위치'로부터 변화 지름부(92)를 향해서 'Z' 방향으로 미소한 소정 값만큼 이동시킨 곳에 존재한다. 이와 같이 하여, 변형검출장치(8)는, 검출부위(SP)가 목표부위(TG)에 도달했음을 검출할 때까지, 시작 위치를 변화 지름부(92)를 향해서 'Z' 방향으로 조금씩 이동시키면서 일련의 접촉 위치 취득 동작(단계 S13 ~ S15)을 반복하도록 로봇 암(4)을 제어한다.
도 6의 흐름도로 다시 돌아가서, 변형검출장치(8)는, 상기 탐색처리에 의해서 핸드(5)의 제1 ~ 4 검출부위(SP1 ~ SP4) 각각에서 탐색 된 목표부위(TG)의 위치정보에 의거하여 핸드(5)의 변형을 평가한다(단계 S2 ~ S4). 본 실시형태에서는, 핸드(5)의 비틀림 변형, 휨 변형 및 회전 변형 각각에 대해서 변형이 평가된다. 변형검출장치(8)는 각각의 변형에 대해서 동일한 형태의 변형 평가 처리를 반복하므로, 이하에서는 핸드(5)의 비틀림 변형의 평가 처리에 대해 상세히 설명하고, 휨 변형 및 회전 변형의 평가 처리에 대해서는 상세한 설명을 생략한다.
도 8은 변형의 평가처리의 흐름도이다. 도 8에 도시된 바와 같이, 변형검출장치(8)는, 먼저, 변형을 검출하기 위하여 이용할 위치정보를 위치정보 격납부(82)로부터 독출 한다(단계 S21). 독출 할 위치정보에는, 취득한 목표부위(TG)의 위치정보와, 소정의 참조위치정보가 포함된다. 'Z' 방향 위치정보는, 예를 들면, 취득한 위치정보에 포함되는 로봇 암(4)의 손목 기준점의 'Z' 방향 위치정보여도 좋다.
본 실시형태에서, 참조위치정보는, 핸드(5) 상의 상이한 검출부위(SP)(참조위치)에서 탐색 처리를 수행하는 것에 의해서 얻은 목표부위(TG)의 위치정보이다. 비틀림 변형을 검출하기 위해 이용되는 위치정보는, 제1 검출부위(SP1)에서 목표부위(TG)를 탐색하여 얻은 목표부위(TG)의 위치정보와, 제2 검출부위(SP2)에서 목표부위(TG)를 탐색하여 얻은 목표부위(TG)의 위치정보이다. 휨 변형을 검출하기 위해 이용되는 위치정보는, 제1 검출부위(SP1)에서 목표부위(TG)를 탐색하여 얻은 목표부위(TG)의 위치정보와, 제3 검출부위(SP3)에서 목표부위(TG)를 탐색하여 얻은 목표부위(TG)의 위치정보이다. 회전 변형을 검출하기 위해 이용되는 위치정보는, 제3 검출부위(SP3)에서 목표부위(TG)를 탐색하여 얻은 목표부위(TG)의 위치정보와, 제4 검출부위(SP4)에서 목표부위(TG)를 탐색하여 얻은 목표부위(TG)의 위치정보이다. 또한, 회전 변형을 검출할 경우는, 상기 제4 검출부위(SP4)에 대신하여 또는 더하여, 제1 검출부위(SP1)에서 목표부위(TG)를 탐색하여 얻은 목표부위(TG)의 위치정보를 이용하여도 좋다.
다음으로, 변형검출장치(8)는, 독출 한 2개의 위치정보를 비교한다(단계 S22). 단계 S22에서, 검출할 변형이 비틀림 변형과 휨 변형일 경우에는, 독출 한 2개의 위치정보의 'Z' 방향 위치정보를 비교한다. 그리고 2개의 목표부위(TG)의 위치정보 중 어느 한쪽의 'Z' 방향 위치정보와 다른 쪽의 'Z' 방향 위치정보의 차이가 소정의 임계값 이하일 경우는, '변형이 없음' 또는 '변형의 정도가 작음'이라고 판정하고(단계 S23에서 '아니오'), 변형의 평가 처리를 종료한다. 한편, 변형검출장치(8)는, 독출 한 2개의 목표부위(TG)의 위치정보 중 어느 한쪽의 'Z' 방향 위치정보와 다른 쪽의 'Z' 방향 위치정보의 차이가 소정의 임계값을 초과할 경우는, 엔드 이펙터의 변형을 검출했다고 판정한다(단계 S23에서 '예').
또한, 단계 S22에서, 검출할 변형이 회전 변형일 경우에는, 독출 한 2개의 위치정보의 X-Y 방향(X-Y 평면 내)의 위치정보를 비교한다. 회전 변형을 검출할 때에는, 제4 축(L4)과 평행하게 규정되어 있는 핸드 중심선(C)의 연장 방향과 'Y' 축 방향이 평행이 되도록, 로봇 암(4)의 위치 및 자세가 제어되는 것이 바람직하다. 본 실시형태에 따른 핸드(5)는, 제3 링크(43)와 제4 링크(44) 사이에 연결부를 가지기 때문에, 이 연결부에서의 연결 오차에 의해 핸드 중심선(C)에 대해, 핸드(5)가 선대칭이 되어 있지 않을 수가 있다. 또한, 핸드(5)가 다른 물체에 충돌하는 것에 의해, 핸드(5)에 제3 축(L3) 주위의 회전방향에 변형이 생겨, 핸드 중심선(C)의 연장 방향과 'Y' 축 방향이 평행하지 않을 수가 있다. 이와 같은 회전 변형을, 변형검출장치(8)는, 예를 들면, 다음과 같이 하여 검출할 수 있다. 즉, 변형 전의 핸드(5)에서 제3 검출부위(SP3)와 제4 검출부위(SP4)를 연결하는 직선(평가 직선)의 'Y' 축 방향에 대한 기울기(기준 기울기)를 기억해 두고, 취득한 제3 검출부위(SP3)의 X-Y 방향 위치정보와 취득한 제4 검출부위(SP4)의 X-Y 방향 위치정보에 의거하여 평가 직선의 'Y' 축 방향에 대한 기울기를 산출하며, 산출한 기울기와 기준 기울기를 비교하여, 이것들의 차이가 소정의 임계치를 초과하면 엔드 이펙터의 회전 변형을 검출했다고 판정하고(단계 S23에서 '예'), 상기 차이가 소정의 임계치 이하이면 변형이 없다고 판정한다(단계 S23에서 '아니오' ).
엔드 이펙터의 변형이 검출되면, 변형검출장치(8)는, 계속하여, 로봇 암(4)의 위치 및 자세 중 적어도 어느 한쪽의 조정에 의해서 변형이 보정 가능한지를 판단한다(단계 S24). 변형의 보정의 가능 여부는, 예를 들면, 독출 한 2개의 위치정보의 차이로부터 도출되는 변형의 정도나, 변형을 보정 하기 위해 필요한 축이 로봇 암(4)에 존재하는지 등에 의거하여 판단된다.
변형검출장치(8)는, 변형이 보정 가능하다고 판단한 경우(단계 S24에서 '예')에는, 제어 장치(6)에 변형을 보정시키기 위한 변형 보정 정보를 작성하여, 이것을 제어 장치(6)로 출력하고(단계 S25), 변형의 평가 처리를 종료한다. 또한, 본 실시형태에 따른 로봇 암(4)은, 핸드(5)를 제4 축(L4) 주위로 회전시키는 것에 의해 비틀림 변형을 보정 할 수가 있다. 또한, 본 실시형태에 따른 로봇 암(4)은, 휨 변형을 보정 할 수 있는 축을 구비하고 있지 않기 때문에, 휨 변형을 보정 할 수 없다. 또한, 본 실시형태에 따른 로봇 암(4)은, 산출한 평가 직선의 기울기가 기준 기울기가 되도록 핸드(5)를 제3 축(L3) 주위로 회전시킴과 함께, X-Y 방향 위치를 조정하는 것에 의해, 회전 변형을 보정 할 수가 있다.
한편, 변형검출장치(8)는, 변형이 보정 불가능하다고 판단한 경우(단계 S24에서 '아니오')에는, 에러(error) 처리를 하고(단계 S26), 변형 평가 처리를 종료한다. 에러 처리에서, 변형검출장치(8)는, 예를 들면, 경보를 발생시킴과 더불어 제어 장치(6)에서 로봇 암(4)의 움직임을 정지시킨다.
이상과 같이 하여, 변형검출장치(8)는, 비틀림 변형의 평가처리(단계 S2), 휨 변형의 변형 평가 처리(단계 S3) 및 회전 변형의 변형 평가처리(단계 S4)를 수행하고, 엔드 이펙터의 변형 검출 처리를 종료한다.
이상 설명한 바와 같이, 본 실시형태에 따른 로봇 시스템(1)은, 선단부에 소정 방향으로 연장되는 회동축(제3 축(L3))을 중심으로 하여 회동이 자유로운 손목을 가지는 로봇 암(4)과, 손목에 장착된 엔드 이펙터인 핸드(5)와, 핸드(5)의 소정의 검출부위(SP)가 도달할 목표부위(GT)를 가지는 타깃 핀(9)을 이용하여 해당 엔드 이펙터의 변형을 검출하는 변형검출장치(8)를 구비하고 있다. 타깃 핀(9)의 목표부위(TG)는, 핸드(5)의 검출부위(SP)가 해당 목표부위(TG)에 도달했음을 나타내는 표시기능을 가지고 있다. 상기 변형검출장치(8)는, 핸드(5)의 검출부위(SP)를 타깃 핀(9)에 접촉시키도록 로봇 암(4)을 제어하여 목표부위(TG)를 탐색하고, 목표부위(TG)의 표시기능에 의거하여 검출부위(SP)가 목표부위(TG)에 도달한 것을 검출하는 탐색부(81)와, 검출부위(SP)가 목표부위(TG)에 도달했을 때의 검출부위(SP)의 위치정보(상정위치 정보)와 참조 위치정보를 비교하여 핸드(5)의 변형을 검출하는 변형 검출부(83)를 구비하고 있다.
또한, 이상에 설명한 본 실시형태에 따른 엔드 이펙터의 변형 검출 방법은, 상기 로봇 시스템(1)에서, 상기 타깃 핀(9)을 이용하여 변형검출장치(8)가 핸드(5)의 변형을 검출하는 방법으로서, 변형검출장치(8)가, 검출부위(SP)를 타깃 핀(9)에 접촉시키도록 로봇 암(4)을 제어하여 목표부위(TG)를 탐색하는 것과, 목표부위(TG)의 표시기능에 의거하여 검출부위(SP)가 목표부위(TG)에 도달한 것을 검출하는 것과, 검출부위(SP)가 목표부위(TG)에 도달했을 때의 검출부위(SP)의 위치정보 및 소정의 참조위치정보를 비교하여, 엔드 이펙터의 변형을 검출하는 것을 포함하고 있다.
상기와 같은 로봇 시스템(1) 및 엔드 이펙터의 변형 검출 방법에 의하면, 엔드 이펙터의 가동 범위 내에 마련된 타깃 핀(9)을 이용하여, 엔드 이펙터의 변형을 검출할 수가 있다. 특허문헌 1 ~ 3에 기재된 종래의 기술에서는, 로봇 핸드의 변형을 검출하기 위하여 전용의 비접촉식 센서가 로봇 시스템에 구비되어 있다. 이것에 대해, 본 실시형태에 따른 로봇 시스템(1)에서는, 특별한 배선과 제어를 요하는 비접촉식 센서를 이용하지 않고, 타깃 핀(9)과 종래 구조의 로봇 암(4)을 이용하여 엔드 이펙터의 변형을 검출할 수가 있다.
또한, 본 실시형태에 따른 로봇 시스템(1) 및 엔드 이펙터의 변형 검출 방법에서, 타깃 핀(9)의 목표부위(TG)는, 표시기능을 발휘하기 위해, 핸드(5)를 타깃 핀(9)에 접촉시키면서 타깃 핀(9)을 따라서 'Z' 방향으로 이동시킨 경우에, 타깃 핀(9)에 대한 핸드(5)의 접촉위치가 국부적으로 변화하는 형상으로 형성되어 있다. 그리고 변형검출장치(8)는, 핸드(5)의 검출부위(SP)를 타깃 핀(9)에 접촉시키면서 타깃 핀(9)을 따라서 'Z' 방향으로 이동시키도록 로봇 암(4)을 제어하여 목표부위(TG)를 탐색하고, 타깃 핀(9)에 대한 검출부위(SP)의 접촉위치의 국부적 변화에 의거하여 해당 검출부위(SP)가 목표부위(TG)에 도달한 것을 검출한다.
더 구체적으로는, 타깃 핀(9)은, 타깃 핀(9)에 대한 핸드(5)의 접촉 위치가 국부적으로 변화하는 형상으로서, 지름이 일정한 동일 지름부(91)와, 지름이 변화하는 변화 지름부(92)를 소정 방향으로 연속하여 가지며, 동일 지름부(91)와 변화 지름부(92)의 경계(경계선(95))에 의해서 목표부위(TG)가 구성되어 있다. 그리고 변형검출장치(8)는, 핸드(5)를 제3 축(L3) 주위로 요동시켜 검출부위(SP)가 타깃 핀(9)에 접촉했을 때의 검출부위(SP)의 위치정보(접촉 위치정보)를 취득하는 것을, 핸드(5)를 동일 지름부(91)로부터 변화 지름부(92)를 향해서 'Z' 방향으로 변위 시킨 복수 개소에서 수행하여 목표부위(TG)를 탐색하고, 취득한 복수의 접촉 위치정보로부터 도출되는 제3 축(L3) 주위의 각변위에 의거하여 검출부위(SP)가 목표부위(TG)에 도달한 것을 검출한다.
이와 같은 로봇 시스템(1) 및 엔드 이펙터의 변형 검출 방법에 의하면, 타깃 핀(9)의 동일 지름부(91)와 변화 지름부(92)의 지름의 변화에 의거하여 검출부위(SP)가 목표부위(TG)에 도달한 것을 검출할 수가 있다. 이와 같은 타깃 핀(9)의 목표부위(TG)의 표시기능은, 타깃 핀(9)의 외형 형상에 의해 실현되고 있고, 비교적 간단한 구조로서, 이 기능을 위해 배선이나 제어를 필요로 하지 않는다.
또한, 본 실시형태에 따른 로봇 시스템(1) 및 엔드 이펙터의 변형 검출 방법에서, 변형검출장치(8)는, 핸드(5)의 변형이 검출된 때, 그 변형이 로봇 암(4)의 위치 및 자세 중 적어도 어느 한쪽의 조정으로 보정이 가능한지를 판단하고, 보정이 가능한 경우에 그 변형을 보정한다.
이와 같은 로봇 시스템(1) 및 엔드 이펙터의 변형 검출 방법에 의하면, 로봇 암(4)을 정지시키거나 해체하지 않고, 엔드 이펙터의 변형을 보정 할 수가 있다. 따라서, 로봇 암(4)을 정지시키는 빈도를 줄일 수가 있고, 생산성을 향상시킬 수가 있다.
또한, 본 실시형태에 따른 로봇 시스템(1) 및 엔드 이펙터의 변형 검출 방법에서, 참조위치정보는, 변형검출장치(8)에 의해서, 핸드(5)의 검출부위(SP)와 서로 다른 참조부위를 타깃 핀(9)에 접촉시키도록 로봇 암(4)을 제어하여 목표부위(TG)를 탐색하고, 목표부위(TG)의 표시기능에 의거하여 참조부위가 목표부위(TG)에 도달한 것이 검출된 때의, 참조부위의 상정 위치정보이다. 즉, 핸드(5)의 검출부위(SP)와 서로 다른 참조부위에 대해 탐색처리를 수행하고, 참조부위가 목표부위(TG)에 도달했을 때의 참조부의 위치정보가, 참조위치정보로서 이용되고 있다.
상기 실시 형태에서는, 핸드(5)의 비틀림 변형을 검출할 때에는, 핸드(5)의 선단부에서 핸드 중심선(C)을 사이에 두고 한쪽에 규정된 제1 검출부위(SP1)와 다른 쪽에 규정된 제2 검출부위(SP2)를, 각각 검출부위ㆍ참조부위로 하고 있다. 그리고 검출부위(SP)가 목표부위(TG)에 도달했을 때의 해당 검출부위(SP)의 'Z' 방향의 상정위치와, 참조부위가 목표부위(TG)에 도달했을 때의 해당 참조부위의 'Z' 방향의 상정위치를 비교하는 것에 의해, 변형검출장치(8)로 핸드(5)의 비틀림 변형을 검출하고 있다.
또한, 상기 실시형태에서는, 핸드(5)의 휨 변형을 검출할 때에는, 검출부위와 참조부위 중 어느 한쪽을 핸드(5)의 선단부에 규정된 제1 검출부위(SP1)로 하고, 다른 쪽을 핸드(5)의 뿌리부에 규정된 제3 검출부위(SP3)로 하고 있다. 그리고 검출부위(SP)가 목표부위(TG)에 도달했을 때의 해당 검출부위(SP)의 'Z' 방향의 상정위치와, 참조부위가 목표부위(TG)에 도달했을 때의 해당 참조부위의 'Z' 방향의 상정위치를 비교하는 것에 의해서, 변형검출장치(8)에서 핸드(5)의 휨 변형을 검출하고 있다.
또한, 상기 실시 형태에서는, 핸드(5) 회전 변형을 검출할 때에는, 검출부위와 참조부위 중 어느 한쪽을 핸드(5)의 뿌리부에 규정된 제3 검출부위(SP3)로 하고, 다른 쪽을 핸드(5)의 선단부 또는 뿌리부와 선단부 사이에 규정된 제4 검출부위(SP4)로 하고 있다. 그리고 검출부위(SP)가 목표부위(TG)에 도달했을 때의 해당 검출부위(SP)의 X-Y 평면 내의 상정위치와, 참조부위가 목표부위(TG)에 도달했을 때의 해당 참조부위의 X-Y 평면 내의 상정위치를 비교하는 것에 의해서, 변형검출장치(8)로 핸드(5)의 회전 변형을 검출하고 있다.
상기와 같은 로봇 시스템(1) 및 엔드 이펙터의 변형 검출 방법에 의하면, 핸드(5)의 2개의 검출부위(SP)(검출부위와 참조부위) 각각에 대해서 탐색처리를 수행하여 얻은 위치정보를 비교하기 때문에, 타깃 핀(9)의 목표위치(TG)의 변형이나 위치 오차 등의 영향을 받지 않고, 엔드 이펙터의 변형을 검출할 수가 있다.
이상으로 본 발명의 바람직한 실시형태를 설명하였으나, 상기 로봇 시스템(1)의 구성은 이하와 같이 변경할 수가 있다.
예를 들면, 상기 실시형태에 따른 엔드 이펙터는, 웨이퍼 반송용의 포크 형상의 핸드(5)지만, 엔드 이펙터는 이것에 한정되지 않는다. 예를 들어, 엔드 이펙터가, 복수의 파지 조(爪)를 구비한 범용 핸드, 흡착 패드, 너트 체결구, 용접건, 스프레이 건 중 어느 하나여도 좋다.
또한, 상기 실시형태에 따른 탐색처리에서, 핸드(5)를 'Z' 방향으로 연장되는 제3 축(L3)을 중심으로 회동(요동)시키지만, 엔드 이펙터의 요동 방향은 이것에 한정되지 않는다.
예를 들면, 로봇 암이 수직 다관절 형 로봇일 경우에는, 탐색처리에서, 엔드 이펙터를 'X' 방향 또는 'Y' 방향으로 연장되는 회동축을 중심으로 하여 회동시켜도 좋다. 이 경우, 타깃 핀(9)은, 타깃 핀(9)의 연장 방향이 엔드 이펙터의 회동축의 연장 방향과 평행이 되도록 배치된다.
예를 들면, 탐색처리에서 엔드 이펙터를 거의 회동시키지 않고, 'Z' 방향으로 변위 시켜도 좋다. 상기 실시형태에 따른 로봇 시스템(1)은 웨이퍼 반송 로봇이기 때문에, 핸드(5)와 타깃 핀(9)의 마찰을 최대한 피하는 것에 의해 파티클(particle)의 발생을 방지하지 않으면 안 된다. 그러나 타깃 핀(9)과 엔드 이펙터의 접촉이나 마찰이 제한되지 않는 상황에서는, 엔드 이펙터를 회동시키지 않고 검출부위(SP)를 타깃 핀(9)에 접촉시키면서 'Z' 방향으로 변위 시킴으로써, 목표부위(TG)의 탐색이 수행되어도 좋다.
또한, 상기 실시형태에 따른 참조위치정보는, 핸드(5)에 설정된 별도의 검출부위(SP)(참조부위)에서 탐색처리를 수행하는 것에 의해 얻어진 'Z' 방향 위치정보이지만, 참조위치정보는 이것에 한정되지 않는다.
예를 들어, 참조위치정보는, 변형검출장치(8)에 의해서, 엔드 이펙터의 미변형 검출부위(SP)를 타깃 핀(9)에 접촉시키도록 로봇 암(4)을 제어하여 목표부위(TG)를 탐색하고, 목표부위(TG)의 표시기능에 의거하여 미변형 검출부위(SP)가 목표부위(TG)에 도달한 것이 검출된 때의, 미변형 검출부위(SP)의 위치정보여도 좋다. 즉, 참조위치정보가, 변형되지 않은 엔드 이펙터 상의 검출부위(SP)에서 탐색처리를 수행하는 것에 의해 얻은 목표부위(TG)의 위치정보여도 좋다. 이와 같은 참조위치정보를 이용하면, 변형 전후의 검출부위(SP)에서 탐색한 목표부위(TG)의 위치정보를 비교하는 것으로 핸드(5)의 변형을 검출 할 수가 있다.
예를 들어, 참조위치정보는, 타깃 핀(9)의 목표부위(TG)의 위치정보여도 좋다. 다만, 이 경우 타깃 핀(9)은, 로봇 시스템(1)이 가지는 좌표계에서 정확하게 위치 결정되고, 타깃 핀(9)의 변형이나 이동이 없을 것이 조건이 된다.
또한, 상기 실시형태에 따른 타깃 핀(9)은, 제1 동일 지름부(91)와 변화 지름부(92)의 경계선(95)이 목표부위(TG)가 되고, 제1 동일 지름부(91)와 변화 지름부(92)의 외경의 국부 변화가 표시기능을 구성하고 있지만, 타깃 핀(9)의 형상은 이것에 한정되지 않는다. 타깃 핀(9)은, 엔드 이펙터를 타깃 핀(9)에 접촉시키면서 타깃 핀(9)을 따라서 'Z' 방향으로 이동시킨 경우에, 타깃 핀(9)에 대한 엔드 이펙터의 접촉 위치가 국부적으로 변화하는 형상을 가지고 있으면 좋다.
예를 들어, 타깃 핀(9)의 변화 지름부(92)와 제2 동일 지름부(93)의 경계선(96)을 목표부위(TG)로 하고, 변화 지름부(92)와 제2 동일 지름부(93)의 외형의 X-Y 위치의 국부 변화가 표시기능을 구성하고 있어도 좋다. 이 경우, 도 9에 도시된 바와 같이, 탐색처리에서, 엔드 이펙터의 검출부위(SP)의 초기 시작 위치를 타깃 핀(9')의 제2 동일 지름부(93)의 주위로 하고, 엔드 이펙터를 제2 동일 지름부(93)로부터 변화 지름부(92)를 향해서 'Z' 방향으로 이동시킨 복수 개소에서 일련의 접촉 위치 취득 동작(단계 S13 ~ S15)이 반복된다.
예를 들어, 타깃 핀(9)이 지름이 일정한 원기둥형으로서, 타깃 핀(9)의 상단 가장자리를 목표부위(TG)로 하고, 타깃 핀(9)의 외형의 X-Y 위치의 국부 변화가 표시기능을 구성하고 있어도 좋다. 이 경우, 엔드 이펙터의 검출부위(SP)가 타깃 핀(9)과 접촉하지 않게 된 것에 의해, 검출부위(SP)가 목표부위(TG)에 도달한 것을 검출할 수가 있다.
또한, 본 실시형태에서는, 타깃 핀(9)의 형상에 따라서 목표부위(TG)의 표시기능이 실현되고 있으나, 표시기능이 다른 수단에 의해 실현되어도 좋다. 예를 들면, 타깃 핀(9)은 지름이 일정한 원기둥 형상으로서. 타깃 핀(9) 주위의 목표부위(TG)에 접촉센서가 설치되고, 이 접촉 센서에 의해서 표시기능이 구성되어도 좋다.
또한, 상기 실시형태에서, 변형검출장치(8)는, 핸드(5)의 비틀림 변형, 휨 변형 및 회전 변형의 평가처리(단계 S2 ~ S4)를 차례로 수행하지만, 이러한 변형의 평가처리 중 적어도 어느 하나 이상을 선택적으로 수행하여도 좋다. 예를 들면, 핸드(5)의 비틀림 변형, 휨 변형 및 회전 변형의 평가처리 중, 비틀림 변형의 평가처리만이 수행되어도 좋다. 이 경우, 제3 검출부위(SP3)와 제4 검출부위(SP4)의 각각의 검출부위(SP)에서의 탐색처리는 불필요하다. 또한, 각각의 변형의 평가처리(단계 S2 ~ S4)의 순서는 상기 실시형태에 한정되지 않고, 적절히 순서가 바뀌어도 좋다.
상기 설명에서, 이 분야의 통상의 기술자에게는, 본 발명의 많은 개량이나 다른 실시형태가 자명하다. 따라서, 상기 설명은, 예시로서만 해석되어야 하며, 본 발명을 실행하는 최선의 형태를 통상의 기술자에게 교시할 목적으로 제공된 것이다. 본 발명의 정신을 벗어나지 않고, 그 구조 및/또는 기능의 구체적인 사항을 실질적으로 변경할 수 있다.
1: 로봇 시스템
3: 제어 장치
4: 로봇 암
5: 로봇 핸드(엔드 이펙터)
8: 변형검출장치
9: 타깃 핀
21: 기대
30: 컨트롤러
40: 승강축
41 ~ 44: 제1 ~ 제4 링크
60 ~ 64: 구동 장치
81: 탐색부
82: 위치정보 격납부
83: 변형 검출부
84: 변형 보정부
91: 제1 동일 지름부
92: 변화 지름부
93: 제2 동일 지름부
95, 96: 경계선
A0 ~ A4: 서보 앰프
C: 핸드 중심선
D0 ~ D4: 동력전달기구
E0 ~ E4: 위치 검출기
J1 ~ J4: 제1 ~ 제4 관절
L1 ~ L4: 제1 ~ 제4 축
M0 ~ M4: 서보 모터
SP: 검출부위
TG: 목표부위

Claims (18)

  1. 삭제
  2. 선단부에 소정 방향으로 연장되는 회동축을 중심으로 하여 회동이 자유로운 손목을 가지는 로봇 암과, 상기 손목에 장착된 엔드 이펙터와, 상기 엔드 이펙터의 소정의 검출부위가 도달할 목표부위를 가지는 타깃 핀을 이용하여 해당 엔드 이펙터의 변형을 검출하는 변형검출장치를 구비한 로봇 시스템으로서,
    상기 목표부위는, 상기 검출부위가 해당 목표부위에 도달한 것을 나타내는 표시기능을 가지고 있으며,
    상기 변형검출장치가,
    상기 검출부위를 상기 타깃 핀에 접촉시키도록 상기 로봇 암을 제어하여 상기 목표부위를 탐색하고, 상기 표시기능에 의거하여 상기 검출부위가 상기 목표부위에 도달한 것을 검출하는 탐색부와,
    상기 검출부위가 상기 목표부위에 도달했을 때의 상기 검출부위의 상정위치와 소정의 참조위치를 비교하여, 상기 엔드 이펙터의 변형을 검출하는 변형 검출부를 구비하며,
    상기 목표부위는, 상기 표시기능을 발휘하기 위해, 상기 엔드 이펙터를 상기 타깃 핀에 접촉시키면서 상기 타깃 핀을 따라서 상기 소정 방향으로 이동시킨 경우에, 상기 타깃 핀에 대한 상기 엔드 이펙터의 접촉 위치가 국부적으로 변화하는 형상으로 형성되어 있으며,
    상기 변형검출장치가, 상기 검출부위를 상기 타깃 핀에 접촉시키면서 상기 타깃 핀을 따라서 상기 소정 방향으로 이동시키도록 상기 로봇 암을 제어하여 상기 목표부위를 탐색하고, 상기 타깃 핀에 대한 상기 검출부위의 접촉 위치의 국부적 변화에 의거하여 해당 검출부위가 상기 목표부위에 도달한 것을 검출하도록 구성되는 것을 특징으로 하는 로봇 시스템.
  3. 선단부에 소정 방향으로 연장되는 회동축을 중심으로 하여 회동이 자유로운 손목을 가지는 로봇 암과, 상기 손목에 장착된 엔드 이펙터와, 상기 엔드 이펙터의 소정의 검출부위가 도달할 목표부위를 가지는 타깃 핀을 이용하여 해당 엔드 이펙터의 변형을 검출하는 변형검출장치를 구비한 로봇 시스템으로서,
    상기 목표부위는, 상기 검출부위가 해당 목표부위에 도달한 것을 나타내는 표시기능을 가지고 있으며,
    상기 변형검출장치가,
    상기 검출부위를 상기 타깃 핀에 접촉시키도록 상기 로봇 암을 제어하여 상기 목표부위를 탐색하고, 상기 표시기능에 의거하여 상기 검출부위가 상기 목표부위에 도달한 것을 검출하는 탐색부와,
    상기 검출부위가 상기 목표부위에 도달했을 때의 상기 검출부위의 상정위치와 소정의 참조위치를 비교하여, 상기 엔드 이펙터의 변형을 검출하는 변형 검출부를 구비하며,
    상기 타깃 핀은, 해당 타깃 핀에 대한 상기 엔드 이펙터의 접촉 위치가 국부적으로 변화하는 형상으로서, 지름이 일정한 동일 지름부와 지름이 변화하는 변화 지름부를, 상기 소정 방향으로 연속하여 가지고, 상기 동일 지름부와 상기 변화 지름부의 경계가 상기 목표부위를 구성하고 있으며,
    상기 변형검출장치가, 상기 엔드 이펙터를 상기 회동축 주위로 요동시켜서 상기 검출부위가 상기 타깃 핀에 접촉했을 때의 상기 검출부위의 위치정보를 취득하는 것을, 상기 엔드 이펙터를 상기 동일 지름부로부터 상기 변화 지름부를 향해서 상기 소정 방향으로 변위 시킨 복수 개소에서 수행하여 상기 목표부위를 탐색하고, 취득한 복수의 상기 위치정보로부터 도출되는 상기 회동축 주위의 각변위에 의거하여 상기 검출부위가 상기 목표부위에 도달한 것을 검출하도록 구성되는 것을 특징으로 하는 로봇 시스템.
  4. 제2항 또는 제3항에 있어서,
    상기 변형검출장치가, 상기 변형 검출부에서 상기 엔드 이펙터의 변형이 검출되었을 때, 상기 변형이 상기 로봇 암의 위치 및 자세 중 적어도 어느 한쪽의 조정으로 보정이 가능한지를 판단하고, 보정이 가능한 경우에 상기 변형을 보정 하는 변형 보정부를 더 가지는 것을 특징으로 하는 로봇 시스템.
  5. 선단부에 소정 방향으로 연장되는 회동축을 중심으로 하여 회동이 자유로운 손목을 가지는 로봇 암과, 상기 손목에 장착된 엔드 이펙터와, 상기 엔드 이펙터의 소정의 검출부위가 도달할 목표부위를 가지는 타깃 핀을 이용하여 해당 엔드 이펙터의 변형을 검출하는 변형검출장치를 구비한 로봇 시스템으로서,
    상기 목표부위는, 상기 검출부위가 해당 목표부위에 도달한 것을 나타내는 표시기능을 가지고 있으며,
    상기 변형검출장치가,
    상기 검출부위를 상기 타깃 핀에 접촉시키도록 상기 로봇 암을 제어하여 상기 목표부위를 탐색하고, 상기 표시기능에 의거하여 상기 검출부위가 상기 목표부위에 도달한 것을 검출하는 탐색부와,
    상기 검출부위가 상기 목표부위에 도달했을 때의 상기 검출부위의 상정위치와 소정의 참조위치를 비교하여, 상기 엔드 이펙터의 변형을 검출하는 변형 검출부를 구비하며,
    상기 참조위치가, 상기 변형검출장치에 의해서, 상기 엔드 이펙터의 상기 검출부위와 서로 다른 참조부위를 상기 타깃 핀에 접촉시키도록 상기 로봇 암을 제어하여 상기 목표부위를 탐색하고, 상기 표시기능에 의거하여 상기 참조부위가 상기 목표부위에 도달한 것이 검출된 때의, 상기 참조부위의 상정위치인 것을 특징으로 하는 로봇 시스템.
  6. 제5항에 있어서,
    상기 엔드 이펙터의 변형이 상기 엔드 이펙터의 비틀림 변형이고,
    상기 검출부위와 상기 참조부위가, 상기 엔드 이펙터의 선단부에서 상기 엔드 이펙터의 중심선을 사이에 두고 한쪽과 다른 쪽에 규정되어 있으며,
    상기 변형검출장치는, 상기 검출부위가 상기 목표부위에 도달했을 때의 해당 검출부위의 상기 소정 방향의 상정위치와, 상기 참조부위가 상기 목표부위에 도달했을 때의 해당 참조부위의 상기 소정 방향의 상정위치를 비교하여, 상기 엔드 이펙터의 변형을 검출하는 것을 특징으로 하는 로봇 시스템.
  7. 제5항에 있어서,
    상기 엔드 이펙터의 변형이 상기 엔드 이펙터의 휨 변형이고,
    상기 검출부위와 상기 참조부위 중 어느 한쪽이 상기 엔드 이펙터의 선단부에 규정되고, 다른 쪽이 상기 엔드 이펙터의 뿌리부에 규정되어 있으며,
    상기 변형검출장치는, 상기 검출부위가 상기 목표부위에 도달했을 때의 해당 검출부위의 상기 소정 방향의 상정위치와, 상기 참조부위가 상기 목표부위에 도달했을 때의 해당 참조부위의 상기 소정 방향의 상정위치를 비교하여, 상기 엔드 이펙터의 변형을 검출하는 것을 특징으로 하는 로봇 시스템.
  8. 제5항에 있어서,
    상기 엔드 이펙터의 변형이 상기 엔드 이펙터의 회전 변형이고,
    상기 검출부위와 상기 참조부위 중 어느 한쪽이 상기 엔드 이펙터의 뿌리부에 규정되고, 다른 쪽이 상기 엔드 이펙터의 선단부 또는 뿌리부와 선단부 사이에 규정되어 있으며,
    　상기 변형검출장치는, 상기 검출부위가 상기 목표부위에 도달했을 때의 해당 검출부위의 상기 소정 방향과 직교하는 평면 내의 상정위치와, 상기 참조부위가 상기 목표부위에 도달했을 때의 해당 참조부위의 상기 소정 방향과 직교하는 평면 내의 상정위치를 비교하여, 상기 엔드 이펙터의 변형을 검출하는, 로봇 시스템.
  9. 제2항 또는 제3항에 있어서,
    상기 참조위치가, 상기 변형검출장치에 의해서, 상기 엔드 이펙터의 미변형의 상기 검출부위를 상기 타깃 핀에 접촉시키도록 상기 로봇 암을 제어하여 상기 목표부위를 탐색하고, 상기 표시기능에 의거하여 미변형의 상기 검출부위가 상기 목표부위에 도달한 것이 검출된 때의, 미변형의 상기 검출부위의 상정위치인 것을 특징으로 하는 로봇 시스템.
  10. 삭제
  11. 선단부에 소정 방향으로 연장되는 회동축을 중심으로 하여 회동이 자유로운 손목을 가지는 로봇 암과, 상기 손목에 장착된 엔드 이펙터와, 변형검출장치를 구비한 로봇 시스템에서,
    상기 엔드 이펙터의 소정의 검출부위가 도달할 목표부위로서, 상기 검출부위가 해당 목표부위에 도달한 것을 나타내는 표시기능을 가지는 목표부위를 구비한 타깃 핀을 이용하여 상기 변형검출장치가 상기 엔드 이펙터의 변형을 검출하는 방법으로서,
    상기 검출부위를 상기 타깃 핀에 접촉시키도록 상기 로봇 암을 제어하여 상기 목표부위를 탐색하는 것과,
    상기 표시기능에 의거하여, 상기 검출부위가 상기 목표부위에 도달한 것을 검출하는 것과,
    상기 검출부위가 상기 목표부위에 도달했을 때의 상기 검출부위의 상정위치와 소정의 참조위치를 비교하여, 상기 엔드 이펙터의 변형을 검출하는 것을 포함하며,
    상기 목표부위는, 상기 표시기능을 발휘하기 위해, 상기 엔드 이펙터를 상기 타깃 핀에 접촉시키면서 상기 타깃 핀을 따라서 상기 소정 방향으로 이동시킨 경우에, 상기 타깃 핀에 대한 상기 엔드 이펙터의 접촉 위치가 국부적으로 변화하는 형상으로 형성되어 있으며,
    상기 목표부위를 탐색하는 것이, 상기 검출부위를 상기 타깃 핀에 접촉시키면서 상기 타깃 핀을 따라서 상기 소정 방향으로 이동시키도록 상기 로봇 암을 제어하여 상기 목표부위를 탐색하는 것을 포함하고,
    상기 검출부위가 상기 목표부위에 도달한 것을 검출하는 것이, 상기 타깃 핀에 대한 상기 검출부위의 접촉위치의 국부적 변화에 의거하여 해당 검출부위가 상기 목표부위에 도달한 것을 검출하는 것을 포함하는 것을 특징으로 하는 엔드 이펙터의 변형 검출 방법.
  12. 선단부에 소정 방향으로 연장되는 회동축을 중심으로 하여 회동이 자유로운 손목을 가지는 로봇 암과, 상기 손목에 장착된 엔드 이펙터와, 변형검출장치를 구비한 로봇 시스템에서,
    상기 엔드 이펙터의 소정의 검출부위가 도달할 목표부위로서, 상기 검출부위가 해당 목표부위에 도달한 것을 나타내는 표시기능을 가지는 목표부위를 구비한 타깃 핀을 이용하여 상기 변형검출장치가 상기 엔드 이펙터의 변형을 검출하는 방법으로서,
    상기 검출부위를 상기 타깃 핀에 접촉시키도록 상기 로봇 암을 제어하여 상기 목표부위를 탐색하는 것과,
    상기 표시기능에 의거하여, 상기 검출부위가 상기 목표부위에 도달한 것을 검출하는 것과,
    상기 검출부위가 상기 목표부위에 도달했을 때의 상기 검출부위의 상정위치와 소정의 참조위치를 비교하여, 상기 엔드 이펙터의 변형을 검출하는 것을 포함하며,
    상기 타깃 핀은, 상기 타깃 핀에 대한 상기 엔드 이펙터의 접촉 위치가 국부적으로 변화하는 형상으로서, 지름이 일정한 동일 지름부와 지름이 변화하는 변화 지름부를 상기 소정 방향으로 연속하여 가지고, 상기 동일 지름부와 상기 변화 지름부의 경계가 상기 목표부위를 구성하고 있으며,
    상기 목표부위를 탐색하는 것이, 상기 엔드 이펙터를 상기 회동축 주위로 요동시켜서 상기 검출부위가 상기 타깃 핀에 접촉했을 때의 상기 검출부위의 위치정보를 취득하는 것을, 상기 엔드 이펙터를 상기 동일 지름부로부터 상기 변화 지름부를 향해서 상기 소정 방향으로 변위 시킨 복수의 개소에서 수행하여 상기 목표부위를 탐색하는 것을 포함하고,
    상기 검출부위가 상기 목표부위에 도달한 것을 검출하는 것이, 취득한 복수의 상기 위치정보로부터 도출되는 상기 회동축 주위의 각변위에 의거하여 상기 검출부위가 상기 목표부위에 도달한 것을 검출하는 것을 포함하는 것을 특징으로 하는 엔드 이펙터의 변형 검출 방법.
  13. 제11항 또는 제12항에 있어서,
    상기 변형검출장치가, 상기 엔드 이펙터의 변형이 검출된 때에, 상기 변형이 상기 로봇 암의 위치 및 자세 중 적어도 어느 한쪽의 조정으로 보정이 가능한지를 판단하고, 보정이 가능한 경우에 상기 변형을 보정 하는 것을 더 포함하는 것을 특징으로 하는 엔드 이펙터의 변형 검출 방법.
  14. 선단부에 소정 방향으로 연장되는 회동축을 중심으로 하여 회동이 자유로운 손목을 가지는 로봇 암과, 상기 손목에 장착된 엔드 이펙터와, 변형검출장치를 구비한 로봇 시스템에서,
    상기 엔드 이펙터의 소정의 검출부위가 도달할 목표부위로서, 상기 검출부위가 해당 목표부위에 도달한 것을 나타내는 표시기능을 가지는 목표부위를 구비한 타깃 핀을 이용하여 상기 변형검출장치가 상기 엔드 이펙터의 변형을 검출하는 방법으로서,
    상기 검출부위를 상기 타깃 핀에 접촉시키도록 상기 로봇 암을 제어하여 상기 목표부위를 탐색하는 것과,
    상기 표시기능에 의거하여, 상기 검출부위가 상기 목표부위에 도달한 것을 검출하는 것과,
    상기 검출부위가 상기 목표부위에 도달했을 때의 상기 검출부위의 상정위치와 소정의 참조위치를 비교하여, 상기 엔드 이펙터의 변형을 검출하는 것을 포함하며,
    상기 참조위치가, 상기 엔드 이펙터의 상기 검출부위와 서로 다른 참조부위를 상기 타깃 핀에 접촉시켜서 상기 목표부위를 탐색하고, 상기 목표부위의 상기 표시기능에 의거하여 상기 참조부위가 상기 목표부위에 도달한 것을 검출했을 때의 상기 참조부위의 상정위치인 것을 특징으로 하는 엔드 이펙터의 변형 검출 방법.
  15. 제14항에 있어서,
    상기 엔드 이펙터의 변형이 상기 엔드 이펙터의 비틀림 변형이고,
    상기 검출부위와 상기 참조부위가, 상기 엔드 이펙터의 선단부에서 상기 엔드 이펙터의 중심선을 사이에 두고 한쪽과 다른 쪽에 규정되어 있으며,
    상기 엔드 이펙터의 변형을 검출하는 것이, 상기 검출부위가 상기 목표부위에 도달했을 때의 해당 검출부위의 상기 소정 방향의 상정위치와, 상기 참조부위가 상기 목표부위에 도달했을 때의 해당 참조부위의 상기 소정 방향의 상정위치와 비교하여, 상기 엔드 이펙터의 변형을 검출하는 것을 포함하는 것을 특징으로 하는 엔드 이펙터의 변형 검출 방법.
  16. 제14항에 있어서,
    상기 엔드 이펙터의 변형이 상기 엔드 이펙터의 휨 변형이고,
    상기 검출부위와 상기 참조부위 중 어느 한쪽이 상기 엔드 이펙터의 선단부에 규정되고, 다른 쪽이 상기 엔드 이펙터의 뿌리부에 규정되어 있으며,
    상기 엔드 이펙터의 변형을 검출하는 것이, 상기 검출부위가 상기 목표부위에 도달했을 때의 해당 검출부위의 상기 소정 방향의 상정위치와, 상기 참조부위가 상기 목표부위에 도달했을 때의 해당 참조부위의 상기 소정 방향의 상정위치와 비교하여, 상기 엔드 이펙터의 변형을 검출하는 것을 포함하는 것을 특징으로 하는 엔드 이펙터의 변형 검출 방법.
  17. 제14항에 있어서,
    상기 엔드 이펙터의 변형이 상기 엔드 이펙터의 회전 변형이고,
    상기 검출부위와 상기 참조부위 중 어느 한쪽이 상기 엔드 이펙터의 뿌리부에 규정되고, 다른 쪽이 상기 엔드 이펙터의 선단부 또는 뿌리부와 선단부 사이에 규정되어 있으며,
    상기 엔드 이펙터의 변형을 검출하는 것이, 상기 검출부위가 상기 목표부위에 도달했을 때의 해당 검출부위의 상기 소정 방향과 직교하는 평면 내의 상정위치와, 상기 참조부위가 상기 목표부위에 도달했을 때의 해당 참조부위의 상기 소정 방향과 직교하는 평면 내의 상정위치를 비교하여, 상기 엔드 이펙터의 변형을 검출하는 것을 포함하는 것을 특징으로 하는 엔드 이펙터의 변형 검출 방법.
  18. 제11항 또는 제12항에 있어서,
    상기 참조위치가, 상기 엔드 이펙터의 미변형의 상기 검출부위를 상기 타깃 핀에 접촉시켜서 상기 목표부위를 탐색하고, 상기 목표부위의 상기 표시기능에 의거하여 미변형의 상기 검출부위가 상기 목표부위에 도달한 것을 검출했을 때의 미변형의 상기 검출부위의 상기 소정 방향의 상정위치인 것을 특징으로 하는 엔드 이펙터의 변형 검출 방법.
KR1020177018115A 2014-12-22 2014-12-22 로봇 시스템 및 엔드 이펙터의 변형 검출 방법 KR101952766B1 (ko)

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/JP2014/006394 WO2016103292A1 (ja) 2014-12-22 2014-12-22 ロボットシステム及びエンドエフェクタの変形検出方法

Publications (2)

Publication Number Publication Date
KR20170091705A KR20170091705A (ko) 2017-08-09
KR101952766B1 true KR101952766B1 (ko) 2019-02-28

Family

ID=56149396

Family Applications (1)

Application Number Title Priority Date Filing Date
KR1020177018115A KR101952766B1 (ko) 2014-12-22 2014-12-22 로봇 시스템 및 엔드 이펙터의 변형 검출 방법

Country Status (6)

Country Link
US (1) US10279485B2 (ko)
JP (1) JP6412955B2 (ko)
KR (1) KR101952766B1 (ko)
CN (1) CN107000224B (ko)
TW (1) TWI586498B (ko)
WO (1) WO2016103292A1 (ko)

Families Citing this family (19)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP6718352B2 (ja) * 2016-09-28 2020-07-08 川崎重工業株式会社 基板搬送ハンドの診断システム
USD822735S1 (en) * 2017-03-17 2018-07-10 Donald Dimattia, Jr. Positionable end effector link
CN109285794B (zh) * 2017-07-21 2020-11-20 上海新昇半导体科技有限公司 一种用于晶圆的目视检测机及检测方法
KR102022804B1 (ko) * 2017-11-02 2019-09-18 조재용 웨이퍼 이송용 로봇 감지장치
CN108750574B (zh) * 2018-08-31 2023-09-08 烟台宇信科技有限公司 一种变径支撑压紧定位装置
JP2020077699A (ja) * 2018-11-06 2020-05-21 川崎重工業株式会社 ロボットハンド及びそれを備えるロボット
JP7149815B2 (ja) * 2018-11-15 2022-10-07 川崎重工業株式会社 ロボットシステム及びその運転方法
US11059178B2 (en) * 2018-12-27 2021-07-13 Kawasaki Jukogyo Kabushiki Kaisha Method of correcting position of robot and robot
US10974388B2 (en) * 2018-12-27 2021-04-13 Kawasaki Jukogyo Kabushiki Kaisha Method of correcting position of robot and robot
US10953539B2 (en) * 2018-12-27 2021-03-23 Kawasaki Jukogyo Kabushiki Kaisha Substrate transfer robot and automatic teaching method
JP7169370B2 (ja) * 2018-12-28 2022-11-10 川崎重工業株式会社 ロボット制御装置、ロボットシステム及びロボット制御方法
JP6983206B2 (ja) * 2019-10-15 2021-12-17 株式会社アルバック 基板搬送装置、および、基板搬送方法
CN113548443B (zh) * 2020-04-23 2022-03-25 上海微电子装备（集团）股份有限公司 一种用于机械手交接的检测方法及检测装置
JP2022043559A (ja) * 2020-09-04 2022-03-16 川崎重工業株式会社 ロボット及びハンド部姿勢調整方法
JP2022059951A (ja) * 2020-10-02 2022-04-14 日本電産サンキョー株式会社 産業用ロボット
US11745343B2 (en) * 2020-11-18 2023-09-05 Darrion Vinh Nguyen Method and apparatus for controlling robot arms using elastic distortion simulations
CN112643713B (zh) * 2020-12-08 2022-07-01 江苏科技大学 机器人端拾器高温传递和变形检测装置及方法
KR102516622B1 (ko) * 2021-08-05 2023-03-31 주식회사 쓰리디오토매이션 캘리브레이션 측정용 핀
CN115416018B (zh) * 2022-08-17 2024-03-15 雅客智慧（北京）科技有限公司 末端执行器形变补偿方法、装置、电子设备和存储介质

Family Cites Families (21)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4156835A (en) * 1974-05-29 1979-05-29 Massachusetts Institute Of Technology Servo-controlled mobility device
JPH01257593A (ja) * 1988-04-06 1989-10-13 Hitachi Ltd ロボットの芯ずれ補正方法
JP2996491B2 (ja) * 1990-07-20 1999-12-27 東京エレクトロン株式会社 アーム式搬送装置
JPH07205071A (ja) * 1994-01-27 1995-08-08 Matsushita Electric Ind Co Ltd 産業用ロボット
US6366830B2 (en) * 1995-07-10 2002-04-02 Newport Corporation Self-teaching robot arm position method to compensate for support structure component alignment offset
JPH0970780A (ja) * 1995-09-06 1997-03-18 Fanuc Ltd ロボットのツール形状補正方式
JPH11179692A (ja) 1997-12-16 1999-07-06 Shin Meiwa Ind Co Ltd 産業用ロボットのハンド異常検出装置及びハンド異常検出方法
JP3948092B2 (ja) * 1998-01-29 2007-07-25 松下電器産業株式会社 トーチ位置検出方法
JP4010891B2 (ja) * 2002-07-03 2007-11-21 Ｎｅｃエレクトロニクス株式会社 半導体ウェハ搬送方法
JP5235376B2 (ja) * 2007-10-05 2013-07-10 川崎重工業株式会社 ロボットのターゲット位置検出装置
CN101888959B (zh) 2007-12-05 2013-07-03 平田机工株式会社 基板输送装置及基板输送装置的控制方法
EP2308657B1 (en) * 2008-07-10 2019-09-04 Kawasaki Jukogyo Kabushiki Kaisha Robot and its teaching method
JP2012094554A (ja) * 2009-01-14 2012-05-17 Canon Anelva Corp 真空処理装置、電子部品の製造方法及び真空処理プログラム
JP2010188437A (ja) 2009-02-16 2010-09-02 Amada Co Ltd ロボットハンドの歪み検出方法および自動交換システム
JP2011192676A (ja) * 2010-03-11 2011-09-29 Nikon Corp 基板処理装置、積層半導体装置製造方法及び積層半導体装置
JP5733437B2 (ja) * 2010-08-20 2015-06-10 東京エレクトロン株式会社 基板搬送装置、基板搬送方法及び記録媒体
JP2012212746A (ja) * 2011-03-31 2012-11-01 Tokyo Electron Ltd 基板搬送装置及び基板搬送方法
JP5929271B2 (ja) * 2012-02-07 2016-06-01 セイコーエプソン株式会社 ロボットハンドおよびロボット
JP2013247302A (ja) * 2012-05-29 2013-12-09 Hitachi High-Technologies Corp 基板バッファ並びに有機ｅｌデバイス製造装置及び同製造方法
JP6438189B2 (ja) * 2013-10-01 2018-12-12 川崎重工業株式会社 ロボット及びロボットの制御方法
KR20230048568A (ko) * 2014-11-10 2023-04-11 브룩스 오토메이션 인코퍼레이티드 툴 자동-교시 방법 및 장치

Also Published As

Publication number Publication date
CN107000224B (zh) 2019-09-24
WO2016103292A1 (ja) 2016-06-30
US20180015620A1 (en) 2018-01-18
JPWO2016103292A1 (ja) 2017-07-06
CN107000224A (zh) 2017-08-01
US10279485B2 (en) 2019-05-07
JP6412955B2 (ja) 2018-10-24
TWI586498B (zh) 2017-06-11
KR20170091705A (ko) 2017-08-09
TW201622925A (zh) 2016-07-01

Similar Documents

Publication Publication Date Title
KR101952766B1 (ko) 로봇 시스템 및 엔드 이펙터의 변형 검출 방법
KR102105580B1 (ko) 기판 반송 장치 및 기판 반송 로봇의 교시 방법
JP5235376B2 (ja) ロボットのターゲット位置検出装置
US7445260B2 (en) Gripping type hand
US20180161979A1 (en) Robot system including a plurality of robots, robot controller and robot control method
US10195744B2 (en) Control device, robot, and robot system
WO2016147592A1 (ja) ロボット、ロボットの制御方法、ワークの取付方法及びワークの搬送方法
CN110914025B (zh) 把持系统
JP2006159399A (ja) 作業用移動ロボット
JP5529920B2 (ja) ロボットのターゲット位置検出装置、半導体装置およびターゲット位置検出方法
JP2015085499A (ja) ロボット、ロボットシステム、制御装置及び制御方法
JP7178994B2 (ja) 把持システム
JP5620463B2 (ja) ロボットのターゲット位置検出装置
US10403539B2 (en) Robot diagnosing method
JP7500191B2 (ja) ロボットシステム、搬送車、ロボットシステムの制御方法、物品の製造方法、制御プログラム及び記録媒体
WO2022137917A1 (ja) 基板搬送ロボットの制御装置及び関節モータの制御方法
US11453120B2 (en) Robot system
JP2024002786A (ja) ロボットシステムの制御方法およびロボットシステム
JP6252272B2 (ja) 垂直多関節型ロボットの位置誤差抑制方法
JP2019177441A (ja) ロボットアーム

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