丁磊香，許厚澤，王 勇，柴 華，蔡小波

（1. 中國科學院 測量與地球物理研究所 大地測量學與地球動力學國家重點實驗室，武漢 430077；2. 中國科學院大學，北京 100049）

捷聯(lián)慣導系統(tǒng)最簡多位置解析對準改進算法

丁磊香1,2，許厚澤1，王 勇1，柴 華1，蔡小波1,2

（1. 中國科學院 測量與地球物理研究所 大地測量學與地球動力學國家重點實驗室，武漢 430077；2. 中國科學院大學，北京 100049）

最簡多位置解析對準作為測量IMU偏置的簡單方法，降低了傳統(tǒng)多位置解析對準的工程復雜度，擺脫了伺服平臺的限制，但是最簡多位置解析對準目前使用的是幾何方法，幾何方法計算復雜，精度受先驗信息的影響。針對這一問題，提出了最簡多位置對準解析算法，通過解析算法可得到IMU偏置的解析解。通常兩位置即可求得IMU偏置，特殊情況需要三位置，某些特殊位置可以計算特定軸向的偏置。解析法計算簡單，不受先驗信息的影響，并通過實例仿真證實該算法的有效性，計算誤差主要由一階近似誤差和測量噪聲引起。

捷聯(lián)慣導系統(tǒng)；多位置對準；解析對準；常值偏置

捷聯(lián)慣導系統(tǒng)（SINS）初始對準的時間和精度直接影響導航系統(tǒng)的快速反應能力和導航解算精度[1-2]。靜基座對準時，系統(tǒng)可觀測度較低[3]，東向陀螺漂移不可觀測，對準的精度和速度都會受到影響[4-5]。多位置對準技術可以估計出加速計零偏和東向陀螺漂移，提高初始對準精度[6-8]。根據(jù)使用的信息量不同，多位置對準技術可分為兩類：多位置精對準和多位置解析對準。多位置精對準[9-11]使用靜止和轉(zhuǎn)動過程中的慣性傳感器數(shù)據(jù)，采用卡爾曼濾波法估計出慣性測量單元（IMU）的偏置和姿態(tài)。多位置解析對準[12-13]只使用靜止狀態(tài)下慣性傳感器的輸出數(shù)據(jù)，根據(jù)各靜止位置間的解析關系補償?shù)羝闷睢?/p>

傳統(tǒng)多位置解析對準一般要求捷聯(lián)慣導系統(tǒng)繞天向旋轉(zhuǎn)一個或多個特定的角度，這增加了工程實現(xiàn)的復雜度，且伺服平臺的精度會影響對準精度。文獻[14]提出了最簡多位置解析對準，可以克服上述困難，理論上該方法任意兩位置即可解算慣性傳感器的偏置，它可以作為一種簡易的初始對準或現(xiàn)場標定的方法，并且在特殊狀態(tài)下，該方法可以很好地估計出某一軸向的加速計零偏或陀螺漂移。

上述最簡多位置解析對準使用的是幾何方法，根據(jù)先驗信息反復搜索，得到IMU偏置的幾何解。幾何方法計算復雜，并且先驗信息對計算結果的影響較大。針對此問題，本文推導了IMU偏置的解析表達式，可以得到任意多位置IMU偏置的解析解，稱之為解析方法。解析方法計算簡單，不受先驗信息的影響，并通過實例仿真驗證了該方法的有效性。

1 任意兩位置解析對準

1.1 理論分析

將當?shù)貣|北天地理坐標系作為導航系（記為n系），載體坐標系記為b系，n系到b系的轉(zhuǎn)換矩陣為 C。 IMU輸出的三軸加速度記為，三軸角速度記為。地球自轉(zhuǎn)角速度記為ω，載體所在位置的重力記為g，載體所在位置的緯度記為B。若載體處于靜止狀態(tài)，則有下式成立：

式中， fb為b的理論值， ωb為b的理論值，gn=[00 g]T，ωn=[0 ωcos Bωsin B]T。

由式(1)可得：

式中，||為取模運算符， 〈 〉為內(nèi)積運算符。

對于多位置對準，對準時間在較短時間完成，可認為IMU偏置保持不變。偏置誤差是IMU誤差的主要組成部分，只考慮IMU的常值偏置誤差。記三軸加速度計的常值零偏為，記三軸陀螺的常值漂移為，那么下式成立：

把式(3)代入式(2)可得下式：

式(4)中含有6個未知數(shù)，在多位置初始對準中，每個位置可得到關于IMU偏置的三個方程，理論上兩位置初始對準即可得到IMU偏置。因此如何根據(jù)上述方程求得IMU偏置是最簡多位置解析對準的關鍵。文獻[14]給出了一種求解IMU偏置的幾何方法，這種方法根據(jù)先驗信息反復搜索，直到搜索到滿足所需精度的解，幾何方法計算復雜，并且受先驗信息的影響較大。本文通過研究發(fā)現(xiàn)，上述方程存在解析解，詳細推導過程如下。

1.2 任意兩位置解析對準的解析算法

式(4)第一式等號兩邊平方，忽略掉高階小項，并整理，可得下式：

對式(4)第二式作同樣的處理，可得下式：

式(4)第三式等號兩邊同除以gω，忽略掉高階小項，并整理，可得下式：

把式(5)~(7)寫成矩陣的形式，可得下式：

式中，

式(8)即為關于IMU偏置的解析表達式，表達式為3個六元一次方程。任意兩位置可以得到6個六元一次方程構成的方程組，解此方程組可得到IMU偏置的解析解，把這種方法稱為解析法。

2 實例仿真

舉一仿真實例驗證上述解析法的有效性，相關的仿真參數(shù)與文獻[14]相同。

式中，σa和σε分別為加速計和陀螺的測量白噪聲，

γk、θk和Ψk分別為第k（k=1, 2）個位置處的橫滾角、俯仰角和航向角。

在兩個位置處采集1 min的數(shù)據(jù)取平均，分別得出兩個位置IMU平均輸出數(shù)據(jù)：

根據(jù)式(8)，兩個位置可以得到6個六元一次方程組成的方程組，解此方程組，即可得到IMU偏置，結果見表1。

表1 IMU偏置Tab.1 Constant biases of IMU

通過表1可以看出，IMU偏置可以得到有效計算，但也存在誤差，計算誤差主要是由一階近似誤差與測量噪聲引起。

需要指出的是，在某些特殊位置，比如兩個位置的水平角同為零（即橫滾角和俯仰角都為零），方程組的系數(shù)陣為奇異陣，無法求得IMU的偏置。因此要避免這種情況的發(fā)生，或者增加一個觀測位置，即可求得IMU的偏置。

通過觀察還可以發(fā)現(xiàn)，當載體處于某些特殊位置時，可以計算特定軸向的偏置。當載體近似水平時，由式(5)可以計算天向加速計零偏；當 IMU某軸接近地球自轉(zhuǎn)軸的時候，由式(6)可以計算該軸向的陀螺漂移。

3 結 論

本文對最簡多位置對準進行了研究，推導了 IMU偏置的解析表達式，提出了計算IMU偏置的解析法，指出解析法計算簡單，不受先驗信息的影響。通過解析法，一個位置可得到3個六元一次方程，兩個位置即可得到6個六元一次方程組成的方程組，解此方程組，可計算求得IMU偏置，計算誤差主要由一階近似誤差和測量噪聲引起。某些特殊情況下，需要三個位置求解IMU偏置。某些特殊位置可以計算特定軸向的偏置。

（References）：

[1] Paul G S. Blazing gyros: The evolution of strapdown inertial navigation technology for aircraft[J]. Journal of Guidance, Control, and Dynamics, 2013, 36(3): 637-655.

[2] Liu X X, Xu X S, Wang L H, et al. A fast compass alignment method for SINS based on saved data and repeated navigation solution[J]. Measurement, 2013, 46(10): 3836-3846.

[3] Jiang Y F, Lin Y P. Error estimation of INS ground alignment through observability analysis[J]. IEEE Transactions on Aerospace and Electronic Systems, 1992, 28(1): 92-97.

[4] Cho S Y, Lee H K, Lee H K. Observability and estimation error analysis of the initial fine alignment filter for nonleveling strapdown inertial navigation system[J]. Journal of Dynamic Systems, Measurement and Control, 2012, 135(2): 44-45.

[5] Wang X L. Fast alignment and calibration algorithms for inertial navigation system[J]. Aerospace Science and Technology, 2009, 13(4-5): 204-209.

[6] Wu Y X, Zhang H L, Wu M P, et al. Observability of strapdown INS alignment: A global perspective[J]. IEEE Transactions on Aerospace and Electronic Systems, 2012, 48(1): 78-102.

[7] Xiong J, Guo H, Yang Z H. A two-position SINS initial alignment method based on gyro information[J]. Advances in Space Research, 2014, 53(11): 1657-1663.

[8] 周廣濤, 陳明輝, 劉星伯, 等. 新的兩位置組合對準方法研究[J]. 傳感器與微系統(tǒng), 2008, 27(9): 17-20. Zhou G T, Chen M H, Liu X B, et al. Research on new two-position integrated alignment[J]. Transducer and Microsystem Technologies, 2008, 27(9): 17-20.

[9] Lee J G, Park C G, Park H W. Multiposition alignment of strapdown inertial navigation system[J]. IEEE Transactions on Aerospace and Electronic Systems, 1993, 29(4): 1323-1328.

[10] Chung D, Lee J G, Park C G, et al. Strapdown INS error model for multiposition alignment [J]. IEEE Transactions on Aerospace and Electronic Systems, 1996, 32(4): 1362-1366.

[11] 趙長山, 秦永元, 周琪. 參數(shù)辨識雙位置對準改進算法[J]. 中國慣性技術學報, 2009, 17(6): 631-635. Zhao C S, Qin Y Y, Zhou Q. Modified two-position parameter identification alignment method[J]. Journal of Chinese Inertial Technology, 2009, 17(6): 631-635.

[12] Tan C M, Zhu X H, Wang Y, et al. Multi-position alignment with arbitrary rotation axis for SINS[J]. Journal of Chinese Inertial Technology, 2015, 23(3): 293-297.

[13] 孟衛(wèi)鋒, 袁愛紅, 賈天龍, 等. 高精度慣性平臺十六位置自標定方案[J]. 中國慣性技術學報, 2015, 23(2): 150-155. Meng W F, Yuan A H, Jia T L, et al. 16-position self-calibration of high-accuracy inertial platform[J]. Journal of Chinese Inertial Technology, 2015, 23(2): 150-155.

[14] 譚彩銘, 王宇, 蘇巖, 等. 捷聯(lián)慣導系統(tǒng)最簡多位置解析對準[J]. 北京航空航天大學學報, 2015, 41 (9): 1645-1650. Tan C M, Wang Y, Su Y, et al. The simplest multi-position analytic alignment for SINS[J]. Journal of Beijing University of Aeronautics and Astronautics, 2015, 41(9): 1645-1650.

Improved algorithm of the simplest multi-position analytic alignment for SINS

As a simple method for measuring IMU biases, the simplest multi-position analytic alignment reduces engineering complexity of traditional method and is free from the limitation of servo platform. However, the geometric method, which is used by the simplest multi-position analytic alignment, is complex for calculating and the accuracy of this method is affected by the prior information. To solve this problem, an analytic method is proposed and the analytic expressions of IMU biases are derived. The constant biases can be usually obtained through the information in two positions. Three positions are needed in particular cases. The constant bias of a certain axis can be well estimated when IMU stays in a particular attitude. The analytic method is easy to calculate and is unaffected by the prior information. Simulation results demonstrate that this method is effective and the calculation errors are mainly caused by the first-order approximation errors and the measurement noises.

strapdown inertial navigation system; multi-position alignment; analytic alignment; constant bias

P227.9

：A

2016-03-30；

：2016-04-12

國家自然科學基金（41274084，41406115）

丁磊香（1982—），男，博士研究生，從事組合導航研究。E-mail: dingleixaing@163.com

1005-6734(2016)03-0296-03

10.13695/j.cnki.12-1222/o3.2016.03.004

DING Lei-xiang1,2, XU Hou-ze1, WANG Yong1, CHAI Hua1, CAI Xiao-bo1,2

(1. State Key Laboratory of Geodesy and Earth’s Dynamics, Institute of Geodesy and Geophysics, Wuhan 430077, China; 2. University of Chinese Academy of Sciences, Beijing 100049, China)