許兆鵬，韓樹平

(海軍潛艇學(xué)院 水聲中心，山東青島266042)

0 引言

微處理器性能與網(wǎng)絡(luò)技術(shù)的不斷提高，解決了多部傳感器同步工作和數(shù)據(jù)傳輸上的問題，使得多傳感器聯(lián)合使用進(jìn)行目標(biāo)跟蹤成為一個重要的研究方向，其中，應(yīng)用兩部聲納基陣即雙基陣的量測信息對水中運(yùn)動目標(biāo)的跟蹤問題是研究的熱點之一。

勻加速運(yùn)動是目標(biāo)較為常見的運(yùn)動方式，但尚沒有基于雙基陣量測信息對水中勻加速運(yùn)動目標(biāo)跟蹤方面的研究，以往的研究只針對勻速直線運(yùn)動目標(biāo)［1～4］。這里將雙基陣量測的目標(biāo)方位信息和其中一部基陣量測的目標(biāo)頻率信息作觀測融合后，根據(jù)勻加速運(yùn)動狀態(tài)方程，建立雙基陣方位—頻率勻加速運(yùn)動目標(biāo)跟蹤系統(tǒng)。由于該跟蹤系統(tǒng)的觀測方程中含有非線性函數(shù)，則其為非線性系統(tǒng)。此時，對于系統(tǒng)的非線性性，根據(jù)量測值應(yīng)用非線性濾波算法對勻加速運(yùn)動目標(biāo)進(jìn)行狀態(tài)估計。為此，本文提出了一種雙基陣方位—頻率勻加速運(yùn)動目標(biāo)跟蹤算法。

本文又對該跟蹤系統(tǒng)的可觀測性進(jìn)行了研究。所謂可觀測性，是指系統(tǒng)在忽略觀測噪聲情況下目標(biāo)狀態(tài)是否有唯一解的問題，有唯一解則稱系統(tǒng)是完全可觀測的?？捎^測性是跟蹤系統(tǒng)進(jìn)行目標(biāo)跟蹤的前提和基礎(chǔ)，只有滿足可觀測條件才能對系統(tǒng)進(jìn)行正確求解，從而實現(xiàn)對目標(biāo)的有效跟蹤。以往的研究表明:對于非線性系統(tǒng)的可測性有多種定義方法，而按照線性系統(tǒng)的有關(guān)理論，線性系統(tǒng)的可測性具有明確的定義［5］。由于該系統(tǒng)的非線性性，這里擬從線性系統(tǒng)可測性的有關(guān)理論出發(fā)，通過將雙基陣方位—頻率勻加速運(yùn)動目標(biāo)跟蹤系統(tǒng)偽線性化來進(jìn)行可觀測性的研究，得到其可觀測性判定條件。最后，通過仿真驗證了算法的有效性和可觀測性判定條件的正確性。

1 雙基陣方位—頻率勻加速運(yùn)動目標(biāo)跟蹤算法

在水中目標(biāo)被動跟蹤問題中，由于跟蹤距離遠(yuǎn)遠(yuǎn)大于目標(biāo)深度，可以忽略深度的影響，將目標(biāo)與雙基陣設(shè)定在同一平面內(nèi)，即研究二維的目標(biāo)被動跟蹤問題［6］。為了便于研究，假設(shè)雙基陣位于同一觀測平臺，以基陣1為坐標(biāo)原點建立二維笛卡爾坐標(biāo)系，基陣2位于x軸，雙基陣聲學(xué)中心的間距為L;采樣間隔為T，第k個采樣時刻目標(biāo)以基陣1為基準(zhǔn)的相對運(yùn)動向量為 X(k)=［x(k)，y(k)，vx(k)，vy(k)，ax(k)，ay(k)］T，x(k)，y(k)為 x 方向與 y方向上的相對距離，vx(k)，vy(k)為 x方向與 y方向上的相對速度，ax(k)，ay(k)為x方向與y方向上的相對加速度;α(k)和β(k)分別為雙基陣所觀測的目標(biāo)方位，如圖1所示，這里假設(shè)基陣1觀測的目標(biāo)頻率信息為f(k)，目標(biāo)固有頻率為f0。

圖1 雙基陣跟蹤系統(tǒng)Fig 1 Tracking system of two sonar arrays

狀態(tài)方程為

式中 W(k)為過程高斯白噪聲，狀態(tài)矩陣Φ為

觀測方程為

式中 V(k)是量測高斯白噪聲，c為聲速。

式(1)和式(2)構(gòu)成了基于雙基陣方位—頻率的勻加速運(yùn)動目標(biāo)跟蹤系統(tǒng)。式(2)中含有非線性函數(shù)arctan{·}，則此跟蹤系統(tǒng)為非線性系統(tǒng)。針對系統(tǒng)的非線性性，依據(jù)各采樣時刻的量測值，采用擴(kuò)展卡爾曼濾波(EKF)算法或無跡卡爾曼(UKF)濾波算法等非線性濾波算法［7］，對該系統(tǒng)進(jìn)行勻加速運(yùn)動目標(biāo)狀態(tài)估計，從而可對勻加速目標(biāo)進(jìn)行跟蹤，此過程即構(gòu)成了基于雙基陣方位—頻率勻加速運(yùn)動目標(biāo)跟蹤算法。

2 系統(tǒng)可觀測性判定

2.1 偽線性化

為了便于系統(tǒng)可觀測性判定，將跟蹤系統(tǒng)由離散形式改寫成連續(xù)時間系統(tǒng)的形式，并對觀測方程進(jìn)行偽線性化。需說明的是:在分析過程中并沒有考慮噪聲的影響，這是因為噪聲的存在只對定位和跟蹤的精度有影響，而不影響系統(tǒng)的可觀測性。狀態(tài)向量改寫為

狀態(tài)方程改寫為式(3)

其中，t0為跟蹤起始時刻。

采用偽線性處理后［1，2］，量測方程改寫為

2.2 可觀測性判定條件

這里采用Jaufferet C提出的可觀測性判定定理［5］

可觀測的充要條件是:?Y≠0∈Rn，?t∈［t0，t1］，使得H(t)Φ(t，t0)Y≠0。

該定理又可用其逆否命題表述，可觀測充要條件是:?t∈［t0，t1］，如果 H(t)Φ(t，t0)Y=0，則 Y=0。

其表明系統(tǒng)在時間段［t0，t1］內(nèi)可觀測，當(dāng)且僅當(dāng)對任何一個非零向量 Y，總存在 t∈［t0，t1］使得 H(t)Φ(t，t0)Y≠0或者說若 H(t)Φ(t，t0)Y=0，則 Y 必須為0。

若假 設(shè) Y= ［y1，y2，y3，y4，y5，y6，y7］T，則 根 據(jù)H(t)Φ(t，t0)Y=0 可得方程組式(5)～ 式(7)

由于α(t)隨時間變化，要等式成立只能有y3=y4=y5=y6=0，將它們分別代入式(5)和式(7)可得式(10)和y7=0

由于α(t)隨時間變化，要等式成立只能有y1=y2=0。則Y即為零向量，所以，系統(tǒng)可觀測，此時只要基陣1測量的方位變化，即可滿足條件。

2)當(dāng) α'(t)=0時

式(8)恒為零，此時要使式(5)和式(6)組成的方程組有唯一解，則需方程組的行列式值 sin［α(t)-β(t)］不為零，則 α(t)-β(t)≠kπ。此時，由于行列式是隨t實時變化的，要使等式成立必有

亦由t-t0隨t實時變化，要使等式成立需y1=y3=y5=0和 y2=y4=y6=0，則式(7)中，y7=0。所以，得 Y=0，因此，系統(tǒng)可觀測，此時只要目標(biāo)不在雙基陣連線上運(yùn)動即可滿足條件。

綜上，雙基陣方位—頻率勻加速運(yùn)動目標(biāo)跟蹤系統(tǒng)可觀測條件為:只有當(dāng)勻加速運(yùn)動目標(biāo)在雙基陣連線上運(yùn)動，并且用于測量目標(biāo)頻率的基陣所測量的方位值不發(fā)生變化時，系統(tǒng)才不可觀測外，其余情況均可觀測。

3 仿真驗證

為使問題簡化，假設(shè)兩部聲納均靜止不動，聲納1的坐標(biāo)為(0，0 km)，聲納2的坐標(biāo)為(1，0 km)，兩聲納方位測量均方誤差分別為0.2°和0.3°，聲納1頻率測量均方誤差為0.5 Hz，目標(biāo)固有頻率為500 Hz，采樣周期為2 s;目標(biāo)初始速度為零，初始位置(-5，0 km)，航向90°，軸向分加速度(ax，ay)初始時為(0.04，0 m/s2)，過坐標(biāo)原點后變?yōu)?-0.04，0 m/s2)，運(yùn)動時間為1 000 s;采用本文所提方法進(jìn)行跟蹤，濾波時選用UKF濾波算法，Monte—Carlo仿真次數(shù)為50，跟蹤結(jié)果如圖2所示。

圖2 跟蹤結(jié)果Fig 2 Results of tracking

從仿真結(jié)果可看出:0～500 s，目標(biāo)在雙基陣連線上運(yùn)動，此時基陣1所測方位 α(t)恒為270°，即 α'(t)=0，不滿足可觀測條件，跟蹤結(jié)果不收斂;但當(dāng)目標(biāo)經(jīng)過原點后，α(t)=90°，方位發(fā)生變化，α'(t)≠0，此時滿足可觀測條件，跟蹤結(jié)果收斂。此外，應(yīng)用所提出的方法對目標(biāo)穩(wěn)定跟蹤時的跟蹤精度較高。

4 結(jié)論

基于雙基陣量測的方位信息和其中一部基陣量測的目標(biāo)頻率信息，根據(jù)勻加速運(yùn)動狀態(tài)方程，建立跟蹤系統(tǒng)，進(jìn)而提出了一種基于雙基陣方位—頻率勻加速運(yùn)動目標(biāo)跟蹤算法。從偽線性化角度出發(fā)，用線性理論中可觀測性判斷定理對該跟蹤系統(tǒng)進(jìn)行分析，給出了此系統(tǒng)的可觀測性判定條件。最后，通過仿真驗證了算法的有效性和可觀測性判定條件的正確性。

［1］杜選民，姚 藍(lán).多基陣聯(lián)合的無源純方位目標(biāo)運(yùn)動分析研究［J］.聲學(xué)學(xué)報，1999，24(6):605-610.

［2］陳伏虎，胡 青.多陣方位—頻率目標(biāo)運(yùn)動分析算法研究［J］.聲學(xué)與電子工程，2003(7):1-5.

［3］關(guān) 欣，何 友，衣 曉.雙基陣純方位水下被動目標(biāo)跟蹤性能仿真分析［J］.系統(tǒng)仿真學(xué)報，2003，15(10):1464-1466.

［4］曲 毅，劉 忠，屈津竹.基于時延的水中目標(biāo)純方位跟蹤算法［J］.系統(tǒng)工程與電子技術(shù)，2007，29(1):107-109.

［5］胡友峰.非機(jī)動水下三維被動目標(biāo)運(yùn)動分析研究［D］.西安:西北工業(yè)大學(xué)，2002:19-22.

［6］劉 忠，周 豐，石章松，等.純方位目標(biāo)運(yùn)動分析［M］.北京:國防工業(yè)出版社，2009:77.

［7］郭曉松，李奕芃，郭君斌.貝葉斯目標(biāo)跟蹤方法的研究［J］.計算機(jī)工程，2009，35(12):137-139.