TW201622914A - 多關節機械手臂及多關節機械手臂的控制方法 - Google Patents

多關節機械手臂及多關節機械手臂的控制方法 Download PDF

Info

Publication number
TW201622914A
TW201622914A TW104117944A TW104117944A TW201622914A TW 201622914 A TW201622914 A TW 201622914A TW 104117944 A TW104117944 A TW 104117944A TW 104117944 A TW104117944 A TW 104117944A TW 201622914 A TW201622914 A TW 201622914A
Authority
TW
Taiwan
Prior art keywords
arm
information
track information
track
operation command
Prior art date
Application number
TW104117944A
Other languages
English (en)
Other versions
TWI682839B (zh
Inventor
Yoji Masui
Toru Saeki
Original Assignee
Sinfonia Technology Co Ltd
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 Sinfonia Technology Co Ltd filed Critical Sinfonia Technology Co Ltd
Publication of TW201622914A publication Critical patent/TW201622914A/zh
Application granted granted Critical
Publication of TWI682839B publication Critical patent/TWI682839B/zh

Links

Classifications

    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B25J9/16—Programme controls
    • B25J9/1656—Programme controls characterised by programming, planning systems for manipulators
    • B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
    • 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/67763—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 the wafers being stored in a carrier, involving loading and unloading
    • H01L21/67766—Mechanical parts of transfer devices
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00—Program-control systems
    • G05B2219/30—Nc systems
    • G05B2219/40—Robotics, robotics mapping to robotics vision
    • G05B2219/40431—Grid of preoptimised paths as function of target position, choose closest, fine adapt
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00—Program-control systems
    • G05B2219/30—Nc systems
    • G05B2219/50—Machine tool, machine tool null till machine tool work handling
    • G05B2219/50111—Retract tool along path, reengage along same path
    • Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y10—TECHNICAL SUBJECTS COVERED BY FORMER USPC
    • Y10S—TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y10S901/00—Robots
    • Y10S901/02—Arm motion controller

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

提供一種不需要將記憶裝置的容量增加就可以進行適切的臂先端的位置控制，可短縮位置控制用的軌道資訊的導出時間的多關節機械手臂。 控制手段(4)，是具備：將對應始點及終點的組合的軌道資訊(R)記憶的軌道資訊記憶部(42)、及將臂先端(2b)的現在位置及目標位置作為始點及終點設定的設定部(41)、及依據對應所設定的始點及終點的組合的軌道資訊(R)(=對應軌道資訊(Rc))生成動作指令(C)的動作指令生成部(43)，動作指令生成部(43)，是對應軌道資訊(Rc)沒有被記憶在軌道資訊記憶部(42)，但對應與所設定的始點及終點的組合具有規定的關係性的始點及終點的組合的相關連軌道資訊(Rr)被記憶的情況時，依據相關連軌道資訊Rr生成動作指令(C)。

Description

多關節機械手臂及多關節機械手臂的控制方法
本發明，是有關於使用預先被設定的軌道資訊將臂先端動作的多關節機械手臂及多關節機械手臂的控制方法。
習知具有，驅動將複數臂要素可旋轉地連接的臂，將臂先端朝規定的位置移動的多關節機械手臂。
例如，如專利文獻1所示的多關節機械手臂的一種也就是搬運裝置，是使用藉由軌道資訊生成裝置事前被生成的軌道資訊，進行臂先端的移動控制。在此，在移動控制所使用的軌道資訊，是依據臂的動力學模型，使用最適化手法從所期的始點至終點為止使移動時間極力縮短的方式被生成。
且也有不預先保持驅動用的軌道資訊，而將被給與的2點間藉由直線或是圓弧將插補(Interpolation)的路徑即時算出，依據所算出的資料進行驅動控制的多關節機械手臂。
〔習知技術文獻〕 〔專利文獻〕
[專利文獻1]日本特開2011-167827號公報
但是將軌道資訊預先生成的情況時，有必要 將所生成的軌道資訊記憶在記憶裝置，為了將多關節機械手臂的臂先端可取得軌道的數量增加，必需將記憶裝置的記憶容量增加。且，將軌道資訊預先生成的情況，設定多關節機械手臂時，也需要對應生成的軌道資訊的數量將軌道生成用的軌道計算時間。
另一方面，將搬運路徑由即時算出的情況， 為了藉由直線和圓弧的組合將始點及終點連接，有必要藉由教學作業等設定中繼點，在此設定花費時間，且考慮各軸的扭矩、旋轉數、角度、加速度等大多的限制條件設定通過最適路徑的中繼點，對於熟練者也困難。且，多關節機械手臂因為有必要進行中繼點的插補(Interpolation)運算，所以對於機械手臂的控制手段成為負荷。
本發明，是有鑑於上述的問題者，其目的， 是提供一種不需要增加記憶裝置的容量就可以進行適切的臂先端的位置控制，由即時算出搬運路徑的情況時可削減所需要的教學作業，並且可短縮在位置控制用的軌道資訊的導出所需要的軌道計算時間的多關節機械手臂及多關節 機械手臂的控制方法。
本發明，為了達成這種目的，採用如以下的手段。
即，本發明的多關節機械手臂，是具備：將複數臂要素可旋轉地連接的臂、及藉由朝將前述臂要素驅動的驅動手段將動作指令輸出來進行臂先端的位置控制的控制手段，其特徵為：前述控制手段，是具備：對應以將前述臂先端動作的複數移動目的地之中其中任一作為始點且將其他的其中任一作為終點的組合，將包含沿著時間序列被設定的各臂要素的位置資訊構成的軌道資訊記憶的軌道資訊記憶部；及將前述臂先端的現在位置及目標位置作為始點及終點設定的設定部；及依據對應該設定部所設定的始點及終點的組合的軌道資訊生成前述動作指令的動作指令生成部；前述動作指令生成部，是在前述軌道資訊記憶部中，當對應前述設定部所設定的始點及終點的組合的軌道資訊沒有被記憶，但對應與前述設定部所設定的始點及終點的組合具有規定的關係性的始點及終點的組合的相關連軌道資訊被記憶的情況時，依據該相關連軌道資訊生成前述動作指令。
如此構成的話，軌道資訊記憶部是記憶包含沿著時間序列被設定的各臂要素的位置資訊構成的軌道資訊，動作指令生成部因為是藉由依據對應設定部所設定的 始點及終點的軌道資訊將動作指令輸出來進行臂先端的位置控制，所以因為只要準備一次軌道資訊，就可以在相同構成的多關節機械手臂將資訊共有利用，所以中繼點的調整作業是成為不需要。且，因為藉由被記憶在軌道資訊記憶部的軌道資訊生成動作指令，中繼點的插補(Interpolation)運算的即時運算是成為不需要，由低規格的運算機也可生成適切的動作指令，並且削減為了即時的搬運路徑的算出所需要的教學作業也可以。且，對應設定部所設定的始點及終點的組合的軌道資訊沒有被記憶，但對應與設定部所設定的始點及終點的組合具有規定的關係性的始點及終點的組合的相關連軌道資訊被記憶的情況時，因為依據該相關連軌道資訊生成前述動作指令，所以可以削減記憶在軌道資訊記憶部的軌道資訊，不需搭載大容量的記憶裝置，就可以進行臂先端的位置控制。進一步，藉由將軌道資訊削減，使用相同容量的記憶裝置，就可生成更多的動作指令。此外，也可以短縮在軌道資訊的導出所需要的軌道計算時間。
且對於將被記憶在軌道資訊記憶部的軌道資 訊削減的構成，前述相關連軌道資訊，是包含對應將藉由前述設定部被設定的始點及終點替換的組合的軌道資訊也就是逆向軌道資訊，前述動作指令生成部，是藉由將前述逆向軌道資訊的時間序列逆向利用而可生成前述動作指令也最佳。
進一步，對於將記憶在軌道資訊記憶部的軌 道資訊削減的其他的構成，前述相關連軌道資訊，是包含：對應對於藉由前述設定部被設定的始點及終點，位於將通過前述臂的旋轉中心的直線挾持的對稱的位置的始點及終點的組合的軌道資訊也就是對稱軌道資訊，且前述動作指令生成部，是藉由將前述對稱軌道資訊的位置資訊對稱轉換利用而可生成前述動作指令也有效。
此外，多關節機械手臂是具備作為臂要素的 第1手臂及第2手臂的情況時，為了可將記憶在軌道資訊記憶部的軌道資訊削減，是在前述臂的反基端側，使作為前述臂要素的第1手臂及第2手臂以同一的旋轉軸為中心可旋轉地設置，前述控制手段，是進行形成前述臂先端的第1手臂先端及第2手臂先端的位置控制者，前述動作指令生成部，是依據被記憶在前述軌道資訊記憶部的軌道資訊，生成為了進行前述第1手臂先端及第2手臂先端的位置控制所使用的動作指令是有效果的。
且本發明的多關節機械手臂的控制方法，該 多關節機械手臂，具備：將複數臂要素可旋轉地連接的臂、及將前述臂要素驅動的驅動手段、及記憶對應以將臂先端動作的複數移動目的地之中其中任一作為始點將其他的其中任一作為終點的組合的軌道資訊的軌道資訊記憶部，藉由將動作指令朝前述驅動手段輸出來進行前述臂先端的位置控制，其特徵為，該多關節機械手臂的控制方法，具備：從現在位置資訊及目標位置資訊設定始點及終點的步驟；及判別對應所設定的始點及終點的組合的軌道 資訊是否被記憶於軌道資訊記憶部的步驟；及判別為前述軌道資訊存在於軌道資訊記憶部的情況時，依據該軌道資訊生成動作指令的步驟；及判別為前述軌道資訊未被記憶在軌道資訊記憶部的情況時，判別對應與前述始點及終點的組合具有規定的關係性的始點及終點的組合的相關連軌道資訊是否被記憶於軌道資訊記憶部的步驟；及判別為前述相關連軌道資訊被記憶於軌道資訊記憶部的情況時，依據該相關連軌道資訊生成動作指令的步驟。使用本發明，也可獲得與上述同樣的效果。
依據以上說明的本發明的話成為可提供一種，不需要將記憶裝置的容量增加就可以進行適切的臂先端的位置控制，由即時算出搬運路徑的情況時可削減必要的教學作業，並且可短縮在位置控制用的軌道資訊的導出所需要的軌道計算時間的多關節機械手臂及多關節機械手臂的控制方法。
A‧‧‧位置資訊
C‧‧‧動作指令
D‧‧‧資料庫
h‧‧‧規定距離
L‧‧‧對稱軸
n‧‧‧動作順序
P0~P5‧‧‧基點(移動目的地)
Pa‧‧‧基點
R‧‧‧軌道資訊
R1~R3‧‧‧軌道資訊
Rb‧‧‧軌道資訊
Rc‧‧‧對應軌道資訊
Ri‧‧‧逆向軌道資訊
Ri1~Ri3‧‧‧逆向軌道資訊
Rr‧‧‧相關連軌道資訊
Rs‧‧‧對稱軌道資訊
V1‧‧‧禁止領域
V2‧‧‧擴大禁止領域
W‧‧‧晶圓(被搬運物)
1‧‧‧搬運裝置(多關節機械手臂)
2‧‧‧臂
2a‧‧‧臂基端
2b、2b1、2b2‧‧‧手臂先端(臂先端)
3‧‧‧驅動手段
4‧‧‧控制手段
5‧‧‧承接手段
20‧‧‧基台
21‧‧‧第1臂要素
21a~24a‧‧‧基端部
21b‧‧‧先端部
21c~23c‧‧‧軸
22‧‧‧第2臂要素
22b‧‧‧先端部
23‧‧‧第1手臂
23b、24b‧‧‧保持部
24‧‧‧第2手臂
31‧‧‧編碼器
41‧‧‧設定部
42‧‧‧軌道資訊記憶部
43‧‧‧動作指令生成部
50a‧‧‧搬運室
50b‧‧‧壁
51~54‧‧‧裝載埠
60‧‧‧裝載鎖定室
[第1圖]意示本發明的實施例的多關節機械手臂的構成圖。
[第2圖]顯示同多關節機械手臂的EFEM內的移動目的地的例的俯視圖。
[第3圖]顯示同多關節機械手臂的臂的可動領域的說明圖。
[第4圖]顯示同多關節機械手臂的位置資訊的時間序列資料及軌道資訊的圖。
[第5圖]顯示同多關節機械手臂的動作的流程圖。
[第6圖]顯示同多關節機械手臂的軌道資訊的圖表。
以下，將本發明的實施例的多關節機械手 臂，一邊參照圖面一邊說明。
本實施例的多關節機械手臂，是如第1圖所 示，將被搬運物也就是晶圓W搬運的搬運裝置1，具備：臂2、及將臂2驅動的驅動手段3、及將臂2的驅動控制的控制手段4、及在將晶圓W交接的目標位置承接的承接手段5。
此搬運裝置1，是如第2圖所示，被設在具備 複數裝載埠51~54的EFEM(設備前端模組、Equipment Front End Module)50的搬運室50a內，這些裝載埠51~54、及與EFEM50相鄰接的裝載鎖定室60等，是作為晶圓W的規定的移動目的地也就是基點P1~P5被設定。 且，將搬運裝置1起動隨後的臂先端2b的初期位置(與臂基端2a一致)也作為基點P0被設定。
在此，在以下的說明中，將裝載埠51~54並 列的方向定義成X軸方向，將與X軸方向在垂直方向垂 直交叉的方向定義成Y軸方向，對於X軸逆時針旋轉定義為角度θ。且，在本案中，EFEM50是在平面視的情況時將與通過臂2的旋轉中心也就是臂基端2a的Y軸平行的直線也就是對稱軸L挾持地構成線對稱。
臂2，是如第1圖所示，具備：在基台20連 接基端部21a的第1臂要素21、及在第1臂要素21的先端部21b連接基端22a的第2臂要素22、及在第2臂要素22的先端部22b連接基端23a、24a且在先端設定成將晶圓W載置用的保持部23b、24b的作為第3臂要素及第4臂要素的第1手臂23及第2手臂24，各臂要素21~24是各別以軸21c~23c為中心在水平方向可旋轉地連接。 又，第1手臂23及第2手臂24因為是同一的構成，所以以下只有進行第1手臂23的說明。且，保持部23b是以將晶圓W保持時的晶圓W的中心位置決定為臂先端2b。
驅動手段3，是具備設於臂要素21~23的基 端部21a~23a的伺服馬達(無圖示)，藉由各伺服馬達的驅動，變更：軸21c周圍的基台20及臂要素21之間的角度θ 1、軸22c周圍的臂要素21、22間的角度θ 2、及軸23c周圍的臂要素22、23間的角度θ 3，就可將臂先端2b朝所期的位置移動。且，各伺服馬達是具備編碼器31，可檢出上述的軸21c~23c周圍的角度θ 1~θ 3。之後，將沿著動作順序n，即時間序列被設定的各臂要素21~23的角度(θ 1(n)、θ 2(n)、θ 3(n))，作成臂要素21~23的位置資訊A(第4圖(a)參照)。
控制手段4，是具備：將藉由承接手段5所承 接的目標位置資訊及編碼器31所獲得的現在位置資訊作為臂先端2b的始點及終點設定的設定部41、及將預先被生成的臂先端2b的軌道資訊R作為資料庫D記憶的軌道資訊記憶部42、及依據被記憶在軌道資訊記憶部42的軌道資訊R生成朝驅動手段3輸出的動作指令C的動作指令生成部43。在此，承接手段5，是從顯示器、鍵盤和滑鼠等的已知的操作部，或是上位的系統承接顯示臂先端2b的目標位置的目標位置資訊。此控制手段4，是藉由具備CPU、記憶裝置及介面的通常的微處理器等構成者，在記憶體記憶裝置中預先容納處理必要的程式，CPU是逐次將必要的程式取出實行，與周邊硬資源協動來實現所期的功能。又，此控制手段4，實際上也加上扭矩、旋轉數、角度、加速度等的致動器能力生成動作指令C，對應從編碼器31所獲得的臂要素21~23的角度(θ 1(n)、θ 2(n)、θ 3(n))，修正動作指令C也可以。且，控制手段4，也具有：朝軌道資訊R的資料庫D的登錄的功能、及從資料庫D讀出的功能，在資料庫D中被登錄複數軌道資訊R。
在此，軌道資訊R，是依據動力學模型及限 制條件導引出的軌道資訊之中，使其移動時間成為最小的適切的軌道資訊藉由最適化手法生成者。最適化手法，可適宜使用習知已知者，例如，可利用日本特開2011-167827號公報者生成。
但是在本案中，限制條件的1個，如第3圖 所示，是將藉由EFEM50、裝載埠51~54及裝載鎖定室60等的壁50b被設定的禁止領域V1朝內側，即搬運裝置1側規定距離h擴張的擴張禁止領域V2，設定成臂2及被保持在臂2的晶圓W不可侵入的領域。此規定距離h，是成為例如10mm程度。如此，軌道資訊R，因為是以使保持在臂先端2b的晶圓W不進入擴張禁止領域V2作為限制條件的1個被生成，所以可防止晶圓W與壁50b等的障礙物衝突。
且如此被生成的軌道資訊R，是作為沿著上 述的位置資訊A的時間序列的集合構成者(第4圖(a)參照)，軌道資訊記憶部42，是將此軌道資訊R與從臂先端2b的移動目的地也就是基點P0~P5被選擇的始點及終點的組合對應地記憶。具體而言，在軌道資訊記憶部42的資料庫D中，如第4圖(b)所示，例如(始點、終點)的組合，是對應(P0、P1)、(P0、P2)、(P1、P2)的軌道資訊R也就是軌道資訊R1~R3等被記憶。 且，這些軌道資訊R1~R3，其(始點、終點)的組合，也具有對應與上述(P0、P1)、(P0、P2)、(P1、P2)具有規定的關係性(P1、P0)、(P2、P0)、(P2、P1)的相關連軌道資訊Rr也就是逆向軌道資訊Ri1~Ri3的角色，藉此，另外的資料庫D可以不保持(始點、終點)的組合是(P1、P0)、(P2、P0)、(P2、P1)的情況的軌道資訊R。又，對於逆向軌道資訊 Ri的詳細如後述。
且動作指令生成部43，是從資料庫D的軌道 資訊R，將依動作序被記憶的臂要素21~23的位置資訊A在每控制周期依序讀出並生成使驅動手段3的各伺服馬達動作的動作指令C，收到此動作指令C的驅動手段3，是使成為位置資訊A的角度的方式使驅動手段3的各伺服馬達動作。
以下，對於控制手段4從目標位置資訊及現 在位置資訊生成動作指令C的生成過程，一邊參照第1圖一邊使用第5圖的流程圖具體說明。
首先，在步驟S1中，設定部41，是從編碼器 31取得現在的臂要素21~23的角度θ 1~θ 3也就是現在位置資訊，並且從承接手段5取得目標位置資訊。接著，在步驟S2中，設定部41，是從現在位置資訊將臂先端2b的現在位置作為始點設定，從目標位置資訊，將臂先端2b的目標位置作為終點設定。
接著，在步驟S3中，動作指令生成部43，是 判別對應設定部41所設定的始點及終點的組合的軌道資訊R(以下為對應軌道資訊Rc)是否存在於軌道資訊記憶部42的資料庫D。判別為對應軌道資訊Rc是存在於軌道資訊記憶部42的資料庫D的情況時，移行至步驟S4，動作指令生成部43是藉由將資料庫D的對應軌道資訊Rc讀入依據此對應軌道資訊Rc生成動作指令C。
另一方面，判別為對應軌道資訊Rc不存在於 軌道資訊記憶部42的資料庫D的情況時，移行至步驟S5，動作指令生成部43，是在步驟S2對於設定部41所設定的始點及終點的組合，判別對應將此始點及終點替換的組合的軌道資訊R(以下為逆向向軌道資訊Ri)是否存在於軌道資訊記憶部42的資料庫D。
且判別為此始點及終點相反的逆向軌道資訊 Ri是存在於軌道資訊記憶部42的資料庫D的情況時，移行至步驟S6，動作指令生成部43，是將存在於資料庫D的逆向軌道資訊Ri的時間序列相反地利用，即藉由使用逆讀取來生成動作指令C。又，此逆向軌道資訊Ri，是藉由後述的理由，與將在步驟S3被判別為不存在於資料庫D而無法取得的將臂先端2b從設定部41所設定的始點至終點為止移動用的對應軌道資訊Rc的時間序列逆向者幾乎成為一致。
另一方面，動作指令生成部43，是判別為逆 向軌道資訊Ri不存在於軌道資訊記憶部42的資料庫D的情況時，移行至步驟S7，將通知在資料庫D可以利用的軌道資訊R不存在的訊號輸出。此情況，搬運裝置1，是通過規定的介面將無法生成動作指令C的情況朝搬運裝置1的使用者通知將動作停止，或是藉由周知的即時控制，進行臂2的動作。
又，第6圖(a)及(b)，是將：對於臂先 端2b的某2個基點Pa、Pb使(始點、終點)的組合為(Pa、Pb)的情況的軸21c~23c周圍的時間序列的角度 θ 1(n)~θ 3(n)(軌道資訊Ra)、及將始點及終點替換使(始點、終點)的組合為(Pb、Pa)的情況的軸21c~23c周圍的時間序列的角度θ 1(n)~θ 3(n)(軌道資訊Rb)，各別使用最適化手法計算的結果正規化顯示的圖表。且，顯示第6圖(b)的軌道資訊Rb的圖表、及將第6圖(a)的圖表的左右反轉即將時間序列相反的第6圖(c)的圖表是幾乎重疊。即，設定部41是將(始點、終點)的組合(Pb、Pa)設定的情況時，對應將此始點及終點替換的組合(Pa、Pb)的逆向軌道資訊Ri(第6圖(c)參照)，是與使用最適化手法計算的軌道資訊Rb(第6圖(b)參照)成為幾乎相同，即使不使用最適化手法也可生成將適切的軌道描畫的動作指令C。
且直到現在為止，本發明人已確認，對於任 何的基點的組合，將時間序列相反的圖表皆是幾乎重複，藉由使用對應將設定部41所設定的始點及終點替換的組合的逆向軌道資訊Ri，就可生成與使用最適化手法計算的情況幾乎相同的動作指令C。又，藉由依據作為相關連軌道資訊Rr的逆向軌道資訊Ri被生成的動作指令C將搬運裝置1動作的情況，對於適切的軌道多少也有發生偏離的情況，但是在本案中，軌道資訊R，因為是以將臂2的進入被禁止的禁止領域V1規定距離h擴張的擴張禁止領域V2作為限制條件被生成，所以可防止因為從最適合的軌道的偏離使臂2和晶圓W與壁50b等的障礙物衝突。
如此，控制手段4是藉由從目標位置資訊及 現在位置資訊依據逆向軌道資訊Ri生成動作指令C，就成為可削減被記憶在軌道資訊記憶部42的資料庫D的軌道資訊R的數量。例如，臂先端2b移動目的地是基點P0、P1、P2的3點被設定的情況，原本的話有必要記憶3！=6種的軌道資訊R。但是，在本實施例中，如第4圖(b)所示，(始點、終點)的組合，只有記憶對應(P0、P1)、(P0、P2)、(P1、P2)的3種的軌道資訊R1~R3(=對應軌道資訊Rc(0、1)、Rc(0、2)、Rc(1、2))，因為可以將這些的軌道資訊R1~R3作為逆向軌道資訊Ri(1、0)、Ri(2、0)、Ri(2、1))，生成(始點、終點)的組合為(P1、P0)、(P2、P0)、(P2、P1)的軌道的動作指令C，所以可將記憶的軌道資訊R的數量成為1/2，可將記憶裝置有效率地利用。但是，記憶的軌道資訊R的數量，沒有必要削減至1/2，可對應記憶裝置的容量增減。
又，以上雖只有對於同一的構成也就是第1 手臂23及第2手臂24之中第1手臂23進行了說明，但是在本實施例中，使用第1手臂23及第2手臂24的對稱性將這些的手臂23、24的軌道資訊R共通化，藉由此共通化也可削減被記憶在軌道資訊記憶部42的軌道資訊C。
如以上，本實施例的多關節機械手臂也就是 搬運裝置1，是具備：將複數臂要素21~23可旋轉地連接的臂2、及藉由朝將臂要素21~23驅動的驅動手段3 將動作指令C輸出來進行臂先端2b的位置控制的控制手段4，控制手段4，是具備：對應以將臂先端2b動作的複數移動目的地也就是基點P0~P5之中其中任一作為始點將其他的其中任一作為終點的組合將包含沿著時間序列被設定的臂要素21~23的位置資訊A構成的軌道資訊R記憶的軌道資訊記憶部42、及將臂先端2b的現在位置及目標位置作為始點及終點設定的設定部41、及依據對應設定部41所設定的始點及終點的組合的軌道資訊R也就是對應軌道資訊Rc生成動作指令C的動作指令生成部43，動作指令生成部43，是對應軌道資訊Rc沒有被記憶在軌道資訊記憶部42，但對應與設定部41所設定的始點及終點的組合具有規定的關係性的始點及終點的組合的相關連軌道資訊Rr被記憶的情況時，依據相關連軌道資訊Rr生成動作指令C。
如此構成的話，軌道資訊記憶部42是將包含 沿著時間序列被設定的臂要素21~23的位置資訊A構成的軌道資訊R記憶，因為動作指令生成部43是藉由依據對應設定部41所設定的始點及終點的軌道資訊R將動作指令C輸出來進行臂先端2b的位置控制，所以因為只要準備一次軌道資訊R，就可以在相同構成的多關節機械手臂將資訊共有利用，所以中繼點的調整作業成為不需要。 且，因為藉由被記憶在軌道資訊記憶部42的軌道資訊R生成動作指令C，所以中繼點的插補(Interpolation)運算的即時運算是成為不需要，成為由低規格的運算機也可 生成適切的動作指令C，並且也可以削減為了即時的搬運路徑的算出所必要的教學作業。且，對應軌道資訊Rc沒有被記憶，但相關連軌道資訊Rr被記憶的情況時，因為依據相關連軌道資訊Rr生成動作指令C，所以可以削減被記憶在軌道資訊記憶部42的軌道資訊R，不搭載大容量的記憶裝置，仍可以進行臂先端2b的位置控制。進一步，藉由將軌道資訊R削減，就可使用相同容量的記憶裝置，生成更多的動作指令C。此外，也可以短縮在軌道資訊R的導出所需要的軌道計算時間。
且相關連軌道資訊Rr，是包含對應將藉由設 定部41被設定的始點及終點替換的組合的軌道資訊R也就是逆向軌道資訊Ri，動作指令生成部43，因為可藉由將逆向軌道資訊Ri的時間序列逆向利用而生成動作指令C，所以可將被記憶在軌道資訊記憶部42的軌道資訊R最佳地削減。
且搬運裝置1是具備第1手臂23及第2手臂 24，在臂基端2a側，作為臂要素的第1手臂23及第2手臂24是以同一的旋轉軸23c為中心可旋轉地設置，控制手段4，是進行形成臂先端2b的第1手臂先端2b1及第2手臂先端2b2的位置控制者，動作指令生成部43，因為是依據被記憶在軌道資訊記憶部42的軌道資訊R，生成為了進行第1手臂先端2b1及第2手臂先端2b2的位置控制所使用的動作指令C，所以成為可削減被記憶在軌道資訊記憶部42的軌道資訊C。
且將由如以上說明的搬運裝置1所產生的作 用作為方法的從側面所見的情況，此搬運裝置1的控制方法，搬運裝置1是具備：將複數臂要素21~23可旋轉地連接的臂2、及將臂要素21~23驅動的驅動手段3、及對應將使臂先端2b動作使複數移動目的地也就是基點P0~P5之中其中任一作為始點且將其他的其中任一作為終點的組合的軌道資訊R記憶的軌道資訊記憶部42，藉由朝驅動手段3將動作指令C輸出來進行臂先端2b的位置控制，搬運裝置1的控制方法，具備：從現在位置資訊及目標位置資訊設定始點及終點的步驟S2；及判別對應所設定的始點及終點的組合的軌道資訊R也就是對應軌道資訊Rc是否被記憶於軌道資訊記憶部42的步驟S3；及判別為對應軌道資訊Rc是存在於軌道資訊記憶部42的情況時，依據對應軌道資訊Rc生成動作指令C的步驟S4；及判別為對應軌道資訊Rc未被記憶在軌道資訊記憶部42的情況時，判別對應與始點及終點的組合具有規定的關係性的始點及終點的組合的相關連軌道資訊Rr是否被記憶於軌道資訊記憶部42的步驟S5；及判別為相關連軌道資訊Rr是被記憶於軌道資訊記憶部42的情況時，依據相關連軌道資訊Rr生成動作指令C的步驟S6。且，藉由實現如此的搬運裝置1的控制方法，就可產生上述的效果。
又，各部的具體的構成，不限定於只有上述 的實施例。
例如，上述的實施例中的搬運裝置1，是如第 2圖所示，被設在EFEM50的搬運室50a的中央，如上述，EFEM50是將與通過搬運裝置1的臂2的旋轉中心也就是臂基端2a(基點P0)的Y軸平行的對稱軸L挾持地構成線對稱，因為裝載埠51~54的基點P1及基點P4、基點P2及基點P3各別是將對稱軸L挾持的對稱的位置關係，所以利用軌道的對稱性來削減軌道資訊記憶部42所記憶的軌道資訊R也可以。
具體而言，將臂要素21~23的動作順序n中 的位置資訊A也就是軸21c~23c周圍的角度由(θ 1(n)、θ 2(n)、θ 3(n))顯示的話，有關對稱軸L，對稱的位置資訊是藉由將直線θ=π/2作為對稱軸地對稱轉換，就可顯示成(π-θ 1(n)、π-θ 2(n)、π-θ 3(n))。因此，例如，對應設定部41所設定的始點及終點的組合(P0、P4)的軌道資訊R也就是對應軌道資訊Rc不存在於軌道資訊記憶部42的資料庫D情況時，對於(P0、P4)的組合，只要對於將對稱軸L挾持對稱的位置中(P0、P1)的組合的軌道資訊R作為相關連軌道資訊Rr也就是對稱軌道資訊Rs，就可使用此對稱軌道資訊Rs生成將與對應(P0、P4)的軌道對稱的軌道描畫的動作指令C。
如此，相關連軌道資訊Rr，是包含：對應對 於藉由設定部41被設定的始點及終點，位於將通過臂2的旋轉中心的對稱軸L挾持對稱的位置的始點及終點的組合的軌道資訊也就是對稱軌道資訊Rs，且動作指令生成 部43，是藉由將對稱軌道資訊Rs的位置資訊對稱轉換利用來生成動作指令C，就可削減被記憶在軌道資訊記憶部42的軌道資訊R。
進一步，相關連軌道資訊Rr是將逆向軌道資 訊Ri及對稱軌道資訊Rs組合也可以，藉由這樣做，可以將被記憶在軌道資訊記憶部42的軌道資訊R的數量更削減1/2。
且在上述的實施例中，位置資訊A雖藉由臂 要素21~23的軸21c~23c周圍的角度表示，但是座標的取得方法不限定於此，例如藉由各軸21c~23c的XY座標顯示也可以。進一步，臂先端2b描畫的軌道也不限定於同一平面內，本發明，也可適用於在3次元空間自由地移動的多關節機械手臂。
進一步，在上述的實施例中，多關節機械手 臂雖是假定將被搬運物也就是晶圓W搬運的搬運裝置1，但是這種多關節機械手臂不限定於搬運裝置1，如加工裝置和熔接裝置者也可以。
且在上述的實施例中，臂先端2b的規定的移 動目的地雖假定為基點P0~P5，但是移動目的地也就是基點不限定於上述的點。例如，基點，也可以設定成：裝載埠的前方、定位器、工件站(平台)等。如此，即使將基點增加，也可以將必要的軌道資訊R削減。
此外，在上述的實施例中軌道資訊R雖使用 藉由最適化手法預先生成的資料，但是在多關節機械手臂 的設定時由機械手臂上的計算機計算也可以，且，藉由機械手臂進行教學，利用其資料由機械手臂上的計算機計算生成軌道資訊R也可以。
其他的構成，在未脫離本發明的範圍內也可進行各種變形。
W‧‧‧晶圓(被搬運物)
2‧‧‧臂
2a‧‧‧臂基端
2b‧‧‧手臂先端(臂先端)
2b1‧‧‧手臂先端(臂先端)
2b2‧‧‧手臂先端(臂先端)
3‧‧‧驅動手段
4‧‧‧控制手段
5‧‧‧承接手段
20‧‧‧基台
21‧‧‧第1臂要素
21a‧‧‧基端部
21b‧‧‧先端部
21c‧‧‧軸
22‧‧‧第2臂要素
22a‧‧‧基端部
22b‧‧‧先端部
22c‧‧‧軸
23‧‧‧第1手臂
23a‧‧‧基端部
23b‧‧‧保持部
24‧‧‧第2手臂
24a‧‧‧基端部
24b‧‧‧保持部
31‧‧‧編碼器
41‧‧‧設定部
42‧‧‧軌道資訊記憶部
43‧‧‧動作指令生成部
θ 1~θ 3‧‧‧角度

Claims (5)

  1. 一種多關節機械手臂，具備：將複數臂要素可旋轉地連接的臂、及藉由朝將前述臂要素驅動的驅動手段將動作指令輸出，進行臂先端的位置控制的控制手段，其特徵為：前述控制手段，是具備：對應以將前述臂先端動作的複數移動目的地之中其中任一作為始點且將其他的其中任一作為終點的組合，將包含沿著時間序列被設定的各臂要素的位置資訊構成的軌道資訊記憶的軌道資訊記憶部；及將前述臂先端的現在位置及目標位置作為始點及終點設定的設定部；及依據對應該設定部所設定的始點及終點的組合的軌道資訊生成前述動作指令的動作指令生成部；前述動作指令生成部，是在前述軌道資訊記憶部中，當對應前述設定部所設定的始點及終點的組合的軌道資訊沒有被記憶，但對應與前述設定部所設定的始點及終點的組合具有規定的關係性的始點及終點的組合的相關連軌道資訊被記憶的情況時，依據該相關連軌道資訊生成前述動作指令。
  2. 如申請專利範圍第1項的多關節機械手臂，其中，前述相關連軌道資訊，是包含對應將藉由前述設定部被設定的始點及終點替換的組合的軌道資訊也就是逆向軌道資訊， 前述動作指令生成部，是藉由將前述逆向軌道資訊的時間序列逆向利用而可生成前述動作指令。
  3. 如申請專利範圍第1或2項的多關節機械手臂，其中，前述相關連軌道資訊，是包含：對應對於藉由前述設定部被設定的始點及終點，位於將通過前述臂的旋轉中心的直線挾持的對稱的位置的始點及終點的組合的軌道資訊也就是對稱軌道資訊，前述動作指令生成部，是藉由將前述對稱軌道資訊的位置資訊對稱轉換利用而可生成前述動作指令。
  4. 如申請專利範圍第1至3項中任一項的多關節機械手臂，其中，在前述臂的反基端側中，作為前述臂要素的第1手臂及第2手臂是以同一的旋轉軸為中心可旋轉地設置，前述控制手段，是進行形成前述臂先端的第1手臂先端及第2手臂先端的位置控制者，前述動作指令生成部，是依據被記憶在前述軌道資訊記憶部的軌道資訊，生成為了進行前述第1手臂先端及第2手臂先端的位置控制而使用的動作指令。
  5. 一種多關節機械手臂的控制方法，該多關節機械手臂，具備：將複數臂要素可旋轉地連接的臂、及將前述臂要素驅動的驅動手段、及記憶對應以將臂先端動作的複數移動目的地之中其中任一作為始點且將其他的其中任一作為終點的組合的軌道資訊的軌道資訊 記憶部，藉由將動作指令朝前述驅動手段輸出來進行前述臂先端的位置控制，其特徵為，該多關節機械手臂的控制方法，具備：從現在位置資訊及目標位置資訊設定始點及終點的步驟；及判別對應所設定的始點及終點的組合的軌道資訊是否被記憶於軌道資訊記憶部的步驟；及判別為前述軌道資訊存在於軌道資訊記憶部的情況時，依據該軌道資訊生成動作指令的步驟；及判別為前述軌道資訊未被記憶在軌道資訊記憶部的情況時，判別對應與前述始點及終點的組合具有規定的關係性的始點及終點的組合的相關連軌道資訊是否被記憶於軌道資訊記憶部的步驟；及判別為前述相關連軌道資訊被記憶於軌道資訊記憶部的情況時，依據該相關連軌道資訊生成動作指令的步驟。
TW104117944A 2014-12-25 2015-06-03 多關節機械手臂及多關節機械手臂的控制方法 TWI682839B (zh)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2014263215A JP6511806B2 (ja) 2014-12-25 2014-12-25 多関節ロボット及び多関節ロボットの制御方法
JP2014-263215 2014-12-25

Publications (2)

Publication Number Publication Date
TW201622914A true TW201622914A (zh) 2016-07-01
TWI682839B TWI682839B (zh) 2020-01-21

Family

ID=56163175

Family Applications (1)

Application Number Title Priority Date Filing Date
TW104117944A TWI682839B (zh) 2014-12-25 2015-06-03 多關節機械手臂及多關節機械手臂的控制方法

Country Status (4)

Country Link
US (1) US9579794B2 (zh)
JP (1) JP6511806B2 (zh)
KR (1) KR102359715B1 (zh)
TW (1) TWI682839B (zh)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
TWI814681B (zh) * 2022-03-18 2023-09-01 韓商興寶新思路科技股份有限公司 晶圓機械手臂

Families Citing this family (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP6438189B2 (ja) * 2013-10-01 2018-12-12 川崎重工業株式会社 ロボット及びロボットの制御方法
KR102080424B1 (ko) * 2016-01-04 2020-02-21 저장 리뱌오 로보츠 컴퍼니 리미티드 로봇 현장 복귀를 위한 방법 및 장치
US20200183203A1 (en) 2016-12-08 2020-06-11 Jnc Corporation Reverse mode liquid crystal device
JP6879009B2 (ja) * 2017-03-30 2021-06-02 株式会社安川電機 ロボット動作指令生成方法、ロボット動作指令生成装置及びコンピュータプログラム
JP6869080B2 (ja) * 2017-03-31 2021-05-12 株式会社ダイヘン ロボット制御装置及び制御プログラム
CN110869174B (zh) 2017-07-10 2023-12-05 海别得公司 用于生成材料处理机器人工具路径的计算机实现的方法和系统
JP2020011320A (ja) * 2018-07-17 2020-01-23 オムロン株式会社 パラメータ同定装置、方法、及びプログラム
WO2021041223A1 (en) * 2019-08-23 2021-03-04 Realtime Robotics, Inc. Motion planning for robots to optimize velocity while maintaining limits on acceleration and jerk
TWI770509B (zh) * 2020-05-19 2022-07-11 黃瀚毅 多節旋轉角度之機械手臂

Family Cites Families (23)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH10260712A (ja) * 1997-01-14 1998-09-29 Sekisui Chem Co Ltd ロボットの動作プログラム作成方法
US6502054B1 (en) * 1999-11-22 2002-12-31 Lam Research Corporation Method of and apparatus for dynamic alignment of substrates
JP2002184834A (ja) * 2000-12-15 2002-06-28 Yaskawa Electric Corp 基板搬送用ロボット
DE10196103T1 (de) * 2001-02-22 2003-08-21 Mitsubishi Electric Corp Robotersteuereinrichtung
WO2004095520A2 (en) * 2003-04-22 2004-11-04 Berkeley Process Control, Inc. System of path planning for robotic manipulators based on maximum acceleration and finite jerk constraints
JP2006205264A (ja) * 2005-01-25 2006-08-10 Jel:Kk 基板搬送装置
JP5044991B2 (ja) * 2006-05-25 2012-10-10 トヨタ自動車株式会社 経路作成装置及び経路作成方法
US8419341B2 (en) * 2006-09-19 2013-04-16 Brooks Automation, Inc. Linear vacuum robot with Z motion and articulated arm
JP5055101B2 (ja) * 2007-12-07 2012-10-24 株式会社ダイヘン ロボット制御装置
JP5402284B2 (ja) * 2008-12-18 2014-01-29 株式会社安川電機 基板搬送ロボット、基板搬送装置、半導体製造装置および基板搬送ロボットの干渉物回避方法
JP5504641B2 (ja) * 2009-02-13 2014-05-28 株式会社安川電機 基板搬送用ロボット及びそれを備えた基板搬送装置、半導体製造装置
JP2011020206A (ja) * 2009-07-15 2011-02-03 Panasonic Corp 垂直多関節ロボットのミラーイメージプログラム作成方法
JP5345046B2 (ja) * 2009-11-30 2013-11-20 三菱電機株式会社 ロボットの教示装置、及びロボットの制御装置
JP5516865B2 (ja) * 2010-02-22 2014-06-11 シンフォニアテクノロジー株式会社 移動装置の軌道情報生成装置
CN103069559B (zh) * 2010-08-17 2016-08-24 佳能安内华股份有限公司 基片输送设备以及用于制造电子装置的系统和方法
JP5610952B2 (ja) * 2010-09-24 2014-10-22 日本電産サンキョー株式会社 産業用ロボット
JP5995404B2 (ja) * 2011-01-26 2016-09-21 ナブテスコ株式会社 ウエハ搬送ロボット
JP6178791B2 (ja) * 2011-09-02 2017-08-09 ブルックス オートメーション インコーポレイテッド ロボット移送装置の時間最適軌道
JP5724919B2 (ja) * 2012-03-22 2015-05-27 トヨタ自動車株式会社 軌道生成装置、移動体、軌道生成方法及びプログラム
JP5500206B2 (ja) * 2012-06-01 2014-05-21 株式会社安川電機 搬送ロボットおよび搬送ロボットを備えた局所クリーン装置
US9081306B2 (en) * 2012-09-19 2015-07-14 Taiwan Semiconductor Manufacturing Company, Ltd. Method of optimizing lithography tools utilization
JP5532110B2 (ja) * 2012-11-16 2014-06-25 株式会社安川電機 基板搬送ロボットおよび基板搬送方法
JP2014236036A (ja) * 2013-05-31 2014-12-15 シンフォニアテクノロジー株式会社 ワーク搬送ロボット

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
TWI814681B (zh) * 2022-03-18 2023-09-01 韓商興寶新思路科技股份有限公司 晶圓機械手臂
TWI830673B (zh) * 2022-03-18 2024-01-21 韓商興寶新思路科技股份有限公司 晶圓機械手臂

Also Published As

Publication number Publication date
TWI682839B (zh) 2020-01-21
JP2016120581A (ja) 2016-07-07
KR102359715B1 (ko) 2022-02-09
KR20160078866A (ko) 2016-07-05
US20160184987A1 (en) 2016-06-30
US9579794B2 (en) 2017-02-28
JP6511806B2 (ja) 2019-05-15

Similar Documents

Publication Publication Date Title
TW201622914A (zh) 多關節機械手臂及多關節機械手臂的控制方法
US8428781B2 (en) Systems and methods of coordination control for robot manipulation
Fernandes et al. Towards an orientation enhanced astar algorithm for robotic navigation
US10836042B2 (en) Robot system
JP2019025618A (ja) ロボット制御装置、ロボット制御方法及びロボット制御プログラム
KR20120073616A (ko) 로봇의 경로 계획 장치 및 그 방법
Annem et al. Towards remote teleoperation of a semi-autonomous mobile manipulator system in machine tending tasks
JP5458769B2 (ja) ロボットの制御装置
JP2015174185A (ja) ロボットのシミュレーション装置及び方法、制御装置、及びロボットシステム
JP2019048349A (ja) ロボットシステム、ロボット制御装置および被加工物の製造方法
KR20200073985A (ko) 궤도 생성 장치 및 궤도 생성 방법
Santos et al. M-FABRIK: A new inverse kinematics approach to mobile manipulator robots based on FABRIK
WO2023069292A1 (en) Nonlinear trajectory optimization for robotic devices
JP5933450B2 (ja) ロボットの制御装置および制御方法
KR20220100865A (ko) 제어 방법, 제어 장치, 로봇 시스템, 프로그램 및 기록 매체
JP2010110878A (ja) 多関節型ロボット装置およびその制御方法
Lueth et al. Reliability and integrated capabilities of locomotion and manipulation for autonomous robot assembly
US11396097B2 (en) Teaching apparatus, robot system, and teaching method
KR101619927B1 (ko) 다중 이동조작로봇의 협업제어 및 장애물회피 기법
Hongjun MOTION TRAJECTORY PLANNING AND SIMULATION OF 6-DOF MANIPULATOR ARM ROBOT.
Manjunath et al. Design & simulation of the workspace for a stationary robot system
JP2010036293A (ja) 多関節ロボット
Yang et al. Collision avoidance trajectory planning for a dual-robot system: using a modified APF method
Dragne Directional Kinematics—First Step in Robotic Movement
Ji et al. A Spatial Path Following Method for Hyper-Redundant Manipulators by Step-by-Step Search and Calculating