TWI708129B

TWI708129B - 自動導引車輛聯動系統與控制方法

Info

Publication number: TWI708129B
Application number: TW107128866A
Authority: TW
Inventors: 蔡明祺; 劉彥辰; 彭繼賢; 馬鐸瑋; 陳俊霖
Original assignee: 國立成功大學
Priority date: 2018-08-17
Filing date: 2018-08-17
Publication date: 2020-10-21
Also published as: TW202009620A

Abstract

本發明提出一種自動導引車輛控制方法與承載平台設計，包括：透過自動導引車上的感測器取得對應每一台自動導引車的車輛狀態資訊；根據車輛狀態資訊計算陣形資訊；以及將陣形資訊傳送至每一台自動導引車，藉此每一台自動導引車根據陣形資訊改變自身的位置；因承載平台可旋轉，自動導引車可在不改變車體姿態下，達到陣形變換。

Description

自動導引車輛聯動系統與控制方法

本發明是有關於一種自動導引車輛聯動系統，且特別是有關於一種能夠改變陣形的系統與方法。

現有的自動導引車輛系統可分為有軌道以及無軌道兩種系統。有軌道的自動導引車輛系統需要預先設置場地，缺點在於僅依靠軌道系統無法在未知區域或是無軌道區域進行搬運，並且軌道系統侷限無人搬運車的移動模式。無軌道的自動導引車輛系統則需要在自動導引車輛上設置感測器，但如何在路況改變(例如遇到障礙物)時變換自動導引車輛的排列，為此領域技術人員所關心的議題。

本發明的實施例提出一種自動導引車輛聯動系統，包括電子裝置與多台自動導引車。電子裝置具有一無線通訊模組。每一台自動導引車包括無線通訊模組、處理裝置、至少一個感測器與控制模組。每一台自動導引車中的處理裝置取得感測器所偵測到的感測數值以計算出車輛狀態資訊，並將車輛狀態資訊透過無線通訊模組傳送至電子裝置。電子裝置根據所接收到的車輛狀態資訊計算自動導引車的陣形資訊，並將陣形資訊傳送至每一台自動導引車，藉此每一台自動導引車的控制模組根據陣形資訊改變自動導引車的位置。

在一些實施例中，自動導引車還包括承載平台、耦接至乘載平台的轉動軸、可調節裝置以及編碼感測器。可調節裝置用以控制轉動軸的旋轉角度，編碼感測器用以感測轉動軸的旋轉角度。

在一些實施例中，自動導引車中的感測器包括馬達感測器、測距感測器、方位感測器、慣性感測器、雷達感測器以及編碼感測器。

在一些實施例中，上述多台自動導引車包括領導自動導引車與跟隨自動導引車。電子裝置用以執行以下步驟：根據領導自動導引車與障礙物之間的距離與感測器偏移位置計算出安全距離；判斷安全距離是否小於車體寬度；以及若安全距離小於車體寬度，調整領導自動導引車的行駛角度。

在一些實施例中，電子裝置用以執行以下步驟：若障礙物位於領導自動導引車的左半面，控制領導自動導引車的行駛角度向右邊偏移一預設角度；以及若障礙物位於領導自動導引車的右半面，控制領導自動導引車的行駛角度向左邊偏移一預設角度。

在一些實施例中，電子裝置還用以執行以下步驟：計算跟隨自動導引車與領導自動導引車之間的陣形寬度；判斷通道寬度是否小於陣形寬度；以及若通道寬度小於陣形寬度，設定領導自動導引車與跟隨自動導引車之間的跟隨角度等於通道角度，並設定跟隨自動導引車的行駛角度等於通道角度。

以另一個角度來說，本發明的實施例提出一種自動導引車輛控制方法，適用於自動導引車輛聯動系統，此系統亦包括多台自動導引車。上述的自動導引車輛控制方法包括：透過每一台自動導引車上的電子裝置取得所對應的每一台自動導引車其車輛狀態資訊；根據車輛狀態資訊計算對應至領導自動導引車的陣形資訊；以及將該陣形資訊傳送至每一台跟隨自動導引車，藉此每一台自動導引車皆能根據陣形資訊改變其位置。

在一些實施例中，在一些實施例中，上述的自動導引車輛控制方法還包括：根據領導自動導引車與障礙物之間的距離與感測器偏移位置計算出安全距離；判斷安全距離是否小於車體寬度；以及若安全距離小於車體寬度，調整領導自動導引車的行駛角度。

在一些實施例中，自動導引車輛控制方法更包括：若障礙物位於領導自動導引車的左半面，控制領導自動導引車的行駛角度向右邊偏移一預設角度；以及若障礙物位於領導自動導引車的右半面，控制領導自動導引車的行駛角度向左邊偏移一預設角度。

在一些實施例中，上述的自動導引車輛控制方法更包括：計算跟隨自動導引車與領導自動導引車之間的陣形寬度；判斷通道寬度是否小於陣形寬度；以及若通道寬度小於陣形寬度，設定領導自動導引車與跟隨自動導引車之間的跟隨角度等於通道角度，並設定跟隨自動導引車的行駛角度等於通道角度。

根據上述的系統與方法，可以自動地調整陣形來繞過障礙物。

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

100‧‧‧自動導引車輛聯動系統

110‧‧‧電子裝置

111‧‧‧無線通訊模組

112‧‧‧執行模組

113‧‧‧處理裝置

120‧‧‧自動導引車

121‧‧‧處理裝置

122‧‧‧驅動裝置

123‧‧‧馬達感測器

124‧‧‧測距感測器

125‧‧‧方位感測器

126‧‧‧慣性感測器

127‧‧‧雷達感測器

128‧‧‧編碼感測器

129‧‧‧可調節裝置

130‧‧‧控制模組

131‧‧‧無線通訊模組

140‧‧‧自動導引車

141‧‧‧無線通訊模組

142‧‧‧控制模組

210‧‧‧車體

211~213‧‧‧輪子

220‧‧‧轉動軸

230‧‧‧承載平台

910‧‧‧乘載物

1101~1103‧‧‧步驟

[圖1]是根據一實施例繪示自動導引車輛聯動系統的示意圖。

[圖2]是根據一實施例繪示自動導引車的側視示意圖。

[圖3]是根據一實施例繪示自動導引車的前視示意圖。

[圖4]是根據一實施例繪示自動導引車的上視示意圖。

[圖5]是根據一實施例繪示多台導引車的上視示意圖。

[圖6A]至[圖6C]是根據一實施例繪示繞過障礙物的示意圖。

[圖7]是根據一實施例繪示虛擬碼的示意圖。

[圖8A]至[圖8C]是根據一實施例繪示繞過障礙物的示意圖。

[圖9A]至[圖9B]是根據一實施例繪示多台自動導引車通過通道的示意圖。

[圖10A]至[圖10B]是根據一實施例繪示多台自動導引車通過通道的示意圖。

[圖11]是根據一實施例繪示自動導引車輛控制方法的流程圖。

圖1是根據一實施例繪示自動導引車輛聯動系統的示意圖。請參照圖1，自動導引車輛聯動系統100包括了電子裝置110、多台自動導引車120、140。圖1中雖然僅繪示了兩台自動導引車，但本發明並不在此限，自動導引車輛聯動系統100也可以適用於更多或更少的自動導引車。電子裝置110是用以決定自動導引車120、140的陣形，藉此控制自動導引車120、140的位置、行駛方向等。

電子裝置110包括了無線通訊模組111、執行模組112與處理裝置113。電子裝置110可為個人電腦、工業電腦、伺服器、或者任意形式的電腦。無線通訊模組111可以符合無線保真(wireless fidelity，WiFi)、第4或第5代行動通訊技術、藍芽(Bluetooth)或任意合適的通訊技術。處理裝置113可為中央處理器，執行模組112可以實作為軟體、韌體或硬體，本發明並不在此限。在其他實施例中，電子裝置110也可以透過有線通訊模組(未繪示)連線至網際網路，再進一步地連線至自動導引車120、140，本發明並不在此限。

自動導引車120包括了處理裝置121、驅動裝置122、馬達感測器123、測距感測器124、方位感測器125、慣性感測器126、雷達感測器127、編碼感測器128、可調節裝置129、控制模組130、以及無線通訊模組131。處理裝置121可為中央處理器、微處理器、微控制器或特殊應用積體電路等。驅動裝置122可為馬達，馬達感測器123用以偵測驅動裝置122的狀態(例如轉動的角度)。測距感測器124例如為紅外線感測器或其他可用來量測距離的感測器。方位感測器125例如為電子指南針或其他可用來量測自動導引車120方位的感測器。慣性感測器126例如為三軸加速度感測器。雷達感測器127是用以掃描自動導引車120周圍的空間資訊，處理裝置121可根據此空間資訊與自動導引車本體狀態資訊計算出車輛在空間中的位置，也就是說處理裝置121可指派自動導引車任意地移動於一空間中。自動導引車120還具有一個承載平台與轉動軸(以下會再說明)，可調節裝置129是用以改變此轉動軸的旋轉角度，編碼感測器128則是用以偵測轉動軸的旋轉角度。無線通訊模組131可符合無線保真(wireless fidelity，WiFi)、第4或第5代行動通訊技術、藍芽(Bluetooth)或任意合適的通訊技術。控制模組130可以實作為軟體、韌體或硬體，本發明並不在此限。

自動導引車140和自動導引車120具有相同的元件，即包括了無線通訊模組141、控制模組142、處理裝置、驅動裝置、馬達感測器、等等(並未全部繪示於圖1)。

圖2是根據一實施例繪示自動導引車的側視示意圖，圖3是根據一實施例繪示自動導引車的前視示意圖。請參照圖2與圖3，在此以自動導引車120為例，自動導引車120還包括了車體210，車體210連接至多個輪子211~213(因角度關係，並未繪示出所有的輪子)，這些輪子211~213為全向輪或傳統輪組，本發明並不在此限。此外，自動導引車120還包括了承載平台230與轉動軸220，轉動軸220連接在承載平台230與車體210之間，可調節裝置129用以改變轉動軸220的旋轉角度，藉此可以改變承載平台230的旋轉角度，進而改變承載物(未繪示)的姿態。在圖2的實施例中，在自動導引車120的前後兩端都設置了測距感測器124，用以偵測車輛前後的物體。值得注意的是，圖2與圖3中關於處理裝置121、驅動裝置122、馬達感測器123、測距感測器124、方位感測器125、慣性感測器126、雷達感測器127、編碼感測器128、可調節裝置129、控制模組130、以及無線通訊模組131的設置位置僅為範例，在其他實施例中也可以適當地改變這些元件的設置位置。

每一輛自動導引車120、140會取得關於自身車輛狀態資訊，並將此車輛狀態資訊傳送至電子裝置110。以自動導引車120為例，處理裝置121會取得感測器123~128所偵測到的感測數值以計算出一車輛狀態資訊，此感測數值可以是加速度值、方向、馬達的狀態、距離數值等等。車輛狀態資訊可包括自動導引車120的目前位置、行駛角度、行駛速度、承載平台230的角度、自動導引車120與周圍障礙物之間的距離、以及/或者自動導引車120相對於自動導引車140的距離與角度等等。接下來，此車輛狀態資訊會透過無線通訊模組131傳送至電子裝置110。同樣的，自動導引車140也會將自身的車輛狀態資訊傳送至電子裝置110。在收集到每台車輛的車輛狀態資訊以後，便可以根據這些車輛狀態資訊計算出對應至這些自動導引車120、140的陣形資訊，並將此陣形資訊傳送至每一台自動導引車120、140，藉此每一台自動導引車120、140的控制模組130、142可根據此陣形資訊改變對應自動導引車120、140的位置，以下將舉多個實施例詳細說明。

在一些實施例中，透過馬達感測器123感測驅動裝置122的狀態可以得到自動導引車本體的移動軌跡。此外，慣性感測器126也可以用以感測自動導引車本體的移動軌跡。處理裝置121會分析此兩種感測訊號所得的誤差訊號，以使處理裝置121藉由此誤差訊號可改變傳送至控制模組130的驅動訊號，達到移動軌跡的誤差修正。

在一些實施例中，馬達感測器123驅動裝置122的狀態產生感測訊號。方位感測器125依據自動導引車自身的姿態改變產生感測訊號。處理裝置121分析此兩種感測訊號所得的誤差訊號，以使處理裝置121藉由此誤差訊號改變傳送至控制模組130的驅動訊號，修正自動導引車本體的姿態。

在一些實施例中，雷達感測器127感測空間資訊的訊號。編碼感測器128也量測感測訊號，藉此得到承載平台230上承載物體的姿態，而此承載物體的形狀可以從外部取得。在得到空間資訊與承載物體的形狀以後，可以判斷在此狀態下搬運的可行性，若不可行，處理裝置121可適當地調整轉動軸220的旋轉角度，藉此改變承載物體的姿態使得搬運變得可行。在一些實施例，也可以根據承載物體的幾何形狀來決定自動導引車的陣形，加上承載物體的姿態可改變，因此可以調節出任意的陣形穿梭在移動空間之中。

在一些實施例中，多台自動導引車之間也可以彼此傳輸任意的訊息(例如上述的車輛狀態資訊)，使得自動導引車自身便可以計算出適當的陣形，在這些實施例中可以省略電子裝置110。

在此先定義各種符號，圖4是根據一實施例繪示自動導引車的上視示意圖。請參照圖4，W是車輛寬度的一半，L是車輛長度的一半、R_a是從車輛的中心到右上角角落的距離，換言之R_a~

。

是從車輛中心到右上角角落的直線相對於X軸的夾角，換言之

。V_iw是指輪子的速度，其中i為1、2、3、4。V_X是車輛重心在X方向上的速度，V_Y是車輛重心在Y方向上的速度。Z軸是垂直於X、Y軸(即平行於地面的法向量)，ω _Z是車輛在Z軸上的旋轉角速度。根據V_X、V_Y、ω _Z以及以下方程式(1)可以計算出每個輪子的速度。

請參照圖5，上述自動導引車輛聯動系統100中的多台自動導引車輛中包括了一台領導自動導引車與至少一台跟隨自動導引車，一般來說跟隨自動導引車是跟隨在領導自動導引車之後，兩者之間的相對關係被稱為“陣形”。此領導自動導引車與跟隨自動導引車可以任意指定，本發明並不在此限。圖5中繪示了一台領導自動導引車120與一台跟隨自動導引車140，但在一些實施例中也可指定多台跟隨自動導引車，也就是說可由3台以上的自動導引車組成一陣形，本發明並不在此限。在此用(x,y,θ)來分別表示自動導引車的x座標、y座標以及行駛角度(相對於X軸)。因此，在圖5中(x_L ,y _L ,θ _L)分別表示領導自動導引車120的x座標、y座標以及行駛角度，而(x_f ,y _f ,θ _f)分別表示跟隨自動導引車140的x座標、y座標以及行駛角度。此外，x_t表示自動導引車行進方向的速度，而y_t自動導引車垂直於行進方向的速度。d表示兩台自動導引車的中心之間的距離，θ_o稱為追隨角度(相對於X軸)。

以下將說明如何控制自動導引車繞過一障礙物。圖6A是根據一實施例繪示繞過障礙物的示意圖，圖7是根據一實施例繪示虛擬碼的示意圖。請參照圖6A，在此假設測距感測器124並不是設置在中心線的位置，測距感測器124與車輛中心在X方向上距離W₁，在Y方向上距離L₁，這是為了使得以下的計算更加一般化。請參照圖6A與圖7，在此是以離散的方式來規劃路徑，從起始點到目的地總共有N步，圖7的第1行與第2行便是進行初始設定。在第6行中， P(i)=[x(i),y(i),θ(i)]，分別表示自動導引車在時間i的x座標、y座標以及行駛角度，第6行的程式碼是用以計算在下一離散時間i+1的位置與行使角度，而第7行的程式碼是用以計算目標物的方向(角度)。

接下來，根據領導自動導引車與障礙物之間的距離與感測器偏移位置計算出安全距離。具體來說，測距感測器124會偵測前方180度內每個方向上的物體與車輛之間的距離，在這些距離當中最小的一個便是距離S₁，其角度為

。第8行的程式碼表示判斷障礙物是在領導自動導引車的右半面。第9行程式碼中的

．cos(

+θ _L-θ _g)是用以表示感測器偏移位置，θ _g表示障礙物的角度，這個角度屬於環境資訊，可利用雷達感測器127掃描周圍環境時建立或者是由外部提供。第9行程式碼計算出的S便是上述的安全距離。接下來，第10行程式碼中的|R _a cos(θ _l+θ _w-θ _g)|被稱為車體寬度，如果安全距離S小於車體寬度，這表示自動導引車繼續依照角度θ(i)行駛的話會撞上障礙物，因此需要調整自動導引車的行駛角度向左，在此實施例中是在第11行將角度

加上90度，在第12行中將下一個時間點的角度θ(i+1)設定為θ_LEFT。換言之，程式碼第8~13行是用以判斷障礙物位於領導自動導引車的右半面，此時控制領導自動導引車的行駛角度θ(i)轉向左邊一預設角度(例如90度，在其他實施例中也可以為30度、45度或其他度數)。類似地，程式碼第14-19行是用以判斷障礙物位於領導自動導引車的左半面，此時控制領導自動導引車的行駛角度θ(i)轉向右邊一預設角度(例如90度，在其他實施例中也可以為30度、45度或其他度數)。

依照上述的方法，自動導引車便可以繞過障礙物，例如請參照圖6B，障礙物在右半面，此時調整角度θ(i+1)。因此在圖6C中自動導引車會向左繞過障礙物。又或者如圖8A，障礙物在左半面，因此在圖8B中會調整行駛角度θ(i+1)，並且在圖8C中可向右繞過障礙物。

圖9A與圖9B是根據一實施例繪示改變陣形以通過一通道的示意圖。在圖9A的實施例中領導自動導引車120與跟隨自動導引車140是並排行駛，兩者之間具有陣形寬度T_w以協同搬運乘載物910，但依照此陣形無法通過僅有寬度D的通道，其中D<T_w，因此必須改變陣形如圖9B所示。在此說明將如何改變陣形，首先如以下方程式(2)，計算跟隨自動導引車140與領導自動導引車120之間的陣形寬度。

此外，通道寬度D可以在掃描環境時取得或由外部取得。接下來判斷通道寬度D是否小於陣形寬度T_w，如果是，則設定領導自動導引車120與跟隨自動導引車140之間的跟隨角度θ _o等於通道角度θ _g，並設定跟隨自動導引車的行駛角度θ_f等於通道角度θ _g，如此一來領導自動導引車120與跟隨自動導引車140便會縱向地行使，如圖9B所示，值得注意的是自動導引車120、124也會對應地調整承載平台的角度，使得乘載物910會呈現垂直以通過通道。

另一個例子請參照圖10A與圖10B，根據上述的做法以後，跟隨角度θ _o以及跟隨自動導引車的行駛角度θ_f都等於通道角度θ _g，因此領導自動導引車120與跟隨自動導引車140會斜向地穿過通道。

圖11是根據一實施例繪示自動導引車輛控制方法的流程圖。請參照圖11，在步驟1101中，透過自動導引車上的感測器取得對應的車輛狀態資訊。在步驟1102中，根據車輛狀態資訊計算對應至自動導引車的陣形資訊。在步驟1103中，將陣形資訊傳送至每一台自動導引車，藉此每一台自動導引車根據陣形資訊改變其位置。然而，圖11中各步驟已詳細說明如上，在此便不再贅述。值得注意的是，圖11中各步驟可以實作為多個程式碼或是電路，本發明並不在此限。此外，圖11的方法可以搭配以上實施例使用，也可以單獨使用，換言之，圖11的各步驟之間也可以加入其他的步驟。

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