TW202335808A

TW202335808A - 機器人控制裝置及多關節機器人

Info

Publication number: TW202335808A
Application number: TW112105444A
Authority: TW
Inventors: 岡元崇紘
Original assignee: 日商發那科股份有限公司
Priority date: 2022-02-28
Filing date: 2023-02-15
Publication date: 2023-09-16
Also published as: DE112022006169T5; CN118715091A; US20250196337A1; WO2023162225A1; JPWO2023162225A1

Abstract

一種機器人控制裝置，包括處理器及儲存部。儲存部儲存有定義機器人之特異點附近的指定的區域之參數。處理器用於執行用於機器人之運動的第一教導點及第二教導點及接收從第一教導點至第二教導點之插值的類型。在插值的類型為線性插值，且機器人透過線性插值從第一教導點至第二教導點運動中，第二臂之前端部的指定位置通過指定的區域而為變更對象教導時，自動地對第一教導點及第二教導點之間的插值運動的至少一部分執行不同於線性插值的各軸插值運動。

Description

機器人控制裝置及多關節機器人

本申請涉及一種機器人控制裝置及多關節機器人。

為了改善具有繞著垂直軸線旋轉的第一臂構件(旋轉臂)及相對於第一臂構件繞著水平軸線旋轉的第二臂構件之六軸垂直多關節機器人通過特異點時的行動，習知一種機器人控制裝置，執行機器人姿勢計算處理，以計算教導點至下一教導點之間之垂直多關節機器人的姿勢，及執行判斷處理，以判斷所計算之各機器人姿勢是否通過特異點，且當判斷通過特異點時，執行迴避通過特異點的處理。舉例來說，請參閱專利文獻1。

此外，為了改善具有繞著垂直軸線旋轉的第一臂構件(旋轉臂)及相對於第一臂構件繞著水平軸線旋轉的第二臂構件之六軸垂直多關節機器人通過特異點時的行動，習知一種機器人控制裝置，當教導通過特異點附近時，執行通知使用者的處理、執行接收來自使用者請求之迴避運動的處理及執行根據來自使用者所接收之迴避運動的請求以變更機器人的運動的處理。舉例來說，請參閱專利文獻2。 [先前技術文獻] [專利文獻]

[專利文獻1]日本發明專利2008-137143號公開說明書 [專利文獻2]日本發明專利2021-062445號公開說明書

[發明欲解決之問題]

專利文獻1的機器人控制裝置，沒有通過特異點的狀況下不會執行任何處理。然而，第一臂構件的旋轉軸線及第二臂構件的旋轉軸線為平行的機器人的狀況下，期望即使在沒有通過特異點之教導的情況下，也可以考慮使用者的便利性同時改善機器人的行動。

專利文獻2的機器人控制裝置，為了改善通過特異點時的行動，提出了複數個改善方法的同時，接收複數個提案中來自使用者要使用哪一提案的指示。每當通過特異點時，使用者必須對機器人控制裝置發出指示。此外，使用者在不熟悉機器人的教導及行動的狀況下，來自使用者的指示內容通常並不合適。此外，專利文獻2的機器人控制裝置同樣地，雖然未假設是第一臂構件的旋轉軸線及第二臂構件的旋轉軸線為平行的機器人，期望即使為此種機器人也可以考慮使用者的便利性同時改善機器人的行動。 [解決問題之手段]

綜上所述，根據一實施例，提供一種機器人控制裝置，包括處理器及儲存部，以控制具有以基部所支撐的第一臂及以第一臂所支撐的第二臂之水平多關節機器人。儲存部儲存有定義水平多關節機器人之特異點附近的指定的區域之參數。處理器用於執行包括第一教導點處理、第二教導點處理、插值類型處理及插值變更處理。第一教導點處理接收用於水平多關節機器人之運動的第一教導點。第二教導點處理接收作為第一教導點後之通過點的第二教導點。插值類型處理接收從第一教導點至第二教導點之插值的類型。插值變更處理在插值的類型為線性插值，且水平多關節機器人透過線性插值從第一教導點至第二教導點運動中，第二臂之前端部的指定位置通過指定區域而為變更對象教導時，自動地對第一教導點及第二教導點之間的插值運動的至少一部分執行不同於線性插值的各軸插值運動。

根據另一實施例，提供一種多關節機器人包括第一臂、第二臂及機器人控制裝置。第一臂的後端部於基部上繞著第一軸線可旋轉地被支撐。第二臂於第一臂的前端部上繞著與第一軸線平行的第二軸線可旋轉地被支撐。機器人控制裝置控制第一臂繞著第一軸線的旋轉位置及第二臂繞著第二軸線的旋轉位置。機器人控制裝置的儲存部儲存有定義多關節機器人之特異點附近的指定區域之參數。機器人控制裝置的處理器用於執行包括第一教導點處理、第二教導點處理、插值類型處理及插值變更處理。第一教導點處理接收第一教導點。第二教導點處理接收作為第一教導點後之通過點的第二教導點。插值類型處理接收從第一教導點至第二教導點之插值的類型。插值變更處理隨著插值的類型為線性插值，於多關節機器人透過線性插值從第一教導點至第二教導點運動，且第二臂之前端部的指定位置通過指定區域以作為變更對象教導時，自動地對第一教導點及第二教導點之間插值運動的至少一部分執行不同於線性插值的各軸插值運動。

關於第一實施例的多關節機器人，請參閱以下圖式及說明。如圖1至圖4所示，本實施例的水平多關節型之機器人1，包括從下方固定於指定之設置位置2的基部100、以及其後端部繞著沿豎直方向延伸之第一軸線AX1可旋轉地被支撐於基部100的第一臂10。此外，機器人1更包括其後端部繞著沿豎直方向延伸之第二軸線AX2可旋轉地被支撐於第一臂10的前端部之第二臂20、以及被支撐於第二臂20的前端部之軸部30。機器人1係透過機器人控制裝置40控制。機器人控制裝置40在下述的說明中以控制裝置40稱之。

如圖1至圖4所示，第一臂10的後端部從下方組裝至基部100，第二臂20的後端部從下方組裝至第一臂10的前端部。此外，軸體30的旋轉中心RC、第一軸線AX1以及第二軸線AX2彼此相互平行。軸體30相對於第二臂20可以於豎直方向上移動，且繞著沿豎直方向延伸之旋轉中心RC可旋轉地被第二臂20支撐，軸體30的工具組裝法蘭30a設置於第二臂20的前端部之下方。如此，本實施例的機器人1可以作為懸吊設置地之水平多關節機器人。

如圖1至圖4所示，基部100內設置有作為用於讓第一臂10旋轉之伺服馬達等的第一軸馬達11，第一臂10內設置有作為用於讓第二臂20旋轉之伺服馬達等的第二軸馬達22。此外，第二臂20內設置有作為用於讓軸體30於豎直方向移動之伺服馬達等的第三軸馬達23以及用於讓軸體30繞著旋轉中心RC旋轉之伺服馬達等的第四軸馬達24。

軸體30係透過圖未示的滾珠螺桿螺帽及滾珠花鍵螺帽被支撐於第二臂20的前端部。習知之結構不加以贅述，滾珠螺桿螺帽繞著旋轉中心RC可旋轉地被支撐於第二臂20的前端部，而滾珠花鍵螺帽亦繞著旋轉中心RC可旋轉地被支撐於第二臂20的前端部。此外，滾珠花鍵螺帽及滾珠螺桿螺帽沿著豎直方向並列。第三軸馬達23的旋轉力經由圖未示的皮帶傳輸至滾珠螺桿螺帽，使滾珠螺桿螺帽旋轉。另一方面，第四軸馬達24的旋轉力經由圖未示的皮帶傳輸至滾珠花鍵螺帽，使滾珠花鍵螺帽旋轉。

軸體30作為滾珠螺桿花鍵軸，於軸體30的外表面設有與滾珠螺桿螺帽的金屬滾珠嚙合之螺旋狀滾珠螺紋槽(圖未示)，以及與滾珠花鍵螺帽的金屬滾珠嚙合之花鍵槽(圖未示)。如此，滾珠螺桿螺帽透過第三軸23旋轉使軸體30在豎直方向上移動，滾珠花鍵螺帽透過第四軸馬達24使軸體30繞著旋轉中心RC旋轉。

如圖5所示，控制裝置40包括處理器41、顯示裝置42、儲存部43、輸入裝置44、通訊部45以及伺服控制器46。處理器41具有CPU、微處理器等一或複數個處理元件。儲存部43具有非揮發性記憶體、ROM及RAM等。輸入裝置44係為具有鍵盤、觸控螢幕功能的液晶顯示裝置、操作板及遙控器等。通訊部45用於執行訊號的收發。伺服控制器46分別連接至各馬達11、22、23、24。具觸控螢幕功能之液晶顯示裝置例如為平板電腦，而使用者所擁有的平板電腦具有作為輸入裝置44的功能。

儲存部43儲存有系統程序43a，系統程序43a負責控制裝置40的基本功能。此外，儲存部43儲存有運動程序43b。控制裝置40，根據運動程序43b，在將用於控制各馬達11、22、23、24的控制指令傳送至伺服控制器46的同時，向被組裝於軸體30的下端之工具組裝法蘭30a的手把等之工具31的驅動裝置31a(圖5)傳送控制指令。如此，機器人1執行工件W的取出作業。

此外，儲存部43儲存有教導程序43c、插值程序43d及插值變更程序43e。作為示例，控制裝置40根據教導程序43c，於顯示裝置42或輸入裝置44的顯示裝置顯示用於機器人1的教導點輸入的畫面、用於設定所輸入之教導點之間插值的類型之畫面及所輸入之教導點及所設定之插值的類型之畫面。機器人1的教導點輸入可以透過直接教導（direct teaching）、座標值的輸入等習知的方法進行。

在本實施例中，如圖1所示，舉例來說，教導點的位置對應工具組裝法蘭30a中旋轉中心RC通過法蘭中心之位置，而教導點透過輸入裝置44輸入。如圖6所示的畫面，舉例來說，複數個教導點TB2、TB1、TA1、TA2、TA3、TA4被輸入。前述複數個教導點亦可以從其他電腦輸入。在任何情況下，控制裝置40的處理器41皆接收各教導點。進一步地，儲存部43中集成設置的微處理器具有作為微處理器41一部分的功能。進一步地，在本實施例中，後續的xy座標系中，工具31的TCP(工具中心點)與工具組裝法蘭30a的中心及旋轉中心RC重疊。

在本實施例中，教導點TA1稱為第一教導點、教導點TA2稱為第二教導點、教導點TA3稱為第三教導點、教導點TA4稱為第四教導點。用於設定插值的類型之畫面中，顯示有用於選擇線性插值的按鈕、用於選擇圓弧插值的按鈕以及用於選擇各軸插值運動的按鈕等。當使用者透過輸入裝置44選擇各區間的插值方式，所選擇之插值的類型將由處理器41接收。使用者亦可以透過其他的方式設定插值的類型，插值的類型亦可以從其他的電腦輸入。

舉例來說，根據使用者的輸入，處理器41於第一教導點TA1及第二教導點TA2之間設定線性插值、也於第二教導點TA2及第三教導點TA3之間及第三教導點TA3及第四教導點TA4之間設定線性插值。圖6的畫面中，線性插值的設定雖然由虛線顯示，但亦可以以文字、符號或其他方法顯示插值的類型。

圖6的畫面中，雖然於xy二次元空間中執行顯示教導點的位置及插值的類型等，但亦可以於三次元空間中執行顯示教導點的位置及插值的類型等。如圖1的x軸及y軸所示，xy平面是與第一軸線AX1及第二軸線AX2正交之平面。各教導點至少具有於xy座標系中的座標數據，各教導點也具有與xy平面正交之z方向的座標數據及繞著x、y、z軸旋轉之旋轉位置數據。在本實施例中，運動程序43b的各教導點具有用於將機器人1的旋轉中心RC的xy座標系中的位置配置於各教導點的座標數據。

在本實施例中，如圖6的畫面中，顯示有機器人1運動至教導點之位置時之第一臂10的位置、第二臂20的位置以及軸體30之旋轉中心RC的位置。更具體地，顯示有表示第一臂10之連桿長度的線段L1、表示第二臂20之連桿長度的線段L2、基部100的形狀、第一軸線AX1的位置、第二軸線AX2的位置及軸體30的旋轉中心RC等。該些結果為插值計算時透過控制裝置40所得知。亦可以透過繪製第一臂10及第二臂20的圖以取代線段L1、L2。在本實施例中，線段L1及線段L2的長度相同。

在本實施例中，線性插值係使用各教導點的座標數據、線段L1、L2的長度、旋轉中心RC的位置(指定位置)的目標移動速度及旋轉中心RC的位置的目標移動加速度等，並使用逆運動學連續地計算於xy座標中第一臂10及第二臂20的旋轉位置，將旋轉中心RC的位置(指定位置)直線地從教導點移動至教導點。舉例來說，線性插值的計算可以使用逆雅可比矩陣和行列（Jacobian matrix and determinant）。線性插值的計算亦可以使用其他習知的計算方法。前述指定位置係為與第二軸線AX2正交之xy平面上的位置，也可以說為對應表示以插值計算所得知之第二臂20的連桿長度之線段L2前端之位置。

此外，在本實施例中，各軸插值運動係為在教導點(出發點)及教導點(目標點)之間，透過在空間角度插值第一臂10及第二臂20各自的旋轉位置之差異以進行移動。出發點的旋轉位置及目標點的旋轉位置，亦可以由各臂的旋轉位置直接指定教導點，另亦可以由臂前端的正交位置指定，並以幾何變換計算出教導點。此種插值亦可以說為與各插值點相關之PTP(Point-to-Point)控制的計算。

當控制裝置40具有機器學習功能，或儲存部43透過機器學習儲存所得到的結果。該些狀況下，處理器41使用機械學習的結果控制第一臂10及第二臂20的旋轉，旋轉中心RC的位置在xy坐標系中進行非線性插值移動狀態下之各軸插值運動。舉例來說，為了機器學習，處理器41以通過後述特異點附近指定的區域AR之各種路線，將旋轉中心RC在xy坐標系中移動。接著，通過各種路線時的機器人1的運動之評價可以被作為學習用數據使用，以進行機械學習。此外，通過各種路線時的第一臂10的運動之評價可以作為學習用數據使用，以進行機械學習。處理器41可以根據照相機、加速度感測器及力感測器等感測器進行前述評價。處理器41根據各馬達11、22的驅動電流、控制內容等，計算第一臂10及第二臂20的移動、加速度等，而處理器41亦可以根據該計算結果進行前述評價。此外，使用者進行前述評價，將該評價結果以輸入裝置44輸入，處理器41可以將各該路線及所輸入之評價相互對應。

儲存部43至少儲存有定義xy坐標系中指定的區域AR之參數43f。如圖6所示，舉例來說，為了定義以第一軸線AX1為中心且半徑為r之指定的區域AR，儲存部43儲存有第一軸AX1的位置坐標和半徑r的值。參數43f可以是任何可以定義指定的區域AR之數據，例如指定的區域AR外緣之坐標數據。當如圖6所示顯示裝置的畫面顯示指定的區域AR，使用者可以直接地得知與指定的區域AR有關之控制裝置40後續的處理。在本實施例中，半徑r係為第一臂10之連桿長度的25%~30%，較佳為40%以下，更佳為3%以上。

在本實施例中，由於線段L1及線段L2的長度相同，於xy坐標系中，旋轉中心RC與第一軸線AX1重疊時，執行線性插值計算並同時控制機器人1的移動將被干擾或無法進行。也就是說，第一軸線AX1的位置成為特異點。另外，表示第一臂10之連桿長度的線段L1及表示第二臂20之連桿長度的線段L2重疊時之旋轉中心RC的位置成為特異點。

接著，如圖7所示，當在特異點附近指定的區域AR使用線性插值時，第一臂10如圖7箭頭所示快速且大幅地移動。此外，由於直線越靠近奇異點速度越快，隨著該運動，機器人1的限制器可能將移動中之機器人1緊急停止。此外，該運動也給予使用者不好的印象，且隨著該運動，機器人1的附件、工件及周圍的物品也可能受到毀損。

在本實施例中，在教導點及教導點之間指定線性插值後，機器人1於測試模式下運動時、機器人1為了作業而運動時及該些準備時等，控制裝置40參考指定的區域AR同時執行以下的處理。控制裝置40的運動請參考圖10的流程及說明。以下的說明雖然為與第一教導點TA1及第二教導點TA2有關之處理，其他組的教導點之間也是進行相同的處理。

處理器41根據插值變更程序43e進行以下的處理。首先，處理器41判斷第一教導點TA1及第二教導點TA2之間所設定之插值的類型是否為線性插值(步驟S1-1)。判斷為線性插值時，處理器41將作為參數43f被儲存之指定的區域AR讀出(步驟S1-2)。接著，處理器41判斷第一教導點TA1及第二教導點TA2之間相連的直線是否通過指定的區域AR(步驟S1-3)，當通過時則判斷為變更對象教導(步驟S1-4)。在步驟S1-3中，如圖6及圖7所示，機器人1根據線性插值以路線R0運動時，判斷旋轉中心RC是否通過指定的區域AR。

當於步驟S1-4判斷為變更對象教導時，處理器41計算於作為目標位置之第二教導點TA2之手腕姿勢變成與於第一教導點TA2之手腕姿勢的相反側之第一臂10及第二臂20的旋轉位置(步驟S1-5)。當使用該計算結果，如圖8所示，機器人1的手腕姿勢為在第一教導點TA1以虛線表示之手腕姿勢R及在第二教導點TA2以實線表示之手腕姿勢L。也就是說，機器人1的手腕姿勢在到達第二教導點TA2前被變更。如此，如圖8箭頭所示的第一臂10的旋轉量降低。

在此，手腕姿勢R及手腕姿勢L是機器人1沿著第一軸線AX方向之平面視圖的手腕姿勢。圖2、圖3、圖6至圖9係為從下方觀察機器人1之平面視圖。本實施例的該平面視圖中，雖然定義了手腕姿勢R、手腕姿勢L，亦可以從上方觀察機器人1之平面視圖中定義手腕姿勢。手腕姿勢R為右手手腕姿勢，如圖3所示，從第一軸線AX1觀察，右手手腕姿勢配置在較旋轉中心RC更右側之第二軸線AX2。手腕姿勢L為左手手腕姿勢，如圖2所示，左手手腕姿勢配置於與右手手腕姿勢相對側之第二軸線AX2。第一臂10及第二臂20的旋轉位置，即使第一臂10及第二臂20所形成的角度產生變化，亦可以根據第二軸線AX2的位置判斷是手腕姿勢R或手腕姿勢L。

接著，處理器41自動地對第一教導點TA1及第二教導點TA2之間的插值運動執行不同於線性插值的各軸插值運動，以計算為了各軸插值運動的第一臂10及第二臂20之運動位置(步驟S1-6)。當使用該計算結果，如圖8所示，旋轉中心RC例如通過大致呈圓弧狀之路線R1到達第二教導點TA2。在本實施例中，圓弧狀之路線R1通過第一軸線AX1的位置。

接著，處理器41，根據運動程序43b，使用步驟S1-5及步驟S1-6的計算結果移動第一臂10及第二臂20(步驟S1-8)。

另一方面，於步驟S1-3中的前述直線未通過指定的區域AR時，處理器41計算於作為目標位置之教導點的手腕姿勢變成與出發位置之教導點的手腕姿勢同側之第一臂10及第二臂20的旋轉位置(步驟S1-7)。於步驟S1-7中，因為未判斷為變更對象教導，透過線性插值進行計算。舉例來說，於圖8中的TA2及TA3之間及TA3及TA4之間等進行該處理。接著，處理器41根據運動程序43b、插值程序43d等，使用步驟S1-7的計算結果透過正常之線性插值移動第一臂10及第二臂20(步驟S1-8)。

進一步地，當於步驟S1-1判斷為非線性插值時，處理器41根據運動程序43b、插值程序43d，透過所指定的插值形式移動第一臂10及第二臂20(步驟S1-8)。

於步驟S1-6中，處理器41於第一教導點TA1及第二教導點TA2之間的一部份執行為了各軸插值運動的計算，另一部分則執行線性插值的計算。舉例來說，如圖9所示，處理器41於第一教導點TA1及第二教導點TA2之間附加中間教導點TM，並在第一教導點TA1及中間教導點TM之間執行線性插值的計算，於中間教導點TM及第二教導點TA2之間執行為了各軸插值運動的計算。在另一實施例中，中間教導點TM被附加於指定的區域AR之外。

第二實施例的多關節機器人，請參閱圖11至圖13及以下說明。如圖11所示，在第二實施例中，於xy坐標系的工具31之TCP的位置從旋轉中心RC偏移。即使在此狀況下，仍與第一實施例相同，機器人1於測試模式下運動時、機器人1為了作業而運動時及該些準備時等，控制裝置40參考指定的區域AR同時執行以下的處理。控制裝置40的運動請參考圖13的流程及說明。以下的說明雖然為與第一教導點TA1及第二教導點TA2有關之處理，其他組的教導點之間也是進行相同的處理。在第二實施例中，各教導點表示為TCP的位置。

處理器41根據插值變更程序43e進行以下的處理。首先，處理器41判斷第一教導點TA1及第二教導點TA2之間所設定之插值的類型是否為線性插值(步驟S2-1)。判斷為線性插值時，處理器41將作為參數43f被儲存之指定的區域AR讀出(步驟S2-2)。接著，處理器41判斷旋轉中心RC是否通過指定的區域AR(步驟S2-3)，當通過時則判斷為變更對象教導(步驟S2-4)。

在步驟S2-3中，如圖12所示，關於從第一教導點TA1至第二教導點TA2的機器人1運動，處理器41判斷旋轉中心RC的軌跡是否通過指定的區域AR。在此，根據第一教導點TA1及第二教導點TA2之軸體30的旋轉位置，如圖12所示從S至D的曲線路徑一般，旋轉中心RC的軌跡可能不是直線。為此，處理器41仍可使用於從第一教導點TA1至第二教導點TA2之線性插值的計算所得到之旋轉中心RC的路線，判斷旋轉中心RC是否通過指定的區域AR，亦可以計算從第一教導點TA1至第二教導點2任意之經過點的旋轉中心RC之位置V，近似地判斷線段SV或線段VD是否通過指定的區域AR。

接著，執行與第一實施例的步驟S1-5至S1-8相同的步驟S2-5至S2-8。進一步地，取代軸體30，機器人1具有在第二臂20的前端部繞著旋轉中心RC旋轉之前端側臂，前端側臂的前端部更其他臂可旋轉地支撐。進一步地，設定有關於前端側臂或另一臂的前端部的教導點。即使在該些狀態下，處理器41也可以執行上述第二實施例中的處理。也就是說，如上述第二實施例的說明，使用於從第一教導點TA1至第二教導點TA2之線性插值的計算所得到之旋轉中心RC的路線，可判斷旋轉中心RC是否通過指定的區域AR。

進一步地，在第一實施例及第二實施例中，線段L1及線段L2的長度可能不同。舉例來說，如圖14所示線段L1及線段L2重疊時的旋轉中心RC之位置為特異點。即使在此狀態下，也可以定義特異點附近為指定的區域AR，而控制裝置40可以參考指定的區域AR同時執行與第一實施例及第二實施例相同的處理。圖14中，於第一實施例機器人1的規格，第一教導點TA1及第二教導點TA2之間設定為線性插值，而第一教導點TA1及第二教導點TA2所相連接之直線通過指定的區域AR。因此，執行第一實施例的步驟S1-5及步驟S1-6，旋轉中心RC例如通過大致呈圓弧狀之路線R1到達第二教導點TA2。圖14中，雖然線段L2較線段L1更短，但線段L2較線段L1更長時同樣適用。

上述各實施例中，定義特異點附近之指定的區域AR之參數43f儲存於儲存部43中。此外，控制裝置40的處理器41，隨著插值的類型為線性插值，在機器人1透過線性插值從第一教導點TA1至第二教導點TA2時的旋轉中心RC(指定位置)為通過指定的區域AR之變更對象教導時，自動地對第一教導點TA1及第二教導點TA2之間插值運動的至少一部分執行不同於線性插值的各軸插值運動。因此，使用者即使於特異點附近指定了線性插值，也可以使第一臂10及第二臂20的運動變得順暢。在多數不熟悉教導機器人的使用者中，上述技術將提升了機器人的便利性，也提升了使用者作業效率。

在上述實施例中，於變更對象教導時，處理器41以於第一教導點TA1的手腕姿勢作為右手手腕姿勢及左手手腕姿勢的其中之一，並於抵達第二教導點TA2時的手腕姿勢作為右手手腕姿勢及左手手腕姿勢的其中之另一地，控制第一臂10及第二臂20。當上述各軸插值運動與該技術自動地合併使用，即使使用者在特異點附近指定了線性插值，第一臂10及第二臂20的移動也可以更順暢。特別是，避免第一臂10不必要的旋轉。

在上述實施例中，機器人1根據線性插值運動時的旋轉中心(指定位置)RC未通過指定的區域AR時，處理器41於線性插值中，若以手腕姿勢於第一教導點TA1作為右手手腕姿勢及左手手腕姿勢的其中之一，則以到達第二教導點TA2時的手腕姿勢為前述其中之一的姿勢地，控制第一臂10及第二臂20。

上述實施例中，插值變更處理的執行可以由顯示裝置42及輸入裝置44的顯示裝置顯示。在另一實施例中，如圖8示出的畫面，顯示了第一教導點TA1及第二教導點TA2之間各軸插值運動之旋轉中心(指定位置)RC的路線R1。如此，使用者可以得知在指定了線性插值的區間旋轉中心(指定位置)RC會如何移動。特別是，如圖8的情況，因為顯示了各軸插值運動的內容，使用者可以更具體地得知旋轉中心(指定位置)RC的移動，而有路線圖也可以更直覺地了解。在其他實施例中，顯示了第一教導點TA1及第二教導點TA2之間插值變更處理的執行。進一步地，在其他實施例中，顯示了根據插值變更處理在第一教導點TA1及第二教導點TA2之間形成了圓弧狀的軌跡。

此外，在上述實施例中，顯示裝置42及輸入裝置44的顯示裝置顯示了於第一教導點TA1及第二教導點TA2的手腕姿勢。在另一實施例中，如圖8所示的畫面，透過虛線、實線等顯示線段L1及線段L2，而使用者能直覺地得知各教導點的手腕姿勢。在圖8中，可以顯示關於全部教導點的線段L1及線段L2。此外，在圖8中，也可以不顯示線段L1及線段L2，在全部或部分教導點的旁邊顯示R、L等表示手腕姿勢之文字、記號、圖案等，以達到同樣的效果。

在上述實施例中，雖然機器人1以懸吊設置地從下方固定於基部100之指定的設置位置，亦可以將機器人1的基部100從水平方向固定至沿著豎直方向延伸之壁面，亦可以將機器人1的基部100從上方固定於地板。

1:機器人 10:第一臂 100:基部 11:第一軸馬達 20:第二臂 22:第二軸馬達 23:第三軸馬達 24:第四軸馬達 30:軸體 30a:工具組裝法蘭 31:工具 31a:驅動裝置 40:機器人控制裝置 41:處理器 42:顯示裝置 43:儲存部 43a:系統程序 43b:運動程序 43c:教導程序 43d:插值程序 43e:插值變更程序 44:輸入裝置 45:通訊部 46:伺服控制器 L1:線段 L2:線段 AX1:第一軸線 AX2:第二軸線 AR:指定的區域 R1:路線 RC:旋轉中心 TA1:第一教導點 TA2:第二教導點 TA3:第三教導點 TA4:第四教導點 TB1、TB2:教導點 TM:中間教導點 SV:線段 VD:線段 W:工件 R:手腕姿勢 L:手腕姿勢 V:位置

[圖1]為根據一第一實施例多關節機器人的局部側視圖。 [圖2]為根據一第一實施例多關節機器人的局部俯視圖。 [圖3]為根據一第一實施例多關節機器人的局部俯視圖。 [圖4]為根據一第一實施例多關節機器人的局部側視圖。 [圖5]為根據一第一實施例多關節機器人之控制裝置的方塊圖。 [圖6]為根據一第一實施例多關節機器人之顯示裝置的表示例示意圖。 [圖7]為多關節機器人的運動之一例的示意圖。 [圖8]為根據一第一實施例多關節機器人之顯示裝置的表示例示意圖。 [圖9]為根據一第一實施例多關節機器人之顯示裝置的表示例示意圖。 [圖10]為根據一第一實施例多關節機器人之控制裝置執行處理例的流程圖。 [圖11]為根據一第二實施例多關節機器人的局部側視圖。 [圖12]為根據一第二實施例多關節機器人的運動之一例的示意圖。 [圖13]為根據一第二實施例多關節機器人之控制裝置執行處理例的流程圖。 [圖14]為根據一第一實施例多關節機器人的運動之變形例的示意圖。

100:基部

L1:線段

L2:線段

AX1:第一軸線

AX2:第二軸線

R1:路線

RC:旋轉中心

TA1:第一教導點

TA2:第二教導點

TA3:第三教導點

TA4:第四教導點

TB1、TB2:教導點

R:手腕姿勢

L:手腕姿勢

Claims

一種機器人控制裝置，包括一處理器及一儲存部，以控制具有以一基部所支撐的一第一臂及以該第一臂所支撐的一第二臂之一水平多關節機器人；其中，該儲存部儲存有定義該水平多關節機器人之特異點附近的一指定的區域之一參數；其中，該處理器用於執行包括：一第一教導點處理，以接收用於該水平多關節機器人之運動的一第一教導點；一第二教導點處理，以接收作為該第一教導點後之通過點的一第二教導點；一插值類型處理，以接收從該第一教導點至該第二教導點之一插值的類型；以及一插值變更處理，在該插值的類型為一線性插值，且該水平多關節機器人透過該線性插值從該第一教導點至該第二教導點運動中，該第二臂之一前端部的一指定位置通過該指定的區域而為一變更對象教導時，自動地對該第一教導點及該第二教導點之間的插值運動的至少一部分執行不同於該線性插值的一各軸插值運動。
如請求項1所述之機器人控制裝置，其中，該指定位置係指作為被該第二臂的該前端部所支撐之軸部的旋轉中心之位置。
如請求項1或2所述之機器人控制裝置，其中，於該變更對象教導時，該處理器以於該第一教導點由該第一臂及該第二臂所形成的一手腕姿勢作為一右手手腕姿勢及一左手手腕姿勢的其中之一，以抵達該第二教導點時的該手腕姿勢作為該右手手腕姿勢及該左手手腕姿勢的其中之另一，控制該第一臂及該第二臂。
如請求項1或2所述之機器人控制裝置，其中，於該水平多關節機器人透過該線性插值從該第一教導點至該第二教導點運動中，該指定位置未通過該指定的區域時，若該處理器以於該第一教導點由該第一臂及該第二臂所形成的一手腕姿勢作為一右手手腕姿勢及一左手手腕姿勢的其中之一的姿勢的話，以抵達該第二教導點時的該手腕姿勢作為該其中之一的姿勢，控制該第一臂及該第二臂。
如請求項1或2所述之機器人控制裝置，更包括一顯示裝置，以顯示該插值變更處理的執行。
如請求項1或2所述之機器人控制裝置，更包括一顯示裝置，以顯示該插值變更處理的執行及該各軸插值運動的內容。
如請求項3所述之機器人控制裝置，更包括一顯示裝置，以顯示於該第一教導點及該第二教導點的該手腕姿勢。
一種多關節機器人，包括：一第一臂，該第一臂的一後端部於一基部上繞著一第一軸線可旋轉地被支撐；一第二臂，於該第一臂的一前端部上繞著與該第一軸線平行的一第二軸線可旋轉地被支撐；以及一機器人控制裝置，控制該第一臂繞著該第一軸線的旋轉位置及該第二臂繞著該第二軸線的旋轉位置；其中，該機器人控制裝置的一儲存部儲存有定義該多關節機器人之特異點附近的一指定的區域之一參數；其中，該機器人控制裝置的一處理器用於執行包括：一第一教導點處理，以接收一第一教導點；一第二教導點處理，以接收作為該第一教導點後之通過點的一第二教導點；一插值類型處理，以接收從該第一教導點至該第二教導點之一插值的類型；以及一插值變更處理，在該插值的類型為一線性插值，且該多關節機器人透過該線性插值從該第一教導點至該第二教導點運動中，該第二臂之一前端部的一指定位置通過該指定的區域而為一變更對象教導時，自動地對該第一教導點及該第二教導點之間的插值運動的至少一部分執行不同於該線性插值的一各軸插值運動。
如請求項8所述之多關節機器人，其中，該指定位置位於與該第二軸線正交之平面上，且位於對應於表示插值運算所識別的該第二臂之連桿長度之線段的前段之位置。
如請求項8或9所述之多關節機器人，其中，於該變更對象教導時，該處理器以於該第一教導點由該第一臂及該第二臂所形成的一手腕姿勢作為一右手手腕姿勢及一左手手腕姿勢的其中之一，以抵達該第二教導點時的該手腕姿勢作為該右手手腕姿勢及該左手手腕姿勢的其中之另一，控制該第一臂及該第二臂。
如請求項8或9所述之多關節機器人，其中，於該多關節機器人透過該線性插值從該第一教導點至該第二教導點運動中，該指定位置未通過該指定的區域時，若該處理器以於該第一教導點由該第一臂及該第二臂所形成的一手腕姿勢作為一右手手腕姿勢及一左手手腕姿勢的其中之一的姿勢的話，以抵達該第二教導點時的該手腕姿勢作為該其中之一的姿勢，控制該第一臂及該第二臂。