基于橢圓擬合的雙軸磁傳感器標定方法

李 冰，雷瀧杰，陳 超

(西安機電信息技術(shù)研究所，陜西 西安 710065)

0 引言

隨著新形勢下戰(zhàn)場環(huán)境的惡化，對常規(guī)兵器的作戰(zhàn)性能的要求也隨之提高，實現(xiàn)精確打擊已成為現(xiàn)代常規(guī)彈藥的重要任務(wù)，彈體姿態(tài)測量方法的實現(xiàn)也顯得越發(fā)重要[1]。利用彈載磁傳感器實時測量引信在地磁場的各個分量，通過地面坐標系與彈體坐標系的轉(zhuǎn)換可解算得到引信飛行過程中的實時滾轉(zhuǎn)角。

利用磁傳感器實現(xiàn)引信滾轉(zhuǎn)角測量的方法目前國內(nèi)外均有研究。文獻[2]中利用卡爾曼濾波方法對磁傳感器輸出進行濾波，但未考慮磁傳感器坐標軸間的正交誤差。文獻[3]中研究了使用雙軸磁傳感器測量滾轉(zhuǎn)角的不同算法，但對于磁傳感器本身輸出信號的標定補償未提及。文獻[4]考慮了磁傳感器在實際滾轉(zhuǎn)角測量過程中存在的不同類型誤差，但是僅針對傳感器的安裝誤差進行補償，未能對零偏及靈敏度誤差同時補償。從已有的文獻來看，目前對磁傳感器的標定僅是簡單的對其測量輸出進行處理，如求均值或濾波處理，或者僅采用器件手冊上磁傳感器的標稱誤差對其進行補償，因此測量誤誤差來源差散布較大，進而導致計算出的滾轉(zhuǎn)角誤差較大。本文針對此問題，提出了基于橢圓擬合的雙軸磁傳感器標定方法。

1 雙軸磁傳感器的傳統(tǒng)標定方法及橢圓擬合參數(shù)求解

1.1 雙軸磁傳感器測量原理

雙軸磁傳感器是利用合金電阻對平面內(nèi)互相正交的兩個方向上的磁場敏感的原理制成，在外磁場的影響下，內(nèi)部磁阻變化使其輸出電壓發(fā)生變化，從而敏感到磁場的變化。其工作原理為，用4個磁控電阻器制成的惠斯通電橋帶有供電電壓，使電流通過電阻器。電阻器是同一結(jié)構(gòu)材料，則4個電阻器的電阻是相同的。如果給電阻器施加正交偏置磁場，會導致電阻器發(fā)生磁化，進而發(fā)生阻值的改變。同向放置的兩個電阻器阻值增加，另2個與其相反放置的電阻器阻值減小。在外磁場的作用下，內(nèi)部磁阻的變化引起輸出管腳兩端電壓的變化，其電壓的幅值表示所測磁場的強度。

雙軸磁傳感器用于地磁測量時主要存在四種固有誤差：非正交誤差、靈敏度誤差、零位誤差[5]、外界干擾磁場。非正交誤差是由于磁傳感器兩個敏感軸在制造過程中不能保證嚴格正交所產(chǎn)生的誤差；敏感度誤差是由于磁傳感器各軸的靈敏度不完全相同而產(chǎn)生的測量誤差；零位誤差是由于雙軸磁傳感器中傳感器以及調(diào)理電路零點不為零而產(chǎn)生的零點偏移[6]。

1.2傳統(tǒng)磁傳感器標定方法

將測量裝置安裝于轉(zhuǎn)臺，轉(zhuǎn)臺方位角調(diào)至0°，俯仰角調(diào)至-90°，啟動采集程序，啟動轉(zhuǎn)臺，以一定轉(zhuǎn)速使橫滾軸旋轉(zhuǎn)，采集并存儲磁傳感器輸出數(shù)據(jù)。具體方法見圖1。

圖1 傳統(tǒng)磁傳感器標定方法Fig.1 Method of traditional calibration based on magnetic sensor

零位誤差標定：對實驗存儲數(shù)據(jù)取若干整周期數(shù)據(jù)做統(tǒng)計分析，y軸輸出的均值即為y軸零偏Ey，z軸輸出的均值即為z軸零偏Ez。靈敏度誤差標定：由于磁傳感器兩個敏感軸在水平面內(nèi)轉(zhuǎn)動，故其敏感到的磁場最大值應(yīng)該等于Mxz，則根據(jù)上面得到的零偏可得到其兩軸靈敏度為之比。同理，將轉(zhuǎn)臺分別置為方位0°、俯仰0°和方位-90°、俯仰0°狀態(tài)進行標定，取三次標定結(jié)果的均值作為最終的標定結(jié)果。磁傳感器標定示意圖如圖2所示。

圖2 磁傳感器標定示意圖Fig.2 Diagram of magnetic sensor calibration

傳統(tǒng)的磁傳感器標定方法僅針對磁傳感器的安裝誤差、靈敏度誤差和零偏誤差中的一項或幾項進行器件手冊上的標稱補償，然后根據(jù)多次測量數(shù)據(jù)通過取均值，從而對磁傳感器的非正交誤差、靈敏度誤差及零位誤差進行補償。

1.3 橢圓擬合參數(shù)估計

在均勻磁場下，如果將理想正交雙軸磁傳感器在兩軸所在平面旋轉(zhuǎn)一圈，則兩軸的輸出會形成一個標準的橢圓[7]。但是由于磁傳感器的非正交誤差、靈敏度誤差和零位誤差，以及周圍磁場干擾的存在，實際的輸出會接近于橢圓而非標準橢圓。因此，通過橢圓的標準參數(shù)方程可實現(xiàn)對雙軸磁傳感器的標定。

設(shè)橢圓的一般方程[8]為：

F(k,ζ)=ax2+by2+2cxy+2dx+2ey+f=0

(1)

式(1)中，k=[a,b,c,d,e,f]T表示待求橢圓的曲線參數(shù)向量，ζ=[x2,y2,2xy,2x,2y,1]T為測量數(shù)據(jù)運算組合向量，F(xiàn)(k,ζ)為測量數(shù)據(jù)(x,y)到該橢圓曲線F(k,ζ)=0對應(yīng)點的代數(shù)距離。

采用測量數(shù)據(jù)到橢圓中心代數(shù)距離的平方和最小的準則進行橢圓擬合[9]：

min‖F(xiàn)(k,ζ)‖2=minkTHTHk

(2)

根據(jù)式(2)即可擬合求解出橢圓曲線參數(shù)k=[a,b,c,d,e,f]T。

再根據(jù)橢圓參數(shù)A和X0，則可估計出雙軸磁傳感器誤差參數(shù)：

(3)

2 基于橢圓擬合的雙軸磁傳感器標定方法

2.1 橢圓擬合標定方法

在均勻磁場下，如果將理想正交雙軸磁傳感器在兩軸所在平面旋轉(zhuǎn)一圈，則兩軸的輸出會形成一個標準的橢圓(其兩軸靈敏度不等)。但是由于磁傳感器的非正交誤差、靈敏度誤差和零位誤差，以及周圍磁場的干擾的存在，實際的輸出會接近于橢圓而非標準橢圓。本文以此為基礎(chǔ)，利用雙軸磁傳感器的輸出具有橢圓效應(yīng)這一特點，提出了一種基于橢圓擬合的雙軸磁傳感器標定方法，具體見圖3。

圖3 橢圓擬合標定方法Fig.3 Calibration method of biaxial magnetic sensor based on Ellipse Fitting

由于橢圓的標準方程已知，如將理想雙軸磁傳感器繞其兩軸所在平面旋轉(zhuǎn)，兩軸輸出為形成標準橢圓，通過若干輸出數(shù)據(jù)，即可計算出橢圓的參數(shù)，進而可以計算出其標稱零偏與靈敏度。而存在誤差的雙軸磁傳感器實際輸出接近于橢圓而非標準橢圓，因此，同樣的方法得到其測量輸出后，可采用最小二乘法對測量數(shù)據(jù)點與橢圓中心的距離的平方和最小的原則進行擬合，進而形成標準橢圓，通過擬合后的數(shù)據(jù)解算出橢圓擬合參數(shù)，通過橢圓與雙軸磁傳感器的誤差參數(shù)方程求解除其靈敏度誤差、零偏誤差以及非正交誤差，代入理想雙軸磁傳感器與存在測量誤差的磁傳感器的關(guān)系方程中，得到理想磁傳感器的輸出，實現(xiàn)利用橢圓擬合對雙軸磁傳感器的標定。

在得到雙軸磁傳感器的誤差參數(shù)后，通過理想磁傳感器與存在測量誤差的磁傳感器的關(guān)系方程中，即可對磁傳感器進行補償標定。

2.2 誤差參數(shù)補償標定

對于實際存在零位誤差、靈敏度誤差以及非正交誤差的雙軸磁傳感器，其測量值與理想雙軸磁傳感器測量值的關(guān)系：

(4)

傳感器測量值，B為存在零位誤差、靈敏度誤差以及非正交誤差的雙軸磁傳感測量值。

從而得到理想磁傳器的輸出為：

(5)

在得到雙軸磁傳感器的輸出后，利用式最小二乘法對其進行橢圓擬合，求解出橢圓擬合參數(shù)，代入磁傳感器誤差參數(shù)方程，即可得到雙軸磁傳感器的誤差參數(shù)。最后，將上面解算得到的誤差系數(shù)代入理想磁傳感器的輸出關(guān)系方程，即可得到理想磁傳感器的測量值，從而實現(xiàn)磁傳感器的標定。

3 試驗驗證

試驗按照圖3所示所示流程對雙軸磁傳感器進行標定，通過與傳統(tǒng)的標定方法比較，來驗證橢圓擬合標定方法的有效性。

3.1 雙軸磁傳感器信號采集

試驗采用HMC1043L磁傳感器對磁場強度進行測量，并驗證橢圓擬合算法的正確性以及有效性。單片機STM32通過SPI接口實時采集HMC1043L磁傳感器各軸數(shù)據(jù)，然后通過串口上傳到上位機。在試驗室將磁傳感器兩軸安裝至垂直于引信縱軸位置，固定俯仰角與方位角，設(shè)置轉(zhuǎn)速5 r/s，啟動轉(zhuǎn)臺，待轉(zhuǎn)速穩(wěn)定后，控制采集模塊上電，充分采集數(shù)據(jù)。

3.2 橢圓擬合

將采集到的雙軸磁傳感器測量數(shù)據(jù)按照式(2)采用測量數(shù)據(jù)到橢圓中心代數(shù)距離的平方和最小的準則進行橢圓擬合，擬合結(jié)果如圖4所示。

圖4 橢圓擬合結(jié)果Fig.4 Results of ellipse fitting

由圖4可看出，實際雙軸磁傳感器在繞其兩軸所在平面旋轉(zhuǎn)時，其輸出軌跡形成了一個橢圓，但是大量數(shù)據(jù)點脫離標準橢圓曲線。在對其進行橢圓擬合后，擬合后的數(shù)據(jù)形成了一個較標準的橢圓，利用式(1)標準橢圓方程即可通過解算橢圓參數(shù)。

3.3 誤差參數(shù)求解

利用上面擬合得到的橢圓參數(shù)即可解算出磁傳感器的誤差參數(shù)，將該誤差參數(shù)代入式(3)磁傳感器誤差參數(shù)方程中，即可求解出式(4)中的傳感器誤差系數(shù)矩陣K以及傳感器零位誤差Bb：

3.4 誤差補償標定

將上面求解得到的誤差參數(shù)代入式(5)理想磁傳感器的輸出方程中，得到理想雙軸磁傳感器的輸出。

圖5給出了橢圓擬合標定補償結(jié)果與傳統(tǒng)標定補償結(jié)果對比。

圖5 橢圓擬合標定補償方法與傳統(tǒng)標定補償方法對比Fig.5 Comparison between ellipse fitting calibration compensation method and traditional calibration compensation method

對實驗結(jié)果進行誤差統(tǒng)計，采用橢圓擬合標定方法其測量均方差為0.001 V；采用傳統(tǒng)標定方法其測量電壓均方差為0.021 V?？梢?，基于橢圓擬合的雙軸磁傳感器標定補法能有效降低磁傳感器測量誤差散布。

4 結(jié)論

本文提出了基于橢圓擬合的雙軸磁傳感器的標定方法。該方法利用雙軸磁傳感器的輸出具有橢圓性的特點，在試驗室轉(zhuǎn)臺采集到傳感器輸出后，采用最小二乘法對測量數(shù)據(jù)點與橢圓中心的距離的平方和最小的原則進行橢圓擬合，解算出橢圓擬合參數(shù)，通過橢圓與雙軸磁傳感器的誤差參數(shù)方程求解出其誤差系數(shù)，代入理想雙軸磁傳感器與存在測量誤差的磁傳感器的關(guān)系方程中，即可對磁傳感進行標定。試驗表明，采用傳統(tǒng)標定方法其測量電壓均方差為0.021 V，而采用橢圓擬合標定方法其測量電壓均方差為0.001 V，可見，基于橢圓擬合的雙軸磁傳感器標定方法能有效降低磁傳感器測量誤差散布。