MT6701磁編碼器通過片內(nèi)差分霍爾陣列生成原始 SIN/COS 模擬信號，經(jīng) ADC 數(shù)字化后進入數(shù)字域進行誤差校正。失調(diào)（Offset）、幅值不平衡（Amplitude Mismatch）與正交非正交（Quadrature Error）是造成角度解算非線性、零漂、溫漂的三大核心誤差源。本文圍繞 MT6701 數(shù)字信號處理架構(gòu)，系統(tǒng)闡述其在數(shù)字域?qū)?SIN/COS 三大量級誤差的建模、檢測、參數(shù)辨識與實時補償算法，重點分析橢圓擬合、最小二乘參數(shù)求解、實時閉環(huán)校正等關鍵技術，為理解芯片高精度來源、二次開發(fā)與算法移植提供理論與工程依據(jù)。

一、SIN/COS 理想模型與誤差模型

1.1 理想正交信號模型

理想情況下，霍爾傳感單元輸出兩路正交正弦信號：

( begin{cases} S_{ideal} = A cdot sintheta \ C_{ideal} = A cdot costheta end{cases} )

滿足：

幅值相等：(A_S = A_C = A)

正交性：相位差嚴格 90°

無直流偏置：(OS_S = OS_C = 0)

對理想信號做反正切解角：

( theta = arctan2(S_{ideal}, C_{ideal}) )

無系統(tǒng)性非線性誤差。

1.2 含誤差的實際信號模型

MT6701 實際采集到的數(shù)字化 SIN/COS 可統(tǒng)一建模為：

( begin{cases} S = A_S cdot sintheta + OS_S \ C = A_C cdot (costheta cdot cosvarepsilon - sintheta cdot sinvarepsilon) + OS_C end{cases} )

其中：

(OS_S, OS_C)：SIN/COS 直流失調(diào)（Offset）

(A_S, A_C)：兩路幅值

(varepsilon)：正交誤差（偏離 90° 的偏差角）

在小角度近似與工程簡化下，該模型對應橢圓軌跡：

( left(frac{S - OS_S}{A_S}right)^2 + left(frac{C - OS_C}{A_C}right)^2 - 2 cdot frac{(S-OS_S)(C-OS_C)}{A_S A_C} sinvarepsilon = 1 )

失調(diào)使橢圓中心偏離原點，幅值不平衡使橢圓長短軸不等，正交誤差使橢圓發(fā)生旋轉(zhuǎn)與畸變。

二、數(shù)字域校準總體架構(gòu)

MT6701 在數(shù)字域?qū)崿F(xiàn)三級實時校正：

失調(diào)校正：去除直流分量，使橢圓中心歸原點

幅值校正：歸一化兩路幅度，使長短軸相等

正交校正：修正相位非正交，使橢圓恢復為標準圓

整體數(shù)據(jù)流：

( text{ADC ??§?°??} rightarrow text{?¤±è°è?￥??} rightarrow text{?1??è?￥??} rightarrow text{?-￡?o¤è?￥??} rightarrow text{???????·} rightarrow text{CORDIC è§￡è§} )

所有補償系數(shù)（Offset、Gain、Phase）均在出廠校準或用戶自校準階段通過橢圓擬合 + 最小二乘辨識，并存儲于片內(nèi) EEPROM，運行時實時加載參與運算。

三、失調(diào)誤差（Offset）數(shù)字校準算法

3.1 誤差影響

失調(diào)使 SIN/COS 波形整體上下平移，導致角度零點漂移、一圈內(nèi)周期性誤差。

3.2 數(shù)字域檢測原理

在完整一圈內(nèi)，理想交流信號均值為 0。實際信號的直流分量即為失調(diào)：

( begin{cases} hat{OS}_S = frac{1}{N}sum_{i=1}^N S_i \ hat{OS}_C = frac{1}{N}sum_{i=1}^N C_i end{cases} )

MT6701 在自校準時采集 N 個均勻分布點（典型 N≥64），通過均值估計失調(diào)。

3.3 數(shù)字補償實現(xiàn)

實時補償結(jié)構(gòu)：

( begin{cases} S_{os} = S_{raw} - OS_S \ C_{os} = C_{raw} - OS_C end{cases} )

芯片內(nèi)部為無符號 ADC 輸出，先做零位對齊再進入后續(xù)處理。

四、幅值不平衡（Amplitude Mismatch）數(shù)字校準算法

4.1 誤差影響

兩路信號峰峰值不等，使理想圓變?yōu)闄E圓，導致解角出現(xiàn)二次諧波型非線性誤差（INL 典型表現(xiàn)為 “波浪形”）。

4.2 幅值估計算法

在完成失調(diào)校正后，計算兩路信號的有效值或峰峰值：

( A_S = sqrt{frac{1}{N}sum S_{os}^2}, quad A_C = sqrt{frac{1}{N}sum C_{os}^2} )

定義幅值校正系數(shù)：

( k_S = frac{A_{ref}}{A_S}, quad k_C = frac{A_{ref}}{A_C} )

通常以一路為基準，或取平均幅值作為 (A_{ref})。

4.3 數(shù)字域幅值歸一化

**( begin{cases} S_{amp} = k_S cdot S_{os} \ C_{amp} = k_C cdot C_{os} end{cases} )

使兩路信號能量相等、幅度一致，橢圓長短軸相等。

五、正交誤差（Quadrature Error）數(shù)字校準算法

5.1 誤差物理意義

理想相位差 90°，實際因霍爾位置偏差、應力、磁場不對稱出現(xiàn)偏差 (90?°+varepsilon)，(varepsilon) 即為正交誤差。

5.2 正交誤差的數(shù)學表達

完成失調(diào)與幅值校正后，信號可寫為：

( begin{cases} S = sintheta \ C = cos(theta + varepsilon) = costhetacosvarepsilon - sinthetasinvarepsilon end{cases} )

數(shù)字域正交校正的目標是消除 (varepsilon)。

5.3 正交校正矩陣（數(shù)字域核心）

MT6701 采用線性正交變換矩陣實現(xiàn)校正：

( begin{bmatrix} S_{quad} \ C_{quad} end{bmatrix} = begin{bmatrix} 1 & 0 \ tanvarepsilon & 1 end{bmatrix} begin{bmatrix} S_{amp} \ C_{amp} end{bmatrix} )

展開為：

( begin{cases} S_{quad} = S_{amp} \ C_{quad} = C_{amp} + tanvarepsilon cdot S_{amp} end{cases} )

該矩陣在數(shù)字域以加法 + 移位 + 系數(shù)乘法實現(xiàn)，無浮點運算，適合硬件實時執(zhí)行。

5.4 正交誤差系數(shù)辨識

通過一圈采樣點構(gòu)建最小二乘代價函數(shù)：

( J = sum big(S^2 + C^2 - 1big)^2 to min )

等價于使所有點到原點距離盡可能為 1，即圓擬合。

求解最優(yōu) (varepsilon) 后得到 (tanvarepsilon) 系數(shù)，寫入寄存器。

六、基于橢圓擬合的一體化參數(shù)辨識算法

MT6701 在出廠校準與自校準階段，并非分步單獨辨識，而是采用一體化橢圓擬合同時求解：

失調(diào) ((OS_S, OS_C))

幅值比 (A_C/A_S)

正交誤差 (varepsilon)

通用橢圓方程：

( acdot S^2 + bcdot S C + ccdot C^2 + dcdot S + ecdot C + f = 0 )

通過最小二乘求解系數(shù) (a,b,c,d,e,f)，再做幾何變換得到：

橢圓中心 ((S_0, C_0)) → 對應 Offset

長短軸比 → 對應 Amplitude 系數(shù)

橢圓旋轉(zhuǎn)角 → 對應 Quadrature 誤差

該方法抗噪聲更強，可一次性完成三大量級誤差建模，是 MT6701 校準精度的核心算法支撐。

七、實時數(shù)字補償流程（硬件執(zhí)行邏輯）

ADC 采樣：同步采集兩路霍爾信號

失調(diào)減法器：減去 EEPROM 存儲的 Offset

幅值乘法器：乘以增益系數(shù)，實現(xiàn)幅度歸一化

正交校正單元：應用矩陣修正，輸出標準正交信號

CORDIC 解算：對標準圓信號做 (arctan2) 輸出角度

全程在數(shù)字域流水線執(zhí)行，延遲為亞微秒級，不影響編碼器高速輸出。

八、校準前后誤差對比（典型指標）

九、工程意義與可移植性

這套失調(diào) / 幅值 / 正交數(shù)字校準算法是通用高精度磁編碼器的標準算法框架，不僅適用于 MT6701，也可移植到：

分立霍爾陣列（如 4 片霍爾搭建編碼器）

自研磁編 FPGA/MCU 方案

光學編碼器細分芯片

核心要點：

先去直流（Offset）

再等幅（Amplitude）

最后正交化（Quadrature）

統(tǒng)一用橢圓擬合 / 圓擬合做參數(shù)辨識

MT6701 在數(shù)字域通過失調(diào)消除、幅值歸一化、正交矩陣校正三級串聯(lián)校正結(jié)構(gòu)，配合橢圓擬合最小二乘參數(shù)辨識，系統(tǒng)性解決了 SIN/COS 原始信號的三大系統(tǒng)性誤差。該套算法完全在數(shù)字域?qū)崿F(xiàn)，硬件開銷小、實時性強、溫度穩(wěn)定性高，是 MT6701 在寬溫、強干擾、安裝偏差工況下仍能保持 14 位高精度角度輸出的關鍵技術核心。

審核編輯 黃宇