基于信息熵的AUV地磁仿生導(dǎo)航方法

李　紅, 劉明雍, 劉　坤

(西北工業(yè)大學(xué)航海學(xué)院, 陜西 西安 710072)

?

基于信息熵的AUV地磁仿生導(dǎo)航方法

李紅, 劉明雍, 劉坤

(西北工業(yè)大學(xué)航海學(xué)院, 陜西 西安 710072)

摘要：針對地磁異常引起磁參量變化規(guī)律失真,導(dǎo)致自主水下航行器(autonomous underwater vehicle,AUV)導(dǎo)航搜索算法極易陷入局部極小的問題,提出了一種基于種群信息熵的進(jìn)化搜索方法。該方法對地磁異常區(qū)域內(nèi)信息熵的變化狀態(tài)進(jìn)行觀測,通過預(yù)設(shè)的熵值門限值判斷搜索算法是否進(jìn)入磁異常區(qū)域,采用最大概率選擇機(jī)制使算法跳出異常區(qū)域的干擾,避免算法陷入局部極小,并且對算法的收斂性進(jìn)行證明。在未知環(huán)境下對AUV的導(dǎo)航搜索算法進(jìn)行仿真,結(jié)果表明,利用熵值觀測和最大概率選取的方法能夠使得AUV在磁異常存在的情況下完成導(dǎo)航任務(wù),驗(yàn)證了算法的有效性。

關(guān)鍵詞：地磁導(dǎo)航; 仿生策略; 地磁異常; 局部極小

0引言

目前,在水下環(huán)境中還沒有一種導(dǎo)航方式能夠與空中的全球定位系統(tǒng)(global positioning system, GPS)媲美,導(dǎo)航問題是發(fā)展自主水下航行器(autonomous underwater vehicles,AUV)的關(guān)鍵所在[1]。水下導(dǎo)航常用慣性導(dǎo)航系統(tǒng),但其存在定位誤差隨時間累積的缺陷,目前應(yīng)用較廣的衛(wèi)星導(dǎo)航系統(tǒng)也存在無線信號水中快速衰減的不足[2]。因此,利用地球磁場導(dǎo)航理論和方法引起了國內(nèi)外研究機(jī)構(gòu)和學(xué)者的廣泛關(guān)注。地磁導(dǎo)航由于具有無源隱蔽、全天候、全地域等特點(diǎn),可以為水下航行器提供高精度的導(dǎo)航和定位信息,這是目前國內(nèi)實(shí)現(xiàn)真正無源導(dǎo)航研究的熱點(diǎn)[3]。

當(dāng)前常用的磁場導(dǎo)航方法是基于磁圖信息進(jìn)行的匹配導(dǎo)航方法[4]。但是由于該方法受限于地磁基準(zhǔn)圖的獲取,為此,研究不依靠任何事先儲存的磁場數(shù)據(jù)信息或磁圖信息進(jìn)行導(dǎo)航方式是必要的。近些年來,眾多科學(xué)家對動物如何進(jìn)行導(dǎo)航展開了研究,并且取得了許多研究成果。文獻(xiàn)[5]在一些海龜身上裝上GPS系統(tǒng),將其帶到完全陌生的兩個地點(diǎn)釋放,然后跟蹤記錄海龜?shù)挠巫哕壽E。實(shí)驗(yàn)表明,海龜可以在不熟悉的環(huán)境下利用地磁信息可以回到巢穴所在地。文獻(xiàn)[6]研究發(fā)現(xiàn),在洋流情況下海龜可以利用地磁場實(shí)現(xiàn)接近直線的洄游。文獻(xiàn)[7]從量化的角度認(rèn)為,信鴿歸巢過程中磁航向角的可控性與信鴿的磁敏感能力有關(guān)。文獻(xiàn)[8]從理論角度對地磁多參量導(dǎo)航線索的生物可用性進(jìn)行了分析,并給出地磁多參量梯度夾角的邊界。

在未知地磁環(huán)境狀態(tài)下,且不依賴于地磁基準(zhǔn)圖的存在,AUV如何進(jìn)行目標(biāo)位置的定位是研究的難點(diǎn)。文獻(xiàn)[9-10]從仿生學(xué)角度入手對該問題進(jìn)行研究,并且提出了利用磁趨勢性進(jìn)行導(dǎo)航的多目標(biāo)搜索方法。但是之前的研究對磁異常影響下的AUV仿生導(dǎo)航方法考慮甚少。

本文針對AUV在地磁異常場環(huán)境中的導(dǎo)航問題,提出了一種基于種群信息熵的進(jìn)化搜索方法。該方法針對地磁異常對導(dǎo)航搜索的影響,利用信息熵對地磁異常區(qū)域進(jìn)行檢測,采用最大概率選擇機(jī)制,實(shí)現(xiàn)對導(dǎo)向動作的選取,通過對AUV未知地磁環(huán)境導(dǎo)航的仿真分析,表明AUV通過與環(huán)境的交互作用,最終完成了在未知地磁環(huán)境下的導(dǎo)航任務(wù)。

1問題描述

二維平面內(nèi),考慮AUV具有如下的運(yùn)動方程:

(1)

式中,ΔT表示采樣周期;k表示航行器運(yùn)行的某一時刻(k可取0,1,2,…,N-1);v(k)表示運(yùn)動速度;θ(k)表示航向角。假定航行器在ΔT內(nèi)進(jìn)行勻速運(yùn)動,則v(k)可以用常量V表示,則式(1)簡化為下式:

(2)

式中,L表示運(yùn)動步長,L=V×ΔT。

1.1基于地磁分量的導(dǎo)航搜索

地球磁場是一個包含多個參量的混合場,每個參量都有其自身的變化規(guī)律[11]。從仿生角度來講,地磁導(dǎo)航過程表現(xiàn)為地磁場多個參量從起始位置到達(dá)各自目標(biāo)收斂的過程[9]。因此,一個具有n個地磁決策變量、m個目標(biāo)函數(shù)的多目標(biāo)搜索問題可表述為:參量分布規(guī)律未知情況下,地磁場分量向給定目標(biāo)值收斂的過程,表示如下:

(3)

在無先驗(yàn)基準(zhǔn)地磁圖的情況下,針對目標(biāo)位置的磁趨勢性,以目標(biāo)位置與當(dāng)前位置磁場分量的差值作為導(dǎo)航運(yùn)動的反饋信息,即通過磁分量誤差值表征對目標(biāo)值的無限逼近,可表示為

(4)

1.2磁異常對導(dǎo)航搜索的影響

磁異常是指磁體產(chǎn)生的磁場疊加在地磁場之上而引起的地磁場的畸變[12]。

(5)

式中,?B為異常區(qū)域的異常幅度。

搜索算法中目標(biāo)函數(shù)由于磁異常的存在使得目標(biāo)函數(shù)可以表示為

(6)

結(jié)合式(4)和式(6)可知,

(7)

由此可知,?B的存在對地磁場原有參量產(chǎn)生擾動,則有ξ>ε 使得各地磁參量搜索空間將形成范圍、強(qiáng)度不同的極值區(qū)域,表現(xiàn)為導(dǎo)航搜索中的局部極小問題。

2磁異常影響下的導(dǎo)航搜索方法

為了克服磁異常影響下進(jìn)化算法陷入局部極小的問題,整個導(dǎo)航搜索過程主要分為兩個任務(wù),這兩個任務(wù)的具體實(shí)現(xiàn)過程如下:

(1) 第一個任務(wù):判斷是否進(jìn)入磁異常區(qū)域

由于異常區(qū)域會引起地磁分量的作用規(guī)律失真,進(jìn)而使得導(dǎo)航路徑在異常區(qū)域內(nèi)出現(xiàn)“繞圈”等現(xiàn)象,此時運(yùn)動航向的盲目性增大。故此,引入信息熵,通過計(jì)算運(yùn)動狀態(tài)的熵值,來衡量AUV對運(yùn)動狀態(tài)的傾向程度。在信息論中,熵用來表征對某事件不確定程度的度量。信息量越少,不確定性越大,熵值就越大。故此,利用種群的信息熵對磁異常環(huán)境進(jìn)行檢測,以此判斷算法是否進(jìn)入磁異常區(qū)域, 即滿足式(8),則認(rèn)為算法陷入磁異常區(qū)域。

(8)

式中,Hth為熵值門限,取Hth=1.8。

(2) 第二個任務(wù):判斷是否到達(dá)目標(biāo)位置

(9)

式中,ε是給定的趨于0的小數(shù);T為預(yù)設(shè)目標(biāo)范圍。

3導(dǎo)航算法步驟

基于種群信息熵的進(jìn)化搜索的具體實(shí)現(xiàn)流程如下:

步驟 1初始化

設(shè)置AUV起始位置和終止位置的地磁參量Bo和Bt、運(yùn)動步長、終止范圍及搜索算法相關(guān)參數(shù)。導(dǎo)航搜索過程中以航向角作為進(jìn)化個體,個體集合為

(10)

式中,m為個體空間中的個數(shù);Δθ為采樣間隔。種群空間由個體集合中的個體組成,種群為Q={θj|j=1,2,…,N},θj表示種群的第i個個體,θj=Δθ×i,i∈[1,m],N表示群體規(guī)模大小。

步驟 2隨機(jī)選取航向角個體

從種群空間Q中隨機(jī)選擇一個個體θi(k)執(zhí)行,由于一開始種群中個體的取向信息是未知的,所以選取各個體行為初始概率均相等,即

(11)

選取各個體行為初始概率相等,意味著搜索初期,AUV不含有任何預(yù)定的方向決策。隨著導(dǎo)航進(jìn)程的進(jìn)行,種群個體中具有較大概率值的個體行為被選中的頻次越高,則k時刻,種群第i個樣本θi被選中的概率為

(12)

步驟 3種群的更新

由于AUV當(dāng)前位置是由前一時刻的位置和種群中的航向角個體共同決定的,搜索結(jié)果的優(yōu)劣很大程度上取決于航向角的選取。種群的一個個體被選中,AUV進(jìn)行行為操作,利用評價函數(shù)進(jìn)行環(huán)境反饋,以實(shí)現(xiàn)對種群熵值的更新。因此,種群中的樣本更新可按照下述規(guī)則進(jìn)行:

(13)

(14)

步驟 4種群熵值更新

執(zhí)行一次操作后,由地磁傳感器獲得當(dāng)前位置的環(huán)境信息,得到當(dāng)前狀態(tài)Bk,并計(jì)算種群的信息熵,即

(15)

這里的熵H表征了種群中個體的不確定性程度,信息熵的減少是進(jìn)化過程的顯著特征。若種群熵值在一段時間內(nèi)異常增大,說明算法進(jìn)入磁異常區(qū)域

步驟 5當(dāng)判斷算法進(jìn)入磁異常區(qū)域時,采用最大概率選擇方式,選取進(jìn)程中被保留下來的好的航向角中的概率最大航向角θki,即為

(16)

步驟 6k=k+1,重復(fù)步驟2～步驟5,直到滿足條件式(9)時終止。

4算法收斂性證明

文獻(xiàn)[13-14]已對最優(yōu)個體保留進(jìn)化算法的全局收斂性進(jìn)行證明,在基礎(chǔ)之上,本文給出搜索進(jìn)程中航向角個體的收斂性證明。

定理 1當(dāng)k→∞時,航向角個體的選取依據(jù)概率1選取具有最大概率的操作行為

(17)

證明假定k時刻,導(dǎo)航進(jìn)程中選取操作行為θki,則

(1) 若θ(k)=θki,由式(13)得

(18)

(2) 若θ(k)=θki,由式(14)得

(19)

因?yàn)?

證畢

定理 2當(dāng)k→∞時,種群熵收斂至極小,即

(20)

證明由于導(dǎo)航搜索過程中種群中的個體是一個不斷進(jìn)化的過程,由于磁異常的存在致使搜索路徑出現(xiàn)抖動和繞圈等運(yùn)動現(xiàn)象,說明種群熵的不確定性增大,因此,采用最大概率的個體使其跳出異常區(qū)域的影響。

(21)

證畢

5仿真分析

為了驗(yàn)證算法的可行性,通過Matlab2012a調(diào)用WMM2010中的磁場參量數(shù)據(jù),得到每一步測量點(diǎn)的地磁參量數(shù)據(jù),用以模擬地磁傳感器一步一測量的狀態(tài)。選取地磁場X方向分量、Y方向分量、總強(qiáng)度F作為環(huán)境特征參量,記為B=∶{Bx,By,BF}。環(huán)境中設(shè)置一個恒定的干擾區(qū)域,即為磁異常干擾區(qū)域。AUV近似為一個質(zhì)點(diǎn),其初始位置設(shè)置為綠色的小圈(“○”),目標(biāo)點(diǎn)設(shè)為紅色的星型(“*”)。

5.1仿真參數(shù)設(shè)置

參數(shù)設(shè)置:種群規(guī)模N=50,Δθ=30°,m=12,運(yùn)動步長L=500 m,ε=0.000 7。

5.2仿真結(jié)果

利用文獻(xiàn)[10]的導(dǎo)航搜索算法解決導(dǎo)航搜索進(jìn)程中磁異常干擾的問題時,仿真結(jié)果發(fā)現(xiàn)由于磁參量的變化規(guī)律受到影響,使得AUV的導(dǎo)航進(jìn)程發(fā)生了變化,搜索算法陷入了局部極小而無法到達(dá)目標(biāo)值,如圖1所示。

圖1　導(dǎo)航搜索路徑

圖1導(dǎo)航搜索結(jié)果表明,文獻(xiàn)[10]的導(dǎo)航搜索算法未考慮到磁異常對AUV導(dǎo)航進(jìn)程的影響,致使AUV進(jìn)入磁異常區(qū)域時,呈現(xiàn)出“繞圈”現(xiàn)象而無法導(dǎo)航預(yù)設(shè)目標(biāo)位置。圖2顯示了地磁參量的變化曲線,由結(jié)果可以看出,隨著導(dǎo)航進(jìn)程的進(jìn)行,搜索算法陷入了局部極小。

圖2　地磁三參量的收斂曲線(1)

圖3顯示了該導(dǎo)航搜索算法中種群熵的變化曲線,通過觀察種群熵值的變化狀態(tài)可以看出,迭代步數(shù)在320步之前,種群熵值呈現(xiàn)明顯下降趨勢,表明進(jìn)程中對航向角的進(jìn)化,方向的傾向性顯著,故此熵值下降,但在320步之后熵值變化極度異常,熵值3次超過2,由此可見,由于環(huán)境因素的變化致使AUV在行進(jìn)中失去了航向的目標(biāo)傾向性,其導(dǎo)向的不確定性增大,故此,熵值在磁異常區(qū)域時變化異常。

圖3　磁異常存在下的種群熵變化曲線

為了驗(yàn)證基于種群信息熵在磁異常存在下的AUV地磁仿生導(dǎo)航搜索方法的有效性,仿真環(huán)境一致,運(yùn)動參數(shù)不變的條件下進(jìn)行導(dǎo)航搜索,如圖4所示。由圖4可知,導(dǎo)航搜索過程是一個不斷探索和鞏固的過程,通過引入信息熵能夠保證對環(huán)境做出合理的判斷,隨即采用最大概率選擇機(jī)制,實(shí)現(xiàn)對導(dǎo)向動作進(jìn)行選取,使算法擺脫異常區(qū)域的干擾,得以逃離異常區(qū)域,最終到達(dá)目標(biāo)點(diǎn),完成導(dǎo)航任務(wù)。

圖4　導(dǎo)航搜索路徑

圖5顯示了地磁參量的變化曲線,由結(jié)果可以看出地磁三參量的收斂過程。圖中迭代步數(shù)在260～300和350～3 400時參量變化曲線異常,均有增長趨勢,在圖4的導(dǎo)航路徑中表現(xiàn)為a,b兩段,說明導(dǎo)航搜索進(jìn)程極易陷入局部極小解。故此,對其進(jìn)行方向?qū)б?即圖4中的c段操作。從地磁三參量的總體收斂狀態(tài)可以看出,導(dǎo)航搜索進(jìn)程中雖然呈現(xiàn)出不一致性,但是三參量最終能同時同地收斂至目標(biāo)參量,即目標(biāo)預(yù)設(shè)位置。

圖5　地磁三參量的收斂曲線(2)

圖6顯示了導(dǎo)航進(jìn)程中種群熵的變化曲線,從整個熵值的變化過程可以看出,迭代步數(shù)在260～360步時熵值急速增大,說明在此期間AUV的航向不確定性增大,直至采用最大概率選擇機(jī)制,對導(dǎo)向進(jìn)行動作選取后,熵值下降直至極小。

對比上述仿真結(jié)果圖1與圖3可以看出,本文利用信息熵對地磁異常區(qū)域進(jìn)行檢測,采用最大概率選擇機(jī)制,實(shí)現(xiàn)對導(dǎo)向動作的選取,最終完成了在未知地磁環(huán)境下的導(dǎo)航搜索任務(wù),克服了地磁異常對AUV導(dǎo)航搜索干擾。

圖6　磁異常存在下的種群熵變化曲線

6結(jié)論

本文提出了一種基于種群信息熵的進(jìn)化搜索方法用于實(shí)現(xiàn)AUV的地磁導(dǎo)航。AUV在導(dǎo)航搜索的進(jìn)程中不斷與環(huán)境進(jìn)行交互,利用信息熵對地磁異常區(qū)域進(jìn)行檢測,并且采用最大概率選擇機(jī)制,實(shí)現(xiàn)對導(dǎo)向動作的選取,通過仿真結(jié)果的對比分析可知,本文提出抗地磁異常干擾的導(dǎo)航搜索算法的有效性,能夠確保AUV在未知地磁環(huán)境下完成導(dǎo)航任務(wù)。

參考文獻(xiàn)：

[1] Stutters L, Liu H, Tiltman C, et al. Navigation technologies for autonomous underwater vehicles[J].IEEETrans.onSystems,Man,andCyberneticsPartC:ApplicationandReviews, 2008, 38(4): 581-589.

[2] Li X C, Zhang H X, Zhang S B. Thedevelopment of geomagnetic navigation technology[J].AerodynamicMissileJournal, 2013, 10(10): 80-83.(李興城, 張慧心, 張雙彪. 地磁導(dǎo)航技術(shù)的發(fā)展現(xiàn)狀[J].飛航導(dǎo)彈, 2013, 10(10): 80-83.)

[3] Cai Y Y, Wei H P, Ren Z X. The review of underwater geomagnetic navigation technology[J].NationalDefenseScience&Technology, 2007 (3): 28-29.(蔡兆云, 魏海平, 任治新. 水下地磁導(dǎo)航技術(shù)研究綜述[J].國防科技, 2007 (3): 28-29.)

[4] Liu F, Zhou X G, Yang Y, et al. Geomagnetic matching positioning technology[J].JournalofChineseInertialTechnology, 2007, 15(1): 59-62.(劉飛, 周賢高, 楊曄, 等. 相關(guān)地磁匹配定位技術(shù)[J].中國慣性技術(shù)學(xué)報(bào), 2007, 15(1): 59-62.)

[5] Benhamou S, Sudre J, Bourjea J, et al. The role of geomagnetic cues in green turtle open sea navigation[J].PLoSOne, 2011, 6(10): 266-272.

[6] Lohmann K J. Animal behaviour: magnetic-field perception[J].Nature, 2010, 464: 1140-1142.

[7] Nehmzow U.Scientificmethodsinmobilerobotics-quantitativeanalysisofagentbehaviour[M].USA：Springer Verlag, 2006.

[8] Bostr?m J E, ?kesson S, Alerstam T. Where on earth can animals use a geomagnetic bi-coordinate map for navigation?[J].Ecography, 2012,35: 1039-1047.

[9] Liu M, Liu K, Yang P, et al. Bio-inspired navigation based on geomagnetic[C]∥Proc.oftheIEEEInternationalConferenceonRoboticsandBiomimetics, 2013: 2339-2344.

[10] Liu M, Li H, Liu K. Geomagnetic navigation of AUV without a priori magnetic map[C]∥Proc.oftheIEEEOceans, 2014: 1-5.

[11] Goldenberg F. Geomagnetic navigation beyond the magnetic compass[C]∥Proc.oftheIEEE/IONPlans, 2006: 684-694.

[12] Wu Z C. Technology and application of magnetic gradient tensor[D].Wuhan: China University of Geosciences,2008.(吳招才.磁力梯度張量技術(shù)及其應(yīng)用研究[D]. 武漢: 中國地質(zhì)大學(xué),2008.)

[13] Cai J X, Ruan X G. Skinner operant conditioning learning model based on genetic algorithm[J].SystemsEngineeringandElectronics, 2011, 33(6): 1370-1376.(蔡建羨,阮曉鋼.基于遺傳算法的Skinner操作條件反射學(xué)習(xí)模型[J].系統(tǒng)工程與電子技術(shù), 2011, 33(6): 1370-1376.)

[14] Dai X M, Zou R M, Rong S, et al. Convergence properties of non-crossover genetic algorithm[C]∥Proc.ofthe4thWorldCongressonIEEEIntelligentControlandAutomation, 2002: 1822-1826.

李紅(1985-),女,博士研究生,主要研究方向?yàn)榈卮欧律鷮?dǎo)航、進(jìn)化搜索。

E-mail:mydreamli_hong@126.com。

劉明雍(1971-),男,教授,主要研究方向?yàn)樽灾魉潞叫衅髋c自主移動機(jī)器人、先進(jìn)控制理論與應(yīng)用、信息融合理論與應(yīng)用。

E-mail:liumingyong@nwpu.edu.cn

劉坤(1984-),男,博士研究生,主要研究方向?yàn)榈卮欧律鷮?dǎo)航、多目標(biāo)優(yōu)化。

E-mail:liukunkmz@126.com

Navigation method of autonomous underwater vehicle based on information entropy

LI Hong, LIU Ming-yong, LIU Kun

(CollegeofMarineScienceandTechnology,NorthwesternPolytechnicalUniversity,Xi’an710072,China)

Abstract:For the local optimal problem of the search algorithm with the disturbance by geomagnetic anomaly, a novel navigation method for autonomous underwater vehicle (AUV) is proposed from the information entropy. This method utilizes the variation of headings to represent the entropy values, and judges whether the evolution algorithm is trapped into the geomagnetic anomaly area based on the preset threshold. If the algorithm is trapped into the geomagnetic anomaly area, the method adopting the direction with the maximum probability mechanism is used to avoid trapping into the local minimum point. Experimental results and their analysis preliminarily demonstrate that the proposed method is able to achieve the navigational task.

Keywords:geomagnetic navigation; bio-inspired navigation; geomagnetic anomaly; local optimal

收稿日期：2015-06-12；修回日期：2015-09-24；網(wǎng)絡(luò)優(yōu)先出版日期：2015-12-19。

基金項(xiàng)目：國家自然科學(xué)基金(51179156,51379176)資助課題

中圖分類號：TP 18

文獻(xiàn)標(biāo)志碼：A

DOI:10.3969/j.issn.1001-506X.2016.06.26

作者簡介：

網(wǎng)絡(luò)優(yōu)先出版地址：http://www.cnki.net/kcms/detail/11.2422.TN.20151229.1755.012.html