TWI701122B

TWI701122B - 多軸機械手臂系統及其路徑規劃方法

Info

Publication number: TWI701122B
Application number: TW108124956A
Authority: TW
Inventors: 黃孝維; 劉軒
Original assignee: 由田新技股份有限公司
Priority date: 2019-07-15
Filing date: 2019-07-15
Publication date: 2020-08-11
Also published as: CN112223272A; TW202103874A; CN112223272B

Abstract

本發明提供一種多軸機械手臂系統，具有多軸機械手臂及處理單元。處理單元依據起始姿態資訊、起始位置、目標姿態資訊及目標位置，計算前軸單元由起始位置至目標位置的最佳路徑資料及最佳姿態資料。處理單元會依據最佳路徑資料及最佳姿態資料，計算後軸單元由起始位置至目標位置的第二姿態資料及相應的第二路徑資料。處理單元還整合最佳姿態資料及該第二姿態資料，以及最佳路徑資料及第二路徑資料，以產生多軸機械手臂的工作路徑。

Description

多軸機械手臂系統及其路徑規劃方法

本發明是有關於一種路徑規劃技術，且特別是有關於一種多軸機械手臂系統及其路徑規劃方法。

在自動化的趨勢下，機械手臂已實際被應用在自動化製程、倉儲管理等產業之中。特別是，多軸機械手臂的自由度高，能夠在空間中自由的移動，更是工業機器人領域中的潮流。為了維持機械手臂的移動效率，同時維持廠房的安全，路徑規劃是很重要的一環。然而，在自由度高的特性之下，相對地也會讓路徑規劃的過程變得複雜。基此，如何能夠提供路徑規劃的同時，也提供更有效率的路徑規劃流程為本領域技術人員所致力的課題。

本發明提供一種多軸機械手臂系統及其路徑規劃方法，以提供更有效率的路徑規劃流程。

本發明的一實施例提供多軸機械手臂系統，此系統具有多軸機械手臂以及處理單元。多軸機械手臂具有至少一個前軸單元、至少一個後軸單元以及控制單元。處理單元電性連接至多軸機械手臂，處理單元依據起始姿態資訊、起始位置、目標姿態資訊及目標位置，計算前軸單元由起始位置至目標位置的最佳路徑資料及相應的最佳姿態資料。處理單元會依據最佳路徑資料及最佳姿態資料，計算後軸單元由起始位置至目標位置的第二姿態資料及相應的第二路徑資料。處理單元還分別整合最佳姿態資料及第二姿態資料，以及最佳路徑資料及第二路徑資料，以產生多軸機械手臂的一工作路徑。

本發明的一實施例提供一種多軸機械手臂路徑規劃方法，具有下列步驟。依據一起始姿態資訊、一起始位置、一目標姿態資訊及一目標位置，獲取多軸機械手臂的至少一個前軸單元由起始位置至目標位置的最佳路徑資料及最佳姿態資料；依據最佳路徑資料及最佳姿態資料，獲取多軸機械手臂的至少一個後軸單元由起始位置至目標位置的第二姿態資料及第二路徑資料；以及整合最佳姿態資料、第二姿態資料、最佳路徑資料及第二路徑資料，以產生多軸機械手臂的一工作路徑。

基於上述，本發明的多軸機械手臂系統以及多軸機械手臂路徑規劃方法會分別依據機械手臂的前軸單元以及後軸單元分別計算最佳路徑。由於每次需要進行路徑規劃的軸單元自由度減少，因此能夠有效的降低路徑規劃的複雜性，加快路徑規劃的速度。於此同時，多軸機械手臂系統以及多軸機械手臂路徑規劃方法所獲取的路徑是依據前軸單元的最佳路徑以及後軸單元的最佳路徑所組成。基此，而在路徑規劃的速度與最佳路徑之間取的權衡。

為讓本發明的上述特徵和優點能更明顯易懂，下文特舉實施例，並配合所附圖式作詳細說明如下。

110:多軸機械手臂

113~115:前軸單元

116~118:後軸單元

120:處理單元

S210~S230:步驟

S:起始位置

D:目標位置

圖1繪示本發明一實施例多軸機械手臂系統的系統示意圖。

圖2繪示本發明一實施例多軸機械手臂路徑規劃方法的流程示意圖。

圖3繪示本發明一實施例虛擬空間的示意圖。

圖4繪示本發明一實施例位形空間的示意圖。

圖1繪示本發明一實施例多軸機械手臂系統的系統示意圖。請參照圖1，在本發明的實施例中，多軸機械手臂系統具有至少一前軸單元、至少一後軸單元與一控制單元多軸機械手臂110以及處理單元120。多軸機械手臂110具有多個軸單元(joint)113~118，以及安設於機械手臂內部的控制單元(未顯示)。並且，多軸機械手臂是串聯式機械手臂，也就是說，每一個軸單元都會在一個軸向上位移、旋轉，並帶動其他軸一起移動。

在下述的描述中，軸單元在邏輯上會被區分為前軸單元及後軸單元，並且在路徑規劃時，會分別規劃前軸單元與後軸單元的路徑。以圖1實施例為例，設在基座內側的軸單元113以及靠近基座的軸單元114~115視為前軸單元，遠離基座的軸單元116~118為後軸單元。前軸單元113~115及後軸單元116~118的區分會依據實際路徑規劃的設計而有所調整。惟需注意的是，在本發明的一實施例中，路徑規劃會採用位形空間(Configuration Space)估算機械手臂在空間中的動作範圍和情形。因此，在本發明實施例中，包含但不限於，前軸單元的數量為三個，使前軸單元能夠在位形空間轉換並進行分析。

控制單元電性連接至前軸單元113~115及後軸單元116~118，用以接收控制訊號，以控制多軸機械手臂110在各軸向的移動。控制單元可以採用任意型號的控制晶片進行實作，本發明不限於此。

在本發明的實施例中，機器手臂是由基座所支撐的。軸單元113~118設置於基座上，用以通過自身的移動而使機械手臂在各軸向旋轉、位移。並且，每一個軸單元113~118分別在不同的軸向運動。在本發明的實施例中，每一個軸單元113~118分別以一個馬達所實現。

處理單元120電性連接於機械手臂110，用以執行各類邏輯運算，並進行路徑規劃。處理單元120例如為，中央處理單元(Central Processing Unit，CPU)，或是其他可程式化之一般用途或特殊用途的微處理器(Microprocessor)、數位信號處理器(Digital Signal Processor，DSP)、可程式化控制器、特殊應用積體電路(Application Specific Integrated Circuit，ASIC)或其他類似元件或上述元件的組合，本發明不限於此。

圖2繪示本發明一實施例多軸機械手臂路徑規劃方法的流程示意圖。圖2的實施例至少適用於圖1實施例所繪示的多軸機械手臂系統。因此，以下將通過圖1與圖2說明以多軸機械手臂系統運行多軸機械手臂路徑規劃方法的過程。

在運行機械手臂路徑規劃方法時，操作人員會選擇機械手臂的目標位置及姿態。

在步驟S210，處理單元120依據起始姿態資訊、起始位置、目標姿態資訊及目標位置，計算前軸單元113~115由起始位置至目標位置的最佳路徑資料及相應的最佳姿態資料。具體來說，在本發明的一實施例中，由於起始位置、起始姿態資訊、目標位置以及目標姿態資訊皆為已知。也就是說，每一個前軸單元113~115的具體起始位置以及最終位置為已知的。基此，處理單元120能夠依據已知的起始位置及目標位置安排在空間中的路徑。

在本揭露的一實施例中，處理單元120是依據一路徑搜尋法，例如A*搜尋演算法、D*搜尋演算法或戴克斯特拉演算法 (Dijkstra’s algorithm)，藉此以搜尋至少一個計算前軸單元113~115由起始位置至目標位置的最佳姿態資料，以及相應的最佳路徑資料。舉例來說，倘若前軸單元113~115的起始位置被設置為(0,0,0)，目標位置被設置為(-70,-30,20)，則處理單元120獲取前軸單元113~115的最佳目標位置以及最佳目標姿態的路徑例如為表一：

需說明的是，在本實施例中，最佳路徑、最佳姿態所述的「最佳」是在處理單元120所運行的方式下所產生最佳的路徑與最佳姿態。舉例來說，A*搜尋演算法會以移動代價最小的路徑作為最佳路徑。此時，倘若處理單元120採用A*搜尋演算法，最佳路徑及最佳姿態即為移動代價最小的路徑及其相應的姿態。也就是說，最佳路徑、最佳姿態會依據處理單元120所採用的演算方式而使結果有所不同，本發明並不以此為限。

在步驟S220，處理單元120會依據最佳路徑資料及最佳姿態資料，計算後軸單元116~118由起始位置至目標位置的第二姿態資料及相應的第二路徑資料。也就是說，處理單元120會在前軸單元113~115的最佳路徑和最佳姿態的限制下，使得多軸機械手臂110的移動範圍(自由度)僅剩相應後軸單元116~118三軸的狀態。基此，再進一步計算相應後軸單元116~118最佳的第二路徑。若從路徑的角度來說明，也就是說，處理單元120會依據前軸單元113~115在第t步時的姿態資料進行運算，以產生第t+1步時的第二姿態資料。六軸的第二步伐資料和第二姿態資料如表二：

在步驟S220的最後一步時，前軸單元113~115的姿態分別是落於(-70,-30,20)。因此，處理單元120會以前軸單元113~115的姿態為(-70,-30,20)為基礎，進而獲取後軸單元116~118的路徑。並且，在本發明的實施例中，處理單元120是以相應於步驟S220計算前軸單元113~115由起始位置至目標位置的最佳姿態資料及相應的最佳路徑資料的方式來計算後軸單元116~118由起始位置至目標位置的最佳姿態資料及相應的最佳路徑資料。也就是說，處理單元120是依據起始位置中以及起始姿態資訊中相應後軸單元的部分、最佳路徑資料與最佳姿態資料中的最後一個路徑與姿態以及目標位置，獲取後軸單元由起始位置至目標位置的第二姿態資料及第二路徑資料。

在步驟S230，處理單元120還分別整合最佳姿態資料及第二姿態資料，以及最佳路徑資料及第二路徑資料，以產生多軸機械手臂的工作路徑。整合的工作路徑例如為表三：

在整合的工作路徑中，路徑0至路徑14是在步驟S220中所產生的最佳路徑資料及最佳路徑姿態，路徑15到路徑33是在步驟S230中所產生的路徑1至18。並且，在整合最佳路徑資料及第二路徑資料之後，處理單元120會進一步在路徑33及路徑34的時候，依據目標位置對多軸機械手臂110校正偏差。

需說明的是，由於處理單元120並非直接由起始位置到目標位置的路徑與姿態規劃所有軸單元的整體路徑與姿態。因此，工作路徑並不一定是在所有可能產生的路徑中最短的路徑。然而通過將前軸單元113~115以及後軸單元116~118分開規劃路徑，能夠大幅的降低路徑規劃耗費的時間，以在最佳工作路徑及工作路徑規劃時間之間取得權衡。

值得一提的是，為了確保多軸機械手臂在運行的過程中不會受到障礙物的干擾，在本發明的一實施例中，處理單元120還會事先依據環境影像資訊建立位形空間(Configuration Space)。圖3繪示本發明一實施例虛擬空間的示意圖。具體來說，處理單元120可以通過電性連接至攝影機而對環境進行拍攝，或者是接收來自操作人員輸入至處理單元120的影像建立三維虛擬空間。

藉由三為虛擬空間，處理單元120會進一步建立相應於每一個軸單元(joint)的位形空間。並且，處理單元120會在該位形空間中產生該前軸單元前軸路徑資訊與前軸姿態資訊。詳細來說，處理單元120會在位形空間中模擬多軸機械手臂110的前軸單元113~115所有的移動情形，以將多軸機械手臂110的移動區域分為干涉情形及非干涉情形。圖4繪示本發明一實施例位形空間的示意圖。請參照圖4，S代表的是起始位置，D代表的是目標位置。而幾何圖案代表著是障礙物。基此，處理單元120能夠判斷前軸單元113~115所有的移動路徑中，哪些會使多軸機械手臂110撞到障礙物，哪些則會使多軸機械手臂110順利的到達目標位置。基此，處理單元120會將會撞到障礙物的路徑進行整合，以形成會撞到障礙物的移動區域，並將此移動區域標示為干涉情形，其餘的移動區域則屬於非干涉情形。基此，處理單元120在執行步驟S220的當下，能夠事先排除前軸單元落入干涉情形的移動區域，並據此產生前軸單元的前軸路徑資訊與前軸姿態資訊，以減少處理單元120執行不必要運算的負擔。

值得一提的是，在本發明的實施例中，多軸機械手臂是以六軸機械手臂作為範例，然在其他實施例中，多軸機械手臂也可以是2軸、3軸，甚至是9軸、10軸，本發明不以此為限。惟需注意的是，倘若多軸機械手臂超過6軸時，軸單元可以被劃分成前軸單元以及多組後軸單元。舉例來說，處理單元120可以以前軸單元的最佳路徑資料及最佳姿態資料為基準，進而規劃第一組後軸單元的路徑。接著，處理單元120再以前軸單元與第一組後軸單元的路徑為基準，進而規劃第二組後軸單元的路徑。然本發明不限於此。

綜上所述，本發明的多軸機械手臂系統以及多軸機械手臂路徑規劃方法會分別依據機械手臂的前軸單元以及後軸單元分別計算最佳路徑。由於每次需要進行路徑規劃的軸單元自由度減少，因此能夠有效的降低路徑規劃的複雜性，加快路徑規劃的速度。於此同時，多軸機械手臂系統以及多軸機械手臂路徑規劃方法所獲取的路徑是依據前軸單元的最佳路徑以及後軸單元的最佳路徑所組成。基此，而在路徑規劃的速度與最佳路徑之間取的權衡。

雖然本發明已以實施例揭露如上，然其並非用以限定本發明，任何所屬技術領域中具有通常知識者，在不脫離本發明的精神和範圍內，當可作些許的更動與潤飾，故本發明的保護範圍當視後附的申請專利範圍所界定者為準。

113~115:前軸單元

116~118:後軸單元

120:處理單元

Claims

一種多軸機械手臂系統，包括：一多軸機械手臂，具有至少一前軸單元、至少一後軸單元與一控制單元；以及一處理單元，電性連接至該多軸機械手臂，依據一起始姿態資訊、一起始位置、一目標姿態資訊及一目標位置，獲取該前軸單元由該起始位置至該目標位置的最佳路徑資料及最佳姿態資料；其中該處理單元依據該最佳路徑資料及該最佳姿態資料，獲取該後軸單元由該起始位置至該目標位置的一第二姿態資料及第二路徑資料，該處理單元整合該最佳姿態資料、該第二姿態資料、該最佳路徑資料及該第二路徑資料，以產生該多軸機械手臂的一工作路徑。
如申請專利範圍第1項所述的多軸機械手臂系統，其中該處理單元依據一環境影像資訊建立一位形空間(Configuration Space)，並在該位形空間中產生該前軸單元前軸路徑資訊與前軸姿態資訊。
如申請專利範圍第2項所述的多軸機械手臂系統，其中，該處理單元透過一路徑搜尋法，自該前軸路徑資訊與前軸姿態資訊中，獲得該最佳路徑資料及對應的該最佳姿態資料。
如申請專利範圍第3項所述的多軸機械手臂系統，其中，該路徑搜尋法包含A*搜尋演算法、D*搜尋演算法或戴克斯特拉演算法(Dijkstra’s algorithm)，藉以該處理單元計算該前軸單元的該最佳路徑資料及對應的該最佳姿態資料。
如申請專利範圍第1項所述的多軸機械手臂系統，更包括，一基座，且該前軸單元連接於該基座、該後軸單元以及該控制單元，且該前軸單元與該後軸單元分別在不同的軸向運動。
一種多軸機械手臂路徑規劃方法，包括：依據一起始姿態資訊、一起始位置、一目標姿態資訊及一目標位置，獲取一多軸機械手臂的至少一個前軸單元由該起始位置至該目標位置的最佳路徑資料及最佳姿態資料；依據該最佳路徑資料及該最佳姿態資料，獲取該多軸機械手臂的至少一個後軸單元由該起始位置至該目標位置的第二姿態資料及第二路徑資料；以及整合該最佳姿態資料、該第二姿態資料、該最佳路徑資料及該第二路徑資料，以產生該多軸機械手臂的一工作路徑。
如申請專利範圍第6項所述的多軸機械手臂路徑規劃方法，更包括：依據一環境影像資訊建立一位形空間(Configuration Space)，在該位形空間中產生該前軸單元前軸路徑資訊與前軸姿態資訊。
如申請專利範圍第7項所述的多軸機械手臂路徑規劃方法，其中，在依據該起始姿態資訊、該起始位置、該目標姿態資訊及該目標位置，獲取該多軸機械手臂的該前軸單元由該起始位置至該目標位置的最佳路徑資料及最佳姿態資料的步驟中，包括：透過一路徑搜尋法，自該前軸路徑資訊與前軸姿態資訊中，獲得該最佳路徑資料及對應的該最佳姿態資料。
如申請專利範圍第8項所述的多軸機械手臂路徑規劃方法，其中，該路徑搜尋法包含A*搜尋演算法、D*搜尋演算法或戴克斯特拉演算法(Dijkstra’s algorithm)，藉以計算該前軸單元由該起始位置至該目標位置的該最佳姿態資料及相應的該最佳路徑資料。