TWI843363B

TWI843363B - 搬運裝置的貨架定位方法及可定位貨架的搬運裝置

Info

Publication number: TWI843363B
Application number: TW111150366A
Authority: TW
Inventors: 李政昕; 賴冠叡
Original assignee: 中光電智能物流股份有限公司
Filing date: 2022-12-28
Publication date: 2024-05-21

Abstract

一種搬運裝置的貨架定位方法，搬運裝置包括測距裝置及控制器，貨架位於一特定空間內的一儲存區域。貨架定位方法包括如下步驟：輸入儲存區域的世界座標、世界方位角及尺寸參數至控制器；利用測距裝置掃描特定空間，以獲得多個數據點；利用控制器計算位於儲存區域以外的多個數據點並移除，以留下位於儲存區域內的數據點作為多個有效數據點；以及利用控制器根據這些有效數據點獲得貨架的一定位資訊。一種可定位貨架的搬運系統亦被提出。

Description

搬運裝置的貨架定位方法及可定位貨架的搬運裝置

本發明是有關於一種搬運裝置及其定位方法，且特別是有關於一種搬運裝置的貨架定位方法及可定位貨架的搬運裝置。

隨著科技的發展，近代倉儲作業與管理的模式都朝著自動化邁進。許多倉儲物流業者紛紛引入機器人來執行高重複性且呆板的工作，使得人力資源可以更有效地運用於較複雜的工作內容。舉例而言，不論是工廠產線或是物流倉儲，常常需要將裝滿貨物的架子搬運至指定地點。這類重複性高且單純的工作，倘若以指派自動搬運車的形式來完成，不僅能夠節省人力搬運貨物的時間成本，更能免去人為因素造成的災害。然而，要能夠將貨架轉運的工作自動化地交給機器人，其執行條件除了必須包括安全地導航載送，還要能穩定辨識貨架的正確位置及方向。

由於貨架於儲位內的擺設在沒有外在條件的約束下是不可能保持一致的。這是因為不論是人為堆放或自動搬運車卸載都一定存在誤差。若是省略自動搬運載貨前對於放置歪斜的貨架進行辨識，則很容易產生碰撞。同時也可能導致自動搬運車載送著歪斜擺放的貨架，造成運送過程中的不確定危險因子和在目的地卸載貨架時的定位困擾。

“先前技術”段落只是用來幫助了解本發明內容，因此在“先前技術”段落所揭露的內容可能包含一些沒有構成所屬技術領域中具有通常知識者所知道的習知技術。在“先前技術”段落所揭露的內容，不代表該內容或者本發明一個或多個實施例所要解決的問題，在本發明申請前已被所屬技術領域中具有通常知識者所知曉或認知。

本發明提供一種搬運裝置的貨架定位方法，其有助於安全且準確地搬運貨架。

本發明提供一種可定位貨架的搬運裝置，其可安全且準確地搬運貨架。

本發明的其他目的和優點可以從本發明所揭露的技術特徵中得到進一步的了解。

為達上述之一或部份或全部目的或是其他目的，本發明的一實施例提供一種搬運裝置的貨架定位方法，搬運裝置包括測距裝置及控制器，貨架位於一特定空間內的一儲存區域。貨架定位方法包括如下步驟：輸入儲存區域的世界座標、世界方位角及尺寸參數至控制器；利用測距裝置掃描特定空間，以獲得多個數據點；利用控制器計算位於儲存區域以外的多個數據點並移除，以留下位於儲存區域內的數據點作為多個有效數據點；以及利用控制器根據這些有效數據點獲得貨架的一定位資訊。

為達上述之一或部份或全部目的或是其他目的，本發明的一實施例提供一種可定位貨架的搬運裝置，搬運裝置包括測距裝置及控制器，貨架位於一特定空間內的一儲存區域。其中，測距裝置用以掃描特定空間，以獲得多個數據點。控制器電性連接至測距裝置，且經配置以執行：接收儲存區域的世界座標、世界方位角及尺寸參數；命令測距裝置掃描特定空間，以獲得這些數據點；計算位於儲存區域以外的多個數據點並移除，以留下位於儲存區域內的數據點作為多個有效數據點；以及根據這些有效數據點來獲得貨架的一定位資訊。

在本發明的一實施例中，測距裝置在多個偵測位置掃描特定空間並獲得對應這些偵測位置的多個子數據點，而將這些子數據點轉換投影在世界座標系的一平面上而獲得這些數據點。

在本發明的一實施例中，控制器經配置以更執行：對這些偵測位置的一部分於世界座標系上作定位，並對根據相鄰兩經定位的偵測位置計算在兩經定位的偵測位置之間的平均速度，並根據平均速度來對相鄰兩經定位的偵測位置之間的至少一未經定位的偵測位置作內插，以獲得至少一未經定位的偵測位置的世界座標。

在本發明的一實施例中，控制器經配置以更執行：根據經定位的偵測位置與未經定位的偵測位置的世界座標來將測距裝置在這些偵測位置所得的數據點轉換到世界座標系上。

在本發明的一實施例中，控制器經配置以更執行：接收貨架的多個腳柱的尺寸參數。

在本發明的一實施例中，控制器經配置以更執行：根據這些腳柱的尺寸參數對這些有效數據點實施基於空間密度之叢集分類運算，以濾除邊緣效應所產生的雜訊點，而獲得分別對應這些腳柱的多個有效數據點叢集。

在本發明的一實施例中，控制器經配置以更執行：計算這些有效數據點叢集的每一個的重心位置；以及根據這些腳柱的尺寸參數對對應於這些腳柱的每一個的重心位置給予一位移補償，以獲得這些腳柱的每一個的中心座標。

在本發明的一實施例中，控制器經配置以更執行：根據這些腳柱的這些中心座標計算出貨架的定位資訊，其中定位資訊包括貨架的中心的世界座標及世界方位角。

在本發明的一實施例中，控制器經配置以更執行：將儲存區域平均分成四個象限區域，落在每一象限區域中的有效數據點叢集對應至這些腳柱之一。

在本發明的一實施例中，測距裝置為二維光達，二維光達發出一偵測光束，而這些數據點包括貨架的這些腳柱反射偵測光束的位置點。

在本發明的一實施例中，控制器經配置以更執行：判斷測距裝置在一預設時間內的掃描次數是否大於等於一預設值；若掃描次數小於預設值，利用控制器將不同掃描次數所獲得的有效數據點疊加在世界坐標系的平面上；以及若掃描次數大於等於預設值，透過控制器建立空間中分佈密度做叢集分類的方法所需的兩個設計參數。

在本發明的實施例的搬運裝置的貨架定位方法及可定位貨架的搬運裝置中，利用測距裝置掃描特定空間以獲得多個數據點，利用控制器計算位於儲存區域以外的多個數據點並移除，以留下位於儲存區域內的數據點作為多個有效數據點，且利用控制器根據這些有效數據點獲得貨架的一定位資訊。因此，可有效且準確地定位貨架，進而使搬運裝置能夠安全且準確地搬運貨架。

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

有關本發明之前述及其他技術內容、特點與功效，在以下配合參考圖式之一較佳實施例的詳細說明中，將可清楚的呈現。以下實施例中所提到的方向用語，例如：上、下、左、右、前或後等，僅是參考附加圖式的方向。因此，使用的方向用語是用來說明並非用來限制本發明。

圖1是本發明的一實施例的搬運系統的搬運裝置及貨架的示意圖，而圖2為圖1的搬運裝置的貨架定位方法的流程圖。請參照圖1及圖2，本實施例提供一種搬運系統100，搬運系統100包括可移動的搬運裝置200及貨架110。搬運裝置200包括測距裝置210及控制器220，可用來執行本實施例的貨架定位方法。貨架110位於一特定空間內的一儲存區域50。在本實施例中，搬運裝置200例如為可搬運貨架110的搬運車，而特定空間例如為一儲物倉庫。此外，在本實施例中，搬運裝置200的測距裝置210例如為二維光達（2D Lidar），其用以發出一偵測光束212。測距裝置210用以掃描上述特定空間，以獲得多個數據點。在本實施例中，這些數據點包括貨架110的多個腳柱112反射偵測光束212的位置點，如圖3所繪示。在本實施例中，控制器220電性連接至測距裝置210，且可以和測距裝置210一起移動。於另一實施例中，控制器220可為與測距裝置210通訊連接的獨立裝置(例如電腦)，而僅有測距裝置210移動並進行偵測。且控制器220經配置以執行下列步驟，如圖2所繪示。首先，執行步驟S110，其為接收儲存區域50的世界座標、世界方位角及尺寸參數，也就是使用者可輸入儲存區域50的世界座標、世界方位角及尺寸參數至控制器220。接著，執行步驟S120，其為命令測距裝置210掃描特定空間，以獲得這些數據點P，如圖3所繪示，也就是利用測距裝置210掃描特定空間，以獲得這些數據點P。然後，執行步驟S130，其為計算（例如利用控制器220計算）位於儲存區域50以外的多個數據點P並移除，以留下位於儲存區域50內的數據點P作為多個有效數據點。之後，執行步驟S140，其為根據這些有效數據點來獲得貨架110的一定位資訊，也就是利用控制器220根據這些有效數據點來分析並計算出貨架110的定位資訊，而此定位資訊可包括貨架110的位置及方向。

在本實施例中，步驟S120包括利用測距裝置210在多個偵測位置Q1、Q2、Q3、Q4掃描特定空間並獲得對應不同的這些偵測位置Q1、Q2、Q3、Q4的多個子數據點P’，如圖4A與圖4B所繪示。其中，圖4A與圖4B是以四個偵測位置Q1、Q2、Q3、Q4為例，但本發明不以此為限。

然後，利用控制器220轉換投影對應各個偵測位置Q1、Q2、Q3、Q4的這些子數據點P’在世界座標系的一平面上而獲得這些數據點P。具體而言，如圖4A所繪示，當搬運裝置200移動到不同的偵測位置Q1、Q2、Q3、Q4且使測距裝置210掃描特定空間時，隨著搬運裝置200的移動，子數據點P’相對於測距裝置210的位置也會隨著測距裝置210的靠近而縮短。因此，在不同的偵測位置Q1、Q2、Q3、Q4偵測後，可將這些子數據點P’的座標轉換為世界座標系的座標，並加以投影於世界座標系的一平面上（也就是將座標轉換後的數據點P都置於世界座標系中）。如圖5A，其繪示了在搬運裝置200的測距裝置210在一個偵測位置掃描後所獲得的子數據點P’，而圖5B繪示了搬運裝置200的測距裝置210在多個偵測位置掃描後轉換投影對應各個偵測位置的這些子數據點P’在世界座標系的平面上而獲得這些數據點P。

在本實施例中，步驟S120更包括利用搬運裝置200的控制器220判斷測距裝置210在一預設時間內的掃描次數是否大於等於一預設值。若此掃描次數小於預設值，則利用控制器220將不同掃描次數所獲得的有效數據點疊加在世界坐標系的x-y平面上。若此掃描次數大於等於預設值，則透過控制器220根據當前測距裝置的位置與儲存區域中心的距離建立空間中分佈密度做叢集分類(DBSCAN)的方法所需的兩個設計參數。

在本實施例中，如圖6所繪示，搬運裝置的貨架定位方法更包括利用控制器220對這些偵測位置Q0、Q1、Q2、Q3及Q4的至少一部分（例如偵測位置Q0與Q4）於世界座標系上作測距裝置210的定位，並對根據相鄰兩個經過定位的偵測位置（如偵測位置Q0與Q4）計算測距裝置210在兩個經過定位的偵測位置Q0、Q4之間的平均速度，並根據此平均速度來對相鄰兩個經過定位的偵測位置Q0與Q4之間的至少一個未經過定位的偵測位置（如偵測位置Q1、Q2及Q3的至少其中之一）作內插，以獲得至少一個未經過定位的偵測位置Q1、Q2、Q3的世界座標。此外，搬運系統的貨架定位方法更包括根據經過定位的偵測位置Q0與Q4與未經過定位的偵測位置Q1、Q2、Q3的世界座標來將測距裝置210在這些偵測位置Q0、Q1、Q2、Q3及Q4分別所得的子數據點轉換投影到世界座標系的平面上。

舉例而言，若測距裝置210在時間t0時位於偵測位置Q0，其x座標為x0，在時間t1時位於偵測位置Q4，其x座標為x1，而經控制器220計算偵測位置Q0至偵測位置Q4的距離除以測距裝置210從偵測位置Q0至偵測位置Q4的時間可得到從偵測位置Q0到偵測位置Q4的平均速度為v。假設測距裝置210要經一預設時間間隔t掃描一次，則偵測位置Q1的x座標是可經由內插計算而為x0+vt，而偵測位置Q2的x座標則為x0+2vt，偵測位置Q3的x座標則為x0+3vt。圖6是以在兩個經過定位的偵測位置Q0與Q4之間測距裝置210掃描了3次為例，但本發明不以此為限。在其他實施例中，若在兩個經過定位的偵測位置之間測距裝置掃描了n次，則第n次掃描時的x座標位置可經內插計算而為x0+nvt。此外，控制器220若接收到測距裝置210在y座標上有移動量，也可以比照上述x座標上的方法做內插計算。

在本實施例中，搬運装置的貨架定位方法更包括輸入貨架110的多個腳柱112的尺寸參數至控制器220，在如圖1所繪示的實施例中，貨架110具有四個腳柱112，腳柱112的尺寸參數例如是各腳柱於x-y平面的長度和寬度，或各腳柱於x-y平面的半徑。此外，如圖3所示，在本實施例中，利用控制器220根據這些有效數據點（即位於儲存區域50內的數據點P）來獲得貨架的定位資訊的步驟包括根據測距裝置所在位置與儲存區域中心的距離結合這些腳柱112的尺寸參數對這些有效數據點實施基於空間密度之叢集分類運算（density-based spatial clustering of applications with noise, DBSCAN），以濾除邊緣效應(Edge effect)所產生的雜訊點P1，而獲得分別對應這些腳柱的多個有效數據點叢集P2。其中，圖3僅繪示腳柱112對應於x-y平面的截面示意。

圖7A至圖7E是圖2的搬運装置的貨架定位方法在各步驟中的數據點的示意圖。請參照圖7A至圖7E，在步驟S120中所獲得的數據點P如圖7A所繪示。在步驟S130中，留下位於圖7A中的儲存區域50中的數據點P作為有效數據點，而儲存區域50外的數據點P則移除。更進一步說明，可將多次掃描所獲得的有效數據點疊加在世界坐標系的x-y平面上。圖7B為圖7A的儲存區域50的放大圖，在圖7B的有效數據點中，控制器220又可進一步根據腳柱的尺寸參數利用空間密度之叢集分類運算(DBSCAN)區分出邊緣效應所產生的雜訊點P1與分別對應這些腳柱的多個有效數據點叢集P2。在圖7C中，濾除雜訊點P1，而留下這些有效數據點叢集P2。

在本實施例中，利用控制器220根據這些有效數據點來獲得貨架110的定位資訊的步驟更包括計算這些有效數據點叢集P2的每一個的重心位置G1，如圖7D所繪示，可以在有效數據點之中計算取得四個有效數據點叢集，並經過計算獲得四個有效數據點叢集的重心位置G1。此外，根據測距裝置的位置到每一個效數據點叢集的重心位置的方向與這些腳柱112的尺寸參數對對應於這些腳柱112的每一個的重心位置G1給予一位移補償，以獲得這些腳柱的每一個的中心座標C1，其中該中心座標C1為一腳柱中心的世界座標，如圖7E所繪示，其中該位移補償至少大於等於0。之後，在本實施例中，利用控制器220根據這些有效數據點來獲得貨架110的定位資訊的步驟更包括根據對應這些腳柱112的這些中心座標C1計算出貨架的定位資訊，其中定位資訊包括貨架110的中心的世界座標C2及世界方位角。

另外，參考圖1、圖7C、圖7D及圖7E所繪示，在本實施例中，利用控制器220根據這些有效數據點來獲得貨架110的定位資訊的步驟更包括將儲存區域50平均分成四個象限區域52，落在每一象限區域52中的有效數據點叢集P2對應至這些腳柱112之一。也就是說，利用儲存區域50的各象限區域52中的有效數據點叢集P2的重心位置G1各別獲得對應的腳柱112的中心座標C1。

在本實施例的搬運系統100的搬運裝置200的貨架定位方法及可定位貨架的搬運裝置200中，利用測距裝置210多次掃描特定空間以分別獲得多個子數據點，並將每次掃描獲得的該些子數據點分別轉換投影至一平面上而形成多個數據點P，利用控制器220計算位於儲存區域50以外的多個數據點P並移除，以留下位於儲存區域50內的數據點P作為多個有效數據點，並將多次掃描獲得的多個有效數據點疊加到該平面上，且利用控制器220根據這些有效數據點獲得貨架110的定位資訊。因此，可有效、快速且準確地於該特定空間內定位貨架110，進而使搬運裝置200能夠安全且準確地搬運貨架110。

圖8用以繪示圖2的搬運裝置的貨架定位方法中基於空間密度之叢集分類運算的參數設定示意圖。請參照圖3及圖8，多次掃描與曡加的方法可以讓數據點P圍繞著物件周圍形成更清晰的輪廓，但同時邊緣效應也產生了許多雜訊點P1。必須先有效地移除邊緣效應才能求取貨架110的腳柱112的中心。由於邊緣效應所具備的特性為數據點P在空間中分佈的密度相較於座落於物體表面的數據點的分佈密度會比較低，因此可利用一種基於空間中分佈密度做叢集分類(DBSCAN)的方法來識別出這些雜訊點P1。DBSCAN有兩個設計參數用來決定所有點的叢集分類方式。其一是距離參數ε，即任一數據點對於相鄰數據點的搜尋範圍，在範圍內可作連結；其二就是已相互連結的數據點成員中必須滿足的最小個數N 方能形成種子（seed）點，相互連結的種子點即歸為一叢集分類，其餘未能形成叢集的數據點則為雜訊點。在本實施例中，貨架110的腳柱112周圍比較密集的數據點P會形成同一個叢集的種子（seed）點，而邊緣效應將因為密度過低被視為雜訊點P1。在本實施例中，測距裝置210為二維光達，其是以輻射狀的掃描方式測量環境，相同大小的物件於不同距離所做的測量，投射在物件表面周圍的數據點數量會不一樣。物件離測距裝置較近時會比較多點，物件離測距裝置較遠時會比較少點。

倘若執行DBSCAN方法中的兩個參數於實際應用中未能動態地隨著物件掃描距離做調整，則無法有效地篩選邊緣效應產生的點。因此，本實施例建立了一個動態調整參數的方法，使得待測物件在離測距裝置不同的距離都能夠使用適當的設計參數。

若測距裝置210對於距離d 的物件（例如為腳柱）其掃描角度增量為θ，則投射在物件表面的掃描點間距h為h=d×tan(θ)，而物件表面上單位長度之掃描點（即數據點P）數量（掃描點之線密度）可表示為(1/h)。接著以物件於一平面上(例如為x-y平面)內切圓之半徑r （例如為腳柱112的內切圓之半徑r）為特徵長度（即DBSCAN 之設計參數ε），那麼二維光達每掃描一次可以投射在物件表面上的掃描數據點數量約為(2r/h)。又因為本提案以行進過程中的光達，由位置A 移動至位置B，對於物件（例如腳柱112）共掃描n 次的所有掃描數據點做曡加，所以投射在物件表面上的總掃描點數量（即DBSCAN的另一設計參數N）可表示為2nr/h。如此操作可以將掃描物件時因為邊緣效應所產生的雜訊點去除，而鄰近物件較高密度的掃描數據點（即數據點P）會被保留下形成一叢集（即有效數據點叢集P2）。透過計算有效數據點叢集P2的中心可推得物件的中心位置(即腳柱的中心的世界座標)。在此結果的基礎上，只要根據已知的貨架110的腳柱112模型再比對貨架110的腳柱112中心的位置就能反推貨架110於特定空間內的位置與方位角。上述方式非常適合在光達掃描資訊中分離雜訊及物體分類。

圖9為圖1的搬運系統的搬運裝置執行貨架定位步驟的流程圖。請參照圖1與圖9，首先，控制器220執行步驟ST110，其為測距裝置210經由偵測而取得第一次掃描的子數據點P’、搬運裝置200的位置及方向資訊。然後，進入貨架辨識定位流程。首先，執行步驟ST120，其為藉由步驟ST110所得的數據對第一次掃描的這些子數據點P’轉換投影至x-y平面，以形成在x-y平面上的數據點P，其中x-y平面為搬運裝置200能在上面移動的平面，且為貨架110的腳柱112所駐立的平面。接著，執行步驟ST130，其為輸入儲存區域50的資訊，包括儲存區域50的座標、方向及長寬。然後，進行步驟ST140，其為保留儲存區域50內的數據點P，並移除儲存區域50外的數據點P。之後，執行步驟ST150，判斷測距裝置210的掃描次數是否大於或等於n，若為否，則再次執行步驟ST110，繼續將不同掃描次數所獲得的有效數據點疊加在x-y平面上。更進一步說明，控制器220保留儲存區域50內於第一次掃描所獲得的有效數據點P，並移除儲存區域50外的數據點P；同時，測距裝置200繼續進行偵測而取得第二次掃描的子數據點P’，控制器220依據儲存區域50的資訊將第二次掃描的子數據點P’轉換投影至在x-y平面上而形成數據點P，控制器220保留在儲存區域50內於第二次掃描所獲得的有效數據點P，並將在儲存區域50內的第一次掃描所獲得的有效數據點P及第二次掃描所獲得的有效數據點P疊加於x-y平面上；若為是，則繼續進行步驟ST160與ST170。步驟ST160為輸入貨架110的腳柱112的資訊，包括腳柱112的內接圓半徑r。在本實施例中，步驟ST130的儲存區域50資訊與步驟ST160的貨架110資訊都可以預先輸入於搬運裝置200的儲存器中，其中儲存器與控制器220電性連接。然後，進行步驟ST170，建立空間中分佈密度做叢集分類(DBSCAN)的方法所需的兩個設定參數ε與N。再來，執行步驟ST180，其為利用空間中分佈密度做叢集分類(DBSCAN)的方法去除邊緣效應的雜訊點而獲得對應腳柱的有效數據點叢集P2。再來，進行步驟ST190，其為計算各有效數據點叢集P2之重心位置G1，以獲得腳柱112的中心座標C1，此時控制器220是以測距裝置的位置到腳柱周圍的有效數據點的重心位置的方向與腳柱的內接圓半徑r的資訊做位移補償以得到腳柱112的中心座標C1。之後，執行步驟ST200，其為計算各腳柱112的中心座標C1，以得到貨架的中心的世界座標C2，並獲得貨架110於特定空間內的位置及方向。

在一實施例中，控制器220例如為中央處理單元（central processing unit, CPU)、微處理器（microprocessor）、數位訊號處理器（digital signal processor, DSP）、可程式化控制器、可程式化邏輯裝置（programmable logic device, PLD）或其他類似裝置或這些裝置的組合，本發明並不加以限制。此外，在一實施例中，控制器220的各功能可被實作為多個程式碼。這些程式碼會被儲存在一個記憶體中，由控制器220來執行這些程式碼。或者，在一實施例中，控制器220的各功能可被實作為一或多個電路。本發明並不限制用軟體或硬體的方式來實作控制器220的各功能。

綜上所述，在本發明的實施例的搬運裝置的貨架定位方法及可定位貨架的搬運裝置中，利用測距裝置掃描特定空間以獲得多個數據點，利用控制器計算位於儲存區域以外的多個數據點並移除，以留下位於儲存區域內的數據點作為多個有效數據點，且利用控制器根據這些有效數據點獲得貨架的一定位資訊。因此，可有效且準確地定位貨架，進而使搬運裝置能夠安全且準確地搬運貨架。

惟以上所述者，僅為本發明之較佳實施例而已，當不能以此限定本發明實施之範圍，即大凡依本發明申請專利範圍及發明說明內容所作之簡單的等效變化與修飾，皆仍屬本發明專利涵蓋之範圍內。另外本發明的任一實施例或申請專利範圍不須達成本發明所揭露之全部目的或優點或特點。此外，摘要部分和標題僅是用來輔助專利文件搜尋之用，並非用來限制本發明之權利範圍。

50:儲存區域 52:象限區域 100:搬運系統 110:貨架 112:腳柱 200:搬運裝置 210:測距裝置 212:偵測光束 220:控制器 A、B:位置 C1:中心座標 C2:貨架中心的世界座標 d:距離 G1:重心位置 h:掃描點間距 P:數據點 P’:子數據點 P1:雜訊點 P2:有效數據點叢集 Q0、Q1、Q2、Q3、Q4:偵測位置 r:內切圓之半徑 S110～S140、ST110～ST200:步驟 v:平均速度 x、x0、x1、y:座標 θ:掃描角度增量

圖1是本發明的一實施例的搬運系統的搬運裝置及貨架的示意圖。圖2為圖1的搬運裝置的貨架定位方法的流程圖。圖3繪示圖1的測距裝置掃描腳柱的示意圖。圖4A為圖1的測距裝置一邊移動一邊掃描的示意圖。圖4B為圖1的測距裝置將一邊移動一邊掃描所得的子數據點轉換到世界座標系以形成數據點的示意圖。圖5A為圖1的測距裝置在一次掃描時所得的子數據點的示意圖。圖5B為圖1的測距裝置一邊移動一邊完成多次掃描後將多次掃描所得的子數據點轉換投影到世界座標系所得的數據點的示意圖。圖6為圖1的測距裝置一邊移動一邊掃描的示意圖。圖7A至圖7E是圖2的搬運裝置的貨架定位方法在各步驟中的數據點的示意圖。圖8用以繪示圖2的搬運裝置的貨架定位方法中基於空間密度之叢集分類運算的參數設定示意圖。圖9為圖1的搬運系統的搬運裝置執行貨架定位步驟的流程圖。

S110、S120、S130、S140:步驟

Claims

一種搬運裝置的貨架定位方法，該搬運裝置包括測距裝置及控制器，用以定位放置於一特定空間內的一儲存區域的貨架，該貨架定位方法包括如下步驟：輸入該儲存區域的世界座標、世界方位角及尺寸參數至該控制器；利用該測距裝置掃描該特定空間，以獲得多個數據點；利用該控制器計算位於該儲存區域以外的多個數據點並移除，以留下位於該儲存區域內的數據點作為多個有效數據點；輸入該貨架的多個腳柱的尺寸參數至該控制器；以及利用該控制器根據該些有效數據點與該些腳柱的該尺寸參數獲得該貨架的一定位資訊，其中，該些腳柱的該尺寸參數為各該些腳柱於一平面的長度和寬度，或各該些腳柱於該平面的半徑。
如請求項1所述的搬運裝置的貨架定位方法，其中在利用該測距裝置掃描該特定空間，以獲得該些數據點的步驟中包括：利用該測距裝置在多個偵測位置掃描該特定空間並獲得對應不同的該些偵測位置的多個子數據點；以及利用該控制器轉換投影該些子數據點到世界座標系的一平面上而獲得該些數據點。
如請求項2所述的搬運裝置的貨架定位方法，更包括：利用控制器對該些偵測位置的一部分於該世界座標系上作定位，並對根據相鄰兩經定位的偵測位置計算在該兩經定位的偵測位置之間的平均速度，並根據該平均速度來對該相鄰兩經定位的偵測位置之間的至少一未經定位的偵測位置作內插，以獲得該至少一未經定位的偵測位置的世界座標。
如請求項3所述的搬運裝置的貨架定位方法，更包括：根據經定位的偵測位置與未經定位的偵測位置的世界座標來將該測距裝置在該些偵測位置所得的數據點轉換到該世界座標系上。
如請求項1所述的搬運裝置的貨架定位方法，其中利用該控制器根據該些有效數據點與該些腳柱的該尺寸參數來獲得該貨架的該定位資訊的步驟包括：根據該些腳柱的該尺寸參數對該些有效數據點實施基於空間密度之叢集分類運算，以濾除邊緣效應所產生的雜訊點，而獲得分別對應該些腳柱的多個有效數據點叢集。
如請求項5所述的搬運裝置的貨架定位方法，其中利用該控制器根據該些有效數據點與該些腳柱的該尺寸參數來獲得該貨架的該定位資訊的步驟更包括：計算該些有效數據點叢集的每一個的重心位置；以及根據該些腳柱的尺寸參數對對應於該些腳柱的每一個的該重心位置給予一位移補償，以獲得該些腳柱的每一個的中心座標。
如請求項6所述的搬運裝置的貨架定位方法，其中利用該控制器根據該些有效數據點與該些腳柱的該尺寸參數來獲得該貨架的該定位資訊的步驟更包括：根據對應該些腳柱的該些中心座標計算出該貨架的該定位資訊，其中該定位資訊包括該貨架的中心的世界座標及世界方位角。
如請求項6所述的搬運裝置的貨架定位方法，其中利用該控制器根據該些有效數據點與該些腳柱的該尺寸參數來獲得該貨架的該定位資訊的步驟更包括：將該儲存區域平均分成四個象限區域，落在每一該象限區域中的該有效數據點叢集對應至該些腳柱之一。
如請求項1所述的搬運裝置的貨架定位方法，其中該測距裝置為二維光達，該二維光達發出一偵測光束，而該些數據點包括該貨架的該些腳柱反射該偵測光束的位置點。
如請求項2的搬運裝置的貨架定位方法，其中利用該控制器計算位於該儲存區域以外的該些數據點並移除，以留下位於該儲存區域內的數據點作為多個有效數據點的步驟更包括：利用該控制器判斷該測距裝置在一預設時間內的掃描次數是否大於等於一預設值；若該掃描次數小於該預設值，利用該控制器將不同掃描次數所獲得的該些有效數據點疊加在該世界坐標系的該平面上；以及若該掃描次數大於等於該預設值，透過該控制器建立空間中分佈密度做叢集分類的方法所需的兩個設計參數。
一種可定位貨架的搬運裝置，包括測距裝置及控制器，該貨架位於一特定空間內的一儲存區域，其中，該測距裝置用以掃描該特定空間，以獲得多個數據點；以及該控制器電性連接至該測距裝置，且經配置以執行：接收該儲存區域的世界座標、世界方位角及尺寸參數；命令該測距裝置掃描該特定空間，以獲得該些數據點；計算位於該儲存區域以外的多個數據點並移除，以留下位於該儲存區域內的數據點作為多個有效數據點；接收該貨架的多個腳柱的尺寸參數；以及根據該些有效數據點與該些腳柱的該尺寸參數來獲得該貨架的一定位資訊，其中，該些腳柱的該尺寸參數為各該些腳柱於一平面的長度和寬度，或各該些腳柱於該平面的半徑。
如請求項11所述的可定位貨架的搬運裝置，其中該測距裝置在多個偵測位置掃描該特定空間並獲得對應該些偵測位置的多個子數據點，而將該些子數據點轉換投影在世界座標系的一平面上而獲得該些數據點。
如請求項12所述的可定位貨架的搬運裝置，其中該控制器經配置以更執行：對該些偵測位置的一部分於該世界座標系上作定位，並對根據相鄰兩經定位的偵測位置計算在該兩經定位的偵測位置之間的平均速度，並根據該平均速度來對該相鄰兩經定位的偵測位置之間的至少一未經定位的偵測位置作內插，以獲得該至少一未經定位的偵測位置的世界座標。
如請求項13所述的可定位貨架的搬運裝置，其中該控制器經配置以更執行：根據經定位的偵測位置與未經定位的偵測位置的世界座標來將該測距裝置在該些偵測位置所得的數據點轉換到該世界座標系上。
如請求項11所述的可定位貨架的搬運裝置，其中該控制器經配置以更執行：根據該些腳柱的該尺寸參數對該些有效數據點實施基於空間密度之叢集分類運算，以濾除邊緣效應所產生的雜訊點，而獲得分別對應該些腳柱的多個有效數據點叢集。
如請求項15所述的可定位貨架的搬運裝置，其中該控制器經配置以更執行：計算該些有效數據點叢集的每一個的重心位置；以及根據該些腳柱的尺寸參數對對應於該些腳柱的每一個的該重心位置給予一位移補償，以獲得該些腳柱的每一個的中心座標。
如請求項16所述的可定位貨架的搬運裝置，其中該控制器經配置以更執行：根據該些腳柱的該些中心座標計算出該貨架的該定位資訊，其中該定位資訊包括該貨架的中心的世界座標及世界方位角。
如請求項16所述的可定位貨架的搬運裝置，其中該控制器經配置以更執行：將該儲存區域平均分成四個象限區域，落在每一該象限區域中的該有效數據點叢集對應至該些腳柱之一。
如請求項11所述的可定位貨架的搬運裝置，其中該測距裝置為二維光達，該二維光達發出一偵測光束，而該些數據點包括該貨架的該些腳柱反射該偵測光束的位置點。
如請求項12的可定位貨架的搬運裝置，其中該控制器經配置以更執行：判斷該測距裝置在一預設時間內的掃描次數是否大於等於一預設值；若該掃描次數小於該預設值，利用該控制器將不同掃描次數所獲得的該些有效數據點疊加在該世界坐標系的該平面上；以及若該掃描次數大於等於該預設值，透過該控制器建立空間中分佈密度做叢集分類的方法所需的兩個設計參數。
一種搬運裝置的貨架定位方法，該搬運裝置包括測距裝置及控制器，用以定位放置於一特定空間內的一儲存區域的貨架，該貨架定位方法包括如下步驟：輸入該儲存區域的世界座標、世界方位角及尺寸參數至該控制器；利用該測距裝置掃描該特定空間，以獲得多個數據點；利用該控制器計算位於該儲存區域以外的多個數據點並移除，以留下位於該儲存區域內的數據點作為多個有效數據點；輸入該貨架的多個腳柱的尺寸參數至該控制器；以及利用該控制器根據該些有效數據點與該些腳柱的該尺寸參數獲得該貨架的一定位資訊，其中，利用該控制器根據該些有效數據點與該些腳柱的該尺寸參數來獲得該貨架的該定位資訊的步驟包括：根據該些腳柱的該尺寸參數對該些有效數據點實施基於空間密度之叢集分類運算，以濾除邊緣效應所產生的雜訊點，而獲得分別對應該些腳柱的多個有效數據點叢集；計算該些有效數據點叢集的每一個的重心位置；根據該些腳柱的尺寸參數對對應於該些腳柱的每一個的該重心位置給予一位移補償，以獲得該些腳柱的每一個的中心座標。
一種可定位貨架的搬運裝置，包括測距裝置及控制器，該貨架位於一特定空間內的一儲存區域，其中，該測距裝置用以掃描該特定空間，以獲得多個數據點；以及該控制器電性連接至該測距裝置，且經配置以執行：接收該儲存區域的世界座標、世界方位角及尺寸參數；命令該測距裝置掃描該特定空間，以獲得該些數據點；計算位於該儲存區域以外的多個數據點並移除，以留下位於該儲存區域內的數據點作為多個有效數據點；以及根據該些有效數據點與該些腳柱的該尺寸參數來獲得該貨架的一定位資訊，其中，該控制器經配置以更執行：接收該貨架的多個腳柱的尺寸參數；根據該些腳柱的該尺寸參數對該些有效數據點實施基於空間密度之叢集分類運算，以濾除邊緣效應所產生的雜訊點，而獲得分別對應該些腳柱的多個有效數據點叢集；計算該些有效數據點叢集的每一個的重心位置；以及根據該些腳柱的尺寸參數對對應於該些腳柱的每一個的該重心位置給予一位移補償，以獲得該些腳柱的每一個的中心座標。