MT6701 SIN/COS 信号失调、幅值、正交误差的数字域校准算法

MT6701磁编码器通过片内差分霍尔阵列生成原始 SIN/COS 模拟信号，经 ADC 数字化后进入数字域进行误差校正。失调（Offset）、幅值不平衡（Amplitude Mismatch）与正交非正交（Quadrature Error）是造成角度解算非线性、零漂、温漂的三大核心误差源。本文围绕 MT6701 数字信号处理架构，系统阐述其在数字域对 SIN/COS 三大量级误差的建模、检测、参数辨识与实时补偿算法，重点分析椭圆拟合、最小二乘参数求解、实时闭环校正等关键技术，为理解芯片高精度来源、二次开发与算法移植提供理论与工程依据。

一、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}) )

无系统性非线性误差。

1.2 含误差的实际信号模型

MT6701 实际采集到的数字化 SIN/COS 可统一建模为：

( 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 直流失调（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 )

失调使椭圆中心偏离原点，幅值不平衡使椭圆长短轴不等，正交误差使椭圆发生旋转与畸变。

二、数字域校准总体架构

MT6701 在数字域实现三级实时校正：

失调校正：去除直流分量，使椭圆中心归原点

幅值校正：归一化两路幅度，使长短轴相等

正交校正：修正相位非正交，使椭圆恢复为标准圆

整体数据流：

( text{ADC åå§æ°æ®} rightarrow text{失è°è¡¥å¿} rightarrow text{å¹å¼è¡¥å¿} rightarrow text{正交补å¿} rightarrow text{æååä¿¡å·} rightarrow text{CORDIC 解è§} )

所有补偿系数（Offset、Gain、Phase）均在出厂校准或用户自校准阶段通过椭圆拟合 + 最小二乘辨识，并存储于片内 EEPROM，运行时实时加载参与运算。

三、失调误差（Offset）数字校准算法

3.1 误差影响

失调使 SIN/COS 波形整体上下平移，导致角度零点漂移、一圈内周期性误差。

3.2 数字域检测原理

在完整一圈内，理想交流信号均值为 0。实际信号的直流分量即为失调：

( 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），通过均值估计失调。

3.3 数字补偿实现

实时补偿结构：

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

芯片内部为无符号 ADC 输出，先做零位对齐再进入后续处理。

四、幅值不平衡（Amplitude Mismatch）数字校准算法

4.1 误差影响

两路信号峰峰值不等，使理想圆变为椭圆，导致解角出现二次谐波型非线性误差（INL 典型表现为 “波浪形”）。

4.2 幅值估计算法

在完成失调校正后，计算两路信号的有效值或峰峰值：

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

定义幅值校正系数：

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

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

4.3 数字域幅值归一化

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

使两路信号能量相等、幅度一致，椭圆长短轴相等。

五、正交误差（Quadrature Error）数字校准算法

5.1 误差物理意义

理想相位差 90°，实际因霍尔位置偏差、应力、磁场不对称出现偏差 (90°+varepsilon)，(varepsilon) 即为正交误差。

5.2 正交误差的数学表达

完成失调与幅值校正后，信号可写为：

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

数字域正交校正的目标是消除 (varepsilon)。

5.3 正交校正矩阵（数字域核心）

MT6701 采用线性正交变换矩阵实现校正：

( 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} )

该矩阵在数字域以加法 + 移位 + 系数乘法实现，无浮点运算，适合硬件实时执行。

5.4 正交误差系数辨识

通过一圈采样点构建最小二乘代价函数：

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

等价于使所有点到原点距离尽可能为 1，即圆拟合。

求解最优 (varepsilon) 后得到 (tanvarepsilon) 系数，写入寄存器。

六、基于椭圆拟合的一体化参数辨识算法

MT6701 在出厂校准与自校准阶段，并非分步单独辨识，而是采用一体化椭圆拟合同时求解：

失调 ((OS_S, OS_C))

幅值比 (A_C/A_S)

正交误差 (varepsilon)

通用椭圆方程：

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

通过最小二乘求解系数 (a,b,c,d,e,f)，再做几何变换得到：

椭圆中心 ((S_0, C_0)) → 对应 Offset

长短轴比 → 对应 Amplitude 系数

椭圆旋转角 → 对应 Quadrature 误差

该方法抗噪声更强，可一次性完成三大量级误差建模，是 MT6701 校准精度的核心算法支撑。

七、实时数字补偿流程（硬件执行逻辑）

ADC 采样：同步采集两路霍尔信号

失调减法器：减去 EEPROM 存储的 Offset

幅值乘法器：乘以增益系数，实现幅度归一化

正交校正单元：应用矩阵修正，输出标准正交信号

CORDIC 解算：对标准圆信号做 (arctan2) 输出角度

全程在数字域流水线执行，延迟为亚微秒级，不影响编码器高速输出。

八、校准前后误差对比（典型指标）

误差项	未补偿典型值	数字域校准后
失调电压	几十 LSB	<1 LSB
幅值失配	±5%~±10%	<0.5%
正交误差	±2°~±5°	<0.1°
角度 INL	±1°	±0.05°~±0.07°

九、工程意义与可移植性

这套失调 / 幅值 / 正交数字校准算法是通用高精度磁编码器的标准算法框架，不仅适用于 MT6701，也可移植到：

分立霍尔阵列（如 4 片霍尔搭建编码器）

自研磁编 FPGA/MCU 方案

光学编码器细分芯片

核心要点：

先去直流（Offset）

再等幅（Amplitude）

最后正交化（Quadrature）

统一用椭圆拟合 / 圆拟合做参数辨识

MT6701 在数字域通过失调消除、幅值归一化、正交矩阵校正三级串联校正结构，配合椭圆拟合最小二乘参数辨识，系统性解决了 SIN/COS 原始信号的三大系统性误差。该套算法完全在数字域实现，硬件开销小、实时性强、温度稳定性高，是 MT6701 在宽温、强干扰、安装偏差工况下仍能保持 14 位高精度角度输出的关键技术核心。

审核编辑 黄宇