徐慶九，孫時珍，戴洪德

（1.海軍航空工程學院控制工程系，山東煙臺264001；2.海軍裝備部天津局，北京100086）

基于速度誤差的系統(tǒng)級標定方法

徐慶九1，孫時珍2，戴洪德1

（1.海軍航空工程學院控制工程系，山東煙臺264001；2.海軍裝備部天津局，北京100086）

為降低捷聯(lián)慣導系統(tǒng)誤差參數(shù)標定過程對高精度轉臺的要求，提出一種基于速度誤差的系統(tǒng)級標定方法。在慣性器件誤差參數(shù)模型和捷聯(lián)慣導系統(tǒng)誤差方程的基礎上，以慣導系統(tǒng)轉動前后的導航速度誤差為觀測量，編排設計旋轉方案，對加速度計和陀螺的誤差參數(shù)進行擬合標定。仿真結果表明，與傳統(tǒng)的分立式標定方法相比，在保證標定精度的同時，對高精度轉臺的要求更低，可應用于外場標定。

捷聯(lián)慣導；誤差方程；系統(tǒng)級標定

捷聯(lián)慣導系統(tǒng)由于其成本低、結構簡單、重量輕、可維護性好以及可靠性高等優(yōu)點[1]，已廣泛應用于陸用平臺、航海、航空和航天等民用領域和軍用領域[2]。陀螺儀和加速度計作為捷聯(lián)慣導系統(tǒng)的核心部件，其確定性誤差是影響系統(tǒng)導航精度的主要誤差源。因此，捷聯(lián)慣導在使用前必須通過標定實驗確定慣性儀表的各項誤差系數(shù)，并在捷聯(lián)慣導系統(tǒng)中進行補償[3]。

通常在實驗室基于高精度轉臺所提供的精確姿態(tài)和相關轉動基準，利用多位置靜態(tài)測試和速率測試分別對加速度計和陀螺的誤差參數(shù)進行標定[4-5]。傳統(tǒng)的標定過程依賴高精度轉臺，轉臺的精度制約著標定結果的精度，以至于制約著高精度捷聯(lián)慣導系統(tǒng)的發(fā)展。

系統(tǒng)級標定方法是將捷聯(lián)慣導系統(tǒng)的導航誤差作為觀測量，通過擬合估計的方法對慣性器件的誤差參數(shù)進行標定。這降低了對高精度轉臺的要求，適合現(xiàn)場標定。

本文主要對基于導航速度誤差的擬合標定方法進行編排設計，從而對慣性器件的誤差參數(shù)進行標定。

1 慣性器件誤差參數(shù)模型

1.1坐標系定義

本文選取i系為地心慣性坐標系，e系為地球坐標系，n系為導航坐標系，b系為載體坐標系，a系為加速度計敏感軸坐標系，p系為加速度計標定參數(shù)坐標系，g系為陀螺敏感軸坐標系。

1.2 慣性器件誤差參數(shù)模型

定義加速度計標定參數(shù)坐標系p系如下：令其xp軸與加速度的敏感軸xa重合，規(guī)定yp軸在xaya平面內，并與xp軸垂直，則xp軸、yp軸與zp軸構成右手直角坐標系[6]。

忽略噪聲，加速度計的誤差參數(shù)模型可寫為

為使加速度計和陀螺的標定參數(shù)坐標系相一致，忽略噪聲，則陀螺的誤差參數(shù)模型可以表示為

從式（1）和（2）可以看出，慣性器件的誤差參數(shù)模型中包括標度因數(shù)誤差項、安裝誤差項和零偏誤差項共21個誤差參數(shù)，即實現(xiàn)了加速度計和陀螺的標定參數(shù)坐標系相一致，又減少了所需標定誤差參數(shù)項的個數(shù)，使標定過程得到簡化[7]。

2 慣導系統(tǒng)誤差方程

為計算方便，取北—東—地為導航坐標系，則基于捷聯(lián)慣導系統(tǒng)的誤差模型方程[8-9]，有，

則在靜基座條件下，系統(tǒng)誤差方程可寫為：

式（5）、（6）建立起導航誤差和慣性器件誤差參數(shù)之間的關系，即可通過將導航速度誤差作為觀測量，進而對加速度計和陀螺的誤差參數(shù)項進行標定。

3 標定原理及標定編排設計

對所標定慣性器件進行旋轉后，導航速度誤差主要由慣性器件的誤差參數(shù)項引起，所以可通過對慣導系統(tǒng)進行位置翻轉的編排設計，充分激勵出誤差參數(shù)項以進行標定[10-13]。

設每次旋轉初始時間和終止時間分別為t=0和 t′=T，則水平速度誤差變化率可以表示為：

由于地球自轉角速度與慣導系統(tǒng)轉動角速度相比量級較小，故可將其忽略不計。

另外，對式（5）求導可得：

依據(jù)充分激勵慣性器件誤差參數(shù)的原則，編排設計三組旋轉標定方案，每組初始位置使x、y、z軸分別指向正北方向，分別轉動3次，每次轉動角度為π，具體如圖1所示。各位置的捷聯(lián)矩陣和比力測量輸入fb如表1所示。

圖1 基于速度誤差的系統(tǒng)級擬合標定方法旋轉示意圖Fig.1 Schematic diagram of the systematic fitting calibration method based on speed error

表1 旋轉各位置捷聯(lián)矩陣和比力測量輸入Tab.1 Specific force input and strap down matrix of each position

慣導系統(tǒng)在進行標定編排旋轉之后，將導航速度誤差作為觀測量可對加速度計和陀螺的誤差參數(shù)進行標定。

對于第1組標定編排旋轉。

1）第1次旋轉后可以得到：

將式（11）和（12）代入式（7）可得

同樣對于式（8）可得

2）第2次旋轉后可以得到：

將式（15）和（16）代入式（7）可得

同樣對于式（8）可得

3）第3次旋轉后可以得到：

將式（19）和（20）代入式（7）可得

同樣對于式（8）可得

而姿態(tài)誤差也可用速度誤差變化率表示，則式（9）和（10）可以表示為：

而從式（5）和（6）可得

對第2組和第3組標定編排旋轉，標定過程與第1組相類似，將每組每次旋轉分別記為≡δv˙x(T)-δv˙x(0)和≡δv˙y(T)-δv˙y(0)，下標i表示旋轉次序，上標j表示標定組數(shù)，各組標定誤差觀測方程如表2所示。

表2 旋轉編排各組標定誤差觀測方程Tab.2 Observation equation of calibration scheme

利用表2中的各組標定誤差觀測方程，可對慣性器件加速度計和陀螺的誤差參數(shù)求解如下：

上面只標定出了陀螺的標度因數(shù)項、安裝誤差項和加速度計的零偏誤差項、安裝誤差項。對陀螺的零偏誤差項，當每組旋轉時利用式（23）、（24）和（28）計算即可，對于加速度計的標度因數(shù)項，可分別利用每組首次旋轉的天向速度誤差求解即可，以第1組為例：

至此標定出加速度計和陀螺的全部誤差參數(shù)項。

4 仿真結果與標定精度分析

基于以上標定編排設計對陀螺和加速度計各誤差參數(shù)進行標定，仿真條件設置為：假設當?shù)鼐暥葹楸本?8°，慣導系統(tǒng)進行旋轉時，轉速設為10(°)/s，在靜態(tài)位置靜止1min，轉臺角位置控制誤差和軸正交度誤差均設為2"，加速度計和陀螺的測量誤差分別為5×10-5g和0.01(°)/h，其仿真標定結果對比見表3、4。

表3 加速度計標定仿真結果對比Tab.3 Contrast of simulation results of accelerometer calibration

表4 陀螺標定仿真結果對比Tab.4 Contrast of simulation results of gyroscope calibration

從表3、4可以看出，與傳統(tǒng)的分立式標定方法相比，加速度計的標度因數(shù)項和陀螺的零偏誤差項的標定精度稍差，是因為對其計算過程中含有速度誤差的二次積分項和姿態(tài)誤差項。總體來說，基于速度誤差的系統(tǒng)級擬合標定法對加速度計和陀螺的誤差參數(shù)標定結果優(yōu)于傳統(tǒng)分立式標定法的標定結果。

5 結論

本章主要研究了基于速度誤差的系統(tǒng)級擬合標定方法，以導航速度誤差為觀測量，編排設計了3組旋轉方案，建立了相應的標定觀測方程以對慣性器件的誤差參數(shù)進行標定。仿真結果表明，系統(tǒng)級標定法在保證標定精度的同時，降低了對高精度轉臺的要求，效果較好。

[1]袁保倫.四頻激光陀螺旋轉式慣導系統(tǒng)研究[D].長沙：國防科學技術大學，2007：3-5. YUAN BAOLUN.Research on rotating inertial navigation system with four-frequency differential laser gyroscope[D].Changsha：National University of Defense Technology，2007：3-5.（in Chinese）

[2]張開東.激光陀螺捷聯(lián)慣導系統(tǒng)連續(xù)自動標定技術研究[D].長沙：國防科學技術大學，2002：3-4. ZHANG KAIDONG.Research on the technology about self calibration of laser gyroscope based strapdown inertial navigation system[D].Changsha：National University of Defense Technology，2002：3-4.（in Chinese）

[3]CUREY R K，ASH M E，THIELMAN L O，et al.Proposed IEEE inertial systems terminology standard and other inertial sensor standards[C]//IEEE Position Location and Navigation Symposium.Monterey，California：IEEE，2004：83-90.

[4]TITTERTON D H，WESTON J L.Strapdown inertial navigation technology[M].London：Peter Peregrinus Ltd.on behalf of the Institute of Electrical Engineers，2004：253-255.

[5]ZHANG H，WU Y，WU W.Improved multi-position calibration for inertial measurement units[J].Measurement Science and Technology，2010，21（1）：1-11.

[6]SKOG I，HANDEL P.Calibration of a MEMS inertial measurement unit[C]//XVII IMEKO World Congress，Metrology for a Sustainable Development.Rio de Janeiro，Brazil，2006：326-329.

[7]謝波，秦永元，萬彥輝.激光陀螺捷聯(lián)慣導系統(tǒng)多位置標定方法[J].中國慣性技術學報，2011，19（2）：157-162. XIE BO，QIN YONGYUAN，WAN YANHUI.Multiposition calibration method of laser gyro SINS[J].Journal of Chinese Inertial Technology，2011，19（2）：157-162.（in Chinese）

[8]肖桂平.光學陀螺捷聯(lián)慣導系統(tǒng)的標定精度分析[D].長沙：國防科學技術大學，2008：8-11. XIAO GUIPING.Accurancy of optic gyro strapdown inertial navigation system calibration[D].Changsha：National University of Defense Technology，2008：8-11.（in Chinese）

[9]張紅良.陸用高精度激光陀螺捷聯(lián)慣導系統(tǒng)誤差參數(shù)估計方法研究[D].長沙：國防科學技術大學，2010：24-26.

ZHANG HONGLIANG.Research on error parameter estimation of land high precision ring laser gyroscope strapdown inertial navigation system[D].Changsha：National University of Defense Technology，2010：24-26.（in Chinese）

[10]KAO W W，TSAI C L.Adaptive and learning calibration of magnetic compass[J].Measurement Science and Technology，2006，17（11）：3073-3082.

[11]JURMAN D，JANKOVEC M，KAMNIK R，et al.Calibra

tion and data fusion solution for the miniature attitude and heading reference system[J].Sensors and Actuators A：Physical，2007，138（2）：411-420.

[12]MIRZAEI F M，ROUMELIOTIS S I.A Kalman filterbased algorithm for IMU-camera calibration：Observability Analysis and Performance Evaluation[J].Robotics，IEEE Transactions on，2008，24（5）：1143-1156.

[13]BONNET S，BASSOMPIERRE C，GODIN C，et al.Calibration methods for inertial and magnetic sensors[J].Sensors andActuatorsA：Physical，2009，156（2）：302-311.

Abstrat:In order to reduce the demand of precise turntable in the calibration of error parameters in strapdown inertial navigation system,a systematic calibration method based on velocity error was proposed.Based on the model of inertial sensors and error equation of SINS,the velocity errors of inertial navigation system before and after rotation were used as observational vectors.Then the rotation scheme was designed to calibrate the error parameters of inertial sensors.The simulation results showed that,compared with the traditional calibration method,systematic calibration method has lower demand of precise turntable which can be applied to the field calibration while maintaining the calibration accuracy.

Systematic Calibration Method Based on Velocity Error

XU Qing-jiu1,SUN Shi-zhen2,DAI Hong-de1
（1.Department of Control Engineering,NAAU,Yantai Shandong 264001,China; 2.Tianjin Bureau of NED,Beijing 100086,China）

SINS;error equation;systematic calibration

V249.32+2

A

1673-1522（2014）01-0009-05

10.7682/j.issn.1673-1522.2014.01.003

2013-09-04；

2013-11-25

徐慶九（1969-），男，副教授，碩士。