TWI751890B - 機械臂校正方法 - Google Patents

Abstract

一種機械臂校正方法，用以解決習知必須針對每個機械臂來個別進行位置校正的問題。係包含：提供一校正件，該校正件具有一原點基準部；將一機械臂以該校正件之原點基準部由至少三個任意方向朝一定位件進行位移，並對位於該定位件以定位出一基準點；及使該校正件相對於該定位件，分別由該原點基準部朝互相垂直的兩方向進行位移並定位出兩坐標軸以獲得一三維座標空間。

Description

機械臂校正方法

本發明關於一種機械臂校正方法，尤其是一種定位機械臂與工件相對位置的校正方法。

現今自動化產業中，以機械臂來進行各種工件的加工，例如，研磨、焊接等加工作業，一般來說，該機械臂在對工件進行自動加工前，需先對該機械臂與工件的位置關係進行校正，例如，該機械臂位移至工件的距離，加工位置的指定等設定，但是，通常以絕對座標來進行上述該機械臂與工件位置關係的校正，即，當以不同位置的機械臂以及不同擺放位置的工件進行加工作業時，必須針對每個機械臂以及該機械臂所加工的工件來個別進行位置的校正，導致進行生產時的前製作業過於繁雜，尤其是機械臂的機台位置需要移動時，也必須重新調整，因而浪費大量的時間。

有鑑於此，習知機械臂的校正作業確實仍有加以改善之必要。

為解決上述問題，本發明的目的是提供一種機械臂校正方法，係可以提升整體作業效率者。

本發明全文所述方向性或其近似用語，例如「前」、「後」、「左」、「右」、「上(頂)」、「下(底)」、「內」、「外」、「側面」 等，主要係參考附加圖式的方向，各方向性或其近似用語僅用以輔助說明及理解本發明的各實施例，非用以限制本發明。

本發明全文所記載的元件及構件使用「一」或「一個」之量詞，僅是為了方便使用且提供本發明範圍的通常意義；於本發明中應被解讀為包括一個或至少一個，且單一的概念也包括複數的情況，除非其明顯意指其他意思。

本發明全文所述「結合」、「組合」或「組裝」等近似用語，主要包含連接後仍可不破壞構件地分離，或是連接後使構件不可分離等型態，係本領域中具有通常知識者可以依據欲相連之構件材質或組裝需求予以選擇者。

本發明的機械臂校正方法，包含：提供一校正件，該校正件具有一原點基準部、一第一軸基準部及一第二軸基準部，該校正件形成一第一軸線，該第一軸線通過該第一軸基準部與該原點基準部，該校正件還形成一第二軸線，該第二軸線通過該第二軸基準部與該原點基準部，該第一軸線與該第二軸線互相垂直；將一機械臂以該校正件的原點基準部由至少三個任意方向朝一定位件進行位移，並對位於該定位件以定位出一基準點；及使該校正件相對於該定位件，分別由該原點基準部朝互相垂直的兩方向進行位移並定位出兩坐標軸以獲得一三維座標空間。

據此，本發明的機械臂校正方法，通過預先建立該三維空間，便可以將該三維座標空間的原點套用至預定位置或預定工件上，立即於該預定位置或該預定工件形成加工運作程式動作的該三維座標空間，藉此，通過機械臂與工件的相對位置進行辨識，而非習知絕對位置定位，本發明機械臂校正方法不需針對每一個機台重新手動定位，可以達到提升生產效率的功效。

其中，該校正件呈L型，以於L型的該校正件的兩端分別具有 該第一軸基準部及該第二軸基準部，並於L型的該校正件的直角處具有該原點基準部。如此，具有方便使用者辨識的功效。

其中，該第一軸基準部與該原點基準部之間的距離，以及該第二軸基準部與該原點基準部之間的距離為80~120mm。如此，具有方便使用者辨識的功效。

其中，由該原點基準部朝該第一軸基準部的方向位移，使該定位件的一針尖部對位於該第一軸基準部以定位出該第一軸線，並重新由該原點基準部朝該第二軸基準部的方向位移，使該針尖部對位於該第二軸基準部以定位出該第二軸線。如此，該第一軸線及該第二軸線可以分別作為該三維座標空間中的其中兩坐標軸，具有可得知第三坐標軸的功效。

其中，以至少三個預定位置為起始位，由一第一起始位朝該定位件位移並對位後，由該定位件往一第二起始位的方向移動以到達該第二起始位，再由該第二起始位朝該定位件位移並對位後，由該定位件往一第三起始位的方向移動以到達該第三起始位，並由該第三起始位朝該定位件位移。如此，通過數次從不同方向及位置進行該定位件的對位，以使該機械臂能夠對該定位件的位置進行識別，具有提升該機械臂對該定位件的識別性的功效。

1:校正件

11:原點基準部

12:第一軸基準部

13:第二軸基準部

2:定位件

21:針尖部

S1:第一軸線

S2:第二軸線

S3:第三軸線

M:機械臂

〔第1圖〕本發明機械臂校正方法之校正件對位於定位件示意圖。

為讓本發明之上述及其他目的、特徵及優點能更明顯易懂，下文特舉本發明之較佳實施例，並配合所附圖式，作詳細說明如下： 請參照圖1所示，其係本發明機械臂校正方法的一較佳實施例，包含將一機械臂M以一校正件1由至少三個方向對位於一定位件2以進行定位，及使該校正件1相對於該定位件2分別朝互相垂直的兩方向進行位移以定位出兩坐標軸。

該機械臂M可以為用以對工件進行加工的工具機，例如該機械臂M可以具有研磨件、焊槍或夾爪等加工構造，通過該機械臂M帶動該加工構造以對一工件進行加工，由此，可以將該校正件1結合於該機械臂M，以該校正件1作為上述加工構造，借此對該機械臂M的移動位置進行校正，以及定位該機械臂M的移動位置。

詳言之，該校正件1可以具有一原點基準部11，該原點基準部11用以定位一三維座標空間中原點的位置，本實施例中，該原點基準部11可以為一針尖，藉此可以精確的以該針尖標示原點在該三維座標空間中的位置。以該原點基準部11可以延伸互相垂直的兩個方向，以定位出該三維座標空間中的其中任兩軸，舉例而言，能夠以該原點基準部11往兩個互相垂直的方向延伸以定位出X軸及Y軸、X軸及Z軸或者Y軸及Z軸，此時，即可以同時定位出垂直于上述任兩軸的一第三軸，即垂直於X軸及Y軸的Z軸、垂直於X軸及Z軸的Y軸或者垂直於Y軸及Z軸的X軸，本發明不予限制，藉此，即可以通過該校正件1定位出用以供該機械臂M位移的該三維座標空間。

本實施例中，該校正件1可以具有一第一軸基準部12及一第二軸基準部13，該第一軸基準部12及該第二軸基準部13同樣可以為一針尖，使該校正件1形成一第一軸線S1，該第一軸線S1通過該第一軸基準部12與該原點基準部11，該校正件1還可以形成一第二軸線S2，該第二軸線S2通過該第二軸基準部13與該原點基準部11，該第一軸線S1與該第二軸線 S2互相垂直，藉此，該第一軸線S1及該第二軸線S2可以分別作為該三維座標空間中的其中兩坐標軸，並可得知第三坐標軸。另外，較佳地，該校正件1可以呈L型，以於L型的該校正件1的兩端分別具有該第一軸基準部12及該第二軸基準部13，並於L型的該校正件1的直角處具有該原點基準部11，該第一軸基準部12與該原點基準部11之間的距離，以及該第二軸基準部13與該原點基準部11之間的距離可以為80~120mm，藉此，具有方便使用者辨識的作用。

該定位件2可位於一預定位置以供該校正件1進行對位，詳言之，該定位件2可以作為一參考點，使該機械臂M的原點位於該參考點，藉此，該機械臂M能夠於該定位件2形成該三維座標空間，當該機械臂M對該工件進行加工時，能夠將該工件定為該參考點，該機械臂M即能夠以該工件所形成的三維座標空間內，進行對該工件的加工，藉此，更換不同的機械臂M或改變該工件的位置時，僅需將該工件設為參考點，並給予機械臂座標位置，該機械臂即可立即以該座標位置形成該三維座標空間，並於該三維座標空間內進行該工件的加工。本實施例中，該定位件2可以具有一針尖部21，該針尖部21用以供該校正件1的針尖(即，該原點基準部11、該第一軸基準部12及該第二軸基準部13)對位。

係可以使該校正件1的原點基準部11由至少任意三處位置往該定位件2移動，並使該原點基準部11對位於該定位件2的針尖部21以對該定位件2進行識別，詳言之，能夠以人工操控該機械臂M以帶動該校正件1，以至少三個預定位置為起始位，該三個起始位分別與該定位件2具有三個預定距離，該三個起始位的位置以該機械臂M能夠位移的距離及位置即可，本發明不需特定該三個起始位的位置，依序由該三個起始位朝該定位件2進行位移，以對位於該針尖部21。

舉例而言，可以由一第一起始位朝該定位件2位移並對位後，由該定位件2往一第二起始位的方向移動以到達該第二起始位，再由該第二起始位朝該定位件2位移並對位後，由該定位件2往一第三起始位的方向移動以到達該第三起始位，最後由該第三起始位朝該定位件2位移並對位以完成對該定位件2的識別。藉此，可以使該校正件1的原點基準部11能夠精確對位於該定位件2的針尖部21，即，通過數次從不同方向及位置進行該針尖部21的對位，以使該機械臂M能夠對該定位件2的位置進行識別。值得注意的是，也可以由四處以上的位置進行該針尖部21的對位，以提升該機械臂M對該定位件2的識別性，本發明不予限制。

當該校正件1與該針尖部21識別完成後，續將該校正件1相對於該定位件2進行位移，以定位出該第一軸線S1及該第二軸線S2，詳言之，能夠使該機械臂M帶動該校正件1進行位移，以由該原點基準部11朝該第一軸基準部12的方向位移，使該定位件2的針尖部21對位於該第一軸基準部12即可定位出該第一軸線S1。續可以重新由該原點基準部11朝該第二軸基準部13的方向位移，使該定位件2的針尖部21對位於該第二軸基準部13即可定位出該第二軸線S2，舉例而言，該校正件1可以沿原方向位移，以使該定位件2的針尖部21退回至該原點基準部11的位置，再由該原點基準部11朝該第二軸基準部13的方向位移以定位出該第二軸線S2，或者，可以使該校正件1位移離開該定位件2，再重新由該原點基準部11回到該定位件2的位置，以進行朝該第二軸基準部13的方向位移以定位出該第二軸線S2，本發明不予限制。據此，可以通過定位出互相垂直的該第一軸線S1及該第二軸線S2即可以獲得同時垂直於該第一軸線S1及該第二軸線S2的一第三軸線S3，且該第三軸線S3通過該原點基準部11，即X、Y及Z軸以形成該三維座標空間。

根據本發明的機械臂校正方法，預先將該機械臂M結合該校正件1進行定位，可以將該定位件2視為欲進行加工的工件，通過該校正件1對位於該定位件2以作為參考點，定出三維座標空間的原點，並可以從該原點分別沿該校正件1的第一軸基準部12及第二軸基準部13定位出第一軸線S1及該第二軸線S2，以將該第一軸線S1及該第二軸線S2作為三維座標空間的其中兩軸，即可推出垂直於該第一軸線S1及該第二軸線S2的該第三軸線S3，並將該第三軸線S3作為三維座標空間的第三軸，最終可以建立以該定位件2(即工件)為原點的三維座標空間，欲先設置於該機械臂M內的加工運作程式即可依照該三維座標空間進行運作，當需使用多個機械臂M時(例如多個焊接用工具機)，僅需要分別給予各機械臂M所要加工的工件的座標，該機械臂M即能夠以該座標為原點，套用上述校正後的三維座標空間，並立即可以執行加工運作程式。

綜上所述，本發明的機械臂校正方法，藉由預先建立該三維座標空間，便可以將該三維座標空間的原點套用至預定位置或預定工件上，立即於該預定位置或該預定工件形成加工運作程式動作的該三維座標空間，藉此，通過機械臂與工件的相對位置進行辨識，而非習知絕對位置定位，本發明機械臂校正方法不需針對每一個機台重新手動定位，可以達到提升生產效率的功效。

雖然本發明已利用上述較佳實施例揭示，然其並非用以限定本發明，任何熟習此技藝者在不脫離本發明之精神和範圍之內，相對上述實施例進行各種更動與修改仍屬本發明所保護之技術範疇，因此本發明之保護範圍當視後附之申請專利範圍所界定者為準。

1:校正件

11:原點基準部

12:第一軸基準部

13:第二軸基準部

2:定位件

21:針尖部

S1:第一軸線

S2:第二軸線

S3:第三軸線

M:機械臂

Claims (5)

1. 一種機械臂校正方法，包含：提供一校正件，該校正件具有一原點基準部、一第一軸基準部及一第二軸基準部，該校正件形成一第一軸線，該第一軸線通過該第一軸基準部與該原點基準部，該校正件還形成一第二軸線，該第二軸線通過該第二軸基準部與該原點基準部，該第一軸線與該第二軸線互相垂直；將一機械臂以該校正件之原點基準部由至少三個任意方向朝一定位件進行位移，並對位於該定位件以定位出一基準點；及使該校正件相對於該定位件，分別由該原點基準部朝互相垂直的兩方向進行位移並定位出兩坐標軸以獲得一三維座標空間。
2. 如請求項1之機械臂校正方法，其中，該校正件呈L型，以於L型的該校正件的兩端分別具有該第一軸基準部及該第二軸基準部，並於L型的該校正件的直角處具有該原點基準部。
3. 如請求項1之機械臂校正方法，其中，該第一軸基準部與該原點基準部之間的距離，以及該第二軸基準部與該原點基準部之間的距離為80~120mm。
4. 如請求項1之機械臂校正方法，其中，由該原點基準部朝該第一軸基準部的方向位移，使該定位件的一針尖部對位於該第一軸基準部以定位出該第一軸線，並重新由該原點基準部朝該第二軸基準部的方向位移，使該針尖部對位於該第二軸基準部以定位出該第二軸線。
5. 如請求項1之機械臂校正方法，其中，以至少三個預定位置為起始位，由一第一起始位朝該定位件位移並對位後，由該定位件往一第二起始位的方向移動以到達該第二起始位，再由該第二起始位朝該定位件位移並對位後，由該定位件往一第三起始位的方向移動以到達該第三起始位，並 由該第三起始位朝該定位件位移。

Images