TWI703022B - 應用於機械手臂之自動復歸控制系統與方法 - Google Patents

Abstract

一種應用於機械手臂之自動復歸控制系統與方法，其系統包含一機械手臂裝置、一控制主機以及一緊急停止控制器，而該方法首先是利用控制主機之處理器執行一生產程序執行緒與一停止偵測執行緒。接著當停止偵測執行緒偵測機械手臂裝置之機械手臂停止時，處理器停止執行生產程序執行緒，並控制機械手臂復歸至初始狀態。然後當停止偵測執行緒偵測機械手臂停止解除時，處理器初始化生產程序執行緒與停止偵測執行緒。

Description

應用於機械手臂之自動復歸控制系統 與方法

本發明係關於一種機械手臂之控制系統與方法，尤其是指一種機械手臂自動復歸之控制系統與方法。

一般來說，為了提高工廠生產產品的效率，通常會在製程中使用機械手臂來完成生產的自動化；其中，由於機械手臂通常是依序執行多個動作指令來完成生產程序的動作，因此當機械手臂因緊急情況而臨時被中止動作時，必須透過現場工作人員在將緊急情況排除後，以人工的方式將機械手臂復歸至初始狀態，此時才能重新啟動用來控制機械手臂運作的程式。

舉例而言，當工作人員發現在機械手臂移動的路徑上出現障礙物時，工作人員必須即時按下緊急停止控制器，使機械手臂停止動作而避免發生工安危險，而在工作人員將障礙物排除後，由於生產程式通常包含了機械手臂由初始狀態到完成生產程序復歸至初始狀態的一連串動作指令，因此無法直接由機械手臂停止 的位置狀態繼續完成生產程序，只能由工作人員以人工操作的方式復歸至初始狀態，然後再重新執行生產程式。

承上所述，由於現有的機械手臂中斷復歸作業是由工作人員以人工的方式進行，因此無法使整個生產製造程序無人自動化的進行生產製造，而需配置現場工作人員隨時待命，不僅造成人力的浪費，還使得整體的產能無法有效提升。

有鑑於現有的機械手臂在遇到緊急情況而停止時，往往需仰賴工作人員以人工操作的方式來將機械手臂復歸至初始狀態，進而導致人力的浪費，且無法有效提升產能；緣此，本發明的主要目的在於提供一種應用於機械手臂之自動復歸控制系統與方法，藉以解決先前技術之機械手臂需以人工操作復歸的問題。

為了達到上述目的，本發明所採用之必要技術手段是提供一種應用於機械手臂之自動復歸控制方法，首先步驟(a)是利用一處理器執行一生產程序執行緒與一停止偵測執行緒，該生產程序執行緒係用以控制一機械手臂進行生產作業，該停止偵測執行緒係用以偵測該機械手臂是否停止運作；接著，步驟(b)是當該停止偵測執行緒偵測該機械手臂停止時，該處理器停止執行該生產程序執行緒，並控制該機械手臂復歸至初始狀態；然後，步驟(c)是當該停止偵測執行緒偵測該機械手臂停止解除時，該處理器初始化該生產程序執行緒與該停止 偵測執行緒。

在上述必要技術手段所衍生之一附屬技術手段中，在步驟(a)之後更包含一步驟(a1)，當該處理器接收到生產命令時，該處理器依據生產命令執行該生產程序執行緒。

在上述必要技術手段所衍生之一附屬技術手段中，在步驟(b)之前更包含一步驟(b0)，利用該處理器接收一按壓偵測單元所發送之一偵測訊號。較佳者，步驟(b)之該停止偵測執行緒係在判斷該偵測訊號為一停止訊號時，觸發急停事件產生，使該處理器依據急停事件停止執行該生產程序執行緒，並控制該機械手臂復歸至初始狀態。

在上述必要技術手段所衍生之一附屬技術手段中，在步驟(c)之前更包含一步驟(c0)，利用該處理器接收該按壓偵測單元所發送之該偵測訊號。較佳者，步驟(c)之該停止偵測執行緒係在判斷該偵測訊號為一停止解除訊號時，停止急停事件產生，使該處理器初始化該生產程序執行緒與該停止偵測執行緒。

本發明所採用之另一必要技術手段是提供一種應用於機械手臂之自動復歸控制系統，包含一機械手臂裝置、一控制主機以及一緊急停止控制器。機械手臂裝置係包含一機械手臂與一機械手臂控制器，該機械手臂控制器係電性連結於該機械手臂，並用以控制該機械手臂之運作。控制主機係電性連結於該機械手臂裝置，並具有一處理器，該處理器係在接收到一生產指令 時發送至少一動作命令訊號至該機械手臂控制器，藉以使該機械手臂控制器驅動該機械手臂執行生產作業。

緊急停止控制器係電性連結於該機械手臂裝置與該控制主機，並且包含一緊急停止按鈕以及一按壓偵測單元。緊急停止按鈕係受操作而發送一緊急停止訊號至該機械手臂裝置，藉以使該機械手臂停止運作。按壓偵測單元係用以偵測該緊急停止按鈕是否受到按壓而發送一偵測訊號至該控制主機，使該處理器依據該偵測訊號對該機械手臂進行控制。

其中，當該偵測訊號為一停止訊號時，該處理器係控制該機械手臂復歸至一初始狀態；當該偵測訊號為一停止解除訊號時，該處理器係初始化而重新運作。

在上述必要技術手段所衍生之一附屬技術手段中，該處理器內建有一生產程序執行緒與一急停偵測執行緒，該生產程序執行緒係用以控制該機械手臂進行生產作業，該停止偵測執行緒係用以偵測該機械手臂是否停止運作。

在上述必要技術手段所衍生之一附屬技術手段中，該機械手臂裝置更包含一電力供應單元，該電力供應單元係電性連結於該機械手臂，且當該機械手臂裝置接收到該一緊急停止訊號時，該電力供應單元係依據該緊急停止訊號停止供應電力至該機械手臂。

如上所述，由於本發明之應用於機械手臂之自動復歸控制系統與方法，是利用控制主機與按壓偵 測單元之配合，使得機械手臂被緊急停止時，可以藉由處理器之運作來解決先前技術之機械手臂需以人工操作復歸的問題。

100‧‧‧應用於機械手臂之自動復歸控制系統

1‧‧‧機械手臂裝置

11‧‧‧機械手臂

12‧‧‧機械手臂控制器

13‧‧‧第一傳輸單元

14‧‧‧電力供應單元

2‧‧‧控制主機

21‧‧‧處理器

211‧‧‧生產程序執行緒

212‧‧‧停止偵測執行緒

22‧‧‧第二傳輸單元

3‧‧‧緊急停止控制器

31‧‧‧緊急停止按鈕

32‧‧‧按壓偵測單元

第一圖係顯示本發明較佳實施例所提供之應用於機械手臂之自動復歸控制系統之系統示意圖；以及第二圖係顯示本發明較佳實施例所提供之應用於機械手臂之自動復歸控制方法之步驟流程圖。

下面將結合示意圖對本發明的具體實施方式進行更詳細的描述。根據下列描述和申請專利範圍，本發明的優點和特徵將更清楚。需說明的是，圖式均採用非常簡化的形式且均使用非精準的比例，僅用以方便、明晰地輔助說明本發明實施例的目的。

請參閱第一圖，第一圖係顯示本發明較佳實施例所提供之應用於機械手臂之自動復歸控制系統之系統示意圖。如圖所示，一種應用於機械手臂之自動復歸控制系統100包含一機械手臂裝置1、一控制主機2以及一緊急停止控制器3。

機械手臂裝置1包含一機械手臂11、一機械手臂控制器12、一第一傳輸單元13以及一電力供應單元14。機械手臂控制器12係電性連結於機械手臂11，並 用以控制機械手臂11之運作。第一傳輸單元13係電性連結於機械手臂控制器12，而電力供應單元14係電性連結於機械手臂11與第一傳輸單元13。在實際運用上，電力供應單元14可以是透過第一傳輸單元13或機械手臂11供電至機械手臂控制器12，或者是直接電性連結於機械手臂控制器12，意即電力供應單元14供應了整個機械手臂裝置1之電力；此外，電力供應單元14例如可以是連接外部電源之電力分配裝置，而第一傳輸單元13可以是有線的傳輸介面或無線的傳輸模組。

控制主機2包含一處理器21與一第二傳輸單元22。處理器21內建有一生產程序執行緒211與一停止偵測執行緒212。第二傳輸單元22係電性連結於處理器21與第一傳輸單元13。其中，生產程序執行緒211係用以控制機械手臂11進行生產作業，停止偵測執行緒212係用以偵測機械手臂11是否停止運作。此外，在實際運用上，處理器21係在接收到一生產指令(圖未示，可以是使用者操作控制主機2所下之指令，或者由遠端主機發送之指令)時，發送至少一動作命令訊號透過第二傳輸單元22與第一傳輸單元13傳送至機械手臂控制器12，藉以使機械手臂控制器12驅動機械手臂11執行生產作業；其中，第二傳輸單元22可以是有線的傳輸介面或無線的傳輸模組。

緊急停止控制器3包含一緊急停止按鈕31以及一按壓偵測單元32。緊急停止按鈕31係電性連結於第一傳輸單元13，而按壓偵測單元32是電性連結第二傳 輸單元22。其中，緊急停止按鈕31係受到使用者之按壓操作而發送一緊急停止訊號至機械手臂裝置1，當機械手臂裝置1接收到一緊急停止訊號時，電力供應單元14係依據緊急停止訊號停止供應電力至機械手臂11，藉以使機械手臂11停止運作。按壓偵測單元32係用以偵測緊急停止按鈕31是否受到按壓而發送一偵測訊號至控制主機2，使處理器21依據偵測訊號對機械手臂11進行控制；其中，當偵測訊號為一停止訊號時，處理器21係控制機械手臂11復歸至一初始狀態；當偵測訊號為一停止解除訊號時，處理器21係初始化而重新運作。

在本實施例中，按壓偵測單元32例如是透過電磁線圈感應緊急停止按鈕31受到按壓產生緊急停止訊號時的電流，進而發送偵測訊號經由第二傳輸單元22傳送至處理器21，但在其他實施例中，按壓偵測單元32亦可透過直接電性連結於緊急停止按鈕31來偵測緊急停止按鈕31是否受到按壓。

請一併參閱第一圖與第二圖，第二圖係顯示本發明較佳實施例所提供之應用於機械手臂之自動復歸控制方法之步驟流程圖。如圖所示，一種應用於機械手臂之自動復歸控制方法，首先步驟S101是利用處理器21初始化生產程序執行緒211與停止偵測執行緒212。

接著，步驟S102是當處理器21接收到生產命令時，執行生產程序執行緒211。然後，步驟S103是利用處理器21接收按壓偵測單元32所發送之偵測訊號。接著步驟S104是停止偵測執行緒212判斷偵測訊號是否 為停止訊號，當偵測訊號為停止訊號時，進入步驟S105；此外，當偵測訊號不是停止訊號時，則回到步驟S103，處理器21繼續接收壓偵測單元32所發送之偵測訊號。

承上所述，當停止偵測執行緒212判斷偵測訊號為停止訊號時，步驟S105為停止偵測執行緒212觸發急停事件產生，然後步驟S106為處理器21依據急停事件停止執行生產程序執行緒211，並控制機械手臂11復歸至初始狀態；其中，初始狀態是指機械手臂11的起始位置與擺設動作，例如機械手臂11之初始狀態是回到一起點，且機械手臂11之爪子為鬆開狀態，且在實際運用時，復歸的流程例如是先透過定位裝置確認手臂目前座標位置，以及透過感測器確認機械手臂11是否有抓取物件，若有抓取物件時，則先控制機械手臂11先將物件放置一臨時存放區，然後在計算出機械手臂11移動至初始狀態之位置的安全路徑。

在機械手臂11復歸至初始狀態後，步驟S107是利用處理器21接收按壓偵測單元32所發送之偵測訊號。而步驟S108是停止偵測執行緒212判斷偵測訊號是否為停止解除訊號，當偵測訊號為停止解除訊號時，則進入步驟S109。步驟S109是停止偵測執行緒212停止急停事件產生。最後步驟S110是利用處理器21初始化生產程序執行緒211與停止偵測執行緒212。藉此，當處理器21再次收到生產指令時，便能重新執行生產程序執行緒211，進而控制機械手臂11進行生產作業。

綜上所述，相較於先前技術之機械手臂在遇到緊急情況而停止時，需仰賴人工操作的方式進行復歸，導致人力浪費，且無法有效提升產能；本發明之處理器是透過與按壓偵測單元之配合，在偵測到緊急停止按鈕受到按壓時控制機械手臂復歸，並在偵測到按壓解除時，初始化處理器，藉以重新控制機械手臂執行生產程序，有效的使生產程序更加的自動化，進而有效的節省人力成本，並能有效提高產能。

上述僅為本發明較佳之實施例而已，並不對本發明進行任何限制。任何所屬技術領域的技術人員，在不脫離本發明的技術手段的範圍內，對本發明揭露的技術手段和技術內容做任何形式的等同替換或修改等變動，均屬未脫離本發明的技術手段的內容，仍屬於本發明的保護範圍之內。

Claims (4)

1. 一種應用於機械手臂之自動復歸控制方法，包含以下步驟：(a)利用一處理器執行一生產程序執行緒與一停止偵測執行緒，該生產程序執行緒係用以控制一機械手臂進行生產作業，該停止偵測執行緒係用以偵測該機械手臂是否停止運作；(b0)利用該處理器接收一按壓偵測單元偵測一受按壓操作而使該機械手臂之電力供應停止之緊急停止按鈕是否受到按壓所發送之一偵測訊號；(b)當該停止偵測執行緒判斷該偵測訊號為一停止訊號時，觸發一急停事件產生，該處理器依據該急停事件停止執行該生產程序執行緒，並控制該機械手臂復歸至初始狀態；以及(c0)利用該處理器接收該按壓偵測單元所發送之該偵測訊號；(c)當該停止偵測執行緒判斷該偵測訊號為一停止解除訊號時，停止該急停事件產生，使該處理器初始化該生產程序執行緒與該停止偵測執行緒。
2. 如申請專利範圍第1項所述之應用於機械手臂之自動復歸控制方法，其中，在步驟(a)之後更包含一步驟(a1)，當該處理器接收到一生產命令時，該處理器依據該生產命令執行該生產程序執行緒。
3. 一種應用於機械手臂之自動復歸控制系統，包含：一機械手臂裝置，係包含一機械手臂與一機械手臂控制器，該機械手臂控制器係電性連結於該機械手臂，並用以控制該機械手臂之運作；一控制主機，係電性連結於該機械手臂裝置，並具有一處理器，該處理器係在接收到一生產指令時發送至少一動作命令訊號至該機械手臂控制器，藉以使該機械手臂控制器驅動該機械手臂執行生產作業，且該處理器內建有一生產程序執行緒與一停止偵測執行緒，該生產程序執行緒係用以控制該機械手臂進行生產作業，該停止偵測執行緒係用以偵測該機械手臂是否停止運作；以及一緊急停止控制器，係電性連結於該機械手臂裝置與該控制主機，並且包含：一緊急停止按鈕，係受操作而發送一緊急停止訊號至該機械手臂裝置，藉以使該機械手臂停止運作；以及一按壓偵測單元，係用以偵測該緊急停止按鈕是否受到按壓而發送一偵測訊號至該控制主機，使該處理器依據該偵測訊號對該機械手臂進行相對應之控制；其中，當該偵測訊號為一停止訊號時，該處理器係控制該機械手臂復歸至一初始狀態；當該偵測訊號為一停止解除訊號時，該處理器係初始化而重新運 作。
4. 如申請專利範圍第3項所述之應用於機械手臂之自動復歸控制系統，其中，該機械手臂裝置更包含一電力供應單元，該電力供應單元係電性連結於該機械手臂，且當該機械手臂裝置接收到該緊急停止訊號時，該電力供應單元係依據該緊急停止訊號停止供應電力至該機械手臂。

Images