左穎輝++王月海
摘 要 為了提高無人飛艇自主垂直起飛和降落過程的高精度高度定位,本文提出了一種信息融合方法,即在機(jī)上安裝多個(gè)傳感器測(cè)量高度,根據(jù)飛行控制系統(tǒng)高度狀態(tài)方程,充分利用各傳感器的測(cè)量信息進(jìn)行遞推平均濾波和Kalman濾波,最后提出了一種基于GNSS高度、氣壓高度和對(duì)地高度的信息融合方案,設(shè)計(jì)了相應(yīng)的融合算法,從而進(jìn)行修正。
【關(guān)鍵詞】無人飛艇 信息融合 測(cè)量高度 平均濾波
1 前言
無人飛艇是利用輕于空氣的氣體(如氦氣等)作為升力的飛行器,其基本原理是在軟式囊體內(nèi)沖入氦氣,產(chǎn)生浮力以克服重力,同時(shí)通過控制飛艇的舵面和動(dòng)力裝置實(shí)現(xiàn)飛艇控制飛行。無人飛艇在飛行動(dòng)態(tài)情況下,GNSS/INS組合導(dǎo)航系統(tǒng)的高度估計(jì)值有較大誤差,不能直接使用,因此本文考慮使用多個(gè)傳感器測(cè)量無人飛艇高度,并進(jìn)行數(shù)據(jù)融合,以降低高度測(cè)量誤差,提高無人飛艇的飛行安全性。
2 多傳感器氣壓高度采集模塊
高度信息可以由多種傳感器進(jìn)行測(cè)量,各種傳感器的特點(diǎn)和適用場(chǎng)合不同。首先總結(jié)了GNSS接收機(jī)、氣壓高度計(jì)和超聲測(cè)距儀等常用高度傳感器的特點(diǎn);然后針對(duì)氣壓高度計(jì)抗干擾能力弱的不足,對(duì)氣壓高度分別進(jìn)行遞推平均濾波和卡爾曼濾波,并討論兩種濾波算法的特點(diǎn);最后提出了一種基于GNSS高度、氣壓高度和對(duì)地高度的信息融合方案,設(shè)計(jì)了相應(yīng)的融合算法。
本文設(shè)計(jì)的無人飛艇系統(tǒng)攜帶多種高度測(cè)量傳感器,包括GNSS接收機(jī)、氣壓高度計(jì)和超聲測(cè)距儀等。
3 氣壓高度的濾波算法
對(duì)氣壓高度來說,大氣壓力隨時(shí)間、地理位置、天氣和氣溫等因素變化,為了提高抗干擾能力,保證氣壓高度穩(wěn)定性,需要對(duì)氣壓高度進(jìn)行濾波。
本文使用Matlab對(duì)氣壓高度進(jìn)行遞推平均濾波,取隊(duì)列長度n為10得到濾波前后的高度曲線如圖1所示。
Kalman濾波方法由匈牙利裔美國數(shù)學(xué)家R. E. Kalman在1960年提出,已經(jīng)在控制等領(lǐng)域獲得了廣泛的應(yīng)用。
本文使用Matlab對(duì)氣壓高度進(jìn)行卡爾曼濾波,取過程噪聲的協(xié)方差Q值恒為0.01,測(cè)量噪聲的協(xié)方差R值恒為0.05,得到濾波前后的高度曲線如圖2所示。
為了減小滯后,提高靈敏度,在應(yīng)用卡爾曼濾波算法時(shí),對(duì)傳感器精度有較高要求。本文采用的氣壓高度計(jì)MS5611分辨率可達(dá)0.1m,精度較高,可以使用卡爾曼濾波算法進(jìn)行濾波。
卡爾曼濾波是目前應(yīng)用最為廣泛的濾波方法,對(duì)于大部分的問題,它是最優(yōu)、效率最高甚至是最有用的,因此本文選擇卡爾曼濾波算法對(duì)氣壓高度進(jìn)行濾波。
4 高度信息融合方法
本文選擇卡爾曼濾波算法對(duì)氣壓高度進(jìn)行濾波,并對(duì)GNSS高度、氣壓高度和對(duì)地高度進(jìn)行信息融合,融合方案如圖3所示。
5 結(jié)論
(1)首先對(duì)抗干擾能力差的氣壓高度進(jìn)行卡爾曼濾波,然后對(duì)GNSS高度、氣壓高度和對(duì)地高度進(jìn)行信息融合;該方案利用軟件算法提高了高度信息的測(cè)量精度,可以編寫代碼實(shí)現(xiàn)后直接集成原有的代碼用于飛行控制系統(tǒng),實(shí)現(xiàn)了不增加硬件成本,保證了系統(tǒng)的完整性。
(2)已利用實(shí)際試飛實(shí)驗(yàn)數(shù)據(jù)驗(yàn)證本文方法,結(jié)果表明該方法提高了系統(tǒng)高度信息獲取的準(zhǔn)確度。
參考文獻(xiàn)
[1]王日俊,白越,續(xù)志軍,趙常均,張欣,田彥濤.基于擾動(dòng)觀測(cè)器的機(jī)載云臺(tái)擾動(dòng)復(fù)合補(bǔ)償方法[J].光電子·激光,2015(01).
[2]張欣,白越,趙常均,王日俊,宮勛,續(xù)志軍.多旋翼姿態(tài)解算中的改進(jìn)自適應(yīng)擴(kuò)展Kalman算法[J].光學(xué)精密工程,2014(12).
[3]牟宏偉.水下航行器組合導(dǎo)航系統(tǒng)與信息融合技術(shù)研究[D].哈爾濱:哈爾濱工程大學(xué),2013.
[4]袁克非.組合導(dǎo)航系統(tǒng)多源信息融合關(guān)鍵技術(shù)研究[D].哈爾濱:哈爾濱工程大學(xué),2012.
作者單位
北方工業(yè)大學(xué) 北京市 100041