基于DSP的平流層驗證飛艇組合導航系統(tǒng)設(shè)計

平流層空域處于飛行高度最高的飛機和軌道最低的衛(wèi)星之間，加之其具有良好的電磁特性和非常穩(wěn)定的氣象條件，因此人們不斷地嘗試利用平流層飛艇作為可長期駐空的平臺進行通信、對地觀測、國土資源監(jiān)測和預警等。由于飛艇具有獨特的優(yōu)勢：可直升、可長時間滯空，且具有較大的有效載荷能力和低能耗等特點，被人們稱為"多功能航空器"[1]，因此世界各國都在飛艇方面開展了多種多樣的研究。

鑒于平流層高空飛艇組合導航系統(tǒng)設(shè)計的復雜性，工程中利用低空飛艇對其進行驗證分析。由于低空飛艇所提供的升力有限，因此組合導航系統(tǒng)的小型化及經(jīng)濟化勢在必行。針對這種現(xiàn)狀，本文設(shè)計了基于dsp+mcu的專用導航計算機。小型驗證飛艇飛行試驗驗證了該系統(tǒng)可滿足實時性和精度的要求，為平流層飛艇的研制打下了基礎(chǔ)。

1 組合導航系統(tǒng)的基本原理

1.1 導航器件的特性

慣性導航系統(tǒng)是一種計算機技術(shù)和慣性測量裝置組合的自主式空間基準保持系統(tǒng)，在航天、航空、航海及陸地車輛有著廣泛的應(yīng)用。根據(jù)結(jié)構(gòu)可將其分為兩大類：平臺式和捷聯(lián)式。捷聯(lián)式慣導系統(tǒng)將慣性測量元件（陀螺和加速度計）固連在載體上，省去了傳統(tǒng)的機電平臺，具有結(jié)構(gòu)簡單、體積小、重量輕、成本低得優(yōu)點[2]。其中，微慣性測量組合（mimu）與傳統(tǒng)的慣性組合相比由于具有尺寸小，重量輕、成本低、功耗小、壽命長、可靠性高和動態(tài)性能好等一系列無法比擬的優(yōu)點，因此其應(yīng)用前景也越來越廣闊，是當今慣性技術(shù)發(fā)展的一個重要方向[3]?；诒鞠到y(tǒng)的具體應(yīng)用領(lǐng)域，本組合導航系統(tǒng)選用捷聯(lián)式微慣性測量組合（smimu）。

gps具有定位精度高、價格低廉等優(yōu)勢，在許多領(lǐng)域得到了廣泛的應(yīng)用。介紹其工作原理的文獻[4]比較多，在此不再贅述。

1.2 組合系統(tǒng)的狀態(tài)方程

選取狀態(tài)變量為慣導系統(tǒng)的各誤差項，系統(tǒng)采用東北天為其導航坐標系，通過對系統(tǒng)的性能和各種誤差源的分析，得到組合導航系統(tǒng)的狀態(tài)方程為：

（2）式中，觀測矢量z＝[δve，δvn，δvu，δl，δλ，δh]t，觀測噪聲矢量為v＝[vvx，vvy，vvz，vl，vλ，vh]t。

實際載體中，將組合導航系統(tǒng)測量得到的各種參量送入導航計算機，經(jīng)過一定的數(shù)據(jù)融合后對載體進行相應(yīng)的控制。

2 系統(tǒng)硬件設(shè)計

長期以來捷聯(lián)導航計算機一直采用x86為核心的計算機結(jié)構(gòu)，這不僅使得系統(tǒng)結(jié)構(gòu)復雜，體積龐大、功耗較高，并且程序效率和直接操作硬件的靈活性都受到影響。因此本系統(tǒng)中采用的運算精度高、接口資源豐富、成本低廉的高速dsp作為核心運算單元。

2.1 主要硬件特征

本系統(tǒng)導航計算任務(wù)由高速dsp完成，型號選用ti公司最新推出的32位定點dsp控制器--tms320f2812芯片。該處理器采用程序與數(shù)據(jù)分離的哈佛結(jié)構(gòu)，提升了數(shù)據(jù)吞吐量。其頻率高達150mhz，大大提高了控制系統(tǒng)的控制精度及核芯片處理能力；集成了128kb的閃存、4kb的引導rom及2kb的otp rom，可用于軟件開發(fā)及對現(xiàn)場軟件進行升級時的簡單再編程；優(yōu)化過的事件管理器包括脈沖寬度調(diào)制（pwm）產(chǎn)生器、可編程通用計時器以及捕捉譯碼接口等；片上標準通信接口可為主機、測試設(shè)備、顯示器及其他組件提供簡便的通信端口[5]。這些特性使得tms320f2812非常適合計算量大、實時性強、對計算精度要求高、接口復雜的處理環(huán)境。

利用mcu完成數(shù)據(jù)采集，接口擴展、電源開發(fā)和人機交互的功能，型號選為cygnal公司的c8051f021。該芯片采用流水線結(jié)構(gòu)，大大提高了指令運行速度，最大速度可達25mips。其含有豐富的數(shù)字外設(shè)，包括4個8位i/o端口，可同時使用的硬件包括smbus、spi和兩個增強型uart串口，5個通用的16位計數(shù)器/定時器，專用的看門狗定時器。該芯片的時鐘頻率達到25mhz。作為導航計算機的從處理器，該芯片能夠方便地擴展接口，實時采集各路傳感器信號。

2.2 基于dsp的系統(tǒng)硬件組成

基于dsp的硬件結(jié)構(gòu)如圖1所示。慣性測量元件包括3個陀螺儀和3個加速度計。tms320f2812帶有12位流水線的模/數(shù)轉(zhuǎn)換器（adc），模/數(shù)轉(zhuǎn)換單元的模擬電路包括前向模擬多路復用開關(guān)（muxs）、采樣/保持（s/h）電路、電壓參考以及其他的模擬輔助電路。其模/數(shù)轉(zhuǎn)換模塊（adc）有16個通道，可以配置為兩個獨立的8通道模塊，分別服務(wù)于事件管理器a和b。因此陀螺儀與加速度計測量得到的角速度與加速度信息不必再通過外圍專門的模/數(shù)轉(zhuǎn)換電路，而是經(jīng)過一定的信號預處理之后直接送入dsp。這樣就簡化了系統(tǒng)的硬件重量和復雜度，提高了系統(tǒng)的可靠性。gps采集到的位置、姿態(tài)等數(shù)字量信息可以通過rs232串口送入dsp。

c8051f021主要完成底層控制。根據(jù)tms320f2812傳入的數(shù)據(jù)，對舵機和能源進行相應(yīng)的控制；并且將實時導航數(shù)據(jù)（速度、位置、姿態(tài)）送入液晶顯示器，方便人機交互。對c8051f021的外部i/o端口進行接口擴展，完成相應(yīng)的控制任務(wù)。

3 系統(tǒng)軟件設(shè)計

以第1節(jié)中介紹的ins系統(tǒng)的誤差方程為狀態(tài)方程，以gps和ins的輸出誤差為觀測量，通過一定的算法對狀態(tài)誤差作出最優(yōu)估計，然后對系統(tǒng)進行校正，提高系統(tǒng)的導航精度?，F(xiàn)代的導航算法普遍采用卡爾曼濾波改進算法和神經(jīng)網(wǎng)絡(luò)算法，參考文獻[6]中進行了詳細介紹。

軟件設(shè)計所采用的語言一般為c語言或匯編語言。在對實時性要求較低的場合，一般采用c語言編程，而在對實時性要求較高或者頻率與外設(shè)交換信息的場合，則利用匯編語言進行編程。本系統(tǒng)軟件流程圖如圖2所示。

利用某小型平流層驗證飛艇進行了試飛實驗，其飛行試驗數(shù)據(jù)示意圖如圖3所示。圖3（a）為飛艇起飛前的準備階段以及飛行過程中的姿態(tài)角信息示意圖。由圖可見測量系統(tǒng)采集到9300個點左右，其在俯仰、滾動角中有少量噪聲存在，這在系統(tǒng)誤差的允許范圍內(nèi)。點位為9200時的姿態(tài)角的跳變是由于艇降落時的非平穩(wěn)性而出現(xiàn)姿態(tài)的較大變動。偏航角信息中角度的跳變是因為偏航角的范圍為0-360度，當角度從接近360度繼續(xù)增加時，角度就會跳轉(zhuǎn)到0度附近，此時便會發(fā)生如圖3（a）第三個小圖中的跳變了。

為了分析問題的方便，將飛行過程中的最后880個點提取出來。圖3（b）為這一階段的載體姿態(tài)角信息示意圖，圖3（c）為這一過程對應(yīng)的飛艇飛行路線圖（起點為a、終點為b）。由圖中可以看出飛艇的滾動角變化量很小，這符合實際情況；而偏航角的變化則可以明顯地體現(xiàn)出飛艇飛行航向的變化。圖中對最后階段的不穩(wěn)定過程也有十分精確的描述。