馮凱強，李 杰，魏曉凱

(中北大學(xué) 儀器科學(xué)與動態(tài)測試教育部重點實驗室， 太原 030051)

在慣性導(dǎo)航系統(tǒng)中，三軸加速度計性能的好壞直接影響到慣導(dǎo)測試系統(tǒng)的速度、姿態(tài)、位置解算精度，因此，對加速度計的測試標(biāo)定已成為慣性測量組合使用過程中的重要環(huán)節(jié)[1]。對于三軸加速度計而言，通常由3個兩兩相互正交的加速度計組成，其測量精度與傳感器的零偏、刻度系數(shù)以及敏感軸之間的不正交安裝誤差相關(guān)[2]。在應(yīng)用過程中，需對傳感器輸出進行標(biāo)定補償以提高系統(tǒng)的測試精度。傳統(tǒng)三軸加速度計的標(biāo)定方法需要借助光學(xué)分度頭或三軸轉(zhuǎn)臺等高精度測試設(shè)備來獲得準(zhǔn)確標(biāo)定參數(shù)。大量試驗表明，慣性器件自身性能參數(shù)會隨時間的推移與應(yīng)用環(huán)境等方面的變化而發(fā)生變化[3]。最為顯著的就是傳感器的零位漂移，與初始標(biāo)定時間相隔越長，傳感器的零漂越明顯；若在后期應(yīng)用過程中沿用原有的標(biāo)定結(jié)果，則會產(chǎn)生較大的解算誤差。實驗表明，加速度計的零偏對導(dǎo)航計算結(jié)果的誤差影響按時間的二次方增長。因此，彈載慣性測量組合在靶場實驗環(huán)境中傳感器自身性能參數(shù)與實驗室環(huán)境中轉(zhuǎn)臺標(biāo)定參數(shù)會有很大不同，實彈飛行測試中，慣性測量單元中傳感器輸出參數(shù)誤差會產(chǎn)生較大的解算誤差，影響慣性測量組合的測試精度。由于火箭彈、炮彈等常規(guī)武器飛行時間短，因此與彈體固聯(lián)的慣性測量單元在較短的工作時間內(nèi)需要有準(zhǔn)確的參數(shù)輸出，以提高導(dǎo)航計算機的解算精度，在靶場實驗環(huán)境中，不可能實時利用轉(zhuǎn)臺等精密設(shè)備對安裝于彈體中的慣性測量組合進行在線標(biāo)定，而通過濾波算法實現(xiàn)的系統(tǒng)級標(biāo)定方法因其可觀測性分析復(fù)雜，計算量大也無法達到有效應(yīng)用。鑒于此，本研究提出了一種三軸加速度計在線快速標(biāo)定方法。該方法無需依賴轉(zhuǎn)臺等精密儀器，根據(jù)橢球擬合算法實現(xiàn)三軸加計的參數(shù)標(biāo)定，并結(jié)合加速度計輸出特點給出了具體的標(biāo)定位置編排，完成了相應(yīng)的誤差補償。

1 三軸加速度計誤差分析

針對單軸加速度計，其測量誤差主要由零偏、靈敏度誤差和隨機漂移誤差組成。加速度計的隨機漂移誤差通常由偏置誤差與白噪聲組成，由于標(biāo)定時間短，加速度計等效漂移往往經(jīng)過后期濾波處理獲得，在標(biāo)定時往往忽略該項。因此，各軸加速度計的測量模型通常表示為

Uai=Kiai+Uai0

(1)

其中：Uai為i軸加計輸出電壓值；Ki為i軸加速度計實際靈敏度；ai為i軸加速度真實值；Uai0為i軸加速度計的零位偏差。在彈載微慣性測量組合中，三軸加速度計通常由3個兩兩相互正交的加速度計組成，用來敏感加速度矢量在坐標(biāo)系下的投影[4]。理想狀況下，可得到三軸加速度計的測量模型為

(2)

但是在制造過程中，由于安裝誤差的存在，無法保證三個傳感器的測量軸兩兩完全正交[5]，其不正交示意圖如圖1。

圖1 不正交示意圖

假設(shè)OX0Y0Z0為理想三軸正交坐標(biāo)系；OXYZ為實際加速度計敏感軸系；其中，Z軸與Z0軸重合，X軸在X0OZ0內(nèi)與X0的夾角為α；Y軸在X0OY0內(nèi)與Y0的夾角為β；Y軸與X0OY0面的夾角為γ。建立三軸加速度計的不正交誤差模型如下

(3)

綜上所述，三軸加速度計誤差主要有加速度計零偏、靈敏度誤差和不正交誤差，由此建立三軸加速度計的測量模型為：

Ua=Ka+Ua0

(4)

2 三軸加速度計在線標(biāo)定模型

由于同一地點的重力加速度為一個常值，理想情況下，靜止放置的三軸加速度計在不同姿態(tài)下測得的加速度分量在三維空間中可構(gòu)成一個中心在原點半徑為當(dāng)?shù)刂亓铀俣鹊臉?biāo)準(zhǔn)球體[5]。但由于三軸加速度計各項誤差的存在，使得形成的球體發(fā)生偏離，變?yōu)橹行钠x原點的橢球。即：

aTa=[K-1(Ua-Ua0)]T[K-1(Ua-Ua0)]=g2

(5)

由上式變換成橢球曲面的二次型方程為：

(6)

三軸加速度計在線標(biāo)定模型的實質(zhì)就是通過測定不同姿態(tài)下三軸加速度分量擬合橢球的中心坐標(biāo)與形狀參數(shù)來獲取加速度計的各項誤差參數(shù)[6]。橢球曲面的一般方程為：

F(ξ,Z)=ξTZ=0

(7)

式中：橢球曲面參數(shù)ξ=[a,b,c,d,e,f,p,q,r,g]；設(shè)Z=[x2,y,z,2xy,2xz,2yz,2x,2y,2z,1]T為采集數(shù)據(jù)運算組合向量；F(ξ,Z)為采集數(shù)據(jù)(x，y，z)到橢球曲面的代數(shù)距離。

在進行二次曲面擬合時，采用帶約束的最小二乘法的橢球擬合一般選擇測量數(shù)據(jù)(x，y，z)到二次曲面代數(shù)距離的平方和最小為判斷準(zhǔn)則，為了確保最終擬合的二次曲面為一橢球體，引入約束條件：

(8)

則得到擬合后的最佳橢球曲面方程整理為矢量形式為

(X-X0)TA(X-X0)=1

(9)

通過對比式(6)與式(9)可以得到

KKT=A-1/g2

(10)

Ua0=X0

(11)

根據(jù)式(4)可以計算得到各標(biāo)定參數(shù)的估計值為

(12)

結(jié)合上述公式，利用擬合的得到的橢球參數(shù)即可獲得三軸加速度計的零偏和誤差系數(shù)矩陣，完成加速度計的標(biāo)定。

3 在線標(biāo)定方案編排與誤差補償

基于橢球約束的最小二乘法擬合原理的實質(zhì)是找到一組最佳橢球參數(shù)，使得測量數(shù)據(jù)到橢球曲面的距離達到最小[7-8]。對用于擬合的測量數(shù)據(jù)來講，要求該數(shù)據(jù)盡可能地覆蓋橢球曲面的絕大部分球面，并且數(shù)據(jù)正確反映各測量軸的重力分量[9-12]。標(biāo)定過程中通常在三維空間內(nèi)采用畫8字的方式進行橢球分布，但是由于加速度計干擾噪聲以及響應(yīng)時間等因素限制，對于單點采樣得到的測量數(shù)據(jù)會出現(xiàn)雜質(zhì)點，無法獲得準(zhǔn)確的標(biāo)定參數(shù)。

因此，依據(jù)傳感器的輸出特點以及擬合要求制定出如下標(biāo)定方案：

1) 待傳感器上電穩(wěn)定后，在待標(biāo)定固定位置點測量當(dāng)?shù)刂亓铀俣龋?/p>

2) 依據(jù)三軸加速度計在載體上的安裝方式(X軸對應(yīng)載體滾轉(zhuǎn)軸)，分別在俯仰45°、0°、-45°時，各繞滾轉(zhuǎn)軸旋轉(zhuǎn)一周；每周大致設(shè)置8個等分測量點，在每個測量點處靜止采集20 s；

3) 再次隨機旋轉(zhuǎn)載體，使其所處姿態(tài)對應(yīng)測量點盡量覆蓋其余橢球曲面，每個測量點處靜止采集20 s；

4) 選取步驟2)、3)中得到的每段測量值的穩(wěn)定數(shù)據(jù)求取均值，并保存為樣本數(shù)據(jù)；

5) 將步驟4)得到的數(shù)據(jù)擬合橢球曲面，獲得擬合橢球的中心點坐標(biāo)與形狀參數(shù)；

6) 計算三軸加計的待標(biāo)定參數(shù)，完成參數(shù)輸出。

在誤差模型的基礎(chǔ)上，由式(4)可得三軸加速度計測量校準(zhǔn)模型為

a=K-1(Ua-Ua0)

(13)

式中：

為誤差補償系數(shù)矩陣。

根據(jù)式(12)利用擬合得到的橢球參數(shù)計算標(biāo)定數(shù)據(jù)，將標(biāo)定結(jié)果代入式(13)，即可得到三軸加速度計的測量校準(zhǔn)模型，利用該模型對三軸加速度計的測量結(jié)果完成誤差補償。

4 驗證

為了驗證該標(biāo)定補償方法的可行性、有效性，以實驗室自行組建的慣性測量組合與采集存儲電路為測試平臺，如圖2所示，利用高精度三軸位置速率溫控轉(zhuǎn)臺進行了靜態(tài)標(biāo)定實驗驗證。

圖2 測試平臺

本實驗室自行組裝的慣性測量組合在X、Y、Z三軸分別集成有量程為±10 g的加速度計，根據(jù)3.1節(jié)中的標(biāo)定方案對三軸加速度計進行現(xiàn)場標(biāo)定試驗，并以5 kHz采樣率對傳感器輸出進行采集存儲。

根據(jù)上述三軸加速度計的在線標(biāo)定模型，利用MATLAB軟件對試驗數(shù)據(jù)進行數(shù)據(jù)處理，擬合得到的最佳橢球曲面如圖3所示，其中橢球擬合殘差表示選取樣本數(shù)據(jù)與擬合數(shù)據(jù)之間的偏差，如圖4所示，若出現(xiàn)殘差過大的奇異點，證明該點數(shù)據(jù)測量時可能受到誤差干擾，將其濾除后重新擬合。最后根據(jù)所得橢球的形狀參數(shù)解算得到三軸加速度計的各項標(biāo)定參數(shù)如下：

kx=0.218 25 V/g，ky=0.208 58 V/g，kz=0.217 19 V/g，Uax0= 2.509 76 V，Uay0= 2.512 98 V，Uaz0= 2.495 36 V，α=1.234 7°，β=-0.865 3°，γ=0.342 5°。

圖3 三軸加速度計輸出

圖4 橢球擬合殘差

由以上獲得的標(biāo)定參數(shù)計算得到三軸加速度計的誤差補償系數(shù)矩陣為

將慣性測量組合放置在三軸高精度位置速率轉(zhuǎn)臺上，根據(jù)三軸加速度計在載體上的安裝位置，將X軸和Z軸設(shè)置為水平狀態(tài)，Y軸敏感重力加速度，如圖5所示，進行多次采集試驗。

應(yīng)用上述誤差補償矩陣對三軸加計輸出進行補償，其補償前后加速度計輸出對比曲線如圖6所示，對比數(shù)據(jù)如表1所示。

圖5 轉(zhuǎn)臺實驗

圖6 補償前后三軸加速度

敏感軸補償前/g補償后/gX0.025 1380.000 438Y0.985 8430.999 041Z0.001 2110.000 365

由表1可得補償后的三軸加速度測量值與補償前相比，補償后三軸加速度測量誤差均小于1 mg，其補償效果與轉(zhuǎn)臺標(biāo)定效果基本吻合，滿足標(biāo)定精度要求。在現(xiàn)場標(biāo)定過程中隨著擬合樣本數(shù)據(jù)的增加，使得測量數(shù)據(jù)盡可能全面地覆蓋擬合橢球曲面，其標(biāo)定效果能夠與轉(zhuǎn)臺標(biāo)定效果相當(dāng)。實際應(yīng)用中，由于加速度計零位和靈敏度隨時間推移而發(fā)生變化，對后期數(shù)據(jù)解算帶來的較大計算誤差，因此應(yīng)用現(xiàn)場標(biāo)定得到的零偏及其誤差補償系數(shù)矩陣對傳感器輸出進行誤差補償滿足實際數(shù)據(jù)解算需求。

5 結(jié)論

1) 對三軸加速度計輸出信號進行標(biāo)定補償是提高慣性導(dǎo)航系統(tǒng)位置測試精度的有效途徑之一。

2) 針對三軸加速度計的零偏與靈敏度等各項標(biāo)定參數(shù)因時間推移而無法得到有效應(yīng)用，依據(jù)最小二乘法的橢球擬合原理實現(xiàn)對三軸加速度計測試標(biāo)定，得到三軸加速度計的零位、靈敏度以及不正交安裝誤差角，無需精密的測試標(biāo)定設(shè)備，修正過程簡單且易于實現(xiàn)，標(biāo)定效果與轉(zhuǎn)臺標(biāo)定效果相當(dāng)，補償精度滿足實際數(shù)據(jù)解算要求，適合在載體在線快速標(biāo)定，具有較高的工程應(yīng)用價值。