TWI608243B - 利用磁力場形之定位裝置及其定位方法 - Google Patents

Description

利用磁力場形之定位裝置及其定位方法

本發明是有關於一種定位裝置，且特別是有關於一種利用磁力場形之定位裝置及其定位方法。

無人搬運車(Automated Guided Vehicle,AGV)為自動化物料傳輸中之重要載具，相較於採用輸送帶之方式，AGV具有不佔空間、可彈性調整產線之優點。對於無軌導引式AGV而言，現有技術多以雷射反光標籤、磁柱或二維條碼標籤等方式來達成定位之目的。然而，上述標籤定位技術在實際使用時，皆須預先淨空場地空間，對於設廠之初未做預先規劃之工廠使用不易。此外，上述標籤定位技術被限制於二維度，故無法應用於三維度，有待改善。

本發明係有關於一種利用磁力場形之定位裝置及其定位方法，以磁性產生元件做為地標，並在移動載具上安裝一組三軸磁力感測器，使移動載具能在三維空間中達到定位之功效，具備機動性與場佈方便性。

根據本發明之一方面，提出一種利用磁力場形之定位裝置，用於定位一移動載具。定位裝置包括一磁性地標、一組設置於移動載具上的至少四個三軸磁力感測器以及一邏輯運算處理單元。此組至少四個三軸磁力感測器在空間座標中形成不共平面的四個點。邏輯運算處理單元連接此組至少四個三軸磁力感測器，此組至少四個三軸磁力感測器感測磁性地標的磁場，並產生至少四組磁場資訊至邏輯運算處理單元。

根據本發明之一方面，提出一種利用磁力場形之定位方法，用於定位一移動載具於一磁性地標處，移動載具上設置一組至少四個三軸磁力感測器，此組至少四個三軸磁力感測器在空間座標中形成不共平面的四個點，其中定位方法包括利用此組至少四個三軸磁力感測器感測磁性地標的磁場，並產生至少四組磁場資訊。

為了對本發明之上述及其他方面有更佳的瞭解，下文特舉較佳實施例，並配合所附圖式，作詳細說明如下：

100‧‧‧移動載具

110‧‧‧磁性地標

112‧‧‧N極磁力源

114‧‧‧S極磁力源

120‧‧‧三軸磁力感測器

130‧‧‧邏輯運算處理單元

140‧‧‧支撐架

142‧‧‧滑槽

144‧‧‧滑塊

第1圖繪示依照本發明一實施例的利用磁力場形之定位系統的示意圖。

第2圖繪示三軸磁力感測器的示意圖。

第3圖繪示磁性地標的示意圖。

第4圖繪示磁力場在空間座標中特定軌跡的分布圖。

第5圖繪示本發明之定位方法與傳統能量估測方法的實驗比 較圖。

以下係提出實施例進行詳細說明，實施例僅用以作為範例說明，並非用以限縮本發明欲保護之範圍。

請參照第1圖，依照本發明一實施例之定位裝置，用以定位一移動載具100，移動載具100例如是無人搬運車。定位裝置包括一磁性地標110、一組至少四個三軸磁力感測器120以及一邏輯運算處理單元130。磁性地標110位於移動載具100的定位點上，四個三軸磁力感測器120設置於移動載具100上。當移動載具100到達一工作站時，在工作站的地面上設置磁性地標110，並以設置在移動載具100上的至少四個三軸磁力感測器120感測磁性地標110的磁場。

磁性地標110用以產生一預定的磁力場形。磁性地標110可為一磁鐵或一電磁鐵。請參照第3圖，磁性地標110例如具有一個N極磁力源112以及一個S極磁力源114，但亦可具有多個N極磁力源以及多個S極磁力源。磁性地標110的磁場強度可由磁力源的數量來決定。

請參照第1及2圖，四個三軸磁力感測器120在空間座標中形成不共平面的四個點(即編號0~3)。四個三軸磁力感測器120對應產生四組磁場資訊至邏輯運算處理單元130。邏輯運算處理單元130例如是電腦或設置在電腦中的微處理器。邏輯運算處理單元130接收磁場資訊之前，可先經由低通濾波器來降低磁場資訊中的雜訊，並提高雜訊比，之後，磁場資訊可經過類比/數位轉換轉換器轉換成數位化磁場資訊。在第2圖中，四個三 軸磁力感測器120分別設置在垂直相交的三個支撐架140上並可藉由各個軸向上的滑槽142及滑塊144來調整相對位置(即滑塊144位於滑槽142內並可鎖固在預定位置上)，因此，任兩個三軸磁力感測器120之間的距離可增加或縮小。

在一實施例中，三軸磁力感測器120例如是三維電子羅盤，由三維磁阻感測器、雙軸傾角感測器和微處理器構成。三維磁阻感測器用來測量外部磁場，傾角感測器是在磁力儀非水平狀態時進行補償，微處理器處理磁力儀和傾角感測器的信號以及資料輸出和軟鐵、硬鐵補償。磁力儀是採用三個互相垂直的磁阻感測器，每個軸向上的磁阻感測器檢測在該軸向上的磁場強度。向前的方向稱為x方向的磁阻感測器檢測外部磁場在x方向的矢量值；向左或Y方向的磁阻感測器檢測外部磁場在Y方向的矢量值；向上或Z方向的磁阻感測器檢測地磁場在Z方向的矢量值。磁阻感測器產生的模擬輸出信號進行放大後送入微處理器進行處理。基於磁阻感測器的電子羅盤具有體積小、響應速度快等優點，在靈敏度及線性度上明顯優於霍爾感測器。

邏輯運算處理單元130可根據至少四組磁場資訊計算至少四個三軸磁力感測器120相對於該磁性地標110之座標及距離資訊，以產生一識別資料。

在第1圖中，p為地標磁矩，磁性地標的座標系統為[Ox Oy Oz]，而四個三軸磁力感測器120在空間中的座標系統為[bx by bz]，此四個三軸磁力感測器120為不共平面的四個點，其中編號0的感測器放置於原點，1號、2號以及3號感測器分別放置於感測器座標系統的X軸、Y軸以及Z軸上，且1號、2 號以及3號感測器與原點的距離為已知數(例如長度d)，編號0~3感測器相對於地標座標系統之位置為r _i ．n _i ，其中i為編號參數0~3，r為四個三軸磁力感測器120分別相對於磁性地標110的距離，n為指向向量。

在下列公式中，B為各個三軸磁力感測器120於距離r所偵測之磁通量。B’為各個三軸磁力感測器120於距離r+ndr所偵測之磁通量。μ ₀為空間介質參數。由公式(1)和(2)能夠得到磁通量差值並簡化得到公式(3)。

上述磁通量差值以空間梯度矩陣G表示，並根據公式(3)可得到下列之公式(4)。

由上述之公式得知，若得知空間中各個三軸磁力感測器120所測得之磁通量B及空間梯度矩陣G，即可得知各個三軸磁力感測器120的座標及距離資訊。有關於利用空間梯度矩陣G聯立方程式求解的說明如下。假設每一個三軸磁力感測器120接收到的磁場訊號可以表示成：

其中B _E 為地磁向量，為地標座標跟感測器座標之間的旋轉矩陣，O為環境中的硬鐵影響，而N為雜訊；如果磁力感測器系統中有陀螺儀資訊，也可以加入系統中以得到更好的估測結果，其中陀螺儀感測訊號可以表示成：

其中ω為感測器座標之轉角速度，而N為雜訊。

根據公式(1)、(4)以及(5)，用近似的方式可以得到空間梯度矩陣如下：

其中可表示成下式：

對進行微分，可得到如下：

重新整理上述式子(7)-(9)，可以得到下式，其中u _i =n _i -n ₀,i=1~3。

如x=[u ₁ u ₂ u ₃ r ₀], R ¹²，則線性系統矩陣A可寫成下 式，w為系統雜訊。

根據旋轉矩陣的特性，可以得知以下限制條件：u ₁ ^T u ₂=0 u ₂ ^T u ₃=0 u ₃ ^T u ₁=0 u ₁ ^T u ₁=1 u ₂ ^T u ₂=1 u ₃ ^T u ₃=1 (14)

最後，使用條件限制型的卡爾曼濾波器(Kalman filter)來得到下列公式。請參見第4及第5圖，第4圖繪示磁力場在空間座標中特定軌跡的分布圖，第5圖則為本發明之定位方法與傳統能量估測方法的實驗比較圖。依據第4及5圖的模擬結果用來驗證演算法的正確性及效能。演算法的流程如下：x(k+1)=A(k)x(k)+w(k)y(k)=h(x(k))+v(k)st.G _hard (x(k))=h (15)

量測更新

P ⁺(k)=(P ^-(k)^-1+H(k) ^T R ^-1 H(k))^-1

時間更新

P ^-(k)=A(k)P ⁺(k)A(k) ^T +Q

其中，x、y為狀態與量測向量，k為時間參數，A為線性系統矩陣，p為磁矩，r為各個感測器到原點的距離，p-、p+為狀態誤差共變異數矩陣(error covariance matrix)，h為量測方程式，H為h之雅可比矩陣(Jacobian matrix)，Q與R為雜訊共變異數矩陣(noise covariance matrix)，w與v為零均值高斯白雜訊(zero mean white Gaussian noise)。

第4圖是利用模擬的方式，在虛擬座標的原點的地方放置一磁性地標，並在空間中規劃一螺旋向上之路徑，圖中的箭頭方向與長度代表路徑上每個點所感測到的磁力線方向與強度，粗虛線的部分代表實際參考位置，細虛線的部分代表利用本發明之演算法估測出來的位置，可以發現，其誤差維持一極小定值，且不會發散，足以證明本發明之演算法的收斂性質。

第5圖是透過實際實驗來突顯本發明之演算法優於傳統利用能量估測距離的優勢，其中曲線1是參考位置，曲線2是利用本發明之演算法估測出來的位置，曲線3是利用能量與距離平方成反比之公式所計算出來之位置，三曲線皆等化至相同的起始點，可以發現，隨著距離拉長訊雜比提升誤差開始增加，即明顯比較出優劣。

由上述的內容可知，當移動載具100通過磁性地標110時，邏輯運算處理單元130根據至少四個三軸磁力感測器120 對磁性地標的磁矩量B以及空間梯度矩陣G計算至少四個三軸磁力感測器120對磁性地標110的位置向量r，其中r=-3G ^-1 B，以得到識別資料，也就是移動載具100的定位資料。

本發明上述實施例所揭露之利用磁力場形之定位裝置及其定位方法，可以用來偵測移動載具在空間中的座標，且磁性地標只要一個。因此，本發明不需要對環境有事先佈置的需求，有不需要多個磁性地標。此外，習知技術利用磁場強度來估測距離為非線性(與距離的平方成反比)且對雜訊抵抗力低，然而本案利用立體化的至少四個三軸磁力感測器，可讓估測系統變成線性系統，其精度可達毫米(mm)級，且可以算出空間座標資訊。另外，本發明之定位裝置完全利用磁力場形來達到定位的效果，不會隨著能量大小變化而有誤差，在應用上也不需要時間資訊來換取空間資訊，故可提供更即時的定位結果。

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

120‧‧‧三軸磁力感測器

140‧‧‧支撐架

142‧‧‧滑槽

144‧‧‧滑塊

Claims (8)

1. 一種利用磁力場形之定位裝置，用於定位一移動載具，該定位裝置包括：一磁性地標；一組至少四個三軸磁力感測器，設置於該移動載具上，該組至少四個三軸磁力感測器在空間座標中形成不共平面的四個點；以及一邏輯運算處理單元，連接該組至少四個三軸磁力感測器，該組至少四個三軸磁力感測器感測該磁性地標的磁場，並產生至少四組磁場資訊至該邏輯運算處理單元。
2. 如申請專利範圍第1項所述之定位裝置，其中該組至少四個三軸磁力感測器在該空間座標中分別位在垂直相交的三個軸線及原點上，且任意兩個三軸磁力感測器之間的距離為已知數。
3. 如申請專利範圍第2項所述之定位裝置，其中該移動載具通過該磁性地標時，該邏輯運算處理單元根據該至少四組磁場資訊計算該組至少四個三軸磁力感測器相對於該磁性地標之座標及距離資訊，以產生一識別資料。
4. 如申請專利範圍第3項所述之定位裝置，其中該邏輯運算處理單元根據該組至少四個三軸磁力感測器對該磁性地標的磁矩量B以及空間梯度矩陣G計算該組至少四個三軸磁力感測器對該磁性地標的位置向量r，其中r=-3G ^-1 B，以得到該識別資料。
5. 一種利用磁力場形之定位方法，用於定位一移動載具於一磁性地標處，該移動載具上設置一組至少四個三軸磁力感測器，該組至少四個三軸磁力感測器在空間座標中形成不共平面的四 個點，其中該定位方法包括：利用該組至少四個三軸磁力感測器感測該磁性地標的磁場，並產生至少四組磁場資訊。
6. 如申請專利範圍第5項所述之定位方法，其中該組至少四個三軸磁力感測器在該空間座標中分別位在垂直相交的三個軸線及原點上，且任意兩個三軸磁力感測器之間的距離為已知數。
7. 如申請專利範圍第6項所述之定位方法，其中該移動載具通過該磁性地標時，該定位方法包括根據該至少四組磁場資訊計算該組至少四個三軸磁力感測器相對於該磁性地標之座標及距離資訊，以產生一識別資料。
8. 如申請專利範圍第7項所述之定位方法，其中根據該組至少四個三軸磁力感測器對該磁性地標的磁矩量B以及空間梯度矩陣G計算該組至少四個三軸磁力感測器對該磁性地標的位置向量r，其中r=-3G ^-1 B，以得到該識別資料。