基于聯(lián)合估計(jì)迭代算法的三軸磁力儀標(biāo)定補(bǔ)償方法

孫歡， 楊賓峰， 管樺， 王潤(rùn)

(空軍工程大學(xué) 信息與導(dǎo)航學(xué)院， 陜西 西安 710077)

0 引言

近年來，地磁導(dǎo)航發(fā)展迅猛，其隱蔽性強(qiáng)、自主性高、抗干擾能力強(qiáng)的特點(diǎn)，使得地磁導(dǎo)航在水下、電磁環(huán)境惡劣的空域，有著明顯優(yōu)勢(shì)和廣闊的發(fā)展前景[1-3]。

地磁傳感器的觀測(cè)精度將直接影響導(dǎo)航精度，但在實(shí)際測(cè)量過程中，地磁信號(hào)和各類誤差信號(hào)相互耦合，組成了地磁傳感器輸出，嚴(yán)重影響了地磁場(chǎng)測(cè)量精度，抑制了磁力儀潛在性能的發(fā)揮。因此對(duì)于地磁傳感器進(jìn)行標(biāo)定和補(bǔ)償，對(duì)提高地磁匹配導(dǎo)航的精度有著重要意義[4-7]。

針對(duì)地磁傳感器的誤差補(bǔ)償問題，國(guó)內(nèi)外學(xué)者進(jìn)行了諸多研究。Renaudin等[8]在磁場(chǎng)域?qū)Ω飨虍愋源抛鑲鞲衅鞯男Ｕ龁栴}進(jìn)行了研究，其詳細(xì)分析了傳感器自身儀表誤差、軟磁以及硬磁誤差的來源和產(chǎn)生機(jī)理，建模時(shí)將這些誤差都予以充分考慮；文獻(xiàn)[9-10]對(duì)地磁傳感器測(cè)量誤差和軟、硬磁誤差進(jìn)行一體化建模，前者采用橢球擬合校準(zhǔn)法進(jìn)行補(bǔ)償，后者考慮到觀測(cè)向量和數(shù)據(jù)矩陣均存在誤差，因此用總體最小二乘進(jìn)行了補(bǔ)償。對(duì)于以上矢量建模方式，仍然不能精確地表示載體內(nèi)磁場(chǎng)的真實(shí)狀況。渦流磁場(chǎng)及相關(guān)的低頻磁場(chǎng)是由于載體的姿態(tài)變換所產(chǎn)生的，渦流磁場(chǎng)不依賴于載體的鐵磁性，而只依賴于其導(dǎo)電性能[11]；文獻(xiàn)[12] 采用多物理仿真軟件Comsol Multiphysics建立了載體渦流干擾場(chǎng)的仿真模型，并進(jìn)行定性分析；文獻(xiàn)[13]提出了一體化建模的思想，并對(duì)旋轉(zhuǎn)速度等特性做了研究。

對(duì)于磁場(chǎng)補(bǔ)償算法，目前主流的算法有航磁補(bǔ)償法、兩步估計(jì)法、橢圓擬合法及無跡卡爾曼濾波(UKF)算法。航磁補(bǔ)償法[11,14]是基于Tolles-Lawson方程，將地磁場(chǎng)測(cè)量值的三分量均投影在地磁場(chǎng)方向，但忽略了地磁場(chǎng)真實(shí)值和測(cè)量值方向之間的誤差，因此只適用于干擾場(chǎng)較小的情況；在兩步估計(jì)算法[5,10]中，由于中間變量的存在，各個(gè)參量的相關(guān)性可能出現(xiàn)系數(shù)矩陣奇異，從而無法正確解算；橢圓擬合法[15-17]要求測(cè)量值要擬合出一個(gè)橢圓，從而建模方式比較簡(jiǎn)單，難以適應(yīng)復(fù)雜的測(cè)量環(huán)境；UKF算法[18-19]能夠?qū)崿F(xiàn)高精度的實(shí)時(shí)補(bǔ)償，但對(duì)初值敏感度高，選取不當(dāng)可能造成濾波發(fā)散，得不到正確結(jié)果。

通過分析，以往研究對(duì)載體內(nèi)渦流磁場(chǎng)及雙噪聲研究不足，缺少一體化模型和高效的補(bǔ)償算法。本文針對(duì)此問題進(jìn)行一體化建模，提出了基于聯(lián)合估計(jì)的迭代算法，并與擴(kuò)展卡爾曼濾波(EKF)算法和非線性最小二乘算法進(jìn)行性能比較。該方法具有良好的仿真和實(shí)驗(yàn)性能，可用于提高三軸磁力儀的測(cè)量精度。

1 誤差補(bǔ)償模型

根據(jù)以往研究[20]，地磁傳感器誤差模型可以表示為

B=CH+b+ε，

(1)

式中：B為地磁傳感器測(cè)量值；H為地磁場(chǎng)真實(shí)值；C=CMCNOCSFCSI，CM為地磁傳感器安裝于載體過程中傳感器和載體3個(gè)軸完全不重合所產(chǎn)生的誤差矩陣，CNO為傳感器內(nèi)部三軸不完全正交所引起的誤差矩陣，CSF為制作工藝所產(chǎn)生的刻度因子誤差，CSI為載體內(nèi)軟磁誤差系數(shù)矩陣；b=CMCNOCSFCSIBh+w+bs，Bh為載體內(nèi)硬磁材料所產(chǎn)生的干擾，w為傳感器內(nèi)部零刻度漂移誤差，bs為傳感器的剩磁誤差；ε為測(cè)量過程中的觀測(cè)噪聲，以往研究表明，ε呈高斯分布。

對(duì)于高速、頻繁作姿態(tài)變換的載體，其內(nèi)部會(huì)產(chǎn)生渦流，進(jìn)而產(chǎn)生渦流磁場(chǎng)，影響傳感器的精確測(cè)量。研究表明，渦流磁場(chǎng)強(qiáng)度與在體內(nèi)部渦流呈線性比例關(guān)系，而渦流強(qiáng)度又與單位時(shí)間磁通量的變化呈線型比例關(guān)系，將比例系數(shù)矩陣整合，考慮渦流磁場(chǎng)在內(nèi)，可得模型[21]：

(2)

式中：k代表第k次求解，k=1,2,…，n，n為數(shù)據(jù)總量；P為整合后的渦流磁場(chǎng)與單位時(shí)間內(nèi)磁通量變化的比例系數(shù)矩陣。

變換得地磁場(chǎng)真實(shí)值的表達(dá)式為

(3)

式中：Q=C-1，在(3)式中，參數(shù)空間維數(shù)Θ為

dimΘ=elements(Q)+elements(b)+
elements(P)=21.

(4)

由上文分析可知，Q在本文所設(shè)環(huán)境下為非奇異矩陣，即儀表誤差和載體干擾磁場(chǎng)誤差必然存在(即使很小)，因此對(duì)參數(shù)矩陣Q進(jìn)行QR分解如下：

Q=QARA.

(5)

經(jīng)過QR[22]分解，將Q參數(shù)矩陣分解為正交矩陣QA和上三角矩陣RA，將(5)式代入(3)式并取模，得

(6)

由于QA、RA是唯一的，因此在保證參數(shù)矩陣的唯一性基礎(chǔ)上，將參數(shù)空間由21維降到了18維，得模型如下：

各參數(shù)矩陣表達(dá)式為

當(dāng)各個(gè)系統(tǒng)參量明確時(shí)，即能對(duì)地磁場(chǎng)測(cè)量值實(shí)現(xiàn)補(bǔ)償，因此設(shè)參數(shù)向量Xk為待求量：

Xk=[vecs(RA)T,bT,vecs(P)T]T=
[q11,q12,q13,q22,q23,q33,b1,b2,b3,p11,
p12,p13,p21,p22,p23,p31,p32,p33]T.

(7)

2 補(bǔ)償算法

2.1 EKF算法

(8)

式中：RAk為RA在第k次的值；νk為觀測(cè)噪聲。

則該問題的狀態(tài)方程和觀測(cè)方程可以表示為

Xk=fk(Xk-1)+ηk,

(9)

(10)

fk(Xk)=Xk,

(11)

(12)

(13)

式中：設(shè)系統(tǒng)噪聲ηk為均值為0，協(xié)方差矩陣為Q的高斯噪聲。

由(13)式，觀測(cè)噪聲的均值μk和方差R可表示為

μk=E[vk]=-tr(Σ),

(14)

(15)

Σ={εεT}.

(16)

k|k-1=fk(k-1),


k=k|k-1+Gk(Zk-hk(k|k-1)),
Pk=(I-GkJk)Pk|k-1,

(17)

在EKF初值設(shè)置中，X0取經(jīng)驗(yàn)值，P0可以取較大，由于數(shù)據(jù)量充足，經(jīng)過k次求解最后得到Xk即為所需參量值。

2.2 非線性最小二乘算法

在非線性最小二乘算法處理時(shí)，由于可以經(jīng)過多次測(cè)量取平均值，因此可以將系統(tǒng)噪聲ηk與觀測(cè)噪聲εk忽略掉，根據(jù)(6)式，地磁場(chǎng)補(bǔ)償模型變換為

(18)

則地磁場(chǎng)真實(shí)值的標(biāo)量值即為

(19)

測(cè)量值與真實(shí)值的差值可以表示為

(20)

經(jīng)過k次測(cè)量，對(duì)差值求和可得總差值表達(dá)式為

(21)

根據(jù)非線性最小二乘算法原理，當(dāng)E取得最小值時(shí)，X取得最優(yōu)解，即X=argmin(E)，進(jìn)而得到補(bǔ)償模型中的各個(gè)系統(tǒng)參量。

2.3 聯(lián)合估計(jì)迭代算法

根據(jù)上文，地磁場(chǎng)補(bǔ)償模型為

(22)

(23)

這同樣是關(guān)于X和w的二次優(yōu)化問題，因此存在閉合解，如(25)式所示。

(24)

(25)

(26)

3 數(shù)值仿真

利用仿真數(shù)據(jù)對(duì)上述算法進(jìn)行驗(yàn)證，根據(jù)(2)式所述地磁場(chǎng)觀測(cè)值模型，設(shè)地磁場(chǎng)真實(shí)值為50 000 nT， 為了模擬載體姿態(tài)變換，設(shè)置球坐標(biāo)系下轉(zhuǎn)動(dòng)變量θ和γ，當(dāng)?shù)卮艌?chǎng)真實(shí)值3軸分量如下產(chǎn)生：

地磁場(chǎng)3個(gè)軸的分量值將會(huì)隨θ和γ的變化而變化，從而模擬載體姿態(tài)變化。

設(shè)觀測(cè)過程中系統(tǒng)噪聲、觀測(cè)噪聲服從均值為0 nT，標(biāo)準(zhǔn)差分別為10 nT和50 nT的高斯分布，且相互統(tǒng)計(jì)獨(dú)立，為了更好地說明補(bǔ)償效果，本文采用誤差均值E(n)和標(biāo)準(zhǔn)差δ進(jìn)行分析：

(27)

(28)

式中：Bi為每次的測(cè)量總值；Bm為測(cè)量值均值；B0為該地磁場(chǎng)的真實(shí)值。

在仿真中，設(shè)置不同轉(zhuǎn)動(dòng)頻率，從而改變載體內(nèi)渦流磁場(chǎng)的強(qiáng)弱，得地磁場(chǎng)測(cè)量值如圖1所示。

圖1 不同轉(zhuǎn)動(dòng)頻率下地磁場(chǎng)測(cè)量值Fig.1 Geomagnetic field measurements at different rotational frequencies

由圖1可知，當(dāng)載體瞬時(shí)轉(zhuǎn)動(dòng)頻率較大時(shí)，其內(nèi)部的渦流磁場(chǎng)將嚴(yán)重影響地磁傳感器的精確測(cè)量。提取仿真數(shù)據(jù)中50 Hz轉(zhuǎn)動(dòng)下的地磁場(chǎng)觀測(cè)數(shù)據(jù)，用本文所提聯(lián)合估計(jì)迭代算法分別對(duì)有無渦流磁場(chǎng)項(xiàng)的模型進(jìn)行補(bǔ)償，驗(yàn)證含渦流磁場(chǎng)一體化模型的有效性，結(jié)果如圖2所示。

圖2 不同模型補(bǔ)償結(jié)果Fig.2 Compensated results of different algorithms

圖2結(jié)果表明，含渦流磁場(chǎng)項(xiàng)的一體化模型有效濾除了由渦流磁場(chǎng)引起的波動(dòng)干擾，使補(bǔ)償結(jié)果更加精確穩(wěn)定。對(duì)以上仿真數(shù)據(jù)，分別采用EKF算法、非線性最小二乘算法和聯(lián)合估計(jì)迭代算法進(jìn)行處理，得到各參量解算值，而后用這些值進(jìn)行誤差補(bǔ)償，比較各個(gè)算法實(shí)用性。經(jīng)過解算，各系統(tǒng)參量的預(yù)設(shè)值和解算值如表1所示。

由表1可知，3種算法均能對(duì)系統(tǒng)參量實(shí)現(xiàn)補(bǔ)償，其中，非線性最小二乘算法由于未考慮噪聲影響，因此補(bǔ)償效果次于其他兩種算法。3種算法補(bǔ)償情況如圖3～圖7、表2所示。

如圖3所示，EKF算法補(bǔ)償時(shí)，任取參數(shù)中的兩個(gè)值分析其收斂情況。由圖3可看出，在經(jīng)過大約400組數(shù)據(jù)的運(yùn)算，各參數(shù)收斂并趨于穩(wěn)定，因此在補(bǔ)償初始階段，整體補(bǔ)償效果不理想。EKF算法整體補(bǔ)償效果如圖4所示。非線性最小二乘算法由于未進(jìn)行降噪處理，補(bǔ)償結(jié)果有較大誤差(見圖5)。聯(lián)合估計(jì)迭代算法無論是地磁場(chǎng)分量還是總量均能夠?qū)崿F(xiàn)較好的補(bǔ)償(見圖6、圖7)，各算法補(bǔ)償結(jié)果數(shù)據(jù)如表2所示。

仿真結(jié)果表明：非線性最小二乘算法補(bǔ)償結(jié)果誤差較大，另外兩種算法均可實(shí)現(xiàn)精度較高的補(bǔ)償，但EKF算法補(bǔ)償精度對(duì)數(shù)據(jù)量的依賴較大(由圖1可知，在本文仿真中，當(dāng)數(shù)據(jù)量少于400組時(shí)，參數(shù)不能收斂，無法做到高精度的補(bǔ)償)；聯(lián)合估計(jì)迭代算法相比于其他兩種算法，補(bǔ)償精度最高，抑制比可以達(dá)到94.08%.

表1 預(yù)設(shè)參數(shù)與不同算法解算值

注：XP為預(yù)設(shè)參數(shù)；XE為EKF算法解算值；XN為非線性最小二乘算法解算值;XJ為聯(lián)合估計(jì)迭代算法解算值。

圖3 EKF算法部分參數(shù)收斂情況Fig.3 Partial parameter convergence of EKF algorithm

圖4 EKF算法補(bǔ)償效果(仿真數(shù)據(jù))Fig.4 Compensation effect of EKF algorithm (simulation data)

圖5 非線性最小二乘算法補(bǔ)償效果(仿真數(shù)據(jù))Fig.5 Compensation effect of nonlinear least square algorithm (simulation data)

圖6 聯(lián)合估計(jì)迭代算法整體補(bǔ)償效果(仿真數(shù)據(jù))Fig.6 Compensation effect of joint estimation iterative algorithm (simulation data)

圖7 聯(lián)合估計(jì)迭代算法各分量補(bǔ)償效果(仿真數(shù)據(jù))Fig.7 Compensation effect of joint estimation iterativealgorithm (simulation data)

表2 不同算法補(bǔ)償結(jié)果(仿真數(shù)據(jù))

Tab.2 Compensated results of different algorithms(simulation data)

算法總體誤差均值/nT總體誤差標(biāo)準(zhǔn)差/nT補(bǔ)償前355.6542.9EKF算法26.380.0非線性最小二乘算法69.887.9聯(lián)合估計(jì)迭代算法21.061.6

4 實(shí)驗(yàn)設(shè)計(jì)

4.1 實(shí)驗(yàn)系統(tǒng)

在實(shí)驗(yàn)設(shè)計(jì)中，采用英國(guó)Bartington公司的Mag-690-FL100(測(cè)量精度0.1 nT)三軸磁力儀進(jìn)行補(bǔ)償，將其置于1∶48飛行器縮比模型上方模擬真實(shí)情況下處于飛行載體內(nèi)部的情況。為模擬飛行載體姿態(tài)變化，選用3FHT30C無磁轉(zhuǎn)臺(tái)提供姿態(tài)信息，該轉(zhuǎn)臺(tái)剩磁為7 nT，測(cè)量系統(tǒng)采用12 V直流電源進(jìn)行供電以隔絕市電電壓不穩(wěn)產(chǎn)生的不良影響。數(shù)據(jù)采集軟件用National Instruments，實(shí)驗(yàn)系統(tǒng)如圖8、圖9所示，后期用數(shù)值分析Matlab軟件進(jìn)行數(shù)據(jù)處理。采用DM050質(zhì)子磁力儀提供地磁場(chǎng)真實(shí)值。

圖8 地磁場(chǎng)測(cè)量系統(tǒng)Fig.8 Geomagnetic field measuring system

圖9 地磁場(chǎng)數(shù)據(jù)采集系統(tǒng)Fig.9 Geomagnetic data acquisition system

4.2 實(shí)驗(yàn)步驟

1)實(shí)驗(yàn)場(chǎng)所選在遠(yuǎn)離強(qiáng)磁干擾的空曠地點(diǎn)，利用水平儀對(duì)無磁轉(zhuǎn)臺(tái)進(jìn)行調(diào)整，將3軸磁力儀固定好之后，在下方放置飛行器縮比模型，用以仿真飛行載體內(nèi)部產(chǎn)生的軟硬磁誤差及其他干擾。

2)連接好設(shè)備，接通直流電源，將數(shù)據(jù)采集軟件采集頻率設(shè)為50 Hz，進(jìn)行連續(xù)數(shù)據(jù)采集，沿轉(zhuǎn)軸快速旋轉(zhuǎn)無磁轉(zhuǎn)臺(tái)進(jìn)行全方位姿態(tài)信息測(cè)量。模擬飛行載體的姿態(tài)轉(zhuǎn)動(dòng)，快速轉(zhuǎn)動(dòng)時(shí)，瞬時(shí)速度較大，因此所采集數(shù)據(jù)中含有渦流磁場(chǎng)。采集所得數(shù)據(jù)用Matlab進(jìn)行后期處理。

3)轉(zhuǎn)動(dòng)無磁轉(zhuǎn)臺(tái)，將地磁傳感器3軸分別對(duì)準(zhǔn)東、北、天，所得數(shù)據(jù)即為導(dǎo)航坐標(biāo)系下地磁場(chǎng)值的各軸分量；無磁轉(zhuǎn)臺(tái)轉(zhuǎn)動(dòng)過程中，每一個(gè)姿態(tài)對(duì)應(yīng)一個(gè)三維角度值，分別為內(nèi)框、中框和外框的轉(zhuǎn)動(dòng)角度(顯示于數(shù)顯箱，記錄于采集數(shù)據(jù)中)，即地磁傳感器3軸偏離初始值的角度，分別記為α、β、γ，由此可以解算得到每一個(gè)姿態(tài)下地磁場(chǎng)3軸分量的真實(shí)值[22]：

式中：Bxk,Byk,Bzk為第k個(gè)姿態(tài)時(shí)地磁場(chǎng)各軸分量真實(shí)值；Bx0,By0,Bz0為初始狀態(tài)地磁場(chǎng)各軸分量真實(shí)值。

5 實(shí)驗(yàn)結(jié)果

在實(shí)驗(yàn)中，首先采用質(zhì)子磁力儀測(cè)得實(shí)驗(yàn)場(chǎng)所的地磁場(chǎng)值為46 157 nT，對(duì)于實(shí)驗(yàn)數(shù)據(jù)依次采用EKF算法、非線性最小二乘算法和聯(lián)合估計(jì)算法進(jìn)行補(bǔ)償，其中，EKF算法初值設(shè)置為

經(jīng)過3種算法補(bǔ)償，補(bǔ)償效果圖如圖10～圖12所示。

圖10 EKF算法補(bǔ)償效果(實(shí)驗(yàn)數(shù)據(jù))Fig.10 Compensation effect of EKF algorithm (experimental data)

圖11 非線性最小二乘算法補(bǔ)償效果(實(shí)驗(yàn)數(shù)據(jù))Fig.11 Compensation effect of nonlinear least square algorithm (experimental data)

圖12 聯(lián)合估計(jì)迭代算法補(bǔ)償效果(實(shí)驗(yàn)數(shù)據(jù))Fig.12 Compensation effect with joint estimation iterative algorithm (experimental data)

由圖10～圖12可以看出：實(shí)驗(yàn)結(jié)果與仿真結(jié)果基本一致；實(shí)驗(yàn)采用的1 000組數(shù)據(jù)，因?yàn)槌踔翟O(shè)為0向量，EKF算法經(jīng)過約300組數(shù)據(jù)后趨于收斂，在前期補(bǔ)償效果次于其他兩種算法；非線性最小二乘算法補(bǔ)償結(jié)果依然有較大噪聲干擾；聯(lián)合估計(jì)迭代算法法收斂速度快，且補(bǔ)償效果良好。

各算法補(bǔ)償結(jié)果均值和方差如表3所示。

由表3可知，聯(lián)合估計(jì)迭代算法相較于其他兩種算法優(yōu)勢(shì)比較明顯，可以將補(bǔ)償誤差均值由142.4 nT縮小至12.5 nT，標(biāo)準(zhǔn)差由170.0 nT縮小至37.2 nT，抑制比達(dá)到84.51%. 考慮到無磁轉(zhuǎn)臺(tái)剩磁誤差達(dá)到7.0 nT，且實(shí)驗(yàn)環(huán)境周邊其他干擾，因此本次實(shí)驗(yàn)結(jié)果對(duì)本文所提理論進(jìn)行了驗(yàn)證，具有實(shí)際意義。

表3 不同算法補(bǔ)償結(jié)果(實(shí)驗(yàn)數(shù)據(jù))

6 結(jié)果分析

1)EKF算法原理簡(jiǎn)單，能夠在較短的時(shí)間內(nèi)實(shí)現(xiàn)較高精度的補(bǔ)償。在模擬仿真中，EKF算法經(jīng)過約500組數(shù)據(jù)達(dá)到收斂，所解算參數(shù)可用于補(bǔ)償，而其他兩種算法皆用2 000組數(shù)據(jù)進(jìn)行參數(shù)解算，體現(xiàn)出EKF算法在時(shí)效性方面的優(yōu)越性，但卡爾曼濾波算法對(duì)初值的依賴度很高。在本文實(shí)驗(yàn)中，由于對(duì)系統(tǒng)參量的先驗(yàn)知識(shí)不足，因此將初值取0向量，協(xié)方差矩陣取得比較大，由于數(shù)據(jù)量大，以此后期也能達(dá)到較好的補(bǔ)償效果。對(duì)于1階EKF算法補(bǔ)償精度不夠的問題，因?yàn)樵诒疚乃芯磕Ｐ蜑槿醴蔷€性，因此其補(bǔ)償精度在可接受范圍之內(nèi)。

2)在實(shí)驗(yàn)過程中，快速轉(zhuǎn)動(dòng)無磁轉(zhuǎn)臺(tái)使得飛行器縮比模型內(nèi)部產(chǎn)生渦流磁場(chǎng)，對(duì)3軸磁力儀的測(cè)量產(chǎn)生影響，體現(xiàn)在測(cè)量值有較大的波動(dòng)，含渦流磁場(chǎng)的一體化模型在建模過程中考慮到渦流磁場(chǎng)信息，因此相比于不含渦流磁場(chǎng)的模型，能夠較好地濾除波動(dòng)，使補(bǔ)償結(jié)果更加穩(wěn)定。

3)對(duì)于觀測(cè)系統(tǒng)系統(tǒng)不穩(wěn)定的問題，在數(shù)學(xué)上體現(xiàn)為各系統(tǒng)參量的變化，在該實(shí)驗(yàn)中，選取新的實(shí)驗(yàn)場(chǎng)所、調(diào)平無磁轉(zhuǎn)臺(tái)及進(jìn)行全姿態(tài)測(cè)量過程中都會(huì)使得系統(tǒng)參量發(fā)生微小改變，勢(shì)必將產(chǎn)生系統(tǒng)誤差。對(duì)于該誤差，本文將其簡(jiǎn)化為零均值高斯噪聲，取得了較好的補(bǔ)償效果，為了更進(jìn)一步提高補(bǔ)償精度，應(yīng)該對(duì)該誤差進(jìn)行更深入的研究。

4)在采用非線性最小二乘算法處理時(shí)，對(duì)于噪聲采取多組數(shù)據(jù)求均值的方法進(jìn)行處理，但求均值的本質(zhì)依然是含噪的。仿真和實(shí)驗(yàn)結(jié)果表明，該算法機(jī)理對(duì)于本問題的局限性導(dǎo)致補(bǔ)償結(jié)果相比于其他兩種算法誤差偏大。

5)質(zhì)子磁力儀測(cè)量誤差很小，因此將所測(cè)地磁場(chǎng)值作為實(shí)驗(yàn)場(chǎng)所真實(shí)值。本文提出含渦流磁場(chǎng)和雙噪聲的一體化模型，含有信息種類更全，模型更完整，補(bǔ)償中更有優(yōu)勢(shì)；在聯(lián)合估計(jì)迭代算法中將觀測(cè)系統(tǒng)噪聲和測(cè)量噪聲進(jìn)行聯(lián)合估計(jì)處理，補(bǔ)償效果表明該方法比非線性最小二乘算法有著更高的補(bǔ)償精度，比EKF算法補(bǔ)償結(jié)果收斂更快，證明了該補(bǔ)償模型和補(bǔ)償方法的開發(fā)潛力。

7 結(jié)論

地磁場(chǎng)測(cè)量值誤差補(bǔ)償向來是地磁導(dǎo)航中一個(gè)關(guān)鍵問題。本文針對(duì)載體中所含渦流磁場(chǎng)和雙噪聲的問題，提出了雙噪聲聯(lián)合估計(jì)迭代算法對(duì)Mag-690-FL100地磁傳感器進(jìn)行標(biāo)定，并與EKF算法、非線性最小二乘算法進(jìn)行比較。仿真和實(shí)驗(yàn)結(jié)果表明，聯(lián)合估計(jì)迭代算法補(bǔ)償效果更好，該方法原理簡(jiǎn)單，對(duì)數(shù)據(jù)量依賴小，實(shí)用性強(qiáng)，有利于提高地磁導(dǎo)航系統(tǒng)的精度。