撓性陀螺尋北儀解算方法研究

賈智學 張小凱 任佳婧

中國航天科技集團公司第九研究院七一Ο七廠 ，寶雞721006

?

撓性陀螺尋北儀解算方法研究

賈智學 張小凱 任佳婧

中國航天科技集團公司第九研究院七一Ο七廠 ，寶雞721006

研究了撓性尋北儀解算算法，首先介紹了尋北儀的組成和算法原理，在此基礎上建立了陀螺和加速度計的誤差模型。根據二位置尋北方法，分別推導了尋北系統在基座水平和傾斜情況下的尋北算法，試驗表明該算法能滿足中低尋北精度要求。

撓性陀螺儀；尋北儀；尋北技術方案；誤差模型；實驗

陀螺尋北儀是一種精密慣性測量儀器[1], 通常用于為火炮、偵察車輛和地面雷達等機動武器系統提供方位參考。近年來，尋北儀在國防軍事高科技領域的需求越來越迫切，同時在民用工程中也越來越顯示出廣闊的應用前景。

尋北技術目前常用技術途徑主要包括天文觀測法、地磁尋北法[2]和慣性尋北法[3]，其中陀螺尋北儀相對其他方式具有獨特的優點，尋北測量不受天氣、地磁場等外界環境的影響。它利用陀螺儀原理測量地球自轉角速率在當地水平面投影方向(即真北方位) 的一種慣性測量系統[4]。撓性陀螺的發展已經非常成熟，相對其他種類陀螺具有精度高、體積小、價格便宜等優點，所以撓性陀螺尋北儀是一種性價比很高的尋北系統。本文針對雙軸撓性陀螺儀的優點，主要進行了二位置尋北技術的研究。

1 尋北儀組成及測量原理

1.1 尋北儀組成

尋北儀主要由高精度動力調諧陀螺儀、石英加速度計、陀螺再平衡電路、數據采集電路、信號處理電路、二次電源、顯示裝置、解算軟件和機械轉動裝置構成,其系統組成框圖如圖1所示。

圖1 系統組成框圖

1.2 尋北儀測量原理

尋北儀測量原理是利用陀螺敏感地球的自轉角速度，通過解算得到載體某一固定軸與真北方向的夾角即方位角。加速度計敏感地球重力加速度，從而得到載體的俯仰角與滾動角，用于傾斜狀態方位解算。陀螺尋北儀尋北方式可以分為連續轉動方案、多位置方案[5]和兩位置方案等。其中，兩位置尋北方案由于其尋北時間短，易于實現而得到廣泛應用。陀螺數學模型如式(1)和(2)，加速度計數學模型如式(3)和(4)所示:

UgxKgx=Dx0+DxxAx+DxyAy+DxzAz+ωecosLsinφ

(1)

UgyKgy=Dy0+DyxAx+DyyAy+DyzAz+ωecosLcosφ

(2)

UaxKay=Kax0+Aax

(3)

UayKaz=Kay0+Aay

(4)

式(1)和(2)中，Ugx和Ugy為陀螺儀輸出；Kgx和Kgy為陀螺儀標度因數；ωe為地球自轉角速度率；Ax,Ay,Az為三軸的加速度；L為當地地理緯度；φ為與真北方向夾角；Dx0，Dy0為陀螺儀的常值漂移；Dxx，Dxy，Dxz，Dyx，Dyy，Dyz，Dzx，Dzy，Dzz為陀螺儀與加速度一次方有關的誤差系數。式(3)和(4)中,Uax和Uay為加速度輸出；Kax和Kay為加速度計的標度因數；Kax0和Kay0為加速度計零偏。

2 尋北技術方案

2.1 坐標系的定義與轉換關系

慣性坐標系用來表示慣性空間的坐標系

OXiYiZi,導航坐標系為OXnYnZn，Xn軸與Yn軸在當地水平面內，Xn軸與正東方向重合，Yn軸與正北方向重合，Zn軸沿地垂線指天，因此也稱為東北天坐標系，如圖2所示。

圖2 慣性坐標系

載體坐標系OXbYbZb與載體固聯，其原點就是載體的重心，Yb軸指向載體的縱軸方向，Xb軸指向載體的右側，Zb軸與Xb軸和Yb軸構成右手坐標系。

圖3 坐標轉換圖

取東北天為導航坐標系,用OXnYnZn表示；載體坐標系用OXbYbZb表示。首先以OXnYnZn繞OZn軸轉動角度Φ，然后繞OX1軸轉動角度θ，最后繞OYb軸轉動角度γ至載體坐標系OXbYbZb。坐標轉換如圖3所示。

從導航坐標系OXnYnZn到載體坐標系OXbYbZb轉換矩陣如下：

(5)

地球自轉角速度在導航坐標系上的投影

(6)

地球自轉角速度在載體坐標系上的投影

(7)

重力加速度在導航坐標系上的投影

(8)

重力加速度在載體坐標系上的投影

(9)

2.2 在基座調平狀態下尋北

尋北方案按工作狀態分為調平狀態下尋北和傾斜狀態下尋北。兩位置尋北時間較短，精度較好，因此廣泛采用兩位置尋北。 采用兩位置尋北方案，根據陀螺的誤差模型，將尋北儀轉到0°和180°位置時，陀螺儀輸出數據之差可以消除陀螺常值誤差和與Z向加速度有關的漂移，并對與X向和Y向加速度有關的漂移進行補償后，計算出地球自轉角速度在載體座標系上的投影。

陀螺和加速度計安裝方式見圖4，陀螺X軸敏感東向角速度，Y軸敏感北向角速度。在水平狀態下，X軸和Y軸加速度計輸出為0。

圖4 陀螺和加速度計安裝方式圖

根據陀螺儀的輸出誤差模型，0°位置陀螺輸出為

Ugx0Kgx=Dx0+ωecosLsinφ

(10)

Ugy0Kgy=Dy0+ωecosLcosφ

(11)

180°位置陀螺輸出為

Ugx1Kgx=Dx 0+ωecosLsin(180+φ)

(12)

Ugy1Kgy=Dy 0+ωecosLcos(180+φ)

(13)

根據式(10)～(13)計算出與真北方向夾角φ為

(14)

1)arctanΦ≥0，φ1>0，φ=φ1；

2)arctanΦ≥0，φ1<0，φ=90°-φ1；

3)arctanΦ≤0，φ1>0，φ=φ1+180°；

4)arctanΦ≤0，φ1>0，φ=360°-φ1。

2.3 在基座傾斜狀態下尋北

當基座處于傾斜狀態下，X軸和Y軸加速度計輸出不為0，與加速度有關誤差系數需要補償，才能提高尋北精度。當基座在傾斜狀態下時，0°位置陀螺儀輸出為：

Ugx0Kgx=Dx0+DxxAx+DxyAy+DxzAz+ωbx

(15)

Ugy0Kgy=Dy0+DyxAx+DyyAy+DyzAz+ωby

(16)

180°位置陀螺儀輸出為

Ugx1Kgx=Dx0-DxxAx-DxyAy+DxzAz-ωbx

(17)

Ugy1Kgy=Dy0-DyxAx-DyyAy+DyzAz-ωby

(18)

由式(16)和(18)相減，計算出地球自轉角速度在載體座標系東向角速度投影：

(19)

由式(17)和(19)相減，計算出地球自轉角速度在載體座標系北向角速度投影：

(20)

由式(9)計算出俯仰角和橫滾角

(21)

θ=-arcsin(AYb/g)

(22)

γ=arcsin(AXb/gcosθ)

(23)

由式(5)～(7)和式(19)～(20)計算出方位角Ф為

(24)

計算后按照基座調平狀態的數據處理方法即可得到φ。

式(24)中，ωbx是地球自轉角速度在載體座標系東向投影；ωby是地球自轉角速度在載體座標系北向投影；θ是載體橫滾角,γ是俯仰角；ωe是地球自轉角速度(15.041(°)/h)；L是當地地理緯度。

3 試驗驗證

3.1 在基座調平狀態下尋北實驗

在常溫狀態下，使轉臺水平，將尋北儀安裝在轉臺上，分別在20°,70°,150°,270°位置進行尋北實驗，試驗數據如表1所示。

表1 基座調平狀態下陀螺實驗數據

3.2 在基座傾斜狀態下尋北實驗

尋北儀在實際工作中不一定是完全水平狀態，可能存在一個小角度的傾斜，所以尋北儀的傾斜尋北實驗非常必要。實驗在-5°傾斜狀態下，分別在0°,45°,90°,150° 位置進行，實驗數據如表2所示。試驗時將尋北裝置安裝在轉臺上，利用式(24)解算出尋北結果以及1σ值。

由實驗數據可以看出，在傾斜狀態下，尋北系統能正確解算出位置信息，實驗驗證了本文提出的傾斜狀態下尋北算法的正確性。

表2 傾斜狀態下的尋北數據

4 結論

首先闡述了撓性陀螺尋北儀的基本原理，給出了撓性陀螺尋北儀的數學模型，在此基礎上詳細討論了基座處于調平狀態和傾斜狀態2種情況下的解算算法，試驗結果證明，文中建立的數學模型、尋北儀解算方法均能滿足中低精度尋北要求。

[1] 白云超，李學琴，馬小輝，田育民. 采用旋轉調制技術的高精度尋北方案[J]. 中國慣性技術學報，2010，18(4)：421-424.( Bai Yunchao, Li Xueqin, Ma Xiaohui, Tian Yumin.High Precision North Seeking Scheme Based on Rotation Modulation [J] .Chinese Journal of Inertial Technology, 2010，18(4)：421-424.)

[2] 王立冬，劉 軍，魯 軍.多位置尋北誤差與陀螺數據采樣時間的關系[J].中國慣性技術學報，2011, 19(3):286-289.(Wang Lidong, Liu Jun, Lu Jun. The Relationship between Multiposition North Seeking Error and Gyro Sampling Time [J] .Chinese Journal of Inertial Technology, 2011, 19(3):286-289.)

[3] 卜繼軍，魏貴玲,等. 陀螺尋北儀二位置尋北方案[J].中國慣性技術學報，2002, 10(3):46-49.(Bu Jijun, Wei Guiling, et al.Neither-north-seeking Scheme of Gyro North Finder [J] .Chinese Journal of Inertial Technology Chinese Inertial Technolog, 2002, 10(3): 46-49.)

[4] 陸元九.慣性器件[M]. 北京：國防工業出版社， 2002.(Lu Yuanjiu. Inertial Devices [M]. Beijing: National Defense Industry Press, 2002.)

[5] Titterton D H, Weston J L. Strapdown Inertial Navigation Technology[M]. Peter Peregrinus Ltd., on behalf of the Institution of Electrical Engineers, London, United Kindom, 1997: 268.

Research on Solver Algorithm for Flexible North Finder

Jia Zhixue,Zhang Xiaokai, Ren Jiajing

Ninth Academy of China Aerospace Science and Technology Company Institute 7107 Factory, Baoji 721006, China

Theflexiblenorthfindersolveralgorithmisstudiedinthispaper.Firstly,theprinciplesofcompositionandalgorithmofnorthfinderareintroduced,andonthebasisoftheestablishmentoftheerrormodelofgyroscopeandaccelerometer.Regardingthetwo-positionnorth-seekingmethod,thenorth-seekingalgorithmisderivedforthenorth-seekingsysteminthecaseofbaselevelandinclination,andtheexperimentresultsshowthatthealgorithmcanmeettherequirementsoflowprecisionlevel.

Flexiblegyroscope;Northfinder;Northfindertechnologysolutions;Errormodel;Experiment

2016-09-08

賈智學(1976-)，男，陜西寶雞人，本科，高級工程師，主要研究慣性儀表；張小凱(1967-)，男，陜西戶縣人，碩士，研究員，主要研究慣性儀表；任佳婧(1989-)，女，黑龍江佳木斯人，碩士，助理工程師，主要從事導航、制導與控制研究。

TP23

A

1006-3242(2017)01-0082-04