TWI821691B - 機器人的示教裝置以及機器人的示教程序 - Google Patents
機器人的示教裝置以及機器人的示教程序 Download PDFInfo
- Publication number
- TWI821691B TWI821691B TW110122581A TW110122581A TWI821691B TW I821691 B TWI821691 B TW I821691B TW 110122581 A TW110122581 A TW 110122581A TW 110122581 A TW110122581 A TW 110122581A TW I821691 B TWI821691 B TW I821691B
- Authority
- TW
- Taiwan
- Prior art keywords
- robot
- arm
- movement trajectory
- hand
- trajectory
- Prior art date
Links
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1628—Programme controls characterised by the control loop
- B25J9/163—Programme controls characterised by the control loop learning, adaptive, model based, rule based expert control
-
- 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
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J13/00—Controls for manipulators
- B25J13/02—Hand grip control means
-
- 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
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B65—CONVEYING; PACKING; STORING; HANDLING THIN OR FILAMENTARY MATERIAL
- B65G—TRANSPORT OR STORAGE DEVICES, e.g. CONVEYORS FOR LOADING OR TIPPING, SHOP CONVEYOR SYSTEMS OR PNEUMATIC TUBE CONVEYORS
- B65G47/00—Article or material-handling devices associated with conveyors; Methods employing such devices
- B65G47/74—Feeding, transfer, or discharging devices of particular kinds or types
- B65G47/90—Devices for picking-up and depositing articles or materials
- B65G47/905—Control arrangements
-
- 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
- G05B19/00—Programme-control systems
- G05B19/02—Programme-control systems electric
- G05B19/42—Recording and playback systems, i.e. in which the programme is recorded from a cycle of operations, e.g. the cycle of operations being manually controlled, after which this record is played back on the same machine
- G05B19/425—Teaching successive positions by numerical control, i.e. commands being entered to control the positioning servo of the tool head or end effector
-
- H10P72/30—
-
- 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/20—Pc systems
- G05B2219/26—Pc applications
- G05B2219/2602—Wafer processing
-
- 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/45—Nc applications
- G05B2219/45031—Manufacturing semiconductor wafers
Landscapes
- Engineering & Computer Science (AREA)
- Mechanical Engineering (AREA)
- Robotics (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Manipulator (AREA)
- Numerical Control (AREA)
Abstract
本發明提供一種機器人的示教裝置,該機器人的示教裝置可按照用戶的意願,來對機器人的動作軌跡簡單地進行細微修正。示教裝置(30)是機器人(10)的示教裝置,機器人(10)具有基座(11)、臂(12)和手(13),該臂(12)具有相互連接的多個連桿(12a)、(12b)且連接在基座(11),該手(13)連接在臂(12)。示教裝置(30)包括設定部(351)、導出部(352)、顯示部(33)和修正部(354),該設定部(351)對包含臂(12)的規定動作中的手(13)的始點以及終點的規定條件進行設定,該導出部(352)根據規定條件,導出從始點到終點的手(13)的動作軌跡以及響應於手(13)的動作軌跡的臂(12)的動作軌跡,該顯示部(33)對由導出部(352)所導出的臂(12)的動作軌跡以及手(13)的動作軌跡的至少之一進行顯示,該修正部(354)按照用戶的輸入操作對顯示在顯示部(33)的動作軌跡進行修正。
Description
本發明關於機器人的示教裝置以及機器人的示教程序。
至今為止,用於向機器人示教(教學)規定動作的示教裝置被眾所周知。例如,專利文獻1中公開的示教裝置(操作裝置)藉由根據從所設定的始點和終點求出的動作軌跡,在觸摸屏上再現機器人模型的動作,來確認機器人模型的動作。並且,在確認後,用戶判斷為該動作不合適時,取消該動作。
現有技術
專利文獻
專利文獻1:日本專利第6526098號公報
但是,在上述示教裝置中,例如,即使判斷為僅是機器人模型的動作(動作軌跡)的一部分不合適,也要取消該動作(動作軌跡)的全部,因此不容易按照用戶的意願,來進行細微修正。
鑒於上述內容,本申請所公開的技術的目的在於,提供一種能夠按照用戶的意願,來簡單地對機器人的動作軌跡進行細微修正的示教裝置。
本申請所公開的技術是具有基座、臂和末端執行器的機器人的示教裝置,該臂具有相互連接的多個連桿且連接在所述基座,該末端執行器連接在所述臂。所述機器人的示教裝置包括設定部、導出部、顯示部和修正部。所述設定部對包含所述臂的規定動作中的所述末端執行器的始點以及終點的規定條件進行設定。所述導出部根據所述規定條件,導出從所述始點到所述終點的所述末端執行器的動作軌跡以及伴隨著所述動作軌跡的所述臂的動作軌跡。所述顯示部對由所述導出部所導出的所述臂的動作軌跡以及所述末端執行器的動作軌跡的至少之一進行顯示。所述修正部按照用戶的輸入操作,對顯示在所述顯示部的所述動作軌跡進行修正。
本申請所公開的其它技術是具有基座、臂和末端執行器的機器人的示教程序,該臂具有相互連接的多個連桿且連接在所述基座,該末端執行器連接在所述臂。所述機器人的示教程序使計算機實現如下功能,即,對包含所述臂的規定動作中的所述末端執行器的始點以及終點的規定條件進行設定的功能,根據所述規定條件,導出從所述始點到所述終點的所述末端執行器的動作軌跡以及響應於所述動作軌跡的所述臂的動作軌跡的功能,對所述導出的所述臂的動作軌跡以及所述末端執行器的動作軌跡的至少之一在顯示部進行顯示的功能,對顯示在所述顯示部的動作軌跡進行修正的功能。
藉由所述機器人的示教裝置,能夠按照用戶的意願,來簡單地對機器人(臂以及末端執行器)的動作軌跡進行細微修正。
藉由所述機器人的示教程序,能夠按照用戶的意願,來簡單地對機器人(臂以及末端執行器)的動作軌跡進行細微修正。
1:基板運送系統
2:框體
3:運送空間
4:前開式晶圓傳送盒
5:處理裝置
10:機器人
11:基座
12:臂
12a:第一連桿(連桿)
12b:第二連桿(連桿)
13:手(末端執行器)
13a:上手
13b:下手
20:機器人控制裝置
30:示教裝置
31:輸入部
32:通信部
33:顯示部
34:儲存部
341:軌跡導出程序
35:處理部
351:設定部
352:導出部
353:再現部
354:修正部
355:動作程序製作部
L1:第一軸心
L2:第二軸心
L3:第三軸心
P1:示教點
P2:示教點
P3:示教點
P4:示教點
Q:指針
S:基板
S1-S9:步驟
T:動作軌跡
Ta:動作軌跡
X:經過點
Xa:經過點
圖1是簡要地表示示教裝置以及機器人的圖。
圖2是表示示教裝置的結構的方塊圖。
圖3是表示示教裝置的動作軌跡的導出動作的流程圖。
圖4是表示顯示在顯示部的圖像的一個例子的圖。
圖5是表示顯示在顯示部的圖像的一個例子的圖。
圖6是表示顯示在顯示部的圖像的一個例子的圖。
圖7是表示顯示在顯示部的圖像的一個例子的圖。
圖8是表示顯示在顯示部的圖像的一個例子的圖。
圖9是表示顯示在顯示部的圖像的一個例子的圖。
圖10是表示顯示在顯示部的圖像的一個例子的圖。
以下,參照附圖,對舉出的實施方式進行詳細說明。
如圖1所示,本實施方式的示教裝置30可通信地連接在機器人控制裝置20,機器人控制裝置20可通信地連接在機器人10。示教裝置30是用於向機器人10示教(教學)規定動作的裝置。
圖1所示的機器人10是示教裝置30設為對象的機器人的一個例子。機器人10是水平多關節機器人(標量型機器人)。機器人10具有基座11、臂12和手13,該臂12具有相互連接的多個連桿12a、12b且連接在基座11,該手13連接在臂12。臂12在水平方向可旋轉地連接在基座11。手13是末端執行器的一個例子。
本實施方式的臂12由兩個連桿12a、12b構成。兩個連桿12a、12b彼此在水平方向可旋轉地連接著。兩個連桿12a、12b從基座11側開始依次為第一連桿12a、第二連桿12b。第一連桿12a以在垂直方向延伸的第一軸心L1為中心可旋轉地連接在基座11。第二連桿12b以在垂直方向延伸的第二軸心L2為中心可旋轉地連接在第一連桿12a。
機器人10具有兩個手13,即,上手13a以及下手13b。上手13a以及下手13b的每一個的基本結構彼此相同。手13形成為在水平方向延伸的板狀,前端側形成為分叉狀。也就是說,手13在朝向其厚度方向觀看時,形成為大致Y字狀。上手13a以及下手13b以在垂直方向延伸的第三軸心L3為中心在水平方向可旋轉地連接在第二連桿12b。第一軸心L1、第二軸心L2以及第三軸心L3彼此平行延伸。
第一連桿12a、第二連桿12b、下手13b以及上手13a以該順序從下向上堆疊著。機器人10具有多個馬達,該多個馬達旋轉驅動兩個連桿12a、12b以及兩個手13,無圖示。本實施方式的機器人10將對象(基板S)放置在手13的上表面而不固定來進行運送。也就是說,對象僅被放置在手13的上表面,而沒有被保持。
本實施方式的機器人10例如被用於運送基板S的基板運送系統1。關於基板運送系統1的簡要結構,參照示意表示的圖6來對基板運送系統1進行說明。
基板運送系統1包括框體2,在框體2內配置有機器人10。基板運送系統1例如是EFEM(Equipment Front End Module)。框體2形成為大致長方體形狀。框體2的內部作為被淨化的運送空間3形成。也就是說,機器人10被配置在運送空間3,運送基板S。例如,基板S是圓盤狀半導體晶圓。
在基板運送系統1中,設置有多個(在本實施方式中為兩個)前開式晶圓傳送盒(FOUP:Front Opening Unified Pod)4和多個(在本實施方式中為兩個)處理裝置5。多個前開式晶圓傳送盒4與框體2的一側壁鄰接設置著。多個處理裝置5在框體2中與前開式晶圓傳送盒4鄰接的側壁對著的側壁鄰接設置著。前開式晶圓傳送盒4以及處理裝置5設置在框體2的外側,各自的內部與框體2的內部(運送空間3)可連通。前開式晶圓傳送盒4將多個基板S以水平狀態在垂直方向上等間隔收納。處理裝置5是例如對基板S進行熱處理、雜質導入處理、薄膜形成處理等各種處理的處理裝置。
在如這樣構成的基板運送系統1中,機器人10在前開式晶圓傳送盒4與處理裝置5之間運送基板S,該前開式晶圓傳送盒4收納基板S,該處理裝置5對基板S進行處理。也就是說,臂12以及手13在前開式晶圓傳送盒4與處理裝置5之間運送基板S。
〈示教裝置的結構〉
如圖2所示,示教裝置30包括輸入部31、通信部32、顯示部33、儲存部34和處理部35。
輸入部31受理來自用戶的輸入操作。輸入部31向處理部35輸出響應輸入操作的輸入信號。例如,輸入部31是鍵盤或者滑鼠。
通信部32是與機器人控制裝置20進行通信的接口。例如,通信部32由電纜調製解調器、軟調製解調器或無線調製解調器形成。
顯示部33對後面將要說明的由處理部35(導出部352)所導出的臂12的動作軌跡以及手13的動作軌跡的至少之一進行顯示。並且,顯示部33還顯示
使機器人10模型化後的機器人模型。顯示部33例如是液晶顯示器或有機EL顯示器。
儲存部34是對各種程序以及各種數據進行儲存的計算機可讀儲存介質。儲存部34藉由硬盤等磁盤、CD-ROM以及DVD等光盤或半導體儲存器形成。
儲存部34儲存有軌跡導出程序341等。軌跡導出程序341是用於讓計算機即處理部35實現各種功能的示教程序,該各種功能是根據所給出的規定條件,來導出手13的最佳動作軌跡以及響應於該手13的動作軌跡的臂12(即,連桿12a、12b)的動作軌跡的各種功能。軌跡導出程序341藉由處理部35讀出且執行。軌跡導出程序341例如基於遺傳算法而構建。
處理部35具有CPU(Central Processing Unit)、GPU(Graphics Processing Unit)以及/或者DSP(Digital Signal Processor)等各種處理器和RAM(Random Access Memory)以及/或者ROM(Read Only Memory)等各種半導體儲存器。處理部35從儲存部34讀出軌跡導出程序341等,實現用於導出臂12以及手13的最佳動作軌跡的各種功能。處理部35具有設定部351、導出部352、再現部353、修正部354以及動作程序製作部355作為功能塊。
設定部351對包含臂12的規定動作中的手13的始點以及終點的規定條件(以下,也稱為動作條件)進行設定。具體而言,設定部351從輸入部31接收與響應於用戶的輸入操作的動作條件有關的輸入信號,設定動作條件。
導出部352根據規定條件(動作條件),導出從始點到終點的手13的動作軌跡以及響應於該手13的動作軌跡的臂12的動作軌跡。更詳細而言,導出部352根據設定部351的動作條件,在使基座11的位置改變的同時,導出從始點到終
點的手13的動作軌跡以及響應於該動作軌跡的臂12的動作軌跡。也就是說,導出部352將基座11的位置作為參數之一,導出與動作條件相匹配的手13的動作軌跡以及臂12的動作軌跡。導出部352從儲存部34中讀出軌跡導出程序341,導出手13等的動作軌跡。
再現部353根據由導出部352所導出的動作軌跡,來在顯示部33中使機器人模型動作。具體而言,再現部353根據顯示在顯示部33的手13的動作軌跡或者臂12的動作軌跡,來使機器人模型的臂以及手動作。也就是說,再現部353既能夠根據由導出部352所導出的動作軌跡使顯示部33中的機器人模型動作,也能夠根據由後面所要說明的修正部354修正後的動作軌跡使顯示部33中的機器人模型動作。
修正部354響應於用戶的輸入操作,來修正顯示在顯示部33的動作軌跡。更詳細而言,修正部354響應於使顯示在顯示部33的動作軌跡中的點或者基座11移動的用戶的輸入操作(修正指示),來修正動作軌跡。也就是說,藉由用戶移動顯示在顯示部33的動作軌跡中的點或者基座11,修正部354來修正動作軌跡。作為一個例子,輸入操作(修正指示)是用戶藉由拖放來移動顯示在顯示部33的動作軌跡中的點或者基座11的操作(指示)。
在由導出部352所導出的手13的動作軌跡以及臂12的動作軌跡被決定後,動作程序製作部355根據該被決定的手13的動作軌跡以及臂12的動作軌跡,來製作用於使機器人10動作的動作程序。所製作的動作程序被發送到機器人控制裝置20。機器人控制裝置20根據從示教裝置30接收到的動作程序,來進行機器人10的動作控制。
〈動作軌跡的導出動作〉
參照圖3的流程圖對示教裝置30(處理部35)中的動作軌跡的導出動作進行說明。
首先,在步驟S1中,設定部351設定機器人10的可動作區域。具體而言,設定部351藉由輸入部31中的用戶的輸入操作,來設定臂12以及手13的可動作區域。在本實施方式中,配置有機器人10的框體2(即,運送空間3)被設定為可動作區域。
如圖4所示,用戶藉由操作滑鼠,在顯示部33中使滑鼠的指針Q例如從左上向右下移動,來生成使框體2模型化後的四邊形框(以下,稱為框體2)。因此,設定部351將顯示在顯示部33的框體2設定為可動作區域。
需要說明的是,也可以代替上述滑鼠的操作,例如,用戶藉由用鍵盤等來輸入座標值,來在顯示部33中生成使框體2模型化後的四邊形框。此時,例如,座標輸入窗口顯示在顯示部33,用戶將座標值輸入到該座標輸入窗口。
接著,在步驟S2中,設定部351設定手13的始點以及終點。具體而言,設定部351藉由輸入部31中的用戶的輸入操作,來將多個(在本實施方式中,為4個)示教點P1~P4設定為手13的始點以及終點。
如圖5以及圖6所示,用戶操作滑鼠,在顯示部33中指定4個示教點P1~P4。在顯示部33準備好了表示各個示教點P1~P4的圖標,無圖示。用戶藉由用指針Q在顯示部33中使表示示教點P1~P4的圖標移動到規定位置,來指定示教點P1~P4。在本實施方式中,例如,示教點P1被指定為始點,示教點P4被指定為終點。藉由這樣的用戶的輸入操作,設定部351來設定手13的始點以及終點。
並且,在顯示部33中,藉由如上所述那樣用戶指定示教點P1~P4,來自動生成將前開式晶圓傳送盒4以及處理裝置5模型化後的圖。在本實施方式
中,在示教點P1、P2的位置生成前開式晶圓傳送盒4,在示教點P3、P4的位置生成處理裝置5。需要說明的是,在步驟S2中,用戶也能夠藉由代替滑鼠的操作,用鍵盤輸入座標值,來在顯示部33指定示教點P1~P4。此時,在指定示教點P1~P4後,也在顯示部33自動生成使前開式晶圓傳送盒4等模型化後的圖。
接著,在步驟S3中,設定部351設定所述可動作區域、手13的始點以及終點之外的規定條件(動作條件)。設定部351藉由輸入部31中的用戶的輸入操作,來設定規定條件。規定條件(動作條件)例如是手13的動作加減速度(移動時的加速度以及減速度)的上限值、臂12以及手13的速度的上限值、從始點到終點的經過點的個數的上限值、連桿12a、12b以及手13的可旋轉角度等。
並且,也可以將手13的動作加減速度的上限值在基板S放置在手13時和基板S沒有放置在手13時設定為不同的數值。也就是說,在基板S放置在手13時,將動作加減速度的上限值限定得低於基板S沒有放置在手13時。並且,在規定條件中還包含臂12以及手13不干涉到框體2的壁等。用戶能夠適當選擇所述規定條件進行輸入。
接著,在步驟S4中,在顯示部33中暫時配置使機器人10模型化後的機器人模型。如圖6所示,用戶操作滑鼠,使機器人模型顯示在顯示部33。需要說明的是,對於圖6~圖10所示的機器人模型,標註有與圖1所示的機器人10一樣的符號。然後,用戶操作滑鼠,來在顯示部33中用指針Q將機器人10的基座11暫時配置在任意位置。需要說明的是,該機器人10的暫時配置也能夠藉由輸入座標值來進行。
接著,在步驟S5中,導出部352根據設定部351的規定條件,來導出從始點(示教點P1)到終點(示教點P4)的手13的動作軌跡以及響應於該動作軌跡
的臂12的動作軌跡。具體而言,導出部352例如藉由用戶用滑鼠操作按下顯示在顯示部33的“優化按鈕”(省略圖示),來開始動作軌跡的導出動作。導出部352在改變基座11的位置的同時,導出與規定條件相匹配的手13的動作軌跡以及響應於該動作軌跡的臂12的動作軌跡。由於像這樣,在改變基座11的位置的同時,導出手13的動作軌跡等,因此與在使基座的位置固定不變的狀態下導出手的動作軌跡時相比,能夠導出更佳的動作軌跡。
並且,在由導出部352導出手13的動作軌跡等後,顯示部33對由導出部352所導出的手13的動作軌跡以及臂12的動作軌跡的至少之一進行顯示。在本實施方式中,作為一個例子,如圖7所示,顯示部33對從始點(示教點P1)到終點(示教點P4)的手13的動作軌跡T進行顯示。此時,在顯示部33中,機器人10(基座11)被配置在在導出手13的動作軌跡T時作為參數採用的位置。像這樣,藉由將由導出部352所導出的動作軌跡顯示在顯示部33,用戶能夠目視確認動作軌跡。
接著,在步驟S6中,再現部353根據顯示在顯示部33的動作軌跡T,使機器人10在顯示部33中動作。具體而言,再現部353例如藉由用戶用滑鼠操作按下顯示在顯示部33的“再現按鈕”(省略圖示),來使機器人10在顯示部33中動作。如圖7所示,再現部353在顯示部33中以手13從始點到終點沿著動作軌跡T移動的方式使臂12以及手13動作。也就是說,再現部353根據由導出部352所導出的手13的動作軌跡以及臂12的動作軌跡,來使臂12以及手13在顯示部33中動作。像這樣,藉由在顯示部33中臂12以及手13根據動作軌跡T動作,用戶能夠目視確認根據動作軌跡T的臂12以及手13的動作。
接著,在步驟S7中,修正部354判斷是否有用戶的修正指示。用戶觀察顯示部33中的臂12以及手13的動作,感到該動作不合適,或者對該動作感到
違和感時等,進行動作軌跡T的的修正指示,以消除那樣的動作。例如,用戶在臂12以及手13非常接近框體2的壁,或者看到臂12以及手13在做徒勞的動作時等,感到該動作不合適。也就是說,用戶用視覺判斷臂12以及手13的動作,決定是否進行修正指示。
在步驟S7中,當沒有用戶的修正指示時,即,當用戶判斷為顯示部33中的臂12以及手13的動作合適時(對於臂12以及手13的動作沒有感到違和感),修正部354將顯示在顯示部33的動作軌跡T決定為最佳動作軌跡(步驟S8)。此時,修正部354也將由導出部352所導出的臂12的動作軌跡,即,響應於手13的動作軌跡T的臂12的動作軌跡決定為最佳動作軌跡。
在本實施方式中,當用戶感到顯示部33中的臂12以及手13的動作不合適(對於臂12以及手13的動作感到違和感)時,進行使顯示在顯示部33的動作軌跡T中的點移動的輸入操作(修正指示)。具體而言,如圖8所示,用戶操作滑鼠,藉由拖放使顯示在顯示部33的動作軌跡T中的點移動到所期望的位置。
在步驟S7中,當有上述用戶的修正指示時,轉移到步驟S9。在步驟S9中,修正部354修正顯示在顯示部33的動作軌跡T。具體而言,修正部354根據基於用戶的修正指示的動作軌跡T的移動信息來修正動作軌跡T,並將修正後的新的動作軌跡Ta顯示在顯示部33。此時,修正後的動作軌跡Ta既可能是修正前的動作軌跡T的一部分被修正而成,也可能是修正前的動作軌跡T的全部被修正而成。
並且,修正部354在修正顯示在顯示部33的手13的動作軌跡T的同時,還修正臂12的動作軌跡。也就是說,修正部354從藉由導出部352所導出的臂
12的動作軌跡(即,響應於修正前的手13的動作軌跡T的臂12的動作軌跡)修正為響應於修正後的手13的動作軌跡Ta的臂12的動作軌跡。
像這樣,由於用戶能夠在觀察顯示在顯示部33的動作軌跡T的同時,進行修正指示,因此能夠更加按照用戶的意願,對動作軌跡T進行細微修正。並且,用戶能夠藉由使顯示在顯示部33的動作軌跡T中的點移動這樣的簡單方法,來修正動作軌跡T。
在步驟S9中,修正部354修正了動作軌跡T之後,再次返回到步驟S6,再現部353根據顯示在顯示部33的修正後的動作軌跡Ta,使機器人10在顯示部33中動作。也就是說,再現部353以在顯示部33中手13從始點到終點沿著修正後的動作軌跡Ta移動的方式,使臂12以及手13動作。進一步換言之,再現部353根據由修正部354所修正的手13的動作軌跡以及臂12的動作軌跡,來使臂12以及手13在顯示部33中動作。像這樣,藉由臂12以及手13在顯示部33中根據修正後的動作軌跡Ta動作,用戶能夠目視確認基於修正後的動作軌跡Ta的臂12以及手13的動作。
再次在步驟S7中有用戶的修正指示時,即,用戶進行了使顯示在顯示部33的修正後的動作軌跡Ta中的點移動的輸入操作(修正指示)時,再次轉移到步驟S9。也就是說,基本上,只要用戶沒有判斷為由再現部353所再現的臂12和手13的動作是合適的,就重複從步驟S9到步驟S6的流程。進一步換言之,用戶能夠不斷修正手13的動作軌跡以及臂12的動作軌跡,直到感到由再現部353所再現的臂12以及手13的動作是合適的。
當在步驟S7中沒有用戶的修正指示時,即,當用戶判斷為基於修正後的動作軌跡Ta的臂12以及手13的動作是合適的(對臂12以及手13的動作沒有
感到違和感)時,修正部354將顯示在顯示部33的修正後的動作軌跡Ta決定為最佳動作軌跡(步驟S8)。此時,修正部354還將修正後的臂12的動作軌跡(即,響應於修正後的手13的動作軌跡Ta的臂12的動作軌跡)決定為最佳動作軌跡。藉由上述內容,動作軌跡的導出動作結束。
動作程序製作部355製作動作程序,該動作程序用於根據由處理部35所決定的臂12的動作軌跡以及手13的動作軌跡來控制真實空間的機器人10。然後,動作程序製作部355經由通信部32將所製作的動作程序發送給機器人控制裝置20。機器人控制裝置20根據從示教裝置30接收到的動作程序,來控制真實空間的機器人10。
像這樣,真實空間的機器人10的動作軌跡在規定條件(動作條件)下被優化。在這種機器人10中,希望盡可能縮短從起點到終點的手13的移動時間,但如果不加以考慮,手13的動作加減速度會有變高的傾向,因此基板S恐怕會從手13上掉下來。尤其是如本實施方式那樣,當是將基板S放置在手13的上表面而不固定來進行運送的機器人10時,上述擔心更加顯著。於是,藉由在設定部351中,設定能夠阻止基板S掉下來的手13的動作加減速度的上限值,能夠在不使基板S從手13掉下來的範圍內導出手13的移動時間成為最短的最佳動作軌跡。
如上所述,上述實施方式的示教裝置30是具有基座11、臂12以及手13(末端執行器)的機器人10的示教裝置,該臂12具有相互連接的多個連桿12a、12b且連接在基座11,該手13連接在臂12。示教裝置30包括設定部351、導出部352、顯示部33以及修正部354,該設定部351對包含臂12的規定動作中的手13的始點以及終點的規定條件進行設定,該導出部352根據規定條件,導出從始點到終點的手13的動作軌跡以及響應於手13的動作軌跡的臂12的動作軌跡,該顯示部33對由
導出部352所導出的臂12的動作軌跡以及手13的動作軌跡的至少之一進行顯示,該修正部354按照用戶的輸入操作,對顯示在顯示部33的動作軌跡進行修正。
並且,上述實施方式的軌跡導出程序341是具有基座11、臂12以及手13(末端執行器)的機器人10的示教程序,該臂12具有相互連接的多個連桿12a、12b且連接在基座11,該手13連接在臂12。軌跡導出程序341讓計算機實現如下功能,即,對包含臂12的規定動作中的手13的始點以及終點的規定條件進行設定的功能,根據規定條件,導出從始點到終點的手13的動作軌跡以及響應於手13的動作軌跡的臂12的動作軌跡的功能,將所導出的臂12的動作軌跡以及手13的動作軌跡的至少之一顯示在顯示部的功能,按照用戶的輸入操作,對顯示在顯示部33的動作軌跡進行修正的功能。
藉由這些結構,由於用戶能夠在目視確認顯示在顯示部33的動作軌跡的同時,進行修正指示(輸入操作),因此能夠更加按照用戶的意願,簡單地對動作軌跡進行細微修正。
並且,修正部354響應於使顯示在顯示部33的手13的動作軌跡中的點移動的用戶的修正指示(輸入操作),來修正手13的動作軌跡。
藉由上述結構,用戶能夠藉由使顯示在顯示部33的動作軌跡中的點移動這樣的簡單方法,來對動作軌跡進行細微修正。
並且,顯示部33還顯示使機器人10模型化後的機器人模型。然後,示教裝置30還包括再現部353,該再現部353根據由導出部352所導出的動作軌跡,來使機器人模型在顯示部33中動作。
藉由上述結構,由於用戶能夠在觀察由再現部353所再現的臂12以及手13的動作之後來進行修正指示(輸入操作),因此能夠更加按照用戶的意願,對動作軌跡進行細微修正。
尤其是再現部353在使由導出部352所導出的動作軌跡T或者由修正部354修正後的動作軌跡Ta顯示在顯示部33的狀態下,使機器人模型(手13以及臂12)動作。這樣一來,由於用戶能夠明確目視確認動作軌跡T(動作軌跡Ta)和機器人模型的動作的對應關係,因此能夠更加按照用戶的意願,對動作軌跡T(動作軌跡Ta)進行修正。
並且,用戶的修正指示(輸入操作)是用戶藉由拖放來使顯示在顯示部33的動作軌跡中的點移動的指示。
藉由上述結構,能夠更簡單地修正動作軌跡。
並且,機器人10是將基板S(對象)放置在手13的上表面而不固定來進行運送的機器人。在設定部351所設定的規定條件中包含手13的動作加減速度的上限值。
藉由上述結構,能夠在不使基板S從手13掉下來的範圍內導出從始點到終點的手13的移動時間成為最短的最佳動作軌跡。
並且,如上所述,當以具有兩個手13作為末端執行器的機器人10為對象時,導出部352還要考慮始點以及終點(即,前開式晶圓傳送盒4以及處理裝置5)中的兩個手13的姿勢,來導出手13的動作軌跡等。作為兩個手13的姿勢,例如,存在有如下狀態等,即,上手13a進入前開式晶圓傳送盒4,下手13b不進入前開式晶圓傳送盒4,而是向右或向左旋轉90度的狀態,下手13b進入前開式晶圓傳送盒4,上手13a不進入前開式晶圓傳送盒4,而是向右或向左旋轉90度的狀
態,上手13a以及下手13b兩者進入前開式晶圓傳送盒4的狀態等。藉由還考慮了這樣的始點以及終點中的兩個手13的姿勢,因此能夠導出更佳的手13的動作軌跡等。
(其它實施方式)
如上所述,將所述實施方式作為在本申請中公開的技術的例子進行了說明。但是,本公開的技術並不限定於此,還能夠適用於進行了適當改變、置換、附加、省略等的實施方式。並且,還能夠將在所述實施方式中所說明的各個構成要素進行組合作為新的實施方式。並且,在記載在附圖以及詳細說明的構成要素中不僅包含了為解決課題所必須的構成要素,為了對所述技術舉例,還可能包含了不是為解決課題所必須的構成要素。因此,不應該以那些不是必須的構成要素被記載在附圖以及詳細說明中,而立刻認為那些不是必須的構成要素是必須的。
在所述實施方式中,導出部352也可以在除了基座11的位置之外,還改變臂12的連桿12a、12b的長度的同時,來導出從始點到終點的手13的動作軌跡以及響應於手13的動作軌跡的臂12的動作軌跡。藉由該結構,由於連桿12a、12b的長度也作為參數之一來導出手13的動作軌跡等,因此能夠導出更佳的手13的動作軌跡以及臂12的動作軌跡。換言之,能夠導出更佳的連桿12a、12b的長度。
並且,在所述實施方式中,導出部352也可以在除了基座11的位置之外,還改變基座11的朝向(即,機器人的朝向)的同時,來導出從始點到終點的手13的動作軌跡以及響應於手13的動作軌跡的臂12的動作軌跡。藉由該結構,由於基座11的朝向也作為參數之一來導出手13的動作軌跡等,因此能夠導出更佳的手13的動作軌跡以及臂12的動作軌跡。換言之,能夠導出最佳的基座11的朝向。
並且,在所述實施方式中,導出部352也可以將所導出的手13的動作軌跡以及臂12的動作軌跡兩者顯示在顯示部33,也可以僅將臂12的動作軌跡顯示在顯示部33。
並且,在所述實施方式中,修正部354也可以響應於使顯示在顯示部33的基座11移動的用戶的修正指示(輸入操作),來修正動作軌跡。那時,例如,用戶操作滑鼠,藉由拖放來使顯示在顯示部33的基座11移動,以進行修正指示。
並且,在所述實施方式中,如圖9所示,由導出部352所導出的動作軌跡T也可以作為連接多個經過點X的軌跡形成。那時,藉由用戶的修正指示(輸入操作)所移動的動作軌跡T中的點是經過點X。例如,當設定部351將“經過點有多個”設定為規定條件時,導出部352導出包含多個經過點X的最佳的手13的動作軌跡T,顯示在顯示部33。例如,經過點X顯示得大於動作軌跡T中的其它點。
此時,用戶在感到由再現部353所再現的臂12以及手13的動作不合適時,例如,進行藉由拖放使顯示在顯示部33的動作軌跡T中的經過點X移動的修正指示(輸入操作)(參照圖9)。修正部354響應於該用戶的修正指示,來修正顯示在顯示部33的動作軌跡T。也就是說,修正部354根據基於用戶的修正指示的經過點X的移動信息,即,經過點X移動之後的經過點Xa的位置信息,來修正動作軌跡T,並將修正後的新的動作軌跡Ta顯示在顯示部33。在修正後的動作軌跡Ta中包含移動後的經過點Xa。
藉由該結構,用戶能夠簡單地掌握在顯示在顯示部33的動作軌跡T中應該移動的點。並且,由於能夠在動作軌跡T中移動的點變少,因此能夠減輕修正部354進行修正所需的處理量。
並且,在所述實施方式中,修正部354也可以響應於使顯示在顯示部33的臂12(即,連桿12a、12b)移動的用戶的修正指示(輸入操作),來修正顯示在顯示部33的動作軌跡T。也就是說,如圖10所示,用戶例如操作滑鼠,進行藉由拖放來使顯示在顯示部33的第二連桿12b移動的修正指示(輸入操作)。修正部354根據基於用戶的修正指示的第二連桿12b的移動信息,來修正動作軌跡T,將修正後的新的動作軌跡(省略圖示)顯示在顯示部33。例如,所述第二連桿12b的移動信息包含移動後的第二連桿12b的位置信息、伴隨著第二連桿12b的移動而移動的手13的位置信息等。
並且,在所述實施方式中,也可以省略再現部353。那時,用戶觀察顯示在顯示部33的動作軌跡,來決定是否進行修正指示。
並且,用戶的修正指示(輸入操作)並不限定於藉由滑鼠的操作所進行的指示。例如,也可以是用戶藉由用鍵盤輸入座標值,來使顯示在顯示部33的動作軌跡等移動。
並且,也可以是再現部353在不使由導出部352所導出的動作軌跡T或者由修正部354修正後的動作軌跡Ta顯示在顯示部33的狀態下,使機器人模型(手13以及臂12)動作。
並且,導出部352也可以在固定了基座11的位置的狀態下,導出從始點到終點的手13的動作軌跡以及響應於手13的動作軌跡的臂12的動作軌跡。那時,在所述步驟S4中,藉由用戶的輸入操作,來使機器人10的基座11配置在顯示部33中的規定位置。
並且,設定部351也可以將“兩個手13中的基板S的有無”設定為規定條件。此時,響應於兩個手13中的基板S的有無,來設定4種模式的條
件。即,如下4種模式的條件,“在上手13a有基板S,在下手13b沒有基板S”、“在上手13a沒有基板S,在下手13b有基板S”、“在上手13a以及下手13b的每個中都有基板S”以及“在上手13a以及下手13b的每個中都沒有基板S”。導出部352按照這4種模式的條件中的每一個條件導出最佳動作軌跡,顯示在顯示部33。用戶從4個動作軌跡中選出一個動作軌跡,對於所選出的動作軌跡,根據需要進行修正指示。
20:機器人控制裝置
30:示教裝置
31:輸入部
32:通信部
33:顯示部
34:儲存部
341:軌跡導出程序
35:處理部
351:設定部
352:導出部
353:再現部
354:修正部
355:動作程序製作部
Claims (6)
- 一種機器人的示教裝置,該機器人具有基座、臂和末端執行器,該臂具有相互連接的多個連桿且連接在所述基座,該末端執行器連接在所述臂,所述機器人的示教裝置包括設定部、導出部、顯示部和修正部,所述設定部對包含所述臂的規定動作中的所述末端執行器的始點以及終點的規定條件進行設定,所述導出部根據所述規定條件,導出從所述始點到所述終點的所述末端執行器的動作軌跡以及響應於所述動作軌跡的所述臂的動作軌跡,所述顯示部對由所述導出部所導出的所述臂的動作軌跡以及所述末端執行器的動作軌跡的至少之一進行顯示,所述修正部按照用戶的輸入操作對顯示在所述顯示部的動作軌跡進行修正,其中,所述修正部根據僅使顯示在所述顯示部的所述動作軌跡中的單一個點移動的所述輸入操作,來修正所述動作軌跡。
- 如請求項1所述之機器人的示教裝置,由所述導出部所導出的所述動作軌跡作為連接多個經過點的路俓形成,藉由所述輸入操作所移動的所述動作軌跡中的點是所述經過點。
- 如請求項1或2所述之機器人的示教裝置,所述顯示部還顯示使所述機器人模型化的機器人模型,所述機器人的示教裝置還包括再現部,該再現部根據由所述導出部所導出的所述動作軌跡,來使所述機器人模型在所述顯示部中動作。
- 如請求項1或2所述之機器人的示教裝置,所述輸入操作是所述用戶藉由拖放來使顯示在所述顯示部的所述動作軌跡中的點移動的操作。
- 如請求項1或2所述之機器人的示教裝置,所述機器人是將對象放置在所述末端執行器的上表面而不固定來進行運送的機器人,所述規定條件包含所述末端執行器的動作加減速度的上限值。
- 一種機器人的示教程序,該機器人具有基座、臂和末端執行器,該臂具有相互連接的多個連桿且連接在所述基座,該末端執行器連接在所述臂,所述機器人的示教程序使計算機實現如下功能:對包含所述臂的規定動作中的所述末端執行器的始點以及終點的規定條件進行設定的功能,根據所述規定條件,導出從所述始點到所述終點的所述末端執行器的動作軌跡以及響應於所述動作軌跡的所述臂的動作軌跡的功能,對所述導出的所述臂的動作軌跡以及所述末端執行器的動作軌跡的至少之一以顯示部進行顯示的功能,以及按照僅使顯示在所述顯示部的所述動作軌跡中的單一個點移動的用戶的輸入操作對顯示在所述顯示部的動作軌跡進行修正的功能。
Applications Claiming Priority (2)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2020-110186 | 2020-06-26 | ||
| JP2020110186A JP7621069B2 (ja) | 2020-06-26 | 2020-06-26 | ロボットの教示装置、ロボットの教示プログラム及びロボットの教示方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| TW202204110A TW202204110A (zh) | 2022-02-01 |
| TWI821691B true TWI821691B (zh) | 2023-11-11 |
Family
ID=79281211
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| TW110122581A TWI821691B (zh) | 2020-06-26 | 2021-06-21 | 機器人的示教裝置以及機器人的示教程序 |
Country Status (4)
| Country | Link |
|---|---|
| US (1) | US12280502B2 (zh) |
| JP (1) | JP7621069B2 (zh) |
| TW (1) | TWI821691B (zh) |
| WO (1) | WO2021261325A1 (zh) |
Families Citing this family (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2025035336A (ja) * | 2023-09-01 | 2025-03-13 | 川崎重工業株式会社 | 動作軌跡生成方法および動作軌跡生成装置 |
| JP2025042153A (ja) * | 2023-09-14 | 2025-03-27 | 川崎重工業株式会社 | 教示支援装置、教示支援方法及び教示支援プログラム |
| JP2025042154A (ja) * | 2023-09-14 | 2025-03-27 | 川崎重工業株式会社 | 教示支援装置、教示支援方法及び教示支援プログラム |
| JP2025056956A (ja) * | 2023-09-27 | 2025-04-09 | 川崎重工業株式会社 | ロボットの動作経路生成方法およびロボットの動作経路生成装置 |
| JP2025115330A (ja) * | 2024-01-25 | 2025-08-06 | 川崎重工業株式会社 | ワーク搬送ロボットの干渉確認方法およびワーク搬送ロボットの干渉確認装置 |
Citations (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH10124132A (ja) * | 1996-10-21 | 1998-05-15 | Tokico Ltd | ロボット制御装置及びロボット |
| CN108732997A (zh) * | 2017-04-17 | 2018-11-02 | 发那科株式会社 | 机器人的离线示教装置 |
| JP2019193975A (ja) * | 2019-08-09 | 2019-11-07 | キヤノン株式会社 | ロボット軌道生成方法、ロボット軌道生成装置、および製造方法 |
Family Cites Families (8)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| EP1209545A1 (fr) * | 2000-11-23 | 2002-05-29 | IRIS Robotique Sàrl | Procédé de commande d'un robot industriel |
| JP2004254899A (ja) | 2003-02-26 | 2004-09-16 | Hitachi Ltd | 手術支援システム及び手術支援方法 |
| JP4168002B2 (ja) | 2004-04-07 | 2008-10-22 | ファナック株式会社 | オフラインプログラミング装置 |
| JP6915543B2 (ja) | 2015-10-30 | 2021-08-04 | 株式会社安川電機 | ロボット教示装置、コンピュータプログラム及びロボット教示方法 |
| US10014205B2 (en) * | 2015-12-14 | 2018-07-03 | Kawasaki Jukogyo Kabushiki Kaisha | Substrate conveyance robot and operating method thereof |
| JP6998660B2 (ja) | 2017-02-21 | 2022-01-18 | 株式会社安川電機 | ロボットシミュレータ、ロボットシステム及びシミュレーション方法 |
| JP6526098B2 (ja) | 2017-04-26 | 2019-06-05 | ファナック株式会社 | ロボットを操作するための操作装置、ロボットシステム、および操作方法 |
| JP2018144228A (ja) | 2018-06-27 | 2018-09-20 | セイコーエプソン株式会社 | ロボット制御装置、ロボット、ロボットシステム、教示方法、及びプログラム |
-
2020
- 2020-06-26 JP JP2020110186A patent/JP7621069B2/ja active Active
-
2021
- 2021-06-15 WO PCT/JP2021/022644 patent/WO2021261325A1/ja not_active Ceased
- 2021-06-15 US US18/013,150 patent/US12280502B2/en active Active
- 2021-06-21 TW TW110122581A patent/TWI821691B/zh active
Patent Citations (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH10124132A (ja) * | 1996-10-21 | 1998-05-15 | Tokico Ltd | ロボット制御装置及びロボット |
| CN108732997A (zh) * | 2017-04-17 | 2018-11-02 | 发那科株式会社 | 机器人的离线示教装置 |
| JP2019193975A (ja) * | 2019-08-09 | 2019-11-07 | キヤノン株式会社 | ロボット軌道生成方法、ロボット軌道生成装置、および製造方法 |
Also Published As
| Publication number | Publication date |
|---|---|
| JP2022007291A (ja) | 2022-01-13 |
| US12280502B2 (en) | 2025-04-22 |
| US20230241769A1 (en) | 2023-08-03 |
| JP7621069B2 (ja) | 2025-01-24 |
| TW202204110A (zh) | 2022-02-01 |
| WO2021261325A1 (ja) | 2021-12-30 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| TWI821691B (zh) | 機器人的示教裝置以及機器人的示教程序 | |
| TWI776556B (zh) | 機器人的示教裝置以及機器人的示教程序 | |
| TWI770712B (zh) | 影像確認用電腦 | |
| KR20150054676A (ko) | 로봇 시뮬레이션 장치, 로봇 시뮬레이션 방법, 및 로봇 시뮬레이션 프로그램 | |
| WO2017103997A1 (ja) | ロボットシミュレーション装置、ロボットシミュレーション方法、ロボットシミュレーションプログラムおよびロボット | |
| TWI905938B (zh) | 示教支援裝置、示教支援方法以及示教支援程序 | |
| TWI900231B (zh) | 示教支援裝置、示教支援方法以及示教支援程序 | |
| TWI900230B (zh) | 示教支援裝置、示教支援方法以及示教支援程序 | |
| TWI912905B (zh) | 動作軌跡產生方法及動作軌跡產生裝置 | |
| TW202517417A (zh) | 動作軌跡產生方法及動作軌跡產生裝置 | |
| TW202519371A (zh) | 動作軌跡生成方法及動作軌跡生成裝置 | |
| TW202521300A (zh) | 示教支援裝置、示教支援方法以及示教支援程序 | |
| JP2025042155A (ja) | 教示支援装置、教示支援方法及び教示支援プログラム | |
| TWI912906B (zh) | 機器人的動作路徑產生方法及機器人的動作路徑產生裝置 | |
| TWI912910B (zh) | 機器人的動作路徑生成方法及機器人的動作路徑生成裝置 | |
| TW202531462A (zh) | 機器人的動作路徑生成方法及機器人的動作路徑生成裝置 | |
| TW202519372A (zh) | 機器人的動作路徑產生方法及機器人的動作路徑產生裝置 | |
| TW202519373A (zh) | 機器人的動作路徑生成方法及機器人的動作路徑生成裝置 | |
| CN118893619A (zh) | 物料装配方法、装配建模方法、装置以及计算机存储介质 |