MT6835 磁编码器正交畸变建模与 FOC 电流环谐波补偿技术研究

纳芯微 MT6835 作为一款 18 位高精度 TMR 磁编码器，在高性能 FOC 伺服系统中得到广泛应用。然而，安装偏角、磁钢偏心、PCB 布线不对称等因素会引入正交信号畸变，进而导致电流环产生 5 次、7 次谐波转矩脉动。本文建立了正交畸变的数学模型，推导了其与电流谐波的映射关系，并提出了一种基于自适应陷波器的在线补偿方案，实验验证可将转矩脉动降低 65% 以上。

艾毕胜电子MT6835磁编码器

一、MT6835 传感原理与正交信号特性

MT6835 采用隧道磁阻（TMR）传感单元，内置两对正交布置的惠斯通电桥，当径向充磁磁钢旋转时，输出两路正交正弦信号：

$$V_x = V_{dc} + Asin(theta$$ $$V_y = V_{dc} + Acos(theta$$

理想情况下，两路信号幅值相等、相位严格相差 90°，通过 CORDIC 算法可精确解算角度。但工程实际中存在三类畸变源：

1.1 安装偏角引入的正交误差

当磁钢旋转轴与传感芯片中心存在安装偏角$$Deltaalph$$时，TMR 单元感受到的磁场分量发生投影畸变：

$$V_x = Asin(theta + delta$$ $$V_y = Bcos(theta$$

其中$$delt$$为相位偏移量，幅值不平衡系数$$k = A/B neq $$。

1.2 PCB 布线不对称引入的幅值偏差

差分信号线长度不匹配会导致两路信号增益不一致，典型偏差范围 0.5%~2%。MT6835 内置自动增益校准（AGC）电路，但高频响应下仍存在动态幅值误差。

1.3 磁钢偏心引入的周期性畸变

磁钢安装偏心$$$$会产生 1 次谐波畸变，畸变幅值与偏心量成正比：

$$Deltatheta(theta) = frac{e}{R}sin(theta$$

其中$$$$为磁钢工作半径。

二、正交畸变的数学建模与谐波分析

2.1 正交畸变统一模型

将所有畸变因素归一化，建立含幅值不平衡$$$$、相位偏移$$delt$$、直流偏移$$V_{ox$$、$$V_{oy$$的统一模型：

$$V_x = kAsin(theta + delta) + V_{ox$$ $$V_y = Acos(theta) + V_{oy$$

通过 CORDIC 解算得到的角度误差为：

$$Deltatheta = arctanleft(frac{V_x}{V_y}right) - thet$$

2.2 傅里叶级数展开

对角度误差进行傅里叶分解，可得到：

$$Deltatheta(theta) = frac{k-1}{2}sin(2theta) + deltacos(2theta) + O(4theta$$

关键结论：正交畸变主要产生2 次电角度谐波，直流偏移主要产生 1 次谐波。

2.3 向电流环的谐波传递

FOC 控制中，位置误差通过位置环→速度环→电流环逐级传递：

$$i_q^*(s) = K_{ptheta}Deltatheta(s) + K_{pomega}sDeltatheta(s$$

2 次位置谐波经过微分后，在 q 轴电流指令中产生 2 次和 3 次谐波，经过 Park 逆变换后，最终在三相静止坐标系中产生5 次、7 次电流谐波，这是永磁同步电机转矩脉动的主要来源。

三、硬件层面的畸变抑制方案

3.1 PCB 布局布线优化

针对 MT6835 的信号完整性设计要点：

差分等长布线：SIN + 与 SIN-、COS + 与 COS - 差分对长度误差控制在 5mil 以内

地平面完整性：芯片下方铺完整地平面，禁止分割，保证 TMR 单元参考地电位一致

电源滤波：AVDD 引脚采用 π 型滤波（10μF+100nF+1nF），靠近引脚放置

远离干扰源：磁编信号区与功率 MOS 管区至少保持 5mm 间距，中间用地沟隔离

3.2 机械安装精度控制

磁钢与芯片气隙：推荐 0.5mm±0.1mm，气隙偏差超过 0.2mm 会引入 3% 以上幅值误差

安装同轴度：控制在 0.05mm 以内，超过 0.1mm 会产生显著 1 次谐波

偏角校准：MT6835 支持寄存器 0x11 配置正交相位补偿，范围 ±15°

四、FOC 电流环谐波补偿算法

4.1 自适应陷波器补偿方案

在电流环前向通道插入 2 次电角度陷波器，结构如下：

$$H(z) = frac{1 - 2cos(2theta_e)z^{-1} + z^{-2}}{1 - 2rcos(2theta_e)z^{-1} + r^2z^{-2}$$

其中$$r=0.9$$为陷波深度系数，$$theta_$$为实时电角度。

4.2 多同步旋转坐标系解耦

针对 5 次、7 次谐波，建立 - 5 次、+7 次同步旋转坐标系：

$$begin{bmatrix}i_d^5 \ i_q^5end{bmatrix} = T(-5theta_e)begin{bmatrix}i_a \ i_b \ i_cend{bmatrix$$ $$begin{bmatrix}i_d^7 \ i_q^7end{bmatrix} = T(7theta_e)begin{bmatrix}i_a \ i_b \ i_cend{bmatrix$$

在各坐标系下分别施加 PI 控制，将谐波电流分量强制控制为零。

4.3 前馈补偿实现流程

 

1. 读取MT6835原始角度θ_raw
2. 在线辨识正交畸变参数(k, δ)
3. 计算预测角度误差Δθ_pred
4. 在位置环输出前叠加补偿量
5. 电流环注入5/7次谐波抑制项

 

五、实验验证与性能分析

5.1 测试平台配置

主控：STM32G474RET6，170MHz Cortex-M4

磁编：MT6835，SPI 10MHz 通信

电机：400W 永磁同步电机，极对数 4

采样：16kHz 电流环，8kHz 速度环，2kHz 位置环

5.2 测试结果对比

测试项	补偿前	硬件校准后	算法补偿后	改善率
角度误差峰峰值	1.25°	0.48°	0.18°	85.6%
5 次电流谐波含量	4.2%	2.8%	1.1%	73.8%
7 次电流谐波含量	3.1%	1.9%	0.7%	77.4%
转矩脉动系数	18.5%	11.2%	6.3%	65.9%
低速转速波动 (10rpm)	±1.2rpm	±0.5rpm	±0.15rpm	87.5%

5.3 工程应用建议

优先硬件校准：通过 MT6835 内置寄存器完成正交相位与幅值校准，可解决 70% 以上畸变问题

算法补偿分级：低速段启用多同步轴谐波抑制，中高速段简化为陷波器方案

温度补偿：TMR 传感特性随温度漂移约 ±0.5%/10℃，建议每 10℃更新一次校准参数

故障诊断：实时监测正交信号幅值比，偏离 0.95~1.05 范围时触发安装异常告警

六、结论

MT6835 磁编码器的正交畸变是高性能 FOC 系统中不可忽视的误差源。本文建立的畸变数学模型揭示了 2 次位置谐波向 5/7 次电流谐波的传递机理，提出的硬件 + 软件协同补偿方案可显著抑制转矩脉动。工程实践表明，该方案无需额外硬件成本，可直接移植到现有伺服驱动平台，尤其适用于工业机器人、AGV、精密云台等对低速平稳性要求苛刻的应用场景。

审核编辑 黄宇