前阵子给一套伺服驱动器换位置反馈方案从 AS5047P 换到 MT6816理由很直接成本更低、现货也更稳。结果电机一挂上去跑开环电流波形明显比原来毛躁低速还有周期性的噪声。一开始怀疑是驱动参数没调好查了一圈把 MT6816 原始角度和光栅尺对着读才发现这颗芯片的原始角度存在明显的非线性误差——同一个机械角度转到不同扇区误差能差出去零点几度。对伺服这种要跑电流环、速度环的应用这零点几度最后都会变成电流谐波和力矩波动。于是花了几天时间把 MT6816 的非线性校准从头做了一遍。这篇文章把整个从原理到代码的过程完整复盘一遍误差怎么来、标定台怎么搭、查找表怎么生成、STM32 上怎么查表补偿以及我在这个过程中踩过的坑。适合正在做电机控制、机器人关节、云台反馈或者刚从光编码器切到磁编码器的朋友参考。1. 先弄清楚误差从哪里来再去想怎么校准1.1 磁编码器内部在做什么MT6816 属于磁旋转编码器内部是一组磁场传感单元一般基于磁阻或霍尔阵列。安装时旋转轴上贴一颗径向充磁的磁铁芯片固定在轴端正上方或者侧面。电机转轴旋转时磁铁产生的磁场方向跟着转芯片内部各个传感单元的输出电压随磁场角度呈周期性变化再由片内电路算出反正切最终输出一个 0°~360° 的角度值。MT6816 是 14 位分辨率也就是一圈被分成 16384 个 LSB每个 LSB 对应 360/16384 ≈ 0.022°。这里有个容易忽略的点芯片输出的角度本质上是磁场方向的角度而不是机械转轴的实际角度。磁场方向是否和机械轴严格同步取决于磁铁安装、磁场质量和芯片位置。只要磁场相对于芯片的旋转不是理想均匀的输出角度就会偏离真实机械角度这就是非线性误差的来源。1.2 误差的主要贡献来源从工程实测来看MT6816 的非线性误差不是随机噪声而是典型的系统误差。也就是说你把轴转到某一个固定角度每次读出来的误差基本是同一个值重复性往往不错但是换一个角度误差可能变成另一样。这种跟着角度走、每圈重复出现的误差非常适合用校准表来补偿。误差主要来自几个地方磁铁安装偏心。磁铁中心没有和转轴轴心重合磁场旋转中心偏移产生的误差大体上是 1 次谐波也就是一转一个周期的正弦形状。磁铁轴向倾斜或者芯片与磁铁间隙不一致。磁场在传感平面的投影会变成椭圆典型表现是 2 次谐波。磁铁本身充磁不均匀或者磁铁内部存在瑕疵。这会带来更高次谐波甚至局部毛刺。外部杂散磁场干扰尤其是附近有大电流母排、线圈或者铁磁物体移动时。温度变化。磁铁剩磁和芯片灵敏度都会随温度漂移这部分误差在不同温度下会变。1.3 误差对控制系统的影响在位置环里误差直接表现为定位不准在速度环里轴匀速旋转时编码器读数不是匀速增长的速度反馈会出现周期性波动在电流环/FOC 里电角度有误差意味着 dq 变换角度偏移电流谐波变大电机低速时能听到周期性噪声力矩也不再平滑。如果一个 20 对极的电机机械角度误差 0.3°映射到电角度就是 6° 电角度这个偏差在 FOC 里已经不小了。所以在做伺服级应用时把 MT6816 的非线性校准做掉不是锦上添花而是必要步骤。2. 校准方案的取舍查找表是主干谐波补偿是延伸2.1 为什么可以校准这里先建立一个概念MT6816 的误差是系统误差也就是重复出现的部分远大于随机噪声。系统误差可以用标定的方式建立映射关系然后在运行中反向补偿。剩下的随机噪声才真正决定这个编码器能做到的最终测量极限。所以我做校准的第一步是评估重复性。固定一个角度连续读几千次看读数的标准差。如果 RMS 噪声在 1~2 个 LSB 以内这个芯片就值得做校准表如果噪声本身就飘到十几个 LSB那再校线性误差也没有意义。实测下来MT6816 在静态位置的读数稳定性是够用的这也是它能做伺服反馈的前提。2.2 误差曲线可以拆成谐波把一圈内每个角度的误差画成曲线你会看到它并不是乱糟糟的而是有明显的规律性。对误差序列做一次频域分解通常会看到这些成分1 次谐波主要来自磁铁偏心和轴心偏离幅度往往最大。2 次谐波来自椭圆磁场、芯片平面与磁铁不平行。3 次及更高次谐波来自磁铁磁化不均匀幅度通常依次下降。因此理论上有两种补偿路线一种是用几个谐波系数在运行时实时计算补偿值另一种是直接记录一张误差查找表。谐波补偿参数少、存储小但对非谐波的毛刺无能为力。查找表则不管误差长什么样都能补偿存储占用稍大换来的效果更彻底。2.3 查找表与谐波补偿对比维度查找表谐波补偿校准速度需要逐点采一圈工作量较大采集少量点后拟合参数即可存储占用512~1024 个 int16约 1~2 KB Flash两三个系数可忽略对高次谐波/毛刺能完整补偿基本无能为力运行期计算量查表加一次插值很小需要算多次 sin/cos成本高得多调试直观性表可以直接画出来检查系数不直观出错不好定位现实中绝大部分项目我会直接选查找表。谐波补偿更适合没有标定台、手工转几圈采几十个点就想快速降误差的场景或者做理论分析时用。2.4 我的选择我最终采用的是1024 项 int16 误差表 线性插值。理由很简单1024 项每项之间对应 360°/1024≈0.35°的区间插值后表项引起的残差远小于编码器本身的噪声存储只要 2 KB对 STM32 来说毫无压力线性插值在定点环境下只有几次乘加控制环里调用非常快。如果你 Flash 紧张512 项也能用。再少就不建议了因为误差曲线的高次谐波在局部可能变化比较快表太稀疏插值残差会被拉高。3. 标定台怎么搭数据怎么采才靠谱3.1 基准源精度决定校准上限校准这件事的本质是把 MT6816 的误差向一个更高精度的基准对齐。基准如果不准MT6816 的误差会被校正成基准的误差。所以基准编码器/光栅尺的精度至少要比目标精度高 5~10 倍。比如你想把校准后做到 0.05°以内基准最好能到 0.005°~0.01°或者更好。我用的是一个带高精度圆光栅的转台配一套绝对角度读取模块。如果你没有这种条件也可以用手分度转台配合高精度磁栅尺但每一步都要确认重复定位精度。用步进电机开环带动来凑合标定原则上不推荐除非你的目标精度只有 0.1°量级。3.2 装配和预处理标定之前先尽量把机械装好。磁铁偏心是误差的头号来源先调偏心再谈校准。我自己用的办法轴端打表测磁铁外圆跳动控制到 0.03mm 以内轴向间隙按数据手册推荐的中间值装。装配越差校准表越难兜底而且高次谐波和局部毛刺会变大查找表规格被迫加大。另外确认磁铁充磁方向正确。如果磁铁贴反或者充磁方向偏了角度输出可能翻转或者出现奇怪的分段错误这类问题校准表也救不了。装好后先跑一整圈看一眼原始角度曲线是否平滑、有没有突变。3.3 数据采集等间隔定位 多次平均我的采集流程如下转台每转到一个预定角度停下稳定片刻然后用 STM32 同一时刻读取 MT6816 原始角度和基准编码器角度每个点连续采 64 次取平均用来把芯片本身的读数噪声压掉。一圈从 0°到 360°按 1024 个位置采集。核心伪代码如下#define LUT_SIZE 1024u #define SAMPLE_NUM 64u int16_t err_lut[LUT_SIZE]; for (uint16_t i 0; i LUT_SIZE; i) { float target_angle 360.0f * i / LUT_SIZE; rotate_stage_to(target_angle); // 转台转到目标角度 wait_for_stable(); // 等待机械稳定 float err_sum 0.0f; for (uint16_t j 0; j SAMPLE_NUM; j) { uint16_t raw_lsb mt6816_read_raw_angle(); // 0~16383 float ref_deg read_ref_angle(); // 基准角度单位° float raw_deg raw_lsb * 360.0f / 16384.0f; float delta wrap_pi(ref_deg - raw_deg); // 折到[-180,180] err_sum delta; } err_lut[i] (int16_t)(err_sum / SAMPLE_NUM * 16384.0f / 360.0f); }这里wrap_pi非常重要它的作用是把误差差值折到 [-180°, 180°]避免跨零点时出现基准是 359.9°原始是 0.1°直接相减得到 359.8°这种离谱结果float wrap_pi(float deg) { deg fmodf(deg 540.0f, 360.0f) - 180.0f; return deg; }3.4 从采集数据到最终 LUT上面的伪代码假设转台逐点定位后MT6816 原始读数就落在第i个分区附近。严格来说因为 MT6816 自身有误差raw_lsb不会刚刚好等于i * 16而是会偏移十几个 LSB。比较严谨的上位机处理方式是把整圈 16384 LSB 按每 16 LSB 一个分区把每个原始读数按raw_lsb / 16归到对应分区对每个分区内的误差取平均最后生成 1024 项表。如果某些分区因为采样点分布原因没有数据用相邻分区线性插值补齐。上位机脚本的大致逻辑是这样的import numpy as np raw_arr [] # 所有采样点的 MT6816 原始角度 ref_arr [] # 所有采样点的基准角度换算成 LSB0~16383 err_arr np.array(ref_arr) - np.array(raw_arr) LUT_SIZE 1024 STEP 16384 // LUT_SIZE # 16 # 每个分区收集误差 buckets [[] for _ in range(LUT_SIZE)] for raw, err in zip(raw_arr, err_arr): idx int(raw) // STEP buckets[idx].append(err) err_lut [] for b in buckets: if len(b) 0: err_lut.append(int(round(np.mean(b)))) else: err_lut.append(None) # 空分区线性插值 ...生成后还有一个必须检查的点err_lut[0]和err_lut[LUT_SIZE-1]的差不能太大。如果差值超过 3~5 个 LSB说明跨零点附近的误差不连续可能是标定数据在 0°附近采样有问题也可能是装配畸变更严重这时候做出来的表在跨零处插值会有跳变需要回头补采零点附近的数据。4. STM32 端实现SPI 读数与查表补偿4.1 SPI 初始化先求稳再求快MT6816 通过 SPI 读角度示例代码基于 HAL 库SPI 配置成主机模式。第一版建议不要追求高速先按 2~4 MHz 左右调通再逐步提高。很多角度读出来是乱的问题其实只是 SPI 速率太高或者线序不对。hspi1.Instance SPI1; hspi1.Init.Mode SPI_MODE_MASTER; hspi1.Init.Direction SPI_DIRECTION_2LINES; hspi1.Init.DataSize SPI_DATASIZE_8BIT; hspi1.Init.CLKPolarity SPI_POLARITY_LOW; hspi1.Init.CLKPhase SPI_PHASE_1EDGE; hspi1.Init.NSS SPI_NSS_SOFT; hspi1.Init.BaudRatePrescaler SPI_BAUDRATEPRESCALER_16; // 72MHz/164.5MHz hspi1.Init.FirstBit SPI_FIRSTBIT_MSB; hspi1.Init.TIMode SPI_TIMODE_DISABLE; hspi1.Init.CRCCalculation SPI_CRCCALCULATION_DISABLE; if (HAL_SPI_Init(hspi1) ! HAL_OK) { Error_Handler(); }SPI 模式通常对应模式 0CPOL0, CPHA0。如果你用的是某些特殊封装的 MT6816 或者定制 OTP 版本读不到数据时可以试试把 CPOL/CPHA 切到模式 1。4.2 读取 14 位原始角度MT6816 的 SPI 读角度是一帧两个字节CS 拉低后直接收数。第一字节高 2 位是状态或校验位低 6 位是角度的高 6 位第二字节是角度的低 8 位。合起来是 14 位角度值。#define MT6816_CS_LOW() HAL_GPIO_WritePin(MT6816_CS_GPIO_Port, MT6816_CS_Pin, GPIO_PIN_RESET) #define MT6816_CS_HIGH() HAL_GPIO_WritePin(MT6816_CS_GPIO_Port, MT6816_CS_Pin, GPIO_PIN_SET) uint16_t MT6816_ReadRaw(void) { uint8_t tx[2] {0x00, 0x00}; uint8_t rx[2] {0x00, 0x00}; uint16_t angle 0; MT6816_CS_LOW(); HAL_SPI_TransmitReceive(hspi1, tx, rx, 2, 10); MT6816_CS_HIGH(); // 按我手头这颗料的帧格式第一字节低6位为角度高6位第二字节为角度低8位 angle ((uint16_t)(rx[0] 0x3F) 8) | rx[1]; return angle 0x3FFF; }如果你的驱动读出来总在 0~1023 或者 0~255 范围内大概率是这个帧格式里的掩码位取错了。拿逻辑分析仪抓一下 MISO 数据对照手册确认角度位的位置不要凭感觉试。4.3 查表与线性插值误差表直接定义成const int16_t数组放在 Flash 里。每项表示该分区起点处需要的补偿量单位是 LSB。比如err_lut[i] 14表示当原始读数落在第i个分区起点附近时真实角度大约比原始读数大 14 个 LSB。#define LUT_SIZE 1024u #define LUT_FRAC_BITS 4u // 16384 / 1024 16所以 raw 的低4位是插值比例 #define LUT_FRAC_MASK 0x0Fu #define ANGLE_MAX 16384u // 由标定脚本生成的误差表单位LSB const int16_t err_lut[LUT_SIZE] { // ... 标定生成后填入 }; uint16_t MT6816_GetCompensatedRaw(uint16_t raw) { uint16_t idx raw LUT_FRAC_BITS; uint16_t frac raw LUT_FRAC_MASK; uint16_t nextIdx (idx 1 LUT_SIZE) ? (idx 1) : 0; int32_t diff (int32_t)err_lut[nextIdx] - (int32_t)err_lut[idx]; int32_t compErr (int32_t)err_lut[idx] diff * (int32_t)frac / (int32_t)(1 LUT_FRAC_BITS); int32_t compensated (int32_t)raw compErr; if (compensated (int32_t)ANGLE_MAX) { compensated - ANGLE_MAX; } else if (compensated 0) { compensated ANGLE_MAX; } return (uint16_t)(compensated (ANGLE_MAX - 1)); }这里有个细节因为查找表按 2 的整数次幂分区idx直接由右移得到frac取低 4 位除法/16编译器会优化成移位速度很快。如果你的表项固定但不想用位运算直接写除法也可以效果一样。实际控制环里的用法很简单uint16_t raw MT6816_ReadRaw(); uint16_t corrected MT6816_GetCompensatedRaw(raw); // 后续 FOC 或位置环里全部用 corrected不再用 raw之所以补偿后仍然输出 0~16383 的 LSB而不是输出浮点角度是因为电机控制算法普遍直接用 LSB 做角度归一化省一次浮点换算。如果你需要角度再乘一个360.0f / 16384.0f即可。4.4 集成到控制环的注意事项SPI 读角度是一次阻塞式HAL_SPI_TransmitReceive示例里可以这么写量产代码建议改成 DMA 或者中断方式避免在高速电流环里阻塞太久。如果你把校准后的角度更新放到 10 kHz 中断里一次 SPI 事务大约几微秒实际上影响不大但和 ADC 采样、SVPWM 更新挤在一起时时序要量化看不能想当然。另外如果控制环需要速度反馈不要在控制器里去差分校准后角度。角度差分会把编码器噪声放大建议用两个连续周期的角度差做低通或者用 M/T 测速法处理。校准表的收益主要在位置和电流环速度环能间接感受到噪声变小。5. 校准效果怎么验证才算数5.1 必须用独立数据验证校准表是拿一组数据拟合出来的如果评估效果时又拿同一组数据来算属于开卷考试得到的结果一定偏乐观因为表项里的噪声也被记住了。 正确做法是整个采集过程做两圈第一圈数据生成 LUT第二圈数据只用来验证不参与生成表。第二圈的每个点用同一时刻的 MT6816 原始读数和基准读数代入分别计算校准前的误差和校准后的误差。5.2 用统计数据说话采集完验证数据后统计两组指标峰值误差所有误差绝对值里的最大值反映最差情况。RMS 误差所有误差的均方根值反映整体水平。我在某颗样片、常温、装配良好条件下的实测结果大致是这样的指标校准前校准后峰值误差0.31°0.021°RMS 误差0.083°0.007°这个数据只代表那一颗样片不能当芯片规格书用。但趋势是稳定的做了查找表补偿后误差至少能降一个数量级最后剩下的大头是芯片读数噪声和基准自身的误差。5.3 在电机波形上观察数值验证过关后再把电机挂上去跑。校准时序不要变重新上下电你看低速匀速转动时的电流波形高次谐波明显变小速度环给定一个小的正弦波激励时反馈跟随更平滑。这个时候校准才算真正生效。6. 实操中容易翻车的五个细节6.1 标定数据和验证数据混用这是最容易犯也最隐蔽的错误。很多人在转台上采完一组数据既用来生成表又用来画校准前后的误差曲线误差降得特别漂亮很高兴。实际上你把噪声也学进去了。我建议标定和验证数据分开采集、分开存储哪怕麻烦一点也值得。6.2 跨零点表项不连续LUT 是首尾相接的err_lut[0]和err_lut[LUT_SIZE-1]本质上是同一个地方的误差。如果这两项差距过大校准后会在 0°边界附近出现一个跳变电机转到那里会产生一次明显的顿挫。生成表后第一件事就是检查这两个值的差值通常在几个 LSB 以内。如果差值大回头处理采集数据而不是硬凑表。6.3 装配太差表兜不住校准表能补偿的是稳定的空间误差不是安装事故。磁铁偏心 0.2mm 以上时误差曲线会出现很陡的局部变化表项之间插值追不上轴串动大了读数随机噪声变大表补偿完残差还是很大。我的经验顺序是先把机械安装做到位再做标定而不是靠标定去掩盖机械问题。6.4 温度漂移会让表失效磁编码器的误差里有一个温度相关分量常温下标定的表到了高温或者低温时残差会变大。如果产品只要求室温工作问题不大。如果工作温度范围很宽建议做两个温度点的标定表再根据当前温度做线性插值或者至少要在产品最极端温度点验证一下校准后的残差。这个容易被忽略但返工成本很高。6.5 SPI 帧格式别想当然MT6816 的 SPI 帧格式不同封装、不同 OTP 选项下可能略有差异。网上搜到的代码也有两种掩码写法一种是(rx[0] 0x3F) 8一种是(rx[0] 0x03) 8两个差得很远如果你套了错的代码读出来的角度要么不连续要么范围明显不对。老老实实抓波形确认角度位在哪几个 bit 上再写驱动。我在实际项目里做这套校准从搭台到生成第一版可用 LUT大概花了两天。第一天全在折腾机械对中和基准读取第二天才真正进入采集和代码。如果你手头已经有转台和高精度基准一天能跑完。最后提醒一句每次更换磁铁批次、改动机械结构或者换芯片封装都意味着误差曲线可能变了需要重新标一次。校准表不是一劳永逸的它对应的是某一套具体装配。
