一種手持式MEMS磁力計(jì)的羅差校正方法*

李思民,蔡成林,王亞娜,曹振強(qiáng)

(桂林電子科技大學(xué) 信息與通信學(xué)院,廣西桂林541004)

一種手持式MEMS磁力計(jì)的羅差校正方法*

李思民,蔡成林*,王亞娜,曹振強(qiáng)

(桂林電子科技大學(xué) 信息與通信學(xué)院,廣西桂林541004)

針對(duì)手持式MEMS磁力計(jì)使用過程中航向精度低的問題,在分析磁力計(jì)誤差的基礎(chǔ)上,建立了羅差校正模型,推導(dǎo)了羅差系數(shù)的計(jì)算公式,采用橢圓假設(shè)、約束最小二乘法、解卷繞和滑動(dòng)窗口濾波等方法降低磁力計(jì)航向誤差。該校正過程簡(jiǎn)單方便,只需手持MEMS傳感器組旋轉(zhuǎn)一周。實(shí)驗(yàn)結(jié)果表明,該校正方法具有良好的抗噪聲性能,校正后的磁力計(jì)航向精度優(yōu)于1°。

MEMS傳感器;羅差校正;橢圓擬合;磁力計(jì);最小二乘法

隨著微機(jī)電系統(tǒng)MEMS(Micro-Electro-Mechanical-System)傳感器的應(yīng)用日漸廣泛,它在航天、導(dǎo)航、機(jī)器人等領(lǐng)域的重要性日益凸顯[1]。其中,MEMS感器組最為常見,它主要包括三軸磁力計(jì)、三軸加速度計(jì)、三軸陀螺儀。

磁力計(jì)作為一種磁場(chǎng)測(cè)量?jī)x器,通過測(cè)量周圍磁場(chǎng)在三軸磁力計(jì)上的分量來計(jì)算航向角,具有體積小、功耗低、成本低,可靠性高、航向誤差不隨時(shí)間累積等優(yōu)點(diǎn)[2]。但是,磁力計(jì)在使用過程中容易受到外界壞境的干擾,為了提高航向精度,在使用之前需要對(duì)磁力計(jì)進(jìn)行校正。

目前磁力計(jì)誤差補(bǔ)償常用方法有泊松模型補(bǔ)償法[3]、橢圓擬合補(bǔ)償法[4-6]、橢球擬合補(bǔ)償法[7-8]、基于外部航向基準(zhǔn)輔助的羅差補(bǔ)償法[9]等方法。泊松模型補(bǔ)償法,可采用十二位置翻滾法或者借助外部姿態(tài)參考數(shù)據(jù)進(jìn)行最小二乘遞推等方法來確定12個(gè)參數(shù),補(bǔ)償過程操作復(fù)雜,計(jì)算量大[3]。文獻(xiàn)[4-6]利用橢圓補(bǔ)償法對(duì)磁力計(jì)進(jìn)行校正,在無磁轉(zhuǎn)臺(tái)上進(jìn)行實(shí)驗(yàn),補(bǔ)償效果較好,然而在實(shí)際使用中,用戶通常是手持測(cè)量設(shè)備工作,所以研究手持式磁力計(jì)校正方法具有實(shí)際應(yīng)用價(jià)值。橢球擬合補(bǔ)償法是將二維擬合擴(kuò)展至三維,其補(bǔ)償精度比橢圓擬合效果好,但校正過程相對(duì)橢圓補(bǔ)償較為復(fù)雜[7-8]。基于外部航向基準(zhǔn)補(bǔ)償方法,在校正過程中需要外部航向作為基準(zhǔn),補(bǔ)償效果佳,但在實(shí)際應(yīng)用中往往沒有航向基準(zhǔn)作為參考,故該方法的實(shí)用性較差[9]。

1 磁力計(jì)原理

地球磁場(chǎng)是弱磁場(chǎng),強(qiáng)度大概為0.5 Gauss～0.6 Gauss。地磁強(qiáng)度水平分量的矢量和始終指向磁北,磁力計(jì)算出的航向角為前進(jìn)方向和磁北的夾角α。在實(shí)際應(yīng)用中所參考的北指的是地理北,磁北和地理北并不重合,它們之間的夾角稱為磁偏角β。因此,在實(shí)際使用中,真實(shí)航向角ψ=α+β,當(dāng)?shù)卮牌强梢酝ㄟ^查表獲得。地磁場(chǎng)示意圖如圖1所示,β為磁偏角,T為地磁強(qiáng)度,I為磁傾角。

圖1 地磁場(chǎng)示意圖

磁力計(jì)在水平放置且不受任何磁干擾的情況下,通過測(cè)量磁力計(jì)X、Y軸方向的地磁強(qiáng)度Hx、Hy,便可通過式(1)確定載體相對(duì)于磁北的航向角:

(1)

2 磁力計(jì)羅差分析

MEMS磁力計(jì)的誤差是可以分為兩類:第1類是由系統(tǒng)本身所產(chǎn)生的誤差,包括制造誤差、安裝誤差、羅差等,這類誤差可以歸結(jié)于對(duì)磁力計(jì)三軸原始輸出的影響;第2類是由姿態(tài)引起的誤差,這類誤差是由平臺(tái)傾斜產(chǎn)生。

(2)

在實(shí)際應(yīng)用中,羅差是導(dǎo)致航向精度下降的主要原因,它分為硬磁干擾和軟磁干擾。硬磁干擾主要是由于周圍壞境中的永久磁鐵物質(zhì)引起,它們產(chǎn)生的磁場(chǎng)強(qiáng)度認(rèn)為是恒定不變的,即硬磁材料所合成的磁場(chǎng)投影到磁力計(jì)3個(gè)軸上的分量是恒定的。軟磁干擾主要是周圍壞境中的鐵磁物質(zhì)引起,軟磁材料本身不具有磁性,受到周圍磁場(chǎng)影響后產(chǎn)生磁場(chǎng),其影響程度和方向與磁力計(jì)的位置有關(guān),干擾程度與方向有關(guān)。

在磁力計(jì)處于水平且無任何誤差的情況下,將磁力計(jì)旋轉(zhuǎn)一周并采集X、Y軸的數(shù)據(jù),它們?cè)谧鴺?biāo)平面下的映射為圓心在原點(diǎn)上的正圓。受到硬磁干擾時(shí),會(huì)使正圓偏離原點(diǎn),干擾越大偏離越遠(yuǎn)。受到軟磁干擾時(shí),正圓會(huì)畸變成橢圓,干擾越大畸變?cè)絿?yán)重。磁力計(jì)校正過程就是把橢圓變成圓心在原點(diǎn)的正圓。

3 最佳橢圓假設(shè)

在平面坐標(biāo)系中,可以采用圓錐曲線方程來表示任意位置的橢圓:

(3)

采用直接最小二乘法擬合得到的圓錐曲線不一定是橢圓,所以需要根據(jù)橢圓曲線的性質(zhì),在擬合橢圓的同時(shí)加上約束條件以保證擬合出的曲線為橢圓,選取4AB-C2=1作為橢圓擬合的約束條件,橢圓系數(shù)求解轉(zhuǎn)化為約束條件下求極值問題[12]:

(4)

式中:

根據(jù)拉格朗日乘數(shù)法,引入?yún)?shù)λ,將式(4)轉(zhuǎn)化為求解約束條件下的極值問題:

(5)

經(jīng)過上述推導(dǎo),可以得出約束條件下最小二乘法橢圓擬合最終是需要求出矩陣(DTD,C)的6個(gè)廣義特征值和對(duì)應(yīng)的特征向量,特征值中只有一個(gè)大于0,所求橢圓系數(shù)矩陣K為特征值大于0對(duì)應(yīng)的特征向量。

羅差校正過程就是把偏離圓心的橢圓校正為正圓。從圓到橢圓的過程可以描述為:

(6)

由式(6)可以得出XY軸補(bǔ)償后的磁場(chǎng)值為:

(7)

式中:橢圓系數(shù)矩陣K=(A,B,C,D,E,F)T與式(6)的關(guān)系為:

(8)

(9)

(10)

對(duì)于矩陣L,由于求解航向時(shí)只與Lx/Ly有關(guān),而與它們的值無關(guān),為了方便求解,假設(shè)Lx為1,則有

Ly=A/B

(11)

綜上所述,磁力計(jì)羅差處理過程為:首先將采集到三軸地磁數(shù)據(jù)通過式(2)進(jìn)行傾斜補(bǔ)償,然后用約束條件下的最小二乘法對(duì)數(shù)據(jù)進(jìn)行橢圓擬合,并求出的橢圓系數(shù),再根據(jù)式(7)求出補(bǔ)償后的XY軸磁場(chǎng)值。

4 系統(tǒng)設(shè)計(jì)與實(shí)驗(yàn)結(jié)果分析

羅差校正實(shí)驗(yàn)在室內(nèi)進(jìn)行驗(yàn)證,校正過程中手持MEMS傳感器組進(jìn)行實(shí)驗(yàn)。MEMS傳感器組將加速度計(jì)、陀螺儀、磁力計(jì)對(duì)應(yīng)軸同向組合成慣性傳感器的3個(gè)軸向。

磁力計(jì)在實(shí)驗(yàn)過程中由于手部的抖動(dòng),會(huì)導(dǎo)致系統(tǒng)振動(dòng),所以磁力計(jì)在數(shù)據(jù)采集期間除了會(huì)受到硬磁材料和軟磁材料干擾之外,還會(huì)因?yàn)槭植康亩秳?dòng)產(chǎn)生噪聲。手部抖動(dòng)產(chǎn)生的噪聲可以通過滑動(dòng)窗口濾波得到改善,公式如下:

(12)

式中:2N+1為滑動(dòng)窗口的長(zhǎng)度,由磁力計(jì)的采樣頻率決定。

由于航向角在0～360°之間存在卷繞現(xiàn)象,在窗口平滑濾波之前還需對(duì)求解出的航向角解卷繞,即將航向角取值范圍從0～360°變換至-N1×360或+N2×360范圍內(nèi),其中順時(shí)針旋轉(zhuǎn)為正,逆時(shí)針旋轉(zhuǎn)為負(fù),N1、N2由旋轉(zhuǎn)次數(shù)決定。

4.1 硬件電路框架

本文提出的羅差校正方法是基于MEMS傳感器組。它包括三軸磁力計(jì)(HMC5883L)、三軸加速度計(jì)和三軸陀螺儀(MPU6050)、微控制器(STM32F103)。硬件電路框圖如圖2所示,首先將加速度計(jì)、陀螺儀和磁力計(jì)的原始數(shù)據(jù)通過A/D轉(zhuǎn)換,然后對(duì)數(shù)據(jù)進(jìn)行預(yù)處理,并通過微控制器對(duì)數(shù)據(jù)進(jìn)行融合,解算出平臺(tái)的姿態(tài)角[13]。

圖2 硬件電路框圖

4.2 軟件部分設(shè)計(jì)

在實(shí)驗(yàn)過程中,首先獲取加速度計(jì)、陀螺儀、磁力計(jì)的數(shù)據(jù),用keil軟件進(jìn)行C語言編程,通過四元數(shù)姿態(tài)解算和卡爾曼濾波得出準(zhǔn)確的橫滾角、俯仰角、航向角和三軸原始磁數(shù)據(jù),并通過串口輸出至上位機(jī)并保存成Excel文件格式。

為了對(duì)校正前后的航向誤差進(jìn)行分析,羅差校正算法在MATLAB中實(shí)現(xiàn),算法流程如圖3所示,首先讀取Excel表格中的數(shù)據(jù),將橫滾角、俯仰角作為傾斜償?shù)妮斎?航向角作為誤差分析的參考航向。三軸磁力計(jì)數(shù)據(jù)在傾斜補(bǔ)償之后進(jìn)行橢圓補(bǔ)償,再通過解卷繞、滑動(dòng)窗口濾波剔除抖動(dòng)噪聲,最后輸出校正后的航向角。

圖3 羅差校正流程圖

4.3 實(shí)驗(yàn)結(jié)果分析

實(shí)驗(yàn)以傳感器組通過四元數(shù)姿態(tài)解算和卡爾曼濾波之后的航向角為基準(zhǔn)分析磁力計(jì)的航向誤差[14]。實(shí)驗(yàn)過程,首先手持MEMS傳感器組旋轉(zhuǎn)360°收集三軸地磁數(shù)據(jù)作為校正數(shù)據(jù),然后再次旋轉(zhuǎn)360°,每間隔90°停留一段時(shí)間,并收集三軸地磁作為實(shí)驗(yàn)數(shù)據(jù)。

校正數(shù)據(jù)經(jīng)式(2)傾斜補(bǔ)償之后,將XY軸的地磁數(shù)據(jù)進(jìn)行最佳橢圓擬合,如圖4所示。

圖4 橢圓補(bǔ)償

從圖4可以看出校正數(shù)據(jù)直接擬合出來的是偏離原點(diǎn)的橢圓,通過補(bǔ)償之后橢圓變成圓心在原點(diǎn)的正圓。

圖5對(duì)羅差校正前后的航向誤差與濾波前后的航向誤差進(jìn)行了對(duì)比。從圖中可以看出,使用未校正未濾波(虛線)的地磁數(shù)據(jù)求出的航向角,由于附近硬磁材料、軟磁材料和手部抖動(dòng)噪聲的影響,其航向誤差約為±31°;使用已校正未濾波(點(diǎn)虛線)的地磁數(shù)據(jù)求出的航向角,其航向誤差相比前者有較大改善,但磁力計(jì)在旋轉(zhuǎn)過程中,由于手部抖動(dòng)噪聲的存在,使航向精度在旋轉(zhuǎn)過程產(chǎn)生較大的偏差,其航向誤差約為±11°;使用已校正已濾波(粗實(shí)線)的地磁數(shù)據(jù)求出的航向角,由于抖動(dòng)噪聲被有效限制,其航向誤差降低至±1°之內(nèi)。

圖5 航向誤差

5 結(jié)束語

本文提出的手持式MEMS磁力計(jì)羅差校正方法,在周圍存在軟硬磁干擾的情況下,只需手持磁力計(jì)旋轉(zhuǎn)一周即可對(duì)羅差進(jìn)行校正。在使用過程中,由于平臺(tái)傾斜和手部抖動(dòng)引起的誤差,通過傾斜補(bǔ)償、解卷繞、滑動(dòng)窗口濾波進(jìn)行修正。實(shí)驗(yàn)結(jié)果表明,校正后的航向精度高,在對(duì)航向角有嚴(yán)格要求的室內(nèi)導(dǎo)航中具有較高的應(yīng)用價(jià)值。

[1] 李榮冰,劉建業(yè),曾慶化,等. 基于MEMS技術(shù)的微型慣性導(dǎo)航系統(tǒng)的發(fā)展現(xiàn)狀[J]. 中國慣性技術(shù)學(xué)報(bào),2004,12(6):88-94.

[2] 陳潔,黃慶安,秦明.MEMS磁場(chǎng)傳感器的研究進(jìn)展[J]. 電子器件,2006,29(4):1384-1388.

[3] 郭鵬飛,任章,邱海韜,等. 一種十二位置不對(duì)北的磁羅盤標(biāo)定方法[J]. 中國慣性技術(shù)學(xué)報(bào),2007,15(5):598-601.

[4] 孫宏偉,房建成,李艷.橢圓擬合方法在磁羅盤羅差校準(zhǔn)中的應(yīng)用[J]. 光學(xué)精密工程,2009,17(12):3034-3039.

[5] 秦濤,馬建倉,王彤,等. 電子羅盤最佳橢圓誤差補(bǔ)償方法[J]. 傳感技術(shù)學(xué)報(bào),2013,26(11):1499-1503.

[6] 秦勇,趙杰,王曉宇.基于橢圓擬合誤差補(bǔ)償算法的數(shù)字磁羅盤[J]. 吉林大學(xué)學(xué)報(bào)(工學(xué)版),2009,39(2):489-493.

[7] 李智,李翔.基于橢球假設(shè)的三軸電子羅盤羅差補(bǔ)償研究[J]. 儀器儀表學(xué)報(bào),2011,32(10):2210-2215.

[8] FANG J C,SUN H,CAO J J,et al. A Novel Calibration Method of Magnetic Compass Based on Ellipsoid Fitting[J]. IEEE Instrumentation and Measurement Society.2011,60(6):2053-2061.

[9] 曹平軍,呂冰. 基于誤差補(bǔ)償?shù)碾娮恿_盤抗干擾設(shè)計(jì)[J]. 儀表技術(shù)與傳感器,2013(3):22-24.

[10] 邵婷婷,馬建倉,胡士峰,等. 電子羅盤的傾斜及羅差補(bǔ)償算法研究[J]. 傳感技術(shù)學(xué)報(bào),2007,20(6):1335-1337.

[11] 閆蓓,王斌,李媛.基于最小二乘法的橢圓擬合改進(jìn)算法[J]. 北京航空航天大學(xué)學(xué)報(bào),2008,34(3):295-298.

[12] 鄒益民,汪渤. 一種基于最小二乘的不完整橢圓擬合算法[J]. 儀器儀表學(xué)報(bào),2006,27(7):808-812.

[13] 米剛,田增山,金悅,等. 基于MIMU和磁力計(jì)的姿態(tài)更新算法研究[J]. 傳感技術(shù)學(xué)報(bào),2015,28(1):43-48.

[14] 賈瑞才.基于四元數(shù)EKF的低成本MEMS姿態(tài)估計(jì)算法[J]. 傳感技術(shù)學(xué)報(bào),2014,27(1):90-95.

ErrorCalibrationMethodofMagneticDeviationforHand-HeldMEMSMagnetometer*

LISimin,CAIChenglin*,WANGYana,CAOZhenqiang

(Institute of Information and Communication,Guilin University of Electronic Technology,Guilin 541004,China)

Due to the limitation of heading accuracy in Hand-held MEMS magnetometer,a magnetometer error model was established to improve its accuracy,which is based on the analysis of magnetometer error,meanwhile,the formula of magnetic deviation coefficient was deduced. Some methods of dealing with the data,which included elliptic assumption,least square method,unwrapping and smoothing window filter,were adopted to reduce the heading error of magnetometer. The experiment shows that the operation is simple. Just holding a set of MEMS sensor and rotating it around the whole operation is completed. This method is of stronger anti-noise ability,whose corrected accuracy of heading angle is better than 1°.

Key words:MEMS sensor;magnetic deviation calibration;ellipse fitting method;magnetometer;least squares method

10.3969/j.issn.1005-9490.2017.05.027

項(xiàng)目來源:空天無源探測(cè)平臺(tái)的差分定位體制研究項(xiàng)目(612630028)

2016-07-14修改日期2016-08-17

TP216.1

A

1005-9490(2017)05-1191-05

李思民(1991-),男,漢族,湖南祁東人,桂林電子科技大學(xué)信息與通信學(xué)院,碩士研究生。研究方向?yàn)槭覂?nèi)外無縫導(dǎo)航,lisimin523@126.com;

蔡成林(1969-),男,漢族,湖南雙峰人,教授,博士,碩士生導(dǎo)師,研究方向?yàn)樾l(wèi)星導(dǎo)航與無線通信、時(shí)空基準(zhǔn)與位置服務(wù)、室內(nèi)外無縫定位等,chengcailin@126.com。