磁編碼器在高精度運(yùn)動(dòng)控制領(lǐng)域應(yīng)用廣泛，但受制于傳感器工藝離散性、磁場(chǎng)非均勻性及安裝誤差等因素，原始輸出信號(hào)存在幅度不對(duì)稱與相位正交偏差，嚴(yán)重影響角度測(cè)量精度。本文提出一種基于幅度補(bǔ)償與相位校正的聯(lián)合校準(zhǔn)方法，通過建立雙通道信號(hào)誤差模型，采用橢圓擬合算法提取補(bǔ)償參數(shù)，并結(jié)合查找表（LUT）實(shí)現(xiàn)實(shí)時(shí)角度修正。實(shí)驗(yàn)結(jié)果表明，該方法可將磁編碼器角度誤差從 ±1.2° 降低至 ±0.03°，精度提升約 40 倍，滿足工業(yè)伺服驅(qū)動(dòng)與機(jī)器人關(guān)節(jié)控制的高精度需求。
1. 引言
磁旋轉(zhuǎn)編碼器以其非接觸測(cè)量、高可靠性和低成本的優(yōu)勢(shì)，逐步替代光電編碼器成為工業(yè)運(yùn)動(dòng)控制的主流位置傳感方案。納芯微、TDK、ams 等廠商推出的磁編碼器芯片，通過檢測(cè)旋轉(zhuǎn)磁場(chǎng)產(chǎn)生的正弦/余弦雙通道模擬信號(hào)，經(jīng) CORDIC 或反正切運(yùn)算解算角度。
然而，實(shí)際應(yīng)用中雙通道信號(hào)普遍存在以下問題：

幅度不對(duì)稱：SIN 與 COS 通道增益差異導(dǎo)致李薩如圖形呈橢圓而非圓形
相位正交偏差：兩路信號(hào)相位差偏離理想 90°，引入系統(tǒng)性角度誤差
直流偏置：模擬前端引入的零點(diǎn)漂移

上述誤差疊加后，在每個(gè)電氣周期內(nèi)產(chǎn)生 2 倍頻的周期性角度誤差，對(duì)高精度伺服控制造成顯著影響。本文針對(duì)上述問題，提出一套完整的幅度補(bǔ)償與相位校正聯(lián)合校準(zhǔn)方案。
2. 信號(hào)誤差模型
2.1 理想信號(hào)模型
理想情況下，磁編碼器雙通道輸出為：
$$V_{SIN} = A cdot sintheta$$
$$V_{COS} = A cdot costheta$$
其中 $A$ 為信號(hào)幅值，$theta$ 為機(jī)械角度。角度解算公式為：
$$theta = arctan2(V_{SIN}, V_{COS})$$
2.2 實(shí)際信號(hào)誤差模型
考慮幅度不對(duì)稱、相位偏差與直流偏置后，實(shí)際信號(hào)為：
$$V_{SIN} = A_s cdot sintheta + b_s$$
$$V_{COS} = A_c cdot cos(theta + phi) + b_c$$
其中：

$A_s, A_c$：SIN/COS 通道實(shí)際幅值（$A_s neq A_c$）
$b_s, b_c$：直流偏置
$phi$：相位正交偏差（理想值為 0）

將實(shí)際信號(hào)代入反正切運(yùn)算，角度誤差為：
$$Deltatheta = theta_{out} - theta_{true} = f(A_s, A_c, b_s, b_c, phi)$$
該誤差以 $2theta$ 為周期，峰峰值可達(dá) 1°~2°，在精密控制場(chǎng)景中不可忽視。
3. 橢圓擬合校準(zhǔn)算法
3.1 李薩如圖形分析
將 $V_{SIN}$ 與 $V_{COS}$ 在二維平面上繪制，理想情況下軌跡為圓形。存在幅度不對(duì)稱與相位偏差時(shí)，軌跡退化為傾斜橢圓，其方程為：
$$aX^2 + bXY + cY^2 + dX + eY + f = 0$$
通過擬合該橢圓方程，可直接提取幅度比、相位偏差和直流偏置等全部誤差參數(shù)。
3.2 最小二乘橢圓擬合
采集編碼器旋轉(zhuǎn)一周的 $N$ 組原始數(shù)據(jù) $(V_{SIN_i}, V_{COS_i})$，構(gòu)造設(shè)計(jì)矩陣：
$$mathbf{D} = begin{bmatrix} X_1^2 & X_1Y_1 & Y_1^2 & X_1 & Y_1 & 1 vdots & vdots & vdots & vdots & vdots & vdots X_N^2 & X_NY_N & Y_N^2 & X_N & Y_N & 1 end{bmatrix}$$
最小二乘求解橢圓參數(shù)向量 $mathbf{p} = [a, b, c, d, e, f]^T$：
$$mathbf{p} = argmin |mathbf{D}mathbf{p}|^2, quad text{s.t.} quad 4ac - b^2 = 1$$
3.3 補(bǔ)償參數(shù)提取
由橢圓參數(shù)解算各誤差補(bǔ)償量：
直流偏置：
$$b_s = -frac{2cd - be}{b^2 - 4ac}, quad b_c = -frac{2ae - bd}{b^2 - 4ac}$$
幅度比：
$$k = sqrt{frac{A_c}{A_s}} = sqrt{frac{c}{a}}$$
相位偏差：
$$phi = arcsinleft(frac{-b}{2sqrt{ac}}right)$$
4. 補(bǔ)償校正實(shí)現(xiàn)
4.1 信號(hào)預(yù)處理
利用提取的補(bǔ)償參數(shù)，對(duì)原始信號(hào)進(jìn)行歸一化處理：
Step 1 — 去除直流偏置：
$$V’{SIN} = V{SIN} - b_s, quad V’{COS} = V{COS} - b_c$$
Step 2 — 幅度歸一化：
$$V’‘{SIN} = frac{V’{SIN}}{A_s}, quad V’'{COS} = frac{V’{COS}}{A_c}$$
Step 3 — 相位正交校正：
$$V’‘’{SIN} = frac{V’'{SIN} - V’‘{COS} cdot sinphi}{cosphi}$$
$$V’‘’{COS} = V’'_{COS}$$
經(jīng)過三步處理后，雙通道信號(hào)恢復(fù)為標(biāo)準(zhǔn)正交形式，可直接代入反正切運(yùn)算。
4.2 查找表加速
對(duì)于嵌入式實(shí)時(shí)系統(tǒng)，浮點(diǎn)運(yùn)算開銷較大。實(shí)際工程中采用**查找表（LUT）**方案：

校準(zhǔn)階段離線計(jì)算全角度范圍（0°~360°，步長 0.1°）的補(bǔ)償值
將補(bǔ)償后角度存入 Flash/EEPROM（3600 個(gè) 16-bit 數(shù)據(jù)，約 7.2KB）
運(yùn)行時(shí)通過線性插值快速查表，單次查表時(shí)間 < 1μs

5. 實(shí)驗(yàn)驗(yàn)證
5.1 實(shí)驗(yàn)平臺(tái)

編碼器： 納芯微 NIS3000 系列，14-bit 分辨率
參考基準(zhǔn)： Renishaw RESOLUTE 光柵編碼器（精度 ±0.001°）
驅(qū)動(dòng)： 無刷直流電機(jī)，轉(zhuǎn)速 60 RPM
采樣率： 10kHz

5.2 校準(zhǔn)結(jié)果

5.3 溫度穩(wěn)定性
在 -20°C ~ +85°C 范圍內(nèi)測(cè)試，校準(zhǔn)后角度誤差變化量 < ±0.05°，滿足工業(yè)級(jí)溫度穩(wěn)定性要求。建議在極端溫度環(huán)境下每隔 6 個(gè)月重新執(zhí)行一次校準(zhǔn)流程。
6. 工程應(yīng)用建議
安裝規(guī)范：

磁環(huán)與傳感器氣隙控制在 0.5mm ± 0.1mm
同心度偏差 ≤ 0.05mm，軸向偏移 ≤ 0.1mm

校準(zhǔn)時(shí)機(jī)：

首次出廠前必須執(zhí)行完整校準(zhǔn)
更換磁環(huán)或傳感器后重新校準(zhǔn)
工作環(huán)境溫度變化超過 40°C 時(shí)建議重新校準(zhǔn)

參數(shù)存儲(chǔ)：

補(bǔ)償參數(shù)寫入芯片內(nèi)部 EEPROM，掉電不丟失
建議同時(shí)備份至主控 MCU 的 Flash，防止 EEPROM 損壞

7. 結(jié)論
本文提出了基于橢圓擬合的幅度補(bǔ)償與相位校正聯(lián)合校準(zhǔn)方法，系統(tǒng)解決了磁編碼器雙通道信號(hào)的幅度不對(duì)稱、相位正交偏差和直流偏置三類主要誤差。實(shí)驗(yàn)驗(yàn)證表明，該方法將角度測(cè)量精度提升約 40 倍，達(dá)到 ±0.03° 水平，且具備良好的溫度穩(wěn)定性。結(jié)合查找表的實(shí)時(shí)補(bǔ)償方案，可在資源受限的嵌入式系統(tǒng)中高效運(yùn)行，具有較強(qiáng)的工程實(shí)用價(jià)值，適用于工業(yè)伺服驅(qū)動(dòng)、機(jī)器人關(guān)節(jié)、無人機(jī)云臺(tái)等高精度位置控制場(chǎng)景。

審核編輯 黃宇