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

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

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

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

將實際信號代入反正切運算，角度誤差為：
$$Deltatheta = theta_{out} - theta_{true} = f(A_s, A_c, b_s, b_c, phi)$$
該誤差以 $2theta$ 為周期，峰峰值可達 1°~2°，在精密控制場景中不可忽視。
3. 橢圓擬合校準算法
3.1 李薩如圖形分析
將 $V_{SIN}$ 與 $V_{COS}$ 在二維平面上繪制，理想情況下軌跡為圓形。存在幅度不對稱與相位偏差時，軌跡退化為傾斜橢圓，其方程為：
$$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)造設計矩陣：
$$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 補償參數(shù)提取
由橢圓參數(shù)解算各誤差補償量：
直流偏置：
$$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. 補償校正實現(xiàn)
4.1 信號預處理
利用提取的補償參數(shù)，對原始信號進行歸一化處理：
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)過三步處理后，雙通道信號恢復為標準正交形式，可直接代入反正切運算。
4.2 查找表加速
對于嵌入式實時系統(tǒng)，浮點運算開銷較大。實際工程中采用**查找表（LUT）**方案：

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

5. 實驗驗證
5.1 實驗平臺

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

5.2 校準結(jié)果

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

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

校準時機：

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

參數(shù)存儲：

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

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

審核編輯 黃宇