慣性/北斗組合導(dǎo)航系統(tǒng)的魯棒H∞濾波

李艷輝，楊 琦

慣性/北斗組合導(dǎo)航系統(tǒng)的魯棒H∞濾波

李艷輝，楊 琦

（東北石油大學(xué)電氣信息工程學(xué)院，黑龍江大慶163318）

為提高慣性/北斗組合導(dǎo)航系統(tǒng)的精度，將魯棒H∞濾波算法應(yīng)用于慣性/北斗組合導(dǎo)航系統(tǒng)中，該算法可克服模型的不確定性對濾波精度的影響，并將濾波器的設(shè)計問題轉(zhuǎn)化為線性矩陣不等式約束的凸優(yōu)化問題。仿真試驗最終表明，魯棒H∞濾波算法應(yīng)用于組合導(dǎo)航系統(tǒng)是有效的。

魯棒H∞濾波；慣性/北斗組合導(dǎo)航；線性矩陣不等式；凸優(yōu)化

0 引言

慣性/北斗組合導(dǎo)航系統(tǒng)因其自主性強、隱蔽性好、可靠性高等優(yōu)點，近年來得到廣泛關(guān)注，是目前我國導(dǎo)航領(lǐng)域的一個重要研究方向［1-3］。采用傳統(tǒng)的卡爾曼濾波算法處理組合導(dǎo)航系統(tǒng)的濾波問題時，很難達到期望的精度及可靠性［4］。魯棒濾波算法可提高系統(tǒng)對模型不確定性的魯棒性，應(yīng)用于組合導(dǎo)航系統(tǒng)中可改善系統(tǒng)的濾波精度［5］。

魯棒濾波是在不確定性允許范圍內(nèi)估計系統(tǒng)狀態(tài)，使系統(tǒng)穩(wěn)定并滿足一定的性能指標約束。文獻［6］通過魯棒H∞濾波的黎卡提迭代算法，較好地估計了觀測噪聲的統(tǒng)計特性不確定的慣性/雷達組合導(dǎo)航系統(tǒng)。文獻［7］研究系統(tǒng)模型為非線性的多衛(wèi)星組合導(dǎo)航系統(tǒng)，采用魯棒濾波算法有效估計系統(tǒng)狀態(tài)。文獻［8］針對噪聲的統(tǒng)計特性未知的導(dǎo)航系統(tǒng)，應(yīng)用閉環(huán)魯棒H∞濾波算法，在保證系統(tǒng)魯棒性的同時提高了濾波精度。

筆者針對導(dǎo)航系統(tǒng)動態(tài)模型不確定而外部噪聲干擾的統(tǒng)計特性也不確切已知的問題，研究了基于組合導(dǎo)航系統(tǒng)的魯棒H_______________________________∞濾波算法，采用線性矩陣不等式技術(shù)設(shè)計和求解濾波器［9］，實現(xiàn)對該系統(tǒng)的狀態(tài)估計。該算法不局限于數(shù)值仿真，易于計算機實現(xiàn)，可真正應(yīng)用于運載體實際運動的離線仿真，修正導(dǎo)航參數(shù)。最后通過仿真試驗，驗證該濾波算法是可行有效的。

1 組合導(dǎo)航系統(tǒng)建模及濾波

筆者采用慣性/北斗位置、速度組合模式，該模式是以慣導(dǎo)系統(tǒng)為主，輔以北斗衛(wèi)星提供的位置、速度信息，共同提供導(dǎo)航數(shù)據(jù)；狀態(tài)變量選取為導(dǎo)航系統(tǒng)的參數(shù)誤差，量測變量選取為慣導(dǎo)系統(tǒng)與北斗接收機的量測信息差值。選取以地球固聯(lián)系“東北天”系為參考坐標系（見圖1）。系統(tǒng)模型形式如下

圖1 運載體與參考系的關(guān)系Fig.1 The relationship between machine and the reference frame

為導(dǎo)航系統(tǒng)在東、北、天向的重力加速度分量，l（t）為當(dāng)前時刻緯度值，R為地球半徑

滿足BDT=0，εb，εr，▽b，▽r為陀螺和加速度計的隨機漂移與常值漂移，而實際系統(tǒng)通常直接對狀態(tài)量進行估計，故L=I。

式（1）所表示的系統(tǒng)模型是非線性的，導(dǎo)航解算較困難，但由于有限時間內(nèi)運載體在平衡點附近變化緩慢，非線性程度較小，因此近似線性化處理系統(tǒng)模型為

其中A、C為適當(dāng)維數(shù)的定常矩陣，不確定性系數(shù)矩陣ΔA（t）、ΔC（t）滿足為已知適當(dāng)維數(shù)的定常矩陣。

實際組合導(dǎo)航系統(tǒng)的動態(tài)模型復(fù)雜且運載體空間運動變化具有不確定性，外部噪聲干擾的統(tǒng)計特性也不完全已知，針對上述模型的特點，構(gòu)建如下形式的魯棒H∞濾波器

筆者針對組合導(dǎo)航系統(tǒng)（2），設(shè)計了魯棒H∞濾波器，使濾波誤差系統(tǒng)（4）漸近穩(wěn)定且對于任意的，滿足H∞性能指標約束。

在求取濾波器存在的充分條件前，首先給出后續(xù)證明過程中需要用到的以下兩個引理［10］。

引理1 設(shè)α、β為適當(dāng)維數(shù)向量或矩陣，對適當(dāng)維數(shù)矩陣M，F(xiàn)，N和常量ε＞0（其中FTF≤I），有

引理2 考慮系統(tǒng)（2），濾波誤差系統(tǒng)（4）漸近穩(wěn)定且‖~z（t）‖2≤γ‖~w（t）‖2（γ＞0）的充分條件是存在正定矩陣P=PT滿足

2 組合導(dǎo)航系統(tǒng)魯棒H∞濾波器設(shè)計

利用線性矩陣不等式技術(shù)，求解魯棒H∞濾波器存在的充分條件，并將其轉(zhuǎn)化為凸優(yōu)化問題求解。

定理1 對于系統(tǒng)（2），魯棒 H∞濾波器存在的充分條件為矩陣及標量ε＞0滿足

證明 根據(jù)引理1，式（5）改寫為

對式（7）進行矩陣變換，將P及P-1分塊，即，取，，則，令），式（7）左乘ΩT和右乘Ω，有

推論1 對于實際組合導(dǎo)航系統(tǒng)，可通過求解如下形式的凸優(yōu)化問題獲得系統(tǒng)的γ次優(yōu)H∞濾波器

且魯棒H∞濾波器參數(shù)可通過定理1求得。

3 系統(tǒng)仿真研究

仿真實驗采取半物理仿真形式，通過跑車試驗采集數(shù)據(jù)并離線仿真，其中慣導(dǎo)系統(tǒng)選用國內(nèi)某公司生產(chǎn)的光纖慣導(dǎo)，接收機選用無源北斗二代接收機，且假設(shè)慣導(dǎo)數(shù)據(jù)與北斗數(shù)據(jù)完全同步，載體在水平面上運動。各傳感器在組合導(dǎo)航系統(tǒng)中的誤差如表1所示，仿真初始條件如表2所示。

表1 各傳感器誤差量Tab.1 Errors of each sensor

表2 仿真初始條件Tab.2 Initial conditions of the simulation

試驗分別在平穩(wěn)路段和非平穩(wěn)路段兩種情況下進行，為便于對比分析，選用卡爾曼濾波與魯棒H∞濾波兩種方法對系統(tǒng)進行處理，圖2～圖9所示為系統(tǒng)仿真曲線。

在平穩(wěn)路段，圖2、圖3中兩種濾波方法均可實時跟蹤北斗衛(wèi)星信號，估計系統(tǒng)速度，同樣圖4、圖5中兩種濾波方法均可有效跟蹤載體的經(jīng)緯度變化；在非平穩(wěn)路段，受系統(tǒng)運動狀態(tài)變化影響，圖6、圖7中兩種濾波算法雖能實時跟蹤系統(tǒng)的速度變化但卡爾曼濾波精度下降，與北斗衛(wèi)星實測值偏差較大，而在圖8、圖9中，卡爾曼濾波輸出曲線產(chǎn)生較大跳動，而魯棒H∞濾波曲線變化平穩(wěn)。

圖2 平穩(wěn)路段東向速度Fig.2 The east velocity of the flat

圖3 平穩(wěn)路段北向速度Fig.3 The north velocity of the flat

圖4 平穩(wěn)路段經(jīng)度Fig.4 The longitude of the flat

圖5 平穩(wěn)路段緯度Fig.5 The latitude of the flat

圖6 非平穩(wěn)路段東向速度Fig.6 The east velocity of the rugged road

圖7 非平穩(wěn)路段北向速度Fig.7 The north velocity of the rugged road

圖8 非平穩(wěn)路段經(jīng)度Fig.8 The longitude of the rugged road

圖9 非平穩(wěn)路段緯度Fig.9 The latitude of the rugged road

通過對比分析曲線可以得出，當(dāng)外界干擾相對較小，兩種濾波算法都能有效估計系統(tǒng)狀態(tài)，修正導(dǎo)航參數(shù)；當(dāng)系統(tǒng)受外界干擾較大時，卡爾曼濾波估計值有明顯跳變，精度下降。魯棒H∞濾波不易受機體自身及外界干擾的影響，可保證濾波精度及可靠性，改善系統(tǒng)的觀測性。

4 結(jié)語

筆者將魯棒H∞濾波思想應(yīng)用于系統(tǒng)模型不確定的慣導(dǎo)/北斗組合導(dǎo)航，將濾波器的設(shè)計問題轉(zhuǎn)化為線性矩陣不等式的求解問題，為實際導(dǎo)航系統(tǒng)提供了一種更為有效的狀態(tài)估計方法。最后通過仿真試驗，驗證魯棒H∞濾波具有更好的環(huán)境適應(yīng)性及更高的精度和可靠性。

［1］TAZARTESD A.Inertial Navigation from Gimbaled p latforms to Strapdown Sensors［J］.IEEE Transactions on Aerospace and Electronic Systems，2011，47（3）：2292-2299.

［2］REN H，KAZANZIDES p.Investigation of Attitude Tracking Using an Integrated Inertial and Magnetic Navigation System for Hand-Held Surgical Instruments［J］.IEEE/ASME Transactions on Mechatronics，2012，17（2）：210-217.

［3］蔣慶仙，田育民，孫葵.北斗/INS組合導(dǎo)航關(guān)鍵技術(shù)分析［J］.全球定位系統(tǒng)，2010，35（6）：56-60. JIANG Qingxian，TIAN Yumin，SUN Kui.The Crucial Technologies in INS/BD Integrated Navigation System［J］.GNSS World of China，2010，35（6）：56-60.

［4］WARD B D，JANIK J，MAZAHERIY，et al.Adaptive Kalman Filtering for Real-Time Mapping of the Visual Field［J］. NeuroImage，2012，59（4）：3533-3547.

［5］UGRINOVSKIIV.Distributed Robust Filtering with H∞Consensus of Estimates［J］.Automatica，2011，47（1）：1-13.

［6］GAO Shesheng，ZHONG Yongmin，LIWei.Robust Adaptive Filtering Method for SINS/SAR Integrated Navigation System［J］.Aerospace Science and Technology，2011，15（6）：425-430.

［7］XIONG K，LIU L，LIU YW.Nonlinear Robust Filter Design for Satellite Attitude Determination［J］.IETControl Theory and Applications，2010，4（7）：1222-1234.

［8］康國華，劉建業(yè)，劉瑞華，等.閉環(huán)H∞濾波在無源北斗/SINS導(dǎo)航系統(tǒng)中的實現(xiàn)［J］.控制與決策，2007，22（5）：566-568. KANG Guohua，LIU Jianye，LIU Ruihua，et al.Realization of Closed-Cycle H∞Filtering in passive BD/SINS Navigation System［J］.Control and Decision，2007，22（5）：566-568.

［9］KARIMIH R，ZApATEIRO M，LUO N.A Linear Matrix Inequality Approach to Robust Fault Detection Filter Design of Linear Systems with Mixed Time-Varying Delays and Nonlinear perturbations［J］.Journal of the Franklin Institute，2010，347（6）：957-973.

［10］LIHuaizhong，F(xiàn)U Minyue.A Linear Matrix Inequality Approach to Robust H∞Filtering［J］.Signal processing，IEEE Transactions on，1997，45（9）：2338-2350.

（責(zé)任編輯：劉東亮）

Robust H∞Filtering on INS/BD Integrated Navigation System

LIYanhui，YANG Qi

（College of Electrical and Information Engineering，Northeast petroleum University，Daqing 163318，China）

INS/BD constitutes an integrated navigation system with high precision and complementary advantages，but the usual Kalman filtering can notobtain a satisfying precision.So the robust H∞filtering is used for the INS/BD integrated navigation system，overcoming the precision impact caused by themodel uncertainty，and converting the problem of filter designing into a convex optimization problem subject to LMI（Linear Matrix Inequality）constraints.Simulation experiments show this algorithm can be used for integrated navigation system effectively.

robust H∞filtering；inertial navigation system（INS）/BD integrated navigation；linear matrix inequality（LMI）；convex optimization

Tp273；V249.32

A

1671-5896（2015）03-0261-06

2014-07-18

黑龍江省博士后科研啟動基金資助項目（LBH-Q13177）；黑龍江省自然科學(xué)基金資助項目（F201403）

李艷輝（1970— ），女，遼寧法庫人，東北石油大學(xué)教授，博士生導(dǎo)師，主要從事魯棒控制、濾波和智能控制研究，（Tel）86-459-6504797（E-mail）LY_hui@hotmail.com，Li_yanhui2006@aliyun.com。