馬 爽,蔡 凱,劉元華
(北京遙感信息研究所,北京 100011)
旋轉(zhuǎn)長(zhǎng)基線干涉儀(RLBI)通過(guò)不斷旋轉(zhuǎn)形成時(shí)序上的多條虛擬基線來(lái)完成相位差解模糊和定位。與傳統(tǒng)的多通道干涉儀和陣列測(cè)向等方法相比,旋轉(zhuǎn)基線體制具有設(shè)備簡(jiǎn)單、通道一致性要求低等優(yōu)點(diǎn),但是,長(zhǎng)基線干涉儀只能測(cè)量得到模糊相位差,如何利用模糊相位差高效準(zhǔn)確地定位,是旋轉(zhuǎn)干涉儀定位體制需要解決的首要問(wèn)題。
要解決該問(wèn)題,最直接的思路是首先將模糊相位差恢復(fù)成真實(shí)相位差,再進(jìn)行定位解算。文獻(xiàn)[1-4]分別研究了圓陣、GPS測(cè)向、導(dǎo)彈導(dǎo)引頭測(cè)向和近場(chǎng)測(cè)向等條件下相位差解模糊的方法,實(shí)現(xiàn)了針對(duì)具體應(yīng)用場(chǎng)景的定位解算。但是,該類方法對(duì)信號(hào)測(cè)量間隔和精度要求高,一般需要滿足相對(duì)無(wú)模糊條件才能實(shí)現(xiàn)。為了擴(kuò)展適用范圍,文獻(xiàn)[5-7]探索了利用模糊相位差直接定位的方法,在定位解空間利用各種優(yōu)化算法直接搜索最優(yōu)解。該類方法不再需要恢復(fù)真實(shí)相位差,但是,計(jì)算量隨著可能定位區(qū)域的擴(kuò)大迅速增加,且定位精度與搜索粒度密切相關(guān),在具體應(yīng)用中受到一定限制。
本文在研究旋轉(zhuǎn)長(zhǎng)基線干涉儀相位差和模糊數(shù)變化特點(diǎn)的基礎(chǔ)上,提出了相位差“條帶”和“路徑”的概念,將需要搜索的解空間限制在模糊數(shù)序列空間中,與直接在定位空間中搜索相比,大大降低了解空間的維度。用隱馬爾可夫模型(HMM)對(duì)“條帶”轉(zhuǎn)移過(guò)程和相位差觀測(cè)過(guò)程進(jìn)行建模,通過(guò)結(jié)合“卡爾曼”濾波過(guò)程和“維特比”狀態(tài)解碼過(guò)程,同步實(shí)現(xiàn)了相位差解模糊和濾波定位。該算法能夠?qū)?shù)據(jù)進(jìn)行序貫處理,實(shí)時(shí)完成解模糊和定位,
定位性能與使用真實(shí)相位差進(jìn)行定位時(shí)的“卡爾曼”濾波算法一致。
旋轉(zhuǎn)基線通過(guò)不斷旋轉(zhuǎn)來(lái)獲取目標(biāo)在不同基線轉(zhuǎn)角下的相位差測(cè)量值。在旋轉(zhuǎn)過(guò)程中,目標(biāo)與基線的相對(duì)位置不斷變化,對(duì)應(yīng)的模糊數(shù)和相位差測(cè)量值也隨之改變,這一過(guò)程可以用HMM[8]來(lái)建模。
旋轉(zhuǎn)基線干涉儀采用單根基線測(cè)量信號(hào)相位差,真實(shí)相位差為:
式中,d為基線長(zhǎng)度,λ是信號(hào)波長(zhǎng),θ為信號(hào)到達(dá)方向與基線法平面的夾角。
干涉儀輸出的測(cè)量相位差φ′∈(-π,π],當(dāng)d>λ時(shí),存在相位差模糊,測(cè)量相位差φ′與真實(shí)相位差φ之間滿足如下關(guān)系:
式中,mod2π(·)表示按照2π取模,整數(shù)n稱為模糊數(shù)。
模糊數(shù)n的取值范圍為[-N,N],N為不超過(guò)dλ的整數(shù)。例如,當(dāng)信號(hào)頻率為3 GHz、基線長(zhǎng)度為1 m時(shí),模糊數(shù)的取值范圍為[-10,10]。
假設(shè)干涉儀基線在定位區(qū)域上方水平放置,定位區(qū)域內(nèi)每個(gè)點(diǎn)對(duì)應(yīng)的真實(shí)相位差φ、模糊相位差φ′和模糊數(shù)n具有如下特點(diǎn):
1)真實(shí)相位差φ連續(xù)分布,并沿基線矢量方向單調(diào)變化。φ的取值范圍由基線波長(zhǎng)比d/λ決定,d/λ越大,取值范圍也越大;基線法平面與定位平面交線對(duì)應(yīng)的相位差為0°。
2)模糊相位差φ′是真實(shí)相位差φ向(-π,π]區(qū)間內(nèi)塌縮的結(jié)果。由φ=0的區(qū)域向外,每當(dāng)φ超出(-π,π]范圍時(shí),就加上或減去2π的整數(shù)倍,使其值保持在(-π,π]區(qū)間中。
3)定位區(qū)域被劃分為一系列具有相同模糊數(shù)n的區(qū)域,區(qū)域的邊界由φ′=π對(duì)應(yīng)等相位差線確定,這些區(qū)域按照-N到N的順序沿基線矢量方向依次排列,隨著基線的旋轉(zhuǎn)不斷變化。
將定位區(qū)域上具有相同模糊數(shù)的區(qū)域稱為“條帶”。隨著基線的旋轉(zhuǎn),目標(biāo)位置所在條帶不斷變化。將每個(gè)測(cè)量時(shí)刻目標(biāo)所在的條帶n連接起來(lái),就構(gòu)成了一條“路徑”。圖1顯示一條可能的路徑在條帶空間的變化情況。
圖1 每個(gè)測(cè)量時(shí)刻目標(biāo)所在條帶構(gòu)成的路徑
目標(biāo)所在條帶與其位置和基線轉(zhuǎn)角有關(guān),將條帶作為隱變量,旋轉(zhuǎn)基線相位差序列的觀測(cè)過(guò)程可用HMM來(lái)描述。
HMM是一種時(shí)序的概率模型,描述由一個(gè)隱藏的馬爾可夫鏈隨機(jī)生成不可觀測(cè)的狀態(tài)隨機(jī)序列,再由各個(gè)狀態(tài)生成一個(gè)觀測(cè)而產(chǎn)生觀測(cè)隨機(jī)序列的過(guò)程,其中隱藏的隨機(jī)序列稱為狀態(tài)序列,觀測(cè)產(chǎn)生的隨機(jī)序列稱為觀測(cè)序列。
設(shè)Q={q1,q2,q3,…,q K}代表所有狀態(tài)的集合,V={v1,v2,v3,…,v M}代表所有可能觀測(cè)的集合,HMM可由如下三元組來(lái)描述:
式 中,A=[aij]K×K為 狀 態(tài) 轉(zhuǎn) 移 概 率 矩 陣,aij=P(st+1=qj|st=qi)表示從時(shí)刻t到時(shí)刻t+1由狀態(tài)qi轉(zhuǎn)移到狀態(tài)qj的概率;B=[bij]K×M為觀測(cè)概率矩陣,bij=P(ot=v j|st=qi)表示時(shí)刻t在qi狀態(tài)下觀測(cè)到v j的概率;Π=[πi]K×1為初始狀態(tài)概率向量,πi=P(s1=qi)代表t=1時(shí)刻處于狀態(tài)qi的概率。
具體到旋轉(zhuǎn)基線干涉儀定位的情況,目標(biāo)所在條帶n是不可觀測(cè)的隱藏狀態(tài),狀態(tài)集合Q={-N,-(N-1),…,N-1,N}。觀測(cè)集合對(duì)應(yīng)相位差測(cè)量值,是(-π,π]之間的連續(xù)變量。狀態(tài)轉(zhuǎn)移矩陣A用于描述基線旋轉(zhuǎn)導(dǎo)致的目標(biāo)在各“條帶”之間的轉(zhuǎn)移概率。觀測(cè)概率矩陣B表示目標(biāo)位于某一“條帶”時(shí)觀測(cè)到測(cè)量相位差的概率。Π代表目標(biāo)位置最初所在條帶的概率。
由上文可知,任意一條“路徑”對(duì)應(yīng)一個(gè)狀態(tài)序列s1s2s3…sT,如果能夠由測(cè)量相位差序列o1o2o3…o T推斷出目標(biāo)真實(shí)位置對(duì)應(yīng)的狀態(tài)序列,就實(shí)現(xiàn)了相位差解模糊。
接下來(lái),通過(guò)將“卡爾曼”濾波(Kalman filtering)過(guò)程嵌入到“維特比”算法(Viterbi algorithm)中,同步實(shí)現(xiàn)相位差動(dòng)態(tài)解模糊和濾波定位。
“卡爾曼”濾波[9]是一種經(jīng)典的遞歸濾波器,典型應(yīng)用是從一組包含噪聲的觀測(cè)序列中預(yù)測(cè)物體的運(yùn)動(dòng)狀態(tài)。在旋轉(zhuǎn)干涉儀定位中,假設(shè)真實(shí)相位差已知,卡爾曼濾波定位過(guò)程如下。
1)狀態(tài)方程和觀測(cè)方程
為了討論方便,假定目標(biāo)固定不動(dòng),對(duì)應(yīng)的狀態(tài)方程為:
狀態(tài)S=rT,rT=[x y z]T是目標(biāo)的直角坐標(biāo)矢量。
假設(shè)能夠測(cè)量到真實(shí)相位差φ,觀測(cè)方程為:φ=
式中,d為干涉儀基線長(zhǎng)度,b=[x b yb zb]T為單位基線矢量,r1=[x1y1z1]T是干涉儀所在位置的直角坐標(biāo)矢量。
2)卡爾曼濾波過(guò)程
根據(jù)以上的狀態(tài)方程和觀測(cè)方程,卡爾曼濾波的具體過(guò)程如下。
預(yù)測(cè):
最小預(yù)測(cè)均方誤差(MSE)矩陣:
卡爾曼增益:
修正:
最小MSE矩陣:
式中,σ2[n]為真實(shí)相位差φ的測(cè)量噪聲方差,H[n]為觀測(cè)方程φ=h(S)的雅克比矩陣
濾波過(guò)程中v(n)=φ[n]-h(S?[n|n-1]稱為“新息”,表示觀測(cè)值與預(yù)測(cè)值的差。
令?[-1|-1]等于目標(biāo)的初始位置[x0y0z0]T,M[-1|-1]等于目標(biāo)初始位置方差矩陣為相位差φ的觀測(cè)方差,通過(guò)遞歸計(jì)算,就可以得到對(duì)系統(tǒng)狀態(tài)S的估計(jì)。
3)雅克比矩陣H[n]的推導(dǎo)
雅克比矩陣H[n]是真實(shí)相位差φ關(guān)于目標(biāo)位置rT=[x y z]T的導(dǎo)數(shù):
式中,
令:
得:
以上是假設(shè)真實(shí)相位差φ已知情況下的卡爾曼濾波過(guò)程,但實(shí)際中干涉儀只能輸出測(cè)量相位差φ′,要完成濾波定位過(guò)程,就需要實(shí)時(shí)解出目標(biāo)所在的條帶n,接下來(lái),通過(guò)引入“維特比”算法來(lái)解決這一問(wèn)題。
“維特比”算法是HMM模型中根據(jù)觀測(cè)序列解碼狀態(tài)序列的標(biāo)準(zhǔn)算法。給定觀測(cè)序列o1o2o3…o T,要找出最可能的狀態(tài)序列s1s2s3…sT,使式(16)中的條件概率最大:
根據(jù)馬爾可夫齊次性假設(shè)和觀測(cè)獨(dú)立性假設(shè),等價(jià)于:
如果直接計(jì)算式(17),計(jì)算復(fù)雜度將是O(K T),式中,K為狀態(tài)數(shù),T為序列長(zhǎng)度,計(jì)算量非常大?!熬S特比”算法通過(guò)在“籬笆網(wǎng)絡(luò)(Lattice)”中應(yīng)用動(dòng)態(tài)規(guī)劃技術(shù),將計(jì)算復(fù)雜度降低為O(TK2),有效解決了狀態(tài)解碼問(wèn)題。
圖2給出了籬笆網(wǎng)絡(luò)的結(jié)構(gòu)。路徑在網(wǎng)絡(luò)中從左向右傳播,由于所有路徑必然經(jīng)過(guò)網(wǎng)絡(luò)中的每一列,且如果最大概率路徑經(jīng)過(guò)節(jié)點(diǎn)X ij,那么該路徑上從起始時(shí)刻到第i個(gè)時(shí)刻的部分路徑也必然是該時(shí)段所有路徑中的最大概率路徑。因此,在任一時(shí)刻t,只要考慮K條最大概率路徑即可[10]。
圖2 籬笆網(wǎng)絡(luò)(Lattice)的結(jié)構(gòu)
基于以上性質(zhì),籬笆網(wǎng)絡(luò)中最大概率的路徑的計(jì)算過(guò)程如下:
1)初始化。計(jì)算第一列各狀態(tài)節(jié)點(diǎn)的初始概率δ1,并記錄每個(gè)節(jié)點(diǎn)前一時(shí)刻的狀態(tài)ψ1:
式中,πk為狀態(tài)k的初始概率,bk(o1)為狀態(tài)k條件下觀測(cè)到o1的概率。由于第一列沒(méi)有前一時(shí)刻,因此ψ1(k)統(tǒng)一記為0。
2)遞推。對(duì)于t=2,3,…,T,根據(jù)下式遞推計(jì)算籬笆網(wǎng)絡(luò)中每一列的K個(gè)節(jié)點(diǎn)的概率δt,并記錄每個(gè)節(jié)點(diǎn)前一個(gè)時(shí)刻的狀態(tài)ψt:
式中,ajk為狀態(tài)j轉(zhuǎn)移到狀態(tài)k的概率,bk(ot)為狀態(tài)k條件下觀測(cè)到ot的概率。
3)終止。當(dāng)遞推到達(dá)時(shí)刻T后,遞推終止,此時(shí),按照下式計(jì)算最優(yōu)路徑概率P*和最優(yōu)路徑的最后一個(gè)狀態(tài)k*T:
4)回溯。找到最優(yōu)路徑的最后一個(gè)狀態(tài)k*T后,根據(jù)下式回溯出最大概率路徑:
最后求得最大概率路徑I*:
接下來(lái),通過(guò)將“卡爾曼”濾波步驟嵌入到“維特比”算法過(guò)程中,擴(kuò)展上述遞歸過(guò)程,完成狀態(tài)轉(zhuǎn)移概率A=[aij]K×K和觀測(cè)概率B t=[bi(ot)]K×1的計(jì)算,同步實(shí)現(xiàn)旋轉(zhuǎn)基線干涉儀相位差解模糊和濾波定位。
2.3.1 初始化籬笆網(wǎng)絡(luò)和濾波狀態(tài)
根據(jù)式(18)、式(19),初始化籬笆網(wǎng)絡(luò)的狀態(tài),由于目標(biāo)的位置未知,信號(hào)到達(dá)的初始時(shí)刻基線的旋轉(zhuǎn)角度也是隨機(jī)的,因此,可以簡(jiǎn)單地認(rèn)為目標(biāo)位于各個(gè)條帶的概率是相等的,即πi=1/k,i=1,2,…,K。同樣,由于目標(biāo)在條帶中的具體位置未知,觀測(cè)概率的最初狀態(tài)概率也認(rèn)為是相等的,bk(o1)=1/k,i=1,2,…,K,因此:
在籬笆網(wǎng)絡(luò)中,初始時(shí)刻的每個(gè)狀態(tài)代表目標(biāo)所在的條帶,也就是可能的模糊數(shù)n∈[-N,N]。根據(jù)測(cè)量相位差φ′和模糊數(shù)n可以恢復(fù)出K=2N+1個(gè)可能的真實(shí)相位差φ(k),利用φ(k)根據(jù)式(6)-(10)執(zhí)行一步濾波定位,得到初始時(shí)刻每個(gè)狀態(tài)下的一次定位位置S1(k)和最小均方誤差矩陣M1(k)。
2.3.2 遞推計(jì)算濾波位置和最大概率路徑
注意到“卡爾曼”濾波和“維特比”最大概率路徑計(jì)算過(guò)程都采用遞歸的方式計(jì)算,將2種過(guò)程融合在一起,用籬笆網(wǎng)絡(luò)的狀態(tài)k將測(cè)量相位差φ′轉(zhuǎn)換為真實(shí)相位差φ(k),用其進(jìn)行一步濾波定位,同時(shí),用該濾波定位結(jié)果對(duì)應(yīng)的估計(jì)相位差φ?(k)與真實(shí)相位差φ(k)之間的相似程度來(lái)計(jì)算觀測(cè)概率,完成一步遞歸計(jì)算,具體步驟如下:
1)執(zhí)行一步濾波定位
對(duì)于籬笆網(wǎng)絡(luò)中的節(jié)點(diǎn)X tk,利用該節(jié)點(diǎn)對(duì)應(yīng)的模糊數(shù)n將測(cè)量相位差φ′t轉(zhuǎn)換為真實(shí)相位差φt(k):
分別以t-1時(shí)刻的K個(gè)節(jié)點(diǎn)對(duì)應(yīng)的濾波位置St-1(k),k=1,2,…,K和 最 小 均 方 誤 差 矩 陣M t-1(k),k=1,2,…,K為狀態(tài),φt(k)為觀測(cè)值,根據(jù)式(6)-(10)執(zhí)行一步濾波定位,得到節(jié)點(diǎn)X tk下的K個(gè) 濾 波 位 置Stk(j),j=1,2,…,K和M tk(j),j=1,2,…,K。
2)計(jì)算狀態(tài)轉(zhuǎn)移概率
狀態(tài)轉(zhuǎn)移概率矩陣A=[aij]K×K,其中aij表示隨著基線的旋轉(zhuǎn),在相鄰時(shí)刻目標(biāo)在從條帶i轉(zhuǎn)移到條帶j的概率。根據(jù)在時(shí)刻t對(duì)系統(tǒng)狀態(tài)了解程度的不同,按照以下幾種情況來(lái)計(jì)算狀態(tài)轉(zhuǎn)移概率。
①無(wú)任何先驗(yàn)知識(shí)的情況
在目標(biāo)位置無(wú)任何先驗(yàn)知識(shí),且時(shí)刻t-1到t之間的時(shí)間間隔隨機(jī)產(chǎn)生的情況下,隨著基線的旋轉(zhuǎn),目標(biāo)位置可能在任意2個(gè)條帶之間轉(zhuǎn)移,此時(shí),可以簡(jiǎn)單認(rèn)為轉(zhuǎn)移概率是平均分布的,即:
②目標(biāo)粗略位置已知的情況
假設(shè)已經(jīng)獲取了目標(biāo)的粗略位置,例如在濾波定位過(guò)程中不斷接近目標(biāo)真實(shí)位置,那么,在t-1時(shí)刻,根據(jù)位置利用式(2)和式(5)可以估計(jì)出目標(biāo)可能的條帶范圍,例如連續(xù)的3個(gè)條帶(i-1,i,i+1),基線旋轉(zhuǎn)到t時(shí)刻,同樣可以計(jì)算出另一個(gè)可能的條帶范圍,例如(j-1,j,j+1),這樣,從t-1時(shí)刻到t時(shí)刻,轉(zhuǎn)移概率可以表示為:
具體的條帶范圍需要根據(jù)估計(jì)位置與真實(shí)位置的接近程度來(lái)設(shè)置,越接近,則可能的條帶范圍越小,否則,需要給多個(gè)可能的條帶賦予非零概率。
③相對(duì)相位差無(wú)模糊的情況
當(dāng)t-1和t時(shí)刻的真實(shí)相位差滿足|φt-φt-1|≤π時(shí),稱為相位差相對(duì)無(wú)模糊。此時(shí),可以恢復(fù)出測(cè)量相位差φ′t+1和φ′t之間真實(shí)的差值。文獻(xiàn)[1]中證明,當(dāng)|Δω|≤2arcsin(λ(4d))時(shí),干涉儀覆蓋范圍內(nèi)任意位置的相位差相對(duì)無(wú)模糊。此時(shí),轉(zhuǎn)移概率可以表示為:
當(dāng)φ′t-φ′t-1≤-π時(shí),
當(dāng)φ′t-φ′t-1>π時(shí),
當(dāng)-π<φ′t-φ′t-1≤π時(shí),
3)計(jì)算觀測(cè)概率
觀測(cè)概率bk(ot)表示t時(shí)刻在狀態(tài)k下觀測(cè)到ot的概率。相位差是由位置決定的,經(jīng)過(guò)一次濾波后,在節(jié)點(diǎn)X tk下有K個(gè)濾波位置Stk(j),j=1,2,…,K,根據(jù)式(5)可計(jì)算出對(duì)應(yīng)的K個(gè)相位差:
將φtk(j)與真實(shí)相位差φt(i)之間的相似程度作為計(jì)算觀測(cè)概率bk(ot)的依據(jù)。首先利用sigmoid函數(shù)將φtk(j)-φt(i)變換到(-1,1)的范圍內(nèi):
然后按照標(biāo)準(zhǔn)正態(tài)分布計(jì)算觀測(cè)概率:
4)保存最大概率狀態(tài)
對(duì)于進(jìn)入節(jié)點(diǎn)X tk的K條路徑,選取當(dāng)前最大的部分路徑概率對(duì)應(yīng)的一條作為X tk的狀態(tài)。根據(jù)下式計(jì)算籬笆網(wǎng)絡(luò)中時(shí)刻t的K個(gè)節(jié)點(diǎn)的概率δt,并記錄每個(gè)節(jié)點(diǎn)前一個(gè)時(shí)刻的狀態(tài)ψt:
記錄最大概率路徑對(duì)應(yīng)的濾波位置和最小均方誤差矩陣:
5)遞歸終止和路徑回溯
當(dāng)遞推到達(dá)時(shí)刻T后,遞推終止,此時(shí),按照下式計(jì)算最優(yōu)路徑概率P*、最優(yōu)路徑的最后一個(gè)狀態(tài)k*T和濾波定位位置S*T:
找到最優(yōu)路徑的最后一個(gè)狀態(tài)k*T后,根據(jù)下式回溯出最大概率路徑:
最后求得最大概率路徑I*:
至此,完成了“維特比-卡爾曼”濾波定位的全過(guò)程。該算法利用“維特比”算法根據(jù)測(cè)量相位差序列解碼最優(yōu)路徑,相當(dāng)于解出每次測(cè)量時(shí)對(duì)應(yīng)的模糊數(shù),從而利用真實(shí)相位差完成濾波定位。定位性能方面與“卡爾曼”濾波一致,此處不再贅述。
仿真場(chǎng)景設(shè)置如下:目標(biāo)位置的經(jīng)緯度為[123.117 5°,23.553 1°],旋 轉(zhuǎn) 基 線 位 置 的 經(jīng) 緯 度 為[125°,28°],在500 km高度水平放置,基線長(zhǎng)度為2 m,按照360°/s的速度旋轉(zhuǎn)。輻射源信號(hào)脈沖重復(fù)間隔在[1 000μs,10 000μs]區(qū)間內(nèi)隨機(jī)選取,脈沖列長(zhǎng)度為100。濾波初始位置經(jīng)緯度隨機(jī)選取為[124.132 7°,22.080 9°]。
采用“維特比-卡爾曼”濾波算法進(jìn)行處理,經(jīng)過(guò)100步濾波后得到定位位置的經(jīng)緯度為[123.114 7°,23.551 3°],定位誤差為351 m,與利用真實(shí)相位差進(jìn)行卡爾曼濾波后的定位結(jié)果一致。濾波定位每一步的結(jié)果如圖3所示。其中,圖3(a)給出了濾波定位過(guò)程中估計(jì)位置不斷接近真實(shí)位置的情況;圖3(b)是濾波過(guò)程中最大概率路徑對(duì)應(yīng)的相位差“新息”的變化情況,可見(jiàn),隨著濾波的進(jìn)行,相位差“新息”在不斷減小,說(shuō)明估計(jì)相位差與真實(shí)相位差越來(lái)越接近;圖3(c)給出了籬笆網(wǎng)格中由最終狀態(tài)回溯的所有路徑(13條)的每一步的定位結(jié)果,可見(jiàn),非真實(shí)路徑對(duì)應(yīng)的定位結(jié)果始終是發(fā)散的,而真實(shí)路徑對(duì)應(yīng)的結(jié)果逐漸收斂到真實(shí)位置(紅色星號(hào));圖3(d)給出了在維特比遞推過(guò)程中籬笆網(wǎng)絡(luò)中每一列最大概率的變化情況,可見(jiàn),隨著遞歸的進(jìn)行,真實(shí)路徑上的概率比重不斷增加,而其它路徑上的概率由于采用了錯(cuò)誤的相位差進(jìn)行濾波,無(wú)法收斂到真實(shí)位置,導(dǎo)致概率比重逐漸減小,通過(guò)選取最大概率的狀態(tài)并回溯后,找出真實(shí)路徑,從而實(shí)現(xiàn)相位差解模糊和定位。
圖3 “維特比-卡爾曼”濾波算法一次仿真中的定位過(guò)程
本文研究了旋轉(zhuǎn)長(zhǎng)基線干涉儀利用模糊相位差直接定位問(wèn)題。首先用HMM對(duì)旋轉(zhuǎn)基線定位過(guò)程建模,利用維特比算法根據(jù)測(cè)量相位差解碼模糊數(shù)序列,在籬笆網(wǎng)格計(jì)算過(guò)程中引入卡爾曼濾波步驟,同步計(jì)算目標(biāo)估計(jì)位置和最優(yōu)路徑概率,解碼最優(yōu)狀態(tài)序列,實(shí)現(xiàn)了利用模糊相位差直接濾波定位。最后用仿真實(shí)驗(yàn)驗(yàn)證了算法的有效性。■