基于SAR系統(tǒng)的無(wú)人機(jī)定位導(dǎo)航系統(tǒng)的設(shè)計(jì)

引言

　　無(wú)人飛機(jī)與載人飛機(jī)相比，它具有體積小、造價(jià)低、使用方便、對(duì)作戰(zhàn)環(huán)境要求低、戰(zhàn)場(chǎng)生存能力較強(qiáng)等優(yōu)點(diǎn)，備受世界各國(guó)軍隊(duì)的青睞。無(wú)人駕駛飛機(jī)以其準(zhǔn)確、高效和靈便的偵察、干擾、欺騙、搜索、校射及在非正規(guī)條件下作戰(zhàn)等多種作戰(zhàn)能力，發(fā)揮著顯著的作用，并引發(fā)了層出不窮的軍事學(xué)術(shù)、裝備技術(shù)等相關(guān)問(wèn)題的研究。

　　高空長(zhǎng)航時(shí)無(wú)人機(jī)的飛行高度利于觀測(cè)星體，為此，考慮在慣性/SAR 組合基礎(chǔ)上，采用慣性導(dǎo)航和星光組合，可以為SAR 成像提供高精度的姿態(tài)信息，提高SAR 成像質(zhì)量。

　　本文以長(zhǎng)航高空無(wú)人機(jī)成像期間對(duì)導(dǎo)航高精度要求為應(yīng)用背景，開(kāi)展了基于SAR 輔助的慣導(dǎo)/星光組合導(dǎo)航研究，結(jié)合SAR 工作的非連續(xù)特性，設(shè)計(jì)了SAR/慣導(dǎo)/星光組合導(dǎo)航定位方案，提出了非同步輸出多傳感器異步集中卡爾曼濾波算法，可有效提高導(dǎo)航定位系統(tǒng)的自主性和精度。

　　1 卡爾曼濾波器設(shè)計(jì)

　　設(shè)位移 s 時(shí)，飛機(jī)的位置坐標(biāo)為X （s），對(duì)于不同的位移值，均有一個(gè)X （s）值與之對(duì)應(yīng)，當(dāng)取樣位移不間斷變化時(shí)，就得到位置坐標(biāo)序列{X （s），X（s+1）……}，飛機(jī)位置預(yù)測(cè)序列{X （s+1），X（s+2）……}，該序列是系統(tǒng)噪聲等驅(qū)動(dòng)的一階遞歸模型，在x 軸方向推導(dǎo)狀態(tài)方程如下：

　　測(cè)量方程如下：

　　Zx （s）為s位移時(shí)飛機(jī)坐標(biāo)x軸向的測(cè)量值。

　　H 為測(cè)量參數(shù)，它是由測(cè)量系統(tǒng)和測(cè)量方法所確定，不隨位移變化的一個(gè)常數(shù)，因?yàn)槭菃文Ｐ?，取?，V（s）為測(cè)量噪聲。

　　均方估計(jì)誤差為Px （s+1） = E[Xx （s +1） — Xx （s）]2，在均方估計(jì)誤差為最小的準(zhǔn)則下，通過(guò)數(shù)學(xué)推導(dǎo)，即可得出飛機(jī)自動(dòng)控制的卡爾曼濾波公式，如下：

　　預(yù)估計(jì)方程：

　　計(jì)算卡爾曼濾波增益，得：

　　均方預(yù)測(cè)誤差方程：

　　同理，可以推導(dǎo)y，z 軸向的狀態(tài)方程，則飛機(jī)位置的狀態(tài)方程如下：

　　卡爾曼濾波是以預(yù)測(cè)加修正來(lái)實(shí)現(xiàn)濾波遞推的，其這個(gè)性質(zhì)，很容易通過(guò)計(jì)算機(jī)仿真實(shí)現(xiàn)，從而可以完成對(duì)飛機(jī)位置的預(yù)測(cè)，預(yù)估計(jì)方程：

同時(shí)，與地面基站雷達(dá)測(cè)量值進(jìn)行比對(duì)，調(diào)飛機(jī)因?yàn)闄C(jī)械振動(dòng)等原因造成的位移偏差，其濾波模型為：

圖 1 卡爾曼濾波的系統(tǒng)模型框圖