TWI748501B - 教導機器人的安全系統及方法 - Google Patents

Abstract

一種教導機器人的安全系統及方法，預設各運行模式相對應的安全模組及安全功能，建構各運行模式適合的安全系統，模式切換裝置切換機器人的運行模式，啟用相對應模式預設的安全模組及安全功能，確保在各種運行模式都能維持專有的安全模組及安全功能，以提升安全性。

Description

教導機器人的安全系統及方法

本發明有關一種機器人的安全系統及方法，尤其關於機器人在切換自動與手拉或非手拉模式下，對於使用者執行教導機器人，進行保護的安全系統及方法。

隨著機器人的技術蓬勃發展，工廠利用機器人，雖可協助作業人員快速進行加工組裝製造作業，提高工廠生產效率，但是機器人能否正常的運作，嚴重影響到作業人員的安全，因此各國訂定嚴格的安全標準規範，以維護機器人的作業安全。

請參圖5，先前技術為了教導機器人1作業，在機器人1的末端設置手拉按鈕2，手拉按鈕通常設計為按壓運行(Hold to Run)，或為軟體上的按鍵，手拉按鈕2電性或通訊連接至機器人1控制器3。在示教器4設定機器人1處於教導模式時，當使用者按壓手拉按鈕2，訊號通知控制器3，將機器人1從靜止狀態切入手拉模式(Hand Guiding)。先前技術的手拉模式有多種方式，例如透過機器人1各肘節5中致動器之編碼器、馬達電流感測器經計算與補償，得知對各關節之施力或對末端之手拉施力，控制機器人1順從手拉移動。利用手拉機器人1至點位記錄位置、或手拉紀錄路徑，教導機器人1作業。並於放開手拉按鈕2時，使機器人1切出手拉模式回到靜 止狀態。

前述先前技術機器人1的示教器4，為了符合安全標準規範ISO 10218-1的要求，在教導模式下，裝設致能裝置(Enable Device)，以保護協作的使用者。致能裝置6通常在示教器4，為三段式按鈕(3 Position Enabling Switch)，其結構設計有三個按壓階段，完全放開、中位、壓緊，其中僅中位可致能機器人1進行教導行為，完全放開或壓緊時，都將電性或通訊傳達至控制器3，安全系統7啟動中斷教導行為，讓機器人1停止運動，並透過「監控靜止」(Stand Still Monitoring)監控機器人1在致動器仍有電時不輕舉妄動，如監控發現機器人發生運動，安全系統7將切斷機器人1致動器之電力，以保護使用者在教導過程中的安全。

然而，前述先前技術的機器人在教導模式下，需進行手拉，或協同工作，或例如吋動、試跑等非手拉等多種教導作業，而各種教導作業均有不同的安全需求，除此以外更有自動模式下之手拉牽引，以單一功能的安全系統套用至全部教導作業，極易造成使用者的危險。因此，機器人在手拉牽引的安全系統及方法上，仍有問題亟待解決。

本發明的目的提供一種教導機器人的安全系統，藉由模式切換裝置切換機器人多種運行模式，配合致能裝置，啟用相對應各教導模式預設不同的安全模組及安全功能，以方便切換模式。

本發明的另一目的提供一種教導機器人的安全方法，利用預設各運行模式相對應的安全模組及安全功能切換機器人，建構各運行模式專適合的安全系統，以確保使用者的安全。

本發明的再一目的提供一種教導機器人的安全方法，在各種運行模式切換至手拉模式時，都能維持手拉模式專有的安全模組及安全功能，以提升使用者的安全性。

為了達到前述發明的目的，本發明教導機器人的安全系統，具有多肘節的機器人，一端為活動的末端，各肘節中設置致動器及位置感測器，連接控制器，控制致動器及位置感測器，移動機器人的末端，致能裝置連接至該控制器，安全模組設於該控制器內，與能裝置電性或通訊相連，依據致能裝置開關狀態，發出電性或通訊訊號，使該機器人進入安全狀態或取消安全狀態，安全功能單元，設於該控制器內，與該安全模組電性或通訊相連，監控的該機器人的安全功能超過預設限制時，讓安全模組使機器人進入安全狀態，模式切換裝置與控制器、安全模組及安全功能單元電性或通訊相連，切換機器人的複數運行模式，當模式切換裝置切換機器人至各運行模式，使安全模組及安全功能單元啟用相對應各運行模式預設的安全模組及安全功能。

本發明的安全模組電性或通訊連接機器人各肘節之位置感測器，接收位置感測器的訊號進行監控機器人。安全模組至少包含以下一種安全狀態的類型，零類安全狀態為斷電停機功能，進入安全狀態時，直接關斷該致動器電力，一類安全狀態為進階斷電停機功能，進入安全狀態時，對該控制器下達減速命令後，經過固定時間該機器人減速運動達成後，關斷該致動器電源，二類安全狀態為非斷電停機功能，進入安全狀態時，對該控制器下達減速命令後，經過固定時間該機器人減速運動達成後，開啟靜止監控安全功能，持續監控該位置感測器，當監控該機器人產生運動， 即關斷該致動器電源。本發明的安全功能單元啟動至少一項以上的下列安全功能：肘節之角度限制、機器人末端的空間位置限制、力量限制或速度限制等。

本發明教導機器人的安全系統的模式切換裝置切換的運行模式包含教導模式及自動模式，教導模式又包含手拉模式、手動低速模式及手動高速模式。模式切換裝置設於機器人的示教器，或由控制器外接。模式切換裝置為多位置旋鈕，透過旋鈕位置標示模式，或以燈號顯示模式。模式切換裝置亦可為純軟體按鍵、或硬體按鍵組合、或軟體與硬體組合按鍵。

本發明教導機器人的安全方法，預設各運行模式相對應的安全模組及安全功能，安全模組及安全功能，啟用與否及限制值，依機器人各運行模式的需求預先設定。進行切換模式，檢查切換的模式為教導模式，例如手動低速模式或手動高速模式，進入教導模式，啟用教導模式預設相對應的安全模組及安全功能，停機機器人進入安全狀態，使致能裝置致能，偵測該致能裝置的開狀態，解除機器人的安全狀態，進行教導機器人作業。檢查機器人完成作業，則結束作業，未完成作業則回至切換模式繼續作業。

本發明檢查切換的模式為自動模式時，啟動該自動模式預設相對應的安全功能，監控機器人，進行機器人自動作業。檢查切換的模式為手拉模式時，進入手拉模式，至少持續按壓致能裝置，解除安全狀態，並致能手拉功能。本發明自手動慢速模式或手動高速模式或自動模式切換至手拉模式時，該機器人自行記錄運行程序的斷點，並啟動該手拉模式預 先設定的安全模組及安全功能，手拉教導該機器人作業後，切回各運行模式後，從中斷點繼續運行程序。

10:安全系統

11:機器人

12:控制器

13:示教器

14:安全模組

15:安全功能單元

16:致能裝置

17:模式切換裝置

18:肘節

19:基座

20:末端

21:位置感測器

圖1 為本發明教導機器人的安全系統的示意圖。

圖2 為本發明安全系統的控制功能的示意圖。

圖3 為本發明利用模式切換裝置切換模式的示意圖。

圖4 為本發明教導機器人的安全方法的流程圖。

圖5 為先前技術手拉教導機器人的示意圖。

有關本發明為達成上述目的，所採用之技術手段及其功效，茲舉較佳實施例，並配合圖式加以說明如下。

機器人為了符合安全標準規範ISO 10218-1之要求，具備以下幾種運行模式(Operation Mode)：自動模式(Auto Mode)、手動(或稱教導)模式(Manual Mode)，教導模式又分為手動低速模式(Manual Reduced Mode)及手動高速模式(Manual High Speed Mode)，其中自動模式定義為機器人自動運行程式，用於生產自動化作業，使用者為產線作業員；手動或教導模式則非用於生產自動化作業，而是用於機器人程式之編寫與測試，使用者為自動化工程師，其中手動低速模式用於點位教導、程式編纂、低速之試跑，而手動高速模式專門只用於程式之試跑，可達程式中全速之試跑，與自動模式功能相近但須額外安全裝置保護-於示教器上須持續按壓致能裝置以保安全。這些傳統之運行模式之切換常用模式切換裝置(Mode Switch)進行切換，如AUT(自動模式)、T1(手動低速模式)、T2(手動高速模式)之三位置旋鈕切換。而手拉牽引功能於ISO 10218-1中僅定義為協作功能，但未明述用於以上哪種用途，蓋因協作機器人技術尚仍處於發展期，安規尚未對新興技術之手拉牽引加以定義。目前手拉牽引已被用於各種運行模式，常見的有用於手動或教導模式中，便利自動化工程師教導點位、拖拉路徑，除此之外，亦常見用於自動模式中，便利產線操作員進行以下任務：手拉移動(例如牽引機器人至下一工作起始點)、手拉示範(例如手拉示範工作路徑)、手拉協作(例如使機器人舉重而由人引導其放置位置)，以上自動模式下之手拉牽引非安全規範中之教導行為，而是自動生產過程中之手拉牽引操作。由此可見，手拉牽引可廣泛使用於自動模式、手動或教導模式。

請同時參閱圖1至圖2，圖1為本發明教導機器人的安全系統的示意圖，圖2為本發明安全系統的控制功能的示意圖，圖3為本發明利用模式切換裝置切換模式的示意圖。圖1中，本發明的安全系統10包含機器人11、控制器12、示教器13、安全模組14、安全功能單元15、致能裝置16及模式切換裝置17等。其中機器人11具有多肘節18，一端為固定的基座19，另一端為活動的末端20。機器人11連接至控制器12，控制器12內含一安全模組14及安全功能單元15。控制器12藉由控制各肘節18中的致動器及位置感測器21，控制移動機器人11的末端20。控制器12連接示教器13，用以編輯機器人11程式或操作控制機器人11。本發明的致能裝置16可設於示教器13或設於機器人11例如末端20，或使用者由控制器12外接獨立的致能裝置16，致能裝置16可設置於以上任一位置或複數位置設置。模式切換裝置17， 可為機器人示教器13內建，或使用者由控制器12外接的模式切換裝置17。

圖2中，安全模組14及安全功能單元15經由控制器12與致能裝置16、模式切換裝置17及位置感測器21電性或通訊相連。致能裝置16具備開狀態(ON)與關狀態(OFF)操作的功能，當致能裝置16處於開狀態(ON)狀態時，安全模組14取消機器人11之安全狀態，而當致能裝置16處於關狀態(OFF)狀態時，安全模組14使機器人11停機進入安全狀態。安全模組14電性或通訊連接機器人11各肘節18之位置感測器21，接收位置感測器21的訊號進行監控機器人11的活動狀態。

安全模組14停機機器人11進入安全狀態有三種類型，零類安全狀態為斷電停機功能：當安全模組14判定機器人11應進入安全狀態時，直接關斷致動器電力。一類安全狀態為進階斷電停機功能：當安全模組14判定機器人11應進入安全狀態時，對控制器12下達減速命令後，經過固定時間或觀察機器人11減速運動達成後，關斷致動器電源。二類安全狀態為非斷電停機功能：當安全模組14判定機器人11應進入安全狀態時，對控制器12下達減速命令後，經過固定時間或觀察機器人減速運動達成後，開啟靜止監控安全功能(Standstill Monitoring)，持續監控位置感測器21，當監控機器人11產生運動，即關斷致動器電源。

本發明的安全功能單元15可利用控制器12經由安全模組監控機器人11，啟動單一或多項安全功能，例如肘節18之角度限制、機器人11末端20的空間位置限制、力量限制(Power and force limiting)或速度限制等，但包含且不限於本實施例列舉的安全功能。當監控的機器人11的安全功能，超過預設限制而產生異常時，讓安全模組14使機器人11進入安全 狀態。本發明的安全模組14的各類安全狀態，及安全功能單元15的多項安全功能，啟用與否，及限制值，係依機器人11不同模式的需求而預先選擇設定。

圖3中，本發明的模式切換裝置17為多位置旋鈕，可於示教器13上透過旋鈕位置標示模式，或以燈號顯示模式。模式切換裝置17亦可為純軟體按鍵、硬體按鍵組合、或軟體與硬體組合按鍵，例如硬體按壓或旋轉允許輸入目標模式，接著由軟體選擇目標模式，再由硬體確認切往的模式。模式切換裝置17可切換機器人11的多種運行模式(Operation Mode)，本實施例舉例包含自動模式(A模式)，手拉模式(H模式)及非手拉模式，非手拉模式包含手動低速模式(T1模式)與手動高速模式(T2模式)等，但包含且不限於本實施例列舉的運行模式。

當使用者利用模式切換裝置17切入手拉模式(H模式)時，本發明機器人11進入安全狀態，因使用者切換手拉模式是要繼續手拉牽引機器人11，安全模組14將手拉模式預設為非斷電停機功能的二類安全狀態，再由使用者至少持續按壓致能裝置16，解除安全狀態，並致能手拉功能，由使用者手拉牽引機器人11，進行例如手拉牽引機器人至下一工作起始點，或手拉示範工作路徑，或手拉協作機器人舉重引導放置等。由於在手拉模式下，使用者接近機器人11作業，需要嚴格的安全保護，因此預設安全功能單元15的肘節18之角度限制、機器人11末端20的空間位置限制、力量限制及速度限制等多項安全功能，以確保使用者安全。

使用者利用模式切換裝置17切換至非手拉的手動低速模式(T1模式)，安全模組14將手動低速模式可預設例如為一類安全狀態的進階 斷電停機功能，切換後安全模組14先進入安全狀態，確保機器人已停機之後，重新啟動對致能裝置16之監控與反應，此時致能裝置16用於致能包含但不限於非手拉教導或教導驗證動作，例如對各肘節18、機器人11、末端20的坐標系各軸方向進行吋動，或機器人11校正動作，或末端20移動到特定點位之動作，或單步執行教導編程之動作等。由於在手動低速模式屬非手拉模式，使用者未接近機器人11作業，不需要嚴格的安全保護，因此僅需預設安全功能單元15的力量限制及速度限制等項安全功能。

使用者利用模式切換裝置17切換至手動高速模式(T2模式)，因高速移動對使用者危害較大，安全模組14將手動高速模式可預設例如為零類安全狀態為斷電停機功能，切換後安全模組14先進入安全狀態，確保機器人已停機之後，重新啟動對致能裝置16之監控與反應，需持續按壓致能裝置16始能連續致能，進行例如手動試跑等。由於在手動高速模式屬非手拉模式，使用者未接近機器人11作業，不需要嚴格的安全保護，因此僅需預設安全功能單元15的速度限制等項安全功能。

使用者利用模式切換裝置17切換至自動模式(A模式)，由使用者藉控制器12控制機器人11進行自動作業。由於自動模式，因自動移動對使用者危害較大，安全模組14將手動高速模式可預設例如為零類安全狀態為斷電停機功能，另需監控機器人11自動作業是否異常，因此當自動運行為協作情境時，需啟用預設安全功能單元15的機器人11末端20的空間位置限制、力量限制及速度限制等多項安全功能，而當自動模式為非協作情境時則可不啟用，以確保作業效率。

利用模式切換裝置17自手動慢速模式或手動高速模式或自 動模式切換至手拉模式時，機器人11自行記錄運行程序的斷點，並啟動手拉模式預先設定的二類安全狀態的安全模組14及多項安全功能，致能手拉功能，在維持手拉模式專用的安全系統下，由使用者手拉教導機器人11修正新作業程序後，切回各運行模式後，從中斷點繼續運行程序。前述本實施利對各運行模式預設的安全模式及安全功能為舉例說明，本發明包含且不限於本實施例的設定項目。

如圖4所示，為本發明教導機器人的安全方法的流程圖。本發明教導機器人的安全方法的詳細步驟說明如下：步驟S1，依照機器人各種運行模式的需要，預設各教導模式相對應的安全模組的安全狀態種類；步驟S2，依照機器人各種運行模式的需要，預設各運行模式相對應的安全模組的安全功能；步驟S3，進行切換模式；步驟S4，檢查切換的模式是否為自動模式？假如切換的模式不為自動模式，則至步驟S5，再檢查切換的模式是否為手拉模式？假如切換的模式為手拉模式，則至步驟S6，進入手拉模式；至步驟S7，啟動該模式預設相對應的安全模組，停機機器人進入安全狀態；再至步驟S8，啟動該模式預設相對應的安全功能，監控機器人；接著在步驟S9，使致能裝置致能，在步驟S10，偵測致能裝置的開狀態，解除機器人的安全狀態，進行教導機器人作業，然後至步驟S11，檢查機器人的是否完成作業？假如機器人完成作業，則至步驟S12，結束作業，假如機器人未完成作業，則回至步驟S3，繼續切換模式。

在步驟S4，檢查切換的模式為自動模式時，則至步驟S13，進入自動模式，接著至步驟S14，啟動自動模式預設相對應的安全模組及安全功能，監控機器人，進行機器人自動作業，然後回至步驟S11，繼續作業。

在步驟S5，檢查切換的模式不為手拉模式時，則至步驟S15，檢查切換的模式是否為手動高速模式？假如檢查切換的模式為手動高速模式，則至步驟S16，進入手動高速模式，然後回至步驟S7，繼續作業，假如檢查切換的模式不為手動高速模式，則至步驟S17，進入手動低速模式，然後回至步驟S7，繼續作業。

因此，本發明的教導機器人的安全系統及方法，就可藉由模式切換裝置切換機器人的多種運行模式，並配合致能裝置，啟用相對應各教導模式預設不同的安全模組及安全功能，達到方便切換多種運行模式的目的。此外，本發明的教導機器人的安全方法，利用預設各運行模式相對應的安全模組及安全功能切換機器人，建構各運行模式適合的安全系統，同時確保在各種運行模式切換至手拉模式時，都能維持手拉模式專有的安全模組及安全功能，達到提升使用者的安全性的目的。

以上所述者，僅為用以方便說明本發明之較佳實施例，本發明之範圍不限於該等較佳實施例，凡依本發明所做的任何變更，於不脫離本發明之精神下，皆屬本發明申請專利之範圍。

10:安全系統

11:機器人

12:控制器

13:示教器

14:安全模組

15:安全功能單元

16:致能裝置

17:模式切換裝置

18:肘節

19:基座

20:末端

21:位置感測器

Claims (15)

1. 一種教導機器人的安全系統，包含：機器人，具有多肘節，一端為活動的末端，該各肘節中設置致動器及位置感測器；控制器，連接該機器人，控制該致動器及該位置感測器，移動該機器人的末端；致能裝置，連接至該控制器；安全模組，設於該控制器內，與該致能裝置電性或通訊相連，依據該致能裝置開關狀態，發出電性或通訊訊號，關狀態使該機器人進入安全狀態，開狀態取消該機器人安全狀態；安全功能單元，設於該控制器內，與該安全模組電性或通訊相連，監控的該機器人的安全功能超過預設限制時，讓安全模組使機器人進入安全狀態；模式切換裝置，與該控制器、該安全模組及該安全功能單元電性或通訊相連，切換該機器人的運行模式；其中，該模式切換裝置在機器人的至少一手拉模式，以及自動模式或手動低速模式或手動高速模式之運行模式間進行切換，該安全模組及該安全功能單元啟用相對應各運行模式預設的安全模組及安全功能。
2. 如申請專利範圍第1項所述之教導機器人的安全系統，其中該手拉模式須按壓該致能裝置以手拉牽引該機器人。
3. 如申請專利範圍第1項所述之教導機器人的安全系統，其中該安全模組電性或通訊連接該機器人各該肘節之該位置感測器，接收該位置感測器的訊 號進行監控該機器人。
4. 如申請專利範圍第3項所述之教導機器人的安全系統，其中該安全模組至少包含以下一種安全狀態類型，零類安全狀態為斷電停機功能，進入安全狀態時，直接關斷該致動器電力，一類安全狀態為進階斷電停機功能，進入安全狀態時，對該控制器下達減速命令後，經過固定時間該機器人減速運動達成後，關斷該致動器電源，二類安全狀態為非斷電停機功能，進入安全狀態時，對該控制器下達減速命令後，經過固定時間該機器人減速運動達成後，開啟靜止監控安全功能，持續監控該位置感測器，當監控該機器人產生運動，即關斷該致動器電源。
5. 如申請專利範圍第1項所述之教導機器人的安全系統，其中該安全功能單元啟動至少一項以上的下列安全功能：肘節之角度限制、機器人末端的空間位置限制、力量限制或速度限制。
6. 如申請專利範圍第1項所述之教導機器人的安全系統，其中該模式切換裝置設於該機器人的示教器，或由該控制器外接。
7. 如申請專利範圍第1項所述之教導機器人的安全系統，其中該模式切換裝置為多位置旋鈕，透過旋鈕位置標示模式，或以燈號顯示模式。
8. 如申請專利範圍第1項所述之教導機器人的安全系統，其中該模式切換裝置為純軟體按鍵、或硬體按鍵組合、或軟體與硬體組合按鍵。
9. 一種教導機器人的安全方法，包含：預設各運行模式相對應的安全模組；預設各運行模式相對應的安全功能；進行切換模式； 檢查切換的模式為手拉模式；進入該手拉模式；啟用該手拉模式預設相對應的安全模組及安全功能，停機機器人進入安全狀態；使致能裝置致能；偵測該致能裝置的開狀態，解除機器人的安全狀態，進行教導該機器人作業。
10. 如申請專利範圍第9項所述之教導機器人的安全方法，其中進行作業後，檢查該機器人完成作業，則結束作業，未完成作業則回至切換模式繼續作業。
11. 如申請專利範圍第10項所述之教導機器人的安全方法，其中該檢查切換的模式為自動模式時，則進入自動模式，啟動該自動模式預設相對應的安全功能，監控機器人，進行機器人自動作業。
12. 如申請專利範圍第9項所述之教導機器人的安全方法，其中該檢查切換的模式為手動低速模式或手動高速模式時，啟動該手動低速或手動高速模式預設相對應的安全功能，監控機器人，進行機器人教導或試跑作業。
13. 如申請專利範圍第12項所述之教導機器人的安全方法，其中自該手動低速模式或該手動高速模式或一自動模式切換至該手拉模式時，該機器人自行記錄運行程序的斷點，並啟動該手拉模式預先設定的的安全模組及安全功能，手拉教導該機器人作業後，切回各運行模式後，從中斷點繼續運行程序。
14. 如申請專利範圍第9項所述之教導機器人的安全方法，其中進入該手拉模 式，至少持續按壓該致能裝置，解除安全狀態，並致能手拉功能。
15. 如申請專利範圍第9項所述之教導機器人的安全方法，其中該安全模組及安全功能，啟用與否及限制值，依該機器人各運行模式的需求預先設定。

Images