李富剛,張聰,田福禮,張喆
(中國飛行試驗研究院 飛行仿真實驗室,西安 710089)
飛行數(shù)據(jù)相容性檢驗方法
李富剛,張聰,田福禮,張喆
(中國飛行試驗研究院 飛行仿真實驗室,西安 710089)
飛行試驗測量數(shù)據(jù)中存在過程噪聲和測量噪聲,導(dǎo)致飛行數(shù)據(jù)之間不相容,國內(nèi)目前常用的輸出誤差法不適用于耦合嚴重的直升機飛行數(shù)據(jù)相容性檢驗。采用增廣卡爾曼濾波方法進行狀態(tài)估計,大幅度地消除測量值中的誤差;再用輸出誤差法對增廣卡爾曼濾波估計的結(jié)果進行相容性檢驗,并將其應(yīng)用于直升機四階縱向等效模型辨識中。結(jié)果表明:提出的這種方法既解決了單獨使用增廣卡爾曼濾波進行數(shù)據(jù)相容性分析時由于初期收斂過程造成的濾波誤差問題,又克服了單獨使用輸入誤差法進行數(shù)據(jù)相容性時需手動修改時間延遲問題和測量值中誤差過大時輸出誤差法無法收斂問題,使得檢驗效果與計算效率大幅提升。
增廣卡爾曼濾波;相容性檢驗;飛行試驗;狀態(tài)估計
飛行數(shù)據(jù)相容性檢驗是通過對測量量的尺度因子誤差、系統(tǒng)誤差進行適當?shù)男拚沟酶鱾€通道所測得的飛行數(shù)據(jù)彼此相容,即滿足飛機運動方程。該項工作引起多數(shù)國家的重視[1-2],并且相繼出現(xiàn)了一系列算法,例如:增廣卡爾曼濾波算法、最小二乘算法、極大似然法、極大似然法的簡化方法輸出誤差法等[3]。直升機飛行數(shù)據(jù)相容性檢驗是直升機模型辨識工作的必備步驟和關(guān)鍵部分,目前,國內(nèi)的研究主要集中在數(shù)據(jù)相容性檢驗后的模型辨識部分,對直升機數(shù)據(jù)相容性檢驗的研究較少[4-6]。國內(nèi),主要采用極大似然法及輸出誤差法進行飛行數(shù)據(jù)相容性檢驗。極大似然法為局部尋優(yōu),其固有缺點是當測量值中的誤差過大(遠離最優(yōu)點)時,算法不易收斂甚至發(fā)散,而且還需通過對比由角速率積分得到的姿態(tài)角和測量姿態(tài)角之間的時間差,手動修正時間延遲??柭鼮V波初期收斂過程造成濾波誤差,致使濾波結(jié)果前面部分效果差、后面部分效果好的現(xiàn)象。英國J2航空公司的飛機模型辨識軟件中數(shù)據(jù)相容性檢驗部分采用卡爾曼濾波方法與其他方法結(jié)合的方法[7]。
本文將兩種方法相結(jié)合,先用增廣卡爾曼濾波方法進行整體估計,大幅消除測量數(shù)據(jù)中的誤差,再用輸出誤差法對估計結(jié)果進行相容性檢驗。集成增廣卡爾曼濾波和輸出誤差法的飛行數(shù)據(jù)相容性檢驗技術(shù)同時具備兩種方法的優(yōu)點,又可以克服兩種方法原有的缺點,以期將該技術(shù)應(yīng)用于飛機模型驗證前期的數(shù)據(jù)相容性檢驗。
1.1 飛行數(shù)據(jù)相容性檢驗?zāi)P徒?/p>
用于飛行試驗數(shù)據(jù)相容性檢驗方程如下:
(1)
假設(shè)輸入量誤差模型:
(2)
觀測量誤差模型:
(3)
式中:λ為縮放因子;ε為穩(wěn)態(tài)差;η為均值為0的測量噪聲,帶下標e的量表示測量值。
將輸入方程組(2)和方程組(3)代入方程組(1)中,將需要估計的縮放因子、穩(wěn)態(tài)誤差增加到狀態(tài)量中,即得到飛機運動的狀態(tài)方程和觀測方程:
(4)
zk=h(xk)+uk
(5)
式中:
x=[u,v,w,φ,θ,ψ,xg,yg,h,λ,ε]T
u=[axe,aye,aze,pe,qe,re]T
w=[ηax,ηay,ηaz,ηp,ηq,ηr]T
zk=[φe,θe,ψe,αe,βe,Ve,xge,yge,he]T
uk=[ηφ,ηθ,ηψ,ηα,ηβ,ηv,ηxg,ηyg,ηh]T
λ=[λax,λay,λaz,λp,λq,λr,λφ,λθ,λψ,λα,λβ,λv,λxg,λyg,λh]
ε=[εax,εay,εaz,εp,εq,εr,εφ,εθ,εψ,εα,εβ,εv,εxg,εyg,εh]
得到方程(4)和方程(5)后,即可利用增廣卡爾曼濾波理論對模型中的參數(shù)進行高精度估計和數(shù)據(jù)重構(gòu)。
1.2 增廣卡爾曼濾波理論
假設(shè)帶誤差的非線性系統(tǒng)模型和觀測模型如下[8-13]:
(6)
zk=h(xk)+vk,vk~N(0,Rk)
(7)
式中:x,u為系統(tǒng)狀態(tài)量和輸入量;zk為觀測量;f、h為狀態(tài)方程組函數(shù)和觀測方程組函數(shù);w(t),vk為過程激勵噪聲和觀測噪聲,假設(shè)它們是相互獨立并滿足正態(tài)分布的白噪聲;N[0,Q(t)]、N(0,Rk)為正態(tài)分布,Q(t)、Rk為協(xié)方差矩陣;xk=x(tk)。
對狀態(tài)方程和觀測方程的一階(或者二階)泰勒展開近似進行卡爾曼濾波,即為增廣卡爾曼濾波。本文采用一階泰勒近似,具體算法過程如下:
第一步:狀態(tài)量、狀態(tài)量誤差協(xié)方差矩陣初始值選擇
P0|0=Var[x(t0)]
第二步:狀態(tài)量、誤差協(xié)方差矩陣預(yù)測
(8)
第三步:增益、狀態(tài)量、狀態(tài)量誤差協(xié)方差矩陣更新
(9)
(10)
Pk|k=(I-KkHk)Pk|k-1
(11)
方程組(8)~方程組(11)即為增廣卡爾曼濾波的主要部分。循環(huán)第二步和第三步直到數(shù)據(jù)段結(jié)束。
將該理論應(yīng)用于求解1.1節(jié)中推導(dǎo)得到的方程(4)和方程(5)中的狀態(tài)量、偏差、尺度因子的估計。
1.3增廣卡爾曼濾波初值選擇,噪聲協(xié)方差矩陣計算
在進行濾波之前,先要估計狀態(tài)量x和誤差協(xié)方差矩陣P的初值。狀態(tài)量中的u,v,w,φ,θ,ψ,xg,yg,h的初值取試飛數(shù)據(jù)中試飛動作的開始時前幾秒穩(wěn)態(tài)狀態(tài)的平均值;εax,εay,εaz,εp,εq,εr,εφ,εθ,εψ,εα,εβ,εv,εxg,εyg,εh的初值,由相應(yīng)的試飛數(shù)據(jù)的測量值經(jīng)過低通濾波后再與原測量值相減得到的噪聲的平均值;其余狀態(tài)量的初值選為0。
P值的大小,表示對狀態(tài)量初始值的信任程度,影響估計過程中的初始階段估計的效果。觀測量和輸入量對應(yīng)P的對角線上的初值,通過響應(yīng)量的噪聲的方差計算??筛鶕?jù)具體估計情況,適當?shù)恼{(diào)節(jié)P的初值。
噪聲協(xié)方差矩陣Q由輸入量u=[axe,aye,aze,pe,qe,re]T減去其經(jīng)過低通濾波的值得到噪聲的方差。噪聲協(xié)方差矩陣R計算過程與Q計算類似。需要說明的是:這里應(yīng)用的增廣卡爾曼濾波實際上是對非線性方程,利用一次泰勒展開來逼近,因此Q、R由噪聲的協(xié)方差和一階泰勒展開余項的誤差組成。在算法的調(diào)試過程中,適當?shù)母淖僎、R,來改變對慣導(dǎo)、GPS等測量數(shù)據(jù)的信任程度。
2.1 相容性檢驗
以直升機中速平飛時的縱向脈沖動作為例進行飛行數(shù)據(jù)相容性檢驗。為了作比較,首先采用輸出誤差法直接進行數(shù)據(jù)相容性檢驗。首先對數(shù)據(jù)進行檢查,檢查結(jié)果如圖1所示,發(fā)現(xiàn)姿態(tài)角均有時間延遲,誤差較大;再用輸出誤差法進行相容性檢驗,檢驗結(jié)果如圖2所示。
從圖2可以看出:姿態(tài)角時間延遲沒有消除,需要手動調(diào)整角速率測量值和測量時間對應(yīng)關(guān)系后重新檢驗一次才能消除時間延遲,并且辨識算法沒有收斂,沒有收斂的原因是過載中的誤差較大導(dǎo)致。
利用增廣卡爾曼濾波進行數(shù)據(jù)相容性檢驗,結(jié)果如圖3~圖4所示,可以看出:姿態(tài)角的時間誤差已經(jīng)被去掉,但是由于增廣卡爾曼濾波初期的收斂過程導(dǎo)致初期的濾波效果不好。
對增廣卡爾曼濾波進行數(shù)據(jù)相容性檢驗,結(jié)果如圖5所示,再利用輸出誤差法進行相容性檢驗,結(jié)果如圖6所示。
從圖5~圖6可以看出:姿態(tài)角時間延遲被消除,同時由增廣卡爾曼濾波算法初期收斂造成的誤差也被消除;在相同收斂條件判據(jù)下,使用本文提出的綜合的數(shù)據(jù)相容性檢驗技術(shù)迭代16次后就收斂,耗時20 s;單獨使用輸出誤差法時,則迭代499次,達到設(shè)置的循環(huán)上限,未收斂。本文提出的數(shù)據(jù)相容性檢驗技術(shù)無需將縱向和橫向參數(shù)分開進行相容性檢驗,更適合參數(shù)耦合嚴重的數(shù)據(jù)相容性檢驗情形。
2.2 相容性檢驗數(shù)據(jù)的應(yīng)用
本文提出的相容性檢驗方法綜合了增廣卡爾曼濾波和輸出誤差法的優(yōu)點,增廣卡爾曼濾波估計過程中對狀態(tài)量和狀態(tài)量的協(xié)方差矩陣進行積分,克服了輸出誤差法手動修改時間延遲的缺點,并且克服了這兩種方法單獨使用時的缺點,提高了相容性檢驗的效率。該方法已經(jīng)應(yīng)用于運動參數(shù)耦合嚴重的直升機模型辨識過程中的飛行數(shù)據(jù)相關(guān)性檢驗和D級直升機模擬器模型校準及某型直升機的定型試飛。
[1] 史忠科. 飛行數(shù)據(jù)相容性檢驗的極大似然方法[J]. 航空學(xué)報, 1990, 11(8): B354-B360.
Shi Zhongke. A maximum likelihood method for flight test data compatibility check[J]. Acta Aeronautica et Astronautica Sinca, 1990, 11(8): B354-B360.(in Chinese)
[2] 張友民, 王培德, 張洪才. 估計理論在飛行數(shù)據(jù)相容性檢驗中的應(yīng)用[J]. 航空學(xué)報, 1992, 13(7): A398-A402.
Zhang Youmin, Wang Peide, Zhang Hongcai. The application of estimation theory in flight data compatibility check[J]. Acta Aeronautica et Astronautica Sinca, 1992, 13(7): A398-A402.(in Chinese)
[3] 吳偉. 直升機飛行動力學(xué)模型辨識與機動飛行研究[D]. 南京: 南京航空航天大學(xué), 2010.
Wu Wei. Identification of helicopter flight dynamics model and investigation on maneuver flight[D]. Nanjing: Nanjing University of Aeronautics and Astronautics, 2010.(in Chinese)
[4] 孫濤. 直升機飛行力學(xué)模型辨識研究[D]. 南京: 南京航空航天大學(xué), 2010.
Sun Tao. Research on helicopter flight dynamics model identification[D]. Nanjing: Nanjing University of Aeronautics and Astronautics, 2010.(in Chinese)
[5] 王云龍. 直升機氣動參數(shù)辨識及機動飛行仿真[D]. 哈爾濱: 哈爾濱工業(yè)大學(xué), 2007.
Wang Yunlong. Helicopter aerodynamic parameters identification and tactical flight simulation[D]. Harbin: Harbin Institute of Technology, 2007.(in Chinese)
[6] 魏愛玉. 直升機氣動參數(shù)辨識方法研究[D]. 西安: 西北工業(yè)大學(xué), 2013.
Wei Aiyu. Research on identification method of pneumatic parameters of helicopter[D]. Xi’an: Northwestern Polytechnical University, 2013.(in Chinese)
[7] Jesse Jeck, Zhao Min. J2 universal flight matching process workshop[R]. Xi’an: Xi’an Jesse Technology Co., Ltd, 2016: 10-25.
[8] Frank L Lewis, Dan Popa, Lihua Xie. Optimal and robust estimation[M]. USA: CRC Press, 2007: 272-290.
[9] 張曉瑩. 非線性卡爾曼濾波的一點討論[D]. 廣州: 中山大學(xué), 2010.
Zhang Xiaoying. A note on nonlinear kalman filter[D].Guangzhou: Sun Yat-sen University, 2010.(in Chinese)
[10] Reif K, Günther S, Yaz E, et al. Stochastic stability of the continuous-time extended kalman filter[J]. IEE Proceedings-Control Theory and Applications, 2000, 147(1): 45-52.
[11] Vladislav Klein, Eugene A Morelli. Aircraft system identification theory and practice[M]. USA: American Institute of Aeronautics and Astronautics, 2005: 190-290.
[12] 劉超, 劉慶, 田福禮. 用于氣動導(dǎo)數(shù)辨識的試飛數(shù)據(jù)處理方法研究[J]. 航空工程進展, 2014, 5(2): 188-192.
Liu Chao, Liu Qing, Tian Fuli. Research on flight test data processing method applied to the identification of aerodynamic derivative[J]. Advances in Aeronautical Science and Engineering, 2014, 5(2): 188-192.(in Chinese)
[13] 蕭德云. 系統(tǒng)辨識理論及應(yīng)用[M]. 北京: 清華大學(xué)出版社, 2014: 197-215.
Xiao Deyun. Theory of system identification with applications[M]. Beijing: Tsinghua University Press, 2014: 197-215.(in Chinese)
李富剛(1986-),男,碩士,工程師。主要研究方向:飛機建模與模型驗證。
張聰(1986-),女,碩士,工程師。主要研究方向:飛行仿真與控制。
田福禮(1965-),男,博士,研究員。主要研究方向:飛行仿真與控制。
張喆(1986-),男,碩士,高級工程師。主要研究方向:飛行控制。
(編輯:趙毓梅)
MethodforFlightDataCompatibilityAnalysis
Li Fugang, Zhang Cong, Tian Fuli, Zhang Zhe
(Flight Simulation Laboratory, Chinese Flight Test Establishment, Xi’an 710089, China)
Process noises and measure noises exist in flight test data, which lead to incompatibility of flight data. The output error method that is the popular method used in flight test data compatibility checking recently is not fit for helicopter model data compatibility checking with serious coupling. Extended Kalman filter is applied for states estimation and error in the measured value is eliminated drastically. Compatibility analysis for results of extended Kalman filter is carried on by way of output error method. This technology is used in the fourth order liner equivalent model identification of helicopter longitudinal. By this technology, problems of wave filtering errors which are caused by extended Kalman filter primary convergence are solved, and problems of time delay modification by hand in output error method is conquered and non-convergence of output error method when errors in measuring data are big is solved, respectively. Verification effect and computational efficiency are greatly improved.
extended Kalman filter; compatibility analysis; flight test; state estimation
2017-03-05;
2017-06-11
李富剛,18192593036@163.com
1674-8190(2017)04-479-07
V217
A
10.16615/j.cnki.1674-8190.2017.04.017