一種單軸旋轉INS大方位失準角下快速對準方法

于化鵬，郭正東,2,3，蔡 鵬，海 深，莫 軍

(1.海軍潛艇學院，山東 青島 266042；2.中國科學院海洋研究所，山東 青島 266071；3.中國科學院大學，北京 100049；4.銅陵學院 數學與計算機學院，安徽 銅陵 244000)

一種單軸旋轉INS大方位失準角下快速對準方法

于化鵬1，郭正東1,2,3，蔡 鵬1，海 深4，莫 軍1

(1.海軍潛艇學院，山東 青島 266042；2.中國科學院海洋研究所，山東 青島 266071；3.中國科學院大學，北京 100049；4.銅陵學院 數學與計算機學院，安徽 銅陵 244000)

以單軸連續旋轉式慣導系統為研究對象，針對慣導系統誤差模型的非線性本質和對初始對準快速性的要求，通過推導其靜基座條件下大方位失準角誤差方程，設計一種利用超球體單形采樣的UKF濾波器，并通過實際測試驗證其有效性。實驗結果表明，利用所設計的UKF濾波算法，10 min方位角對準精度能夠達到優于0.008°。

大失準角；初始對準；無跡卡爾曼濾波；旋轉

0 引 言

由于其簡潔性、魯棒性、高可維護性等自身特有的優勢，捷聯慣導系統(SINS)近幾十年來得到快速發展，并已廣泛應用于航空航天、航海、陸地導航等領域[1-2]。得益于自動控制技術和電子技術的飛速發展，通過計算機能夠方便地實現捷聯慣導系統的機械編排，使得采用旋轉調制方法來補償慣性測量單元(IMU)慣性器件誤差的技術引起世界各國投入大量人力物力進行研究[3-6]。

通過在IMU的外圍加上單軸轉臺并設計規律性的旋轉次序，單軸旋轉調制方法能夠實現不利用外部信息而在一個周期內將部分IMU慣性器件的慢變誤差在導航坐標系內投影成周期變化量，進而在導航解算過程中，這些慢變誤差的影響將在整個轉動周期內積分運算后平均抵消，進而大大減少了慣導系統的誤差累積，達到更好發揮其“自主性”、提高系統對準速度和精度的效果[3-8]。單軸旋轉調制方法中，連續旋轉方案避免了對轉臺控制系統及其性能指標的嚴苛要求[7-10]。

初始對準是慣導系統實際應用中的重要環節，衡量對準算法的2項重要技術指標即為精度和快速性。由于軍事應用的特殊性，國外對單軸連續旋轉式慣導系統(Single-axis Continuously Rotary Inertial Navigation System，SCR-INS)的初始對準與導航算法的公開報道很少[7-10]。在國內的相關研究中，文獻[7]利用其連續旋轉的特點，采用標準Kalman濾波算法抑制了SCR-INS中系統噪聲的影響，且3 min方位對準精度能夠達到3.003′(陀螺精度為0.03°/h，1σ)；通過建立IMU慣性器件誤差變化的二次多項式擬合模型并進行誤差在線整周期擬合估計與補償，文獻[8]設計了適用于SCR-INS快速初始對準的標準卡爾曼濾波算法，在系統完全靜止時方位角對準精度達到10min優于30″(1σ)；文獻[9]利用SCR-INS中IMU慣性器件誤差的周期特性，在考慮初始參數裝訂誤差條件下，為其初始對準過程構造了約束狀態卡爾曼濾濾器，方位角對準精度達到10min優于10″(1σ)；文獻[10]在分析速度殘差序列的基礎上，提出了一種適用于SCR-INS晃動基座初始對準的自適應濾波濾波算法，大大提高了SCR-INS的工程實用性。

慣導系統誤差模型本質上是非線性的，在達到足夠的精對準精度條件下，通過對其進行線性處理后，才可以利用標準卡爾曼濾波算法進行精對準等[11-12]。隨著非線性濾波技術的發展，為了提高初始對準的快速性，近年來越來越多的研究成果直接考慮大失準角下初始對準的誤差模型及其算法。同時，一般情況下，初始對準中方位角誤差收斂較慢，是影響粗對準精度的主要因素[12-13]。

本文結合各種非線性濾波方法的計算效率和工程適用性，開展利用無跡卡爾曼濾波(UnscentedKalmanFilter，UKF)進行SCR-INS的大方位失準角下初始對準研究。當前已發表文獻中，大多僅對UKF算法進行仿真研究。本文通過深入分析SCR-INS誤差特性，實際測試驗證所設計的UKF濾波算法的方位角對準精度。

1 初始對準UKF濾波模型的建立

首先定義本文中將用到的單軸連續旋轉式慣導系統實驗平臺中各坐標系，如圖1所示。

圖1 SCR-INS中坐標系關系Fig.1 Coordinates in the single-axis continuously rotary inertial navigation system

坐標系定義如下：

g系(OXgYgZg)，IMU傳感器安裝坐標系；為了給3個陀螺提供一致的旋轉調制速率，本文中IMU傳感器采用斜置安裝結構[3,9-10]，各坐標軸固連在陀螺敏感軸上；理想情況下，g系為正交系；

b系(OXbYbZb)，轉臺臺面載體系；Xb軸和Yb軸固定在轉臺臺面內隨臺面一起繞旋轉軸轉動，與Zb軸構成右手直角坐標系；

b0系(OXb0Yb0Zb0)，轉臺臺體系，Xb軸與固連在轉臺臺體上的零位指示器重合時的b系，稱之為b0系；

另外，選擇地心慣性坐標系為i系，“北-東-地(NED)” 當地地理坐標系為n系。

1.1 濾波模型

假設姿態誤差角為φ=[φNφEφD]T，則由坐標變換矩陣得:

(1)

其中n′系為實際計算得到的數學平臺。在本文僅有大方位失準角假設條件下，對式(1)進行整理并忽略小量乘積后，有：

(2)

同時，可以得到：

(3)

(4)

(5)

(6)

(7)

(8)

其中V為觀測噪聲。

1.2 UKF濾波方案

基于無跡變換思想，UKF采用無跡變換將標準卡爾曼濾波時間更新遞推替代且計算量與其基本相當，從而直接應用于非線性誤差方程傳播系統各誤差狀態的后驗概率分布特性，適用于本文中討論非線性系統的濾波問題[14]。

考慮到SCR-INS導航解算的實時性要求，需盡量降低計算負載，這就要控制Sigma點的個數。本文UKF濾波器設計中，采用超球體單形采樣策略，此時考慮中心點的Sigma點數目為L=m+2(m為系統誤差狀態變量個數)[15-16]。

利用計算機運行時，需要對式(4)～式(8)所表述的連續系統進行離散化，可記為：

(9)

其中，uk和Vk滿足：

(10)

式中δkj為Kroneckerδ函數。

本文所設計的UKF濾波遞推算法流程如圖2所示[14-16]。

圖2 UKF濾波遞推算法流程Fig.2 Recursive algorithm process utilizing unscented Kalman filter

2 實驗結果及分析

為了驗證所設計的UKF濾波算法的有效性及檢驗利用該算法時初始對準方位角對準精度和誤差收斂速度，利用某型SCR-INS進行了實際測試驗證。實際測試過程中，為了便于統計分析，將系統置于大致調平的靜基座上后，不再改變轉臺零位指示器的方位，即只進行單位置靜基座初始對準實驗測試。下面，將詳細說明實驗及分析結果。

圖3所示為某次初始對準測試時10min內方位角收斂曲線。根據圖3可見，利用所設計的UKF濾波算法進行初始對準時，方位角開始階段波動較大，約4min后趨于穩定。綜合以上得出結論，所設計的UKF濾波算法是有效的，能夠達到使方位角快速收斂的目的。

為了評價該算法的方位角對準精度，可以進行測試得到多次10min對準方位角結果，然后進行統計分析。直觀起見，方位角誤差結果數據4所示。表1列出了方位角誤差數據及分析結果。

圖3 某次初始對準10 min內方位角收斂曲線Fig.3 Azimuth convergence curve within 10 minutes during initial alignment

圖4 多次測試10 min對準方位角誤差統計圖Fig.4 Statistical chart of azimuth errors at 10 minutes for multiple initial alignment tests

根據表1中靜基座9組實際測試方位角誤差統計結果可見，10min對準方位角誤差標準差為0.0075°(27.1″)，使得系統初始對準精度能夠滿足實際應用指標要求。

表1 靜基座9組測試10 min對準方位角誤差數據Tab.1 Azimuth errors at 10 minutes for 9 tests during stationaryinitial alignment

3 結 語

利用旋轉調制方法，慣導系統能夠達到較高的對準和導航精度。單軸連續旋轉調制方案具有結構簡單等不可比擬的優勢，對其進行深入研究具有重要的理論意義和工程價值?？紤]到慣導系統誤差模型的非線性本質以及實際應用中對初始對準快速性的要求越來越高，在推導單軸連續旋轉式慣導系統大方位失準角下靜基座初始對準誤差方程基礎上，基于超球體單形采樣策略設計了一種UKF初始對準濾波算法。利用某型單軸連續旋轉式慣導系統進行實際測試結果表明，所設計的UKF算法是有效性的，能夠達到使方位角快速收斂，10min對準方位角精度達到優于0.008°。

[1]GIBSONC，FLUECKIGERK，HOPKINSR，etal.Demons-tratingpracticalinertialnavigation:thebeginningsandbeyond[C]//ProceedingsofAIAAGuidance,Navigation,andControl(GNC)Conference.Boston,MA:AmericanInstituteofAeronauticsandAstronautics,Inc.,August19-22,2013:5122(5121-5112).

[2]BRAUNRD，PUTNAMZR，STEINFELDTBA.Advancesininertialguidancetechnologyforaerospacesystems[C]//ProceedingsofAIAAGuidance,Navigation,andControl(GNC)Conference.Boston,MA:AmericanInstituteofAeronauticsandAstronautics,Inc.,August19-22,2013:5123(5121-5118).

[3]KURYATOVVN，CHEREMISENOVGV，PANASENKOVN,etal.MarineINSBasedontheLaserGyroscopeKM-11[C]//ProceedingsofSymposiumGyroTechnology2002.Stuttgart,Germany:GermanInstituteofNavigation(DGON),September17-18,2002:19.0-19.17.

[4]TUCKERT，LEVINSONE.TheAN/WSN-7BMarineGyrocompass/Navigator[C]//ProceedingsofIONNTM2000.Anaheim,CA:InstituteofNavigation,January26-28, 2000: 348-357.

[5]NIEQ，GAOX，LIUZ.ResearchonaccuracyimprovementofINSwithcontinuousrotation[C]//Proceedingsofthe2009IEEEInternationalConferenceonInformationandAutomation.Zhuhai/Macau,China:InstituteofElectricalandElectronicsEngineers,Inc.,June22-25,2009:870-874.

[6]GELLERES.Inertialsystemplatformrotation[J].IEEETransactionsonAerospaceandElectronicSystems,1968,AES-4(4):557-568.

[7] 張思將.旋轉式激光陀螺尋北儀尋北算法研究[D].長沙:國防科技大學,2005:28-38.

ZHANGSi-jiang.Researchonalgorithmoftherotaynorth-finderbasedonringlasergyroscope[D].Changsha:NationalUniversityofDeefnseTechnology,2005:28-38.

[8] 張巖,吳文啟,張曉強，等.靜基座速率偏頻激光陀螺捷聯慣導系統快速高精度初始對準算法[J].系統工程與電子技術,2011,33(12):2706-2710.

ZHANGYan,WUWen-qi,ZHANGXiao-qiang,etal.FastandhighaccuracyinitialalignmentalgorithmforratebiasedRLGSINSonstationarybase[J].SystemsEngineeringandElectronics,2011,33(12):2706-2710.

[9]YUH,WUW,HAOM.RapidinitialalignmentundergeographiclatitudeuncertaintyofasinglerotationAHRSonstationarybase[C]//The11thIEEEInternationalConferenceonElectronicMeasurement&Instruments,ICEMI’2013,Harbin,China,August16-18,2013:96-100.

[10] 于化鵬, 吳文啟, 曹聚亮, 等.單軸恒速偏頻激光陀螺航姿系統晃動基座快速對準自適應濾波方法[J].中國慣性技術學報,2013,21(2):169-173.

YUHua-peng,WUWen-qi,CAOJu-liang,etal.Adaptivefilteringalgorithmtorapidalignmentforsingle-axisconstantratebiasedRLGAHRSonrockingbase[J].JournalofChineseInertialTechnology,2013,21(2):169-173.

[11] 趙紅宇, 王哲龍, 姜鳴, 等.基于EPEA的SINS大失準角非線性初始對準方法[J].大連理工大學學報,2012,52(5):736-742.

ZHAOHong-yu,WANGZhe-long,JIANGMing,etal.SINSnonlinearinitialalignmentmethodsforlargemisalignmentanglesbasedonEPEA[J].JournalofDalianUniversityofTechnology,2012,52(5):736-742.

[12]FANGJ,YANGS.StudyoninnovationadaptiveEKFforin-flightalignmentofairbornePOS[J].IEEETransactionsonInstrumentationandMeasurement,2011,60(4):1378-1388.

[13] 郝燕玲, 楊峻巍, 陳亮, 等.基于平方根中心差分卡爾曼濾波的大方位失準角初始對準[J].中國慣性技術學報,2011,19(2):180-187.

HAOYan-ling,YANGJun-wei,CHENLiang,etal.Initialalignmentoflargeazimuthmisalignmentbasedonsquarerootcentraldifferencekalmanfilter[J].JournalofChineseInertialTechnology,2011,19(2):180-187.

[14] 周衛東, 喬相偉, 吉宇人, 等.基于新息和殘差的自適應UKF算法[J].宇航學報,2010,31(7):1798-1804.

ZHOUWei-dong,QIAOXiang-wei,JIYu-ren,etal.Aninnovationandresidual-basedadaptiveUKFalgorithm[J].JournalofAstronautics,2010,31(7):1798-1804.

[15] 朱聯祥, 況盧娟.基于超球體單形采樣的BS-UKF算法在單站無源目標跟蹤中的應用[J].重慶郵電大學學報(自然科學版),2010,22(3):299-301,319.

ZHULian-xiang,KUANGLu-juan.Applicationofsphericalsimplexsamplingbasedbackward-smoothingUKFtosingleobserverpassivetracking[J].JournalofChongqingUniversityofPostsandTelecommunications(NaturalScienceEdition),2010,22(3):299-301,319.

[16] 胡宇, 張世英, 楊月誠, 等.基于超球體平方根無跡Kalman濾波算法的渦扇發動機氣路部件故障診斷[J].航空動力學報,2014,29(3):689-695.

HUYu,ZHANGShi-ying,YANGYue-cheng,etal.Faultdiagnosisofgaspathcomponentsofturbofanenginebasedonsphericalsquarerootunscentedkalmanfilteralgorithm[J].JournalofAerospacePower,2014,29(3):689-695.

Rapid initial alignment of large azimuth misalignment angle for single-axis rotary INS

YU Hua-peng1, GUO Zheng-dong1,2,3, CAI Peng1, HAI Shen4, MO Jun1

(1.Navy Submarine Academy,Qingdao 266042,China;2.Institute of Oceanology, Chinese Academy of Sciences,Qingdao 266071,China;3.University of Chinese Academy of Sciences,Beijing 100049,China；4.Department of Mathematics and Computer, Tongling College,Tongling 244000,China)

The single-axis rotary inertial navigation system (INS) is studied.Regarding the nonlinearity nature of the INS error dynamic model and the requirement of initial alignment rapidity, an unscented Kalman filter with spherical simplex sampling is designed by deriving the large azimuth misalignment angle error equations of the single-axis rotary strapdown INS on stationary base.Then, tests are done on a postulate system to verify the effectiveness of the UKF approach.The experimental results show that, by using the designed UKF approach, azimuth angle precision within 10 minutes has achieved to be less than 0.008°.

large misalignment angle; initial alignment; unscented kalman filter; rotary

2015-03-11；

2015-04-01

國家高技術研究發展計劃(863計劃)資助項目

于化鵬(1985-)，男，博士，助教，主要從事高精度導航系統研究。

U666.1

A

1672-7649(2015)10-0100-05

10.3404/j.issn.1672-7649.2015.10.021