TWI758626B - 機器手臂的視覺系統定位方法 - Google Patents

Abstract

一種機器手臂的視覺系統定位方法，在視覺系統的數個Z軸高度擺設標準校正板，建立及儲存不同Z軸高度的影像平面資訊，由偵測貼設在作業平面的圖標，決定作業平面與視覺系統需要的資訊，套用儲存中最接近的影像平面資訊，移動視覺系統至套用影像平面資訊的Z軸高度進行拍攝，以快速定位。

Description

機器手臂的視覺系統定位方法

本發明有關一種機器手臂，尤其關於機器手臂的視覺系統針對作業平面，進行快速精確定位的方法。

隨著工業生產技術的快速發展，工廠自動化利用機器手臂的視覺系統定位工件之位置和姿態，引導機器手臂自動精確抓取工件，進行組裝製造，以提高精密快速生產的效率。而影響機器手臂自動精確移動的主要關鍵在於引導定位的視覺系統，提升視覺系統精確定位，減少引導機器手臂的誤差，為機器手臂重要的課題。

請參考圖10，為先前技術機器手臂10的定位示意圖。其中機器手臂10一端固定在本體11，另一端為活動部12，活動部12上固定例如手眼相機(Eye In Hand)的視覺系統13。機器手臂10經由驅動多肘節14，控制移動另一端活動部12承載的視覺系統13，用以拍攝活動部12前方的影像，定位工件15，並引導機器手臂10接近及取放工件15。當機器手臂10安裝至生產線時，需進行定位校正作業，以確保作業精密度。機器手臂10定位校正時，為避免妨礙定位校正，首先需清理工作機台16空出較大的位置，以利將標準矩形棋盤格狀的校正板17固定在工作機台16的作業平面18。

進行定位校正時，藉由機器手臂10活動部12上的視覺系統13 拍攝影像，引導移動機器手臂10帶動視覺系統13在預設位置接近並對正校正板17，聚焦拍攝的校正板17的影像。根據拍攝的校正板17的影像，偵測視覺系統13相對校正板17的Z軸高度、方向及校正板17各格點的平面X、Y軸座標。為了減少定位的誤差，機器手臂10需在預設的多個不同位置上，一一執行前述校正動作，進行比對調整。由於標準的校正板17的棋盤格點距離一定，可避免拍攝的校正板17影像周邊扭曲變形所造成的定位誤差，以精確定位作業平面18的平面座標。最後撤除校正板17，重新在工作機台16的作業平面18放置工件15，機器手臂10在預設點利用視覺系統13拍攝作業平面18影像，就可精確定位工件15在作業平面18的座標，以正確取放工件15。

然而，先前技術的機器手臂定位校正時，需大費周章清空工作機台，才能放置較大的校正板，且機器手臂需移動至在預設的多個位置上一一執行校正，定位校正的作業過於耗時繁瑣，而對於已放置大型工件的工作機台更不容易執行定位校正，嚴重影響生產效率。雖然另有例如美國公告專利案US6885759，利用小型的校正板，放置在作業平面的一角，進行影像偵測定位校正，以改進前述缺點。但是小型的校正板相對作業平面面積過小，利用小型的校正板推演至較大的作業平面，無法大量降低作業平面的定位誤差。因此，機器手臂的視覺系統在定位的方法上，仍有問題亟待解決。

本發明的目的提供一種機器手臂的視覺系統定位方法，藉由機器手臂在視覺系統的預設數個Z軸高度擺設標準校正板，建立及儲存不同 Z軸高度的影像平面資訊，再根據視覺系統與作業平面的需要影像平面資訊，直接套用儲存最接近的影像平面資訊，使機器手臂視覺系統精確定位作業平面。

本發明的另一目的提供一種機器手臂的視覺系統定位方法，在作業平面上貼設圖標，機器手臂移動視覺系統至需要的作業高度拍攝圖標，對正視覺系統影像平面，並偵測視覺系統與作業平面的Z軸高度，套用儲存中最接近的Z軸高度的影像平面資訊，以快速定位作業平面。

本發明的再一目的提供一種機器手臂的視覺系統定位方法，利用輸入的作業平面長寬加上預留周邊距離，形成預設機器手臂視覺系統的視野，套用儲存中最接近的視野的影像平面資訊，以正確定位作業平面。

為了達到前述發明的目的，本發明的機器手臂的視覺系統定位方法，本發明機械手臂的視覺系統定位方法，在預設數個不同的視覺系統Z軸高度擺設標準校正板，利用視覺系統分別拍攝標準校正板建立影像平面的資訊，並儲存各Z軸高度的影像平面資訊，再偵測視覺系統與作業平面的資訊，其中作業平面可為工作機台或工件上的平面，依偵測的資訊套用儲存中最接近的影像平面資訊，接著依套用的影像平面資訊的Z軸高度，移動視覺系統距離作業平面Z軸高度進行拍攝影像，將套用的影像平面資訊的X、Y軸座標重疊至拍攝影像進行定位作業平面。

本發明機械手臂的視覺系統定位方法，在偵測視覺系統與作業平面的資訊時，將圖標貼置於作業平面，並移動視覺系統使圖標進入視覺系統的視野，根據拍攝圖標影像，計算圖標在手臂座標系統的座標、 位置及姿態，決定作業平面與視覺系統的相對位置的資訊。其中標準校正板為矩形棋盤格狀，而圖標為小型且具方向性的校正板。根據圖標提供的方位，可使視覺系統對正作業平面，確保視覺系統拍攝的影像平面平行作業平面。

本發明機械手臂視覺系統的定位方法，偵測的資訊為視覺系統與圖標的高度資訊，以作為作業平面與視覺系統間的高度資訊，根據偵測高度，由儲存的影像平面資訊比對最接近的Z軸高度，套用該Z軸高度的影像平面資訊。另一實施例偵測的資訊為利用預先量測輸入的作業平面的長寬及預設加大的周邊距離，計算需要的視覺系統視野，再根據該計算需要的視覺系統視野，比對儲存影像平面資訊中的視野，套用最接近的視野的影像平面資訊。

本發明機械手臂視覺系統的定位方法，對擺設在視覺系統Z軸高度的標準校正板，由機器手臂的視覺系統拍攝影像，根據拍攝的標準校正板影像，偵測在標準校正板的方向及各格點的座標，推演至標準校正板同一平面的X、Y軸座標，建立視覺系統的視覺座標系統在Z軸高度的影像平面及視野，形成Z軸高度的影像平面資訊。

20:機器手臂

21:基座

22:軸節

23:活動部

24:視覺系統

25:致動馬達

26:標準校正板

27:工作機台

28,32:作業平面

29,31:工件

30:圖標

圖1 為本發明機器手臂建立視覺系統影像平面的示意圖。

圖2 為本發明視覺系統建立數個Z軸高度的影像平面的示意圖。

圖3 為本發明視覺系統定位作業平面的示意圖。

圖4 為本發明視覺系統進行定位的示意圖

圖5 為本發明機械手臂視覺系統的定位方法的流程圖。

圖6為本發明另一實施例設定視覺系統視野的示意圖。

圖7為本發明另一實施例比對視野套用儲存影像平面的示意圖。

圖8 為本發明另一實施例機械手臂視覺系統的定位方法的流程圖。

圖9 為本發明另一實施例作業平面的定位示意圖。

圖10 為先前技術機械手臂視覺系統的定位校正示意圖。

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

請同時參圖1至圖4，圖1為本發明機器手臂建立視覺系統影像平面的示意圖，圖2為本發明視覺系統建立數個Z軸高度的影像平面的示意圖，圖3為本發明視覺系統定位作業平面的示意圖，圖4為本發明視覺系統進行定位的示意圖。圖1中，本發明的機器手臂20一端為固定的基座21，串接多軸節22形成另一端活動的活動部23，活動部23上設相對位置固定的視覺系統24，各軸節22設致動馬達25。機器手臂20經由控制各軸節22的致動馬達25轉動，移動機器手臂20活動部23承載的視覺系統24，進行拍攝影像，由拍攝影像的景深，形成視覺系統24的視覺座標系統V。本發明的機器手臂20利用固定的基座21作為基準點，形成機器手臂20的手臂座標系統R。並藉由機器手臂20已知的各軸節22與活動部23的長度，以及控制各肘節22致動馬達25轉動的角度，計算出活動部23在座標系統R的移動座標。由於活動部23與視覺系統24相對位置固定，手臂座標系統R與視覺座標系統V具有一定轉換關係，因此機器手臂20可依據視覺座標系統V的座標移動活動部 23。

本發明機器手臂20的視覺系統24在預先建立定位作業平面28時，先將矩形棋盤格狀的標準校正板26固定在工作機台27的作業平面28，藉由機器手臂20活動部23上的視覺系統24拍攝影像，引導移動機器手臂20帶動視覺系統24，在視覺座標系統V的相對標準校正板26的預設Z軸高度H對正標準校正板26，拍攝標準校正板26的影像。根據拍攝的標準校正板26的影像，偵測在預設Z軸高度H的標準校正板26的方向及各格點的座標，推演至標準校正板26同一平面的X、Y軸座標，建立視覺座標系統V在預設Z軸高度H的影像平面P及視野F，並加以儲存為預設Z軸高度H的影像平面資訊。同理，在圖2中，預設複數個不同高度的Z軸高度H1,H2,H3，一一執行相同前述的機器手臂20視覺系統24拍攝標準校正板26影像，進行定位作業平面28的作業，建立視覺座標系統V在各預設Z軸高度H1,H2,H3的影像平面P1,P2,P3及視野F1,F2,F3，並儲存各預設Z軸高度H1,H2,H3的影像平面資訊。

圖3中，本發明機器手臂20的視覺系統24在定位作業平面28時，不須清空作業平面28上的工件29，直接將小型且具方向性校正板的圖標30貼放在工作機台27的作業平面28，本實施例將圖標30對正相對位置較易區別的作業平面28的角落，但包含且不限於本實施例圖貼放標30的位置。本發明藉由移動機器手臂20的視覺系統24至需要的作業高度，並讓圖標30進入移視覺系統24的視野，機器手臂20利用視覺系統24拍攝圖標30，引導視覺系統24移動接近圖標30，拍攝圖標30的影像。再根據拍攝的圖標30影像，計算圖標30在手臂座標系統R的座標，包含位置以及姿態，決定作業平面28與視覺系統24的相對位置，進而獲得視覺系統24與圖標30間的高 度D資訊，以作為作業平面28與視覺系統24的高度D資訊。

圖4中，本發明根據視覺系統24與圖標30間的偵測高度D，由預先儲存的複數個影像平面P資訊比對最接近的Z軸高度，套用該Z軸高度H的影像平面P，再根據前述偵測圖標30定位的作業平面28，機器手臂20隨即依套用的影像平面P，移動視覺系統24距離作業平面28的Z軸高度H進行拍攝影像，將套用的影像平面資訊的X、Y軸座標重疊至拍攝影像，由工件29所在套用影像平面P的X、Y軸座標，快速精確的定位工件29。

如圖5所示，為本發明機械手臂視覺系統的定位方法的流程圖。本發明機械手臂視覺系統的定位方法的詳細流程說明如下：在步驟S1，機器手臂在預設數個不同的視覺系統Z軸高度擺設標準校正板；步驟S2，利用視覺系統分別拍攝標準校正板建立影像平面的資訊；步驟S3，儲存各Z軸高度的影像平面資訊；接著步驟S4，偵測視覺系統與作業平面的資訊，依據偵測的資訊套用儲存的最接近的影像平面資訊；最後在步驟S5，機器手臂依套用的影像平面資訊的Z軸高度，移動視覺系統距離作業平面Z軸高度進行拍攝影像，將套用的影像平面資訊的X、Y軸座標重疊至拍攝影像進行定位。

請同時參圖3、圖6及圖7，圖6為本發明另一實施例設定視覺系統視野的示意圖，圖7為本發明另一實施例比對視野套用儲存影像平面的示意圖。為簡化說明，本實施例與前實施例相同的構件沿用相同件號。由於前述實施例預先儲存的複數個影像平面P，具有與視覺系統24不同的預設Z軸高度H，Z軸高度H越小者越接近視覺系統24，雖然定位精確度較高，但其影像平面P被視覺系統24拍攝作業平面28的視野F越小，反之則Z軸高度H 越大者越遠離視覺系統24，雖然定位精確度較差，但其影像平面P被視覺系統24拍攝作業平面28的視野F越大，會受到定位精度的限制，因此視野F的大小與Z軸高度H具有相對應的關係(參圖2)，本實施例利用偵測視野F也可獲得相對的Z軸高度H。

圖3中，本實施例同樣將圖標30貼放在工作機台27的作業平面28，藉由移動機器手臂20讓圖標30進入移視覺系統24的視野，引導視覺系統24移動接近圖標30，拍攝圖標30的影像。再根據拍攝的圖標30影像，計算圖標30在手臂座標系統R的座標，包含位置以及姿態，進而獲得作業平面28與手臂座標系統R的相對位置。另外，圖3中，機器手臂20也能根據圖標30提供的方位，進一步加強視覺系統24對正作業平面28，確保視覺系統24拍攝的影像平面平行作業平面28，讓套用的影像平面P更加精確。

圖6中，使用機器手臂20定位時，可移除業平面28上的圖標，本發明再藉由使用者預先輸入需要作業平面28的長(L)與寬(W)，並預設作業平面28周邊視野加大周邊距離K，經機器手臂20計算需要視野F的大小。圖7中，根據需要視野F，由預先儲存的複數個影像平面P資訊比對大小最接近的視野F，套用該影像平面P，再根據前述偵測圖標30定位的作業平面28，機器手臂20隨即依套用的影像平面P的Z軸高度H，移動視覺系統24距離作業平面28的Z軸高度H進行拍攝影像，將套用的影像平面資訊的X、Y軸座標重疊至拍攝影像，由工件29所在套用影像平面P的X、Y軸座標，快速精確的定位工件29。

如圖8所示，為本發明另一實施例機械手臂視覺系統的定位方法的流程圖。本發明另一實施例機械手臂視覺系統的定位方法的詳細流 程說明如下：在步驟T1，機器手臂在預設數個不同的視覺系統Z軸高度擺設標準校正板；步驟T2，利用視覺系統分別拍攝標準校正板建立影像平面的資訊；步驟T3，儲存各Z軸高度的影像平面資訊；步驟T4，將圖標貼置於作業平面，並移動視覺系統使圖標進入視覺系統的視野；接著步驟T5，拍攝圖標影像，以計算作業平面與視覺系統的相對位置關係；步驟T6，利用輸入作業平面的長寬及預設的周邊距離，計算需要視覺系統視野；在步驟T7，比對儲存影像平面資訊中的視野，套用最接近尺寸的視野的影像平面資訊；最後在步驟T8，機器手臂依套用的影像平面資訊的Z軸高度，移動視覺系統距離作業平面Z軸高度進行拍攝影像，將套用的影像平面資訊的X、Y軸座標重疊至拍攝影像進行定位。

如圖9所示，為本發明另一實施例作業平面定位的示意圖。前實施例本發明機械手臂視覺系統的定位方法，雖以定位工作機台上的作業平面為例說明，但本發明包含且不限於工作機台的作業平面。圖9中，以工件31的作業平面32舉例，直接將圖標30貼放在工件31的作業平面32，由機器手臂20上的視覺系統24拍攝圖標30的影像，計算圖標30的方位，進而定位作業平面32與視覺系統24的相對位置。測量作業平面32與視覺系統24的偵測高度D，或輸入作業平面32的長(L)與寬(W)，由預設視野加大周邊距離K，計算需要視野F的大小，比對套用最接近的儲存影像平面P資訊，機器手臂就可依套用的影像平面P資訊，移動視覺系統至作業平面32的Z軸高度進行拍攝及定位作業平面32。因此，凡在機器手臂20作業環境中的任一平面，本發明均可適用以定位。

因此，本發明機器手臂的視覺系統定位方法，就可藉由機器 手臂在視覺系統的預設數個Z軸高度擺設標準校正板，預先建立及儲存不同Z軸高度的影像平面資訊。在定位時，偵測作業平面上的圖標，加強視覺系統平行作業平面，並決定作業平面與視覺系統的相對位置，再根據視覺系統與作業平面需要的影像平面資訊，例如偵測Z軸高度，或利用輸入的作業平面長寬加上預留周邊距離形成需要的視野等影像平面資訊，直接套用儲存中最接近的Z軸高度或視野的影像平面資訊，再移動視覺系統至套用的影像平面Z軸高度進行拍攝定位，達到本發明精確快速定位作業平面的發明目的。

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

20‧‧‧機器手臂

24‧‧‧視覺系統

26‧‧‧標準校正板

28‧‧‧作業平面

Claims (10)

1. 一種機械手臂的視覺系統定位方法，其步驟包含：機器手臂在預設數個不同的視覺系統Z軸高度擺設標準校正板，利用視覺系統分別拍攝標準校正板建立影像平面的資訊；儲存各Z軸高度的影像平面資訊；偵測視覺系統與作業平面的資訊，依偵測的資訊套用儲存中最接近的影像平面資訊；依套用的影像平面資訊的Z軸高度，移動視覺系統距離作業平面Z軸高度進行拍攝影像，將套用的影像平面資訊的X、Y軸座標重疊至拍攝影像進行定位作業平面。
2. 如申請專利範圍第1項所述之機械手臂的視覺系統定位方法，其中該偵測視覺系統與作業平面的資訊的步驟包含：將圖標貼置於作業平面，並移動視覺系統使圖標進入視覺系統的視野；根據拍攝圖標影像，計算圖標在手臂座標系統的座標、位置及姿態，決定作業平面與視覺系統的相對位置的資訊。
3. 如申請專利範圍第2項所述之機械手臂的視覺系統定位方法，其中該標準校正板為矩形棋盤格狀，而圖標為小型且具方向性的校正板。
4. 如申請專利範圍第3項所述之機械手臂的視覺系統定位方法，其中該視覺系統拍攝圖標時，根據圖標提供的方位，使視覺系統對正作業平面，確保視覺系統拍攝的影像平面平行作業平面。
5. 如申請專利範圍第3項所述之機械手臂的視覺系統定位方法，其中該偵測的資訊為視覺系統與圖標的高度資訊，以作為作業平面與視覺系統間的 高度資訊。
6. 如申請專利範圍第5項所述之機械手臂的視覺系統定位方法，其中根據該偵測高度，由儲存的影像平面資訊比對最接近的Z軸高度，套用該Z軸高度的影像平面資訊。
7. 如申請專利範圍第2項所述之機械手臂的視覺系統定位方法，其中該偵測的資訊為利用預先量測輸入的作業平面的長寬及預設加大的周邊距離，計算需要的視覺系統視野。
8. 如申請專利範圍第7項所述之機械手臂的視覺系統定位方法，其中根據該計算需要的視覺系統視野，比對儲存影像平面資訊中的視野，套用最接近的視野的影像平面資訊。
9. 如申請專利範圍第1項所述之機械手臂的視覺系統定位方法，其中該擺設在視覺系統Z軸高度的標準校正板，由機器手臂的視覺系統拍攝影像，根據拍攝的標準校正板影像，偵測在標準校正板的方向及各格點的座標，推演至標準校正板同一平面的X、Y軸座標，建立視覺系統的視覺座標系統在Z軸高度的影像平面及視野，形成Z軸高度的影像平面資訊。
10. 如申請專利範圍第1項所述之機械手臂的視覺系統定位方法，其中該作業平面為工作機台或工件上的平面。

Images