基于SAR系統的無(wú)人機定位導航系統的設計
引言
本文引用地址:http://dyxdggzs.com/article/155684.htm無(wú)人飛機與載人飛機相比,它具有體積小、造價(jià)低、使用方便、對作戰環(huán)境要求低、戰場(chǎng)生存能力較強等優(yōu)點(diǎn),備受世界各國軍隊的青睞。無(wú)人駕駛飛機以其準確、高效和靈便的偵察、干擾、欺騙、搜索、校射及在非正規條件下作戰等多種作戰能力,發(fā)揮著(zhù)顯著(zhù)的作用,并引發(fā)了層出不窮的軍事學(xué)術(shù)、裝備技術(shù)等相關(guān)問(wèn)題的研究。
高空長(cháng)航時(shí)無(wú)人機的飛行高度利于觀(guān)測星體,為此,考慮在慣性/SAR 組合基礎上,采用慣性導航和星光組合,可以為SAR 成像提供高精度的姿態(tài)信息,提高SAR 成像質(zhì)量。
本文以長(cháng)航高空無(wú)人機成像期間對導航高精度要求為應用背景,開(kāi)展了基于SAR 輔助的慣導/星光組合導航研究,結合SAR 工作的非連續特性,設計了SAR/慣導/星光組合導航定位方案,提出了非同步輸出多傳感器異步集中卡爾曼濾波算法,可有效提高導航定位系統的自主性和精度。
1 卡爾曼濾波器設計
設位移 s 時(shí),飛機的位置坐標為X (s),對于不同的位移值,均有一個(gè)X (s)值與之對應,當取樣位移不間斷變化時(shí),就得到位置坐標序列{X (s),X(s+1)……},飛機位置預測序列{X (s+1),X(s+2)……},該序列是系統噪聲等驅動(dòng)的一階遞歸模型,在x 軸方向推導狀態(tài)方程如下:
測量方程如下:
Zx (s)為s位移時(shí)飛機坐標x軸向的測量值。
H 為測量參數,它是由測量系統和測量方法所確定,不隨位移變化的一個(gè)常數,因為是單模型,取為1,V(s)為測量噪聲。
均方估計誤差為Px (s+1) = E[Xx (s +1) — Xx (s)]2,在均方估計誤差為最小的準則下,通過(guò)數學(xué)推導,即可得出飛機自動(dòng)控制的卡爾曼濾波公式,如下:
預估計方程:
計算卡爾曼濾波增益,得:
均方預測誤差方程:
同理,可以推導y,z 軸向的狀態(tài)方程,則飛機位置的狀態(tài)方程如下:
卡爾曼濾波是以預測加修正來(lái)實(shí)現濾波遞推的,其這個(gè)性質(zhì),很容易通過(guò)計算機仿真實(shí)現,從而可以完成對飛機位置的預測,預估計方程:
同時(shí),與地面基站雷達測量值進(jìn)行比對,調飛機因為機械振動(dòng)等原因造成的位移偏差,其濾波模型為:
圖 1 卡爾曼濾波的系統模型框圖
評論