简介：「jy901校准算法」面向使用 JY901 姿态模块与 MPU9050 传感器的嵌入式开发者，聚焦磁场与加速度两路的零偏校准及寄存器读写，适合无人机、云台、机器人等姿态解算项目中需要提升航向与倾角稳定性的初中级工程人员参考。资源以单个 docx 文档交付，压缩包约 16KB，篇幅精简，内容集中在操作流程与指令说明，便于随查随用。文档围绕磁场校准展开，区分平面校准与三维校准两种适用场景，并给出三轴磁场最大值、最小值统计与偏移值计算公式；加速度部分说明水平放置时的常值偏差计算方法，将输出归一到【0,0,1g】。文中同时列出 0xff 0xaa 开头的配置、写入与保存指令，提醒指令间隔 100ms，并给出 READADDR 读取多个寄存器的数据包格式及寄存器地址附表，便于定位 AXOFFSET、HXOFFSET 等参数。已有 702 人学习，适合需要快速落地校准流程、核对寄存器配置的读者。
1. 校准不是“点一下”：JY901 的偏移值到底在补什么
JY901 的校准算法最容易让人误判的地方，是把偏移值当成一个“调参”。同一块 MPU9050 模块，平放时 az 读出 2100 而不是 2048，换个桌面航向又漂几度；你写几组偏移，读数似乎好了，过一会儿又歪回去。这里真正要补的不是噪声，而是传感器在零输入或已知输入下的固定偏差：磁力计的硬铁偏移、加速度的常值零偏。它们来自安装位置、磁体和芯片本身的失调，表现为整个读数坐标系被平移。校准算法要做的，是在旋转或水平放置时统计极值或均值，把这个平移量算出来写进寄存器。搞懂它，你才知道平面校准和三维校准的边界，也才知道为什么保存指令不能省。
2. 磁场偏移：为什么 (HxMax+HxMin)/2 就是硬铁中心
2.1 从圆方程看 min/max 中点
磁力计测的是磁场矢量在三个轴上的投影。理想情况下，模块在水平面内绕 Z 轴转一圈，X、Y 两轴读数应该落在一个以原点为圆心的圆上；如果存在硬铁偏移，这个圆整体平移，圆心从 (0,0) 变成 (Ox,Oy)。写成单轴形式，读数 x = 真实值 + 偏移，真实值在 [-R,R] 之间变化，于是读数的最小值是 -R+O，最大值是 R+O。两者相加，R 被消掉，只剩 2O；除以 2 就得到偏移 O。三维情况下同理，只不过圆变成球，球心就是三轴硬铁偏移。
输入里的公式正是这个推论的直接落地：
def hard_iron_offset(mins, maxs): # mins/maxs 是旋转过程中统计到的三轴最小值和最大值 # 每个轴分别取 (min + max) / 2，得到该轴的硬铁偏移 return [(lo + hi) / 2.0 for lo, hi in zip(mins, maxs)] # 示例：三轴极值来自采集阶段，不是随手估的 mins = [-320, -280, -410] maxs = [ 310, 260, 390] print(hard_iron_offset(mins, maxs)) # 约 [-5.0, -10.0, -10.0]这段代码没有做任何滤波，也没有做椭球拟合，只做极值中点。它的前提是：采集阶段确实覆盖了每个轴的正负两端，且硬铁偏移在采集期间基本不变。mins和maxs必须来自同一轮旋转，不能把上一轮的极值和这一轮混在一起，否则圆心会被历史数据拉偏。参数看起来只有两个数组，真正的工程含义在“极值是否采全”上。
硬铁偏移的特点是平移，不是形变。安装位置附近的磁体、扬声器、金属结构，可能让整个圆偏向一侧；而软铁干扰会把圆压成椭圆。输入给出的 min/max 中点法只补平移，不补椭圆。所以它便宜、可解释、对 MCU 友好，但不能包治百病。明白这一点，后面平面校准和三维校准的取舍就不会拧巴。
2.2 平面校准：绕 Z 轴转一圈能测到什么
平面校准的指令顺序很明确：先把三轴磁场偏移值清零，分别写0xff 0xaa 0x0b 0x00 0x00、0xff 0xaa 0x0c 0x00 0x00、0xff 0xaa 0x0d 0x00 0x00，每条间隔 100ms；再把模块放平，绕 Z 轴缓慢旋转 360 度，同时统计 HxMax/HxMin、HyMax/HyMin、HzMax/HzMin，直到最大值和最小值不再变化；最后用中点公式算出三个偏移，写回 0x0b、0x0c、0x0d 三个寄存器，并发0xff 0xaa 0x00 0x00 0x00保存。
这里的关键不是“转一圈”这个动作，而是“绕 Z 轴”带来的覆盖范围。绕 Z 旋转时，X、Y 两轴的正弦、余弦分量会扫过正负两端，所以 X、Y 的极值容易被采到；Z 轴在水平面内几乎不变，只能采到一个接近常值的区间。平面校准适用于模块在平面内工作、俯仰和滚转为小角度变化的情况，原因就在这里：它默认 Z 轴不需要大范围补偿，或者说 Z 轴的偏移对后续姿态解算影响较小。一旦设备在真实场景里俯仰、滚转变化很大，Z 轴只采到一小段，算出来的 HzOffset 就不可信，航向会跟着姿态变化漂。
清零这一步也不能省。假设寄存器里还留着上一轮的偏移，你开始统计极值时，读到的已经是“补偿后”的值，再用它算中点，相当于在旧偏移上又叠了一层。血泪经验是：校准前先清零、再采集、再写入、再保存，顺序不要调换。写入时低字节在前、高字节在后，HxOffsetL是第 4 步算出的 x 轴误差低字节，HxOffsetH是高字节；每条写偏移指令之间同样要留 100ms，别让模块还在处理上一条就收到下一条。
平面校准的另一个边界是安装环境。偏移值跟模块在设备里的固定位置绑定，你把模块拆下来、换一块金属底板、挪动扬声器，原来的偏移就不再成立。校准要在最终安装状态下做，线缆也尽量固定，避免旋转过程中磁场环境变化。转的时候要慢，不是仪式感，而是让采样点覆盖足够密；转太快，极值可能被跳过，最大值和最小值“不再变化”也可能只是暂时没采到新点。
2.3 三维校准：绕 X、Y、Z 依次旋转的覆盖逻辑
三维校准的步骤是：先绕 X 轴缓慢旋转 360 度，再绕 Y 轴缓慢旋转 360 度，再绕 Z 轴缓慢旋转 360 度，最后随意旋转几圈，同时统计三轴磁场强度的最大值和最小值，直到极值不再变化。这个顺序不是随便排的。绕 X 旋转时，Y、Z 分量变化明显，X 分量变化小；绕 Y 旋转时，X、Z 变化明显；绕 Z 旋转时，X、Y 变化明显。三个方向各转一圈，再加上随意旋转，目的是让三个轴都经历正负两端，把球面的采样点铺开。
从机制上看，三维校准采集的是球面极值。硬铁偏移是球心，球心坐标由每个轴的最大值和最小值中点决定。如果只绕 Z 转，Z 轴极值没采全，球心在 Z 方向就是瞎猜；如果只绕 X 转，X 轴极值又不够。三维校准用多方向旋转补足覆盖，所以它适用于俯仰角、滚转角变化较大的设备。它的代价是操作麻烦，采集时间长，对旋转路径有要求；但它的收益是三个轴的偏移都有真实极值支撑，不再依赖“Z 轴差不多就行”的假设。
三维校准同样要先清零偏移，再采集，再写入，再保存。写入顺序是 0x0b、0x0c、0x0d，分别对应 HXOFFSET、HYOFFSET、HZOFFSET，数据格式是低字节在前、高字节在后。每条指令间隔 100ms 这条约束在三维校准里更重要，因为采集和写入之间往往夹着串口交互，模块处理不过来时，你会看到“写进去的值和回读的值不一致”。这不是算法错，是时序没留够。
常见的一个误区是：三维校准转得越快越“均匀”。实际上快速旋转会让采样点稀疏，极值容易被漏掉；而且手持旋转时的抖动会引入加速度和磁场噪声。正确做法是缓慢、连续、覆盖完整，最后随意旋转几圈是为了补死角，不是让你乱甩。校准过程中远离明显磁源，比如音箱、电机、大电流线束；如果设备本身带磁体，校准必须带着磁体一起做，因为你要补的就是最终安装状态下的偏移。
2.4 收敛判定：最大值最小值“不再变化”意味着什么
输入里反复出现“直至最大值与最小值不再发生变化”。这句话容易被理解成“转一圈就停”，但它的真实含义是采样覆盖已经稳定。判断收敛不能只看某一瞬间的最大值有没有刷新，而要看一个时间窗口内极值是否还在被更新。实际调试时，我会看三轴的极值更新计数：如果连续若干圈没有新的最大值或最小值出现，才认为覆盖够了；如果还在刷新，就继续转。这样比“感觉转够了”可靠。
收敛判定还跟异常值有关。磁场读数偶尔会跳出一个很大的值，如果你直接把它当最大值，偏移就会被拉偏。常见的处理思路是：采集时记录原始极值，写入前做一次合理性检查，比如看最大值和最小值是否大致对称、中点是否落在预期附近；如果某一轴的极值明显离群，宁可重新采集，不要硬写。校准不是“有数就行”，极值错了，中点就错了，后面航向漂移只是结果。
平面校准和三维校准的收敛标准也不一样。平面校准只要求 X、Y 极值稳定，Z 轴极值稳定与否参考意义有限；三维校准要求三轴极值都稳定。你在平面场景下用三维校准，可能转了很久 Z 轴极值还是变化不大，这不是算法失效，而是运动路径没有给 Z 轴足够激励。反过来，在大俯仰场景下用平面校准，X、Y 可能稳定了，Z 轴却没覆盖，写进去的 HzOffset 只是局部样本的中点。校准方法要跟设备实际运动范围匹配，这是整个机制里最容易被忽略的设计前提。
3. 加速度与寄存器：从 2048 零偏到 0xff 0xaa 帧
3.1 水平放置时为什么期望 0,0,2048
加速度校准的物理前提比重力更直接：模块水平放置时，重力只作用在 Z 轴，X、Y 轴理论上为 0g，Z 轴为 1g。输入给出的期望输出是[0g, 0g, 1g]，转换成传感器输出值就是[0, 0, 2048]。这里的 2048 是 1g 对应的输出刻度，不是随便定的常数；校准要做的，是把实际读到的ax0, ay0, az0和这个期望值比较，算出常值偏差e = [ax0, ay0, az0 - 2048]。
注意这个公式只减了 Z 轴的 2048，X、Y 轴减的是 0。因为水平放置时 X、Y 的期望就是 0，所以误差就是读数本身。这个细节看起来简单，实际调试时经常有人把三轴都减 2048，或者把 Z 轴忘了减，写进去的偏移直接错一个量级。加速度零偏是常值偏差，不是比例误差；它不修正灵敏度，只修正零点。水平放置、多次读取、取平均，都是为了把随机噪声压下去，让ax0, ay0, az0更接近真实零偏。
为什么要多次读取后取平均？单次采样会受振动、桌面不平、传感器噪声影响。你读一次就写偏移，等于把一次噪声固化成常值补偿。多次平均不能消除桌面倾斜带来的系统性误差，但能降低随机抖动。实际做的时候，模块要真的放平，最好用水平仪或已知平面确认；如果桌面本身有 1 度倾斜，X、Y 轴就会读到重力分量，算出来的 ex、ey 会把倾斜当成零偏补进去，后面水平放置反而不准。
3.2 多读平均与常值偏差的符号
加速度校准的指令顺序是：先把 0x05、0x06、0x07 三个偏移寄存器写 0，指令分别是0xff 0xaa 0x05 0x00 0x00、0xff 0xaa 0x06 0x00 0x00、0xff 0xaa 0x07 0x00 0x00，每条间隔 100ms；然后水平放置，读取当前加速度值，多次读取后取平均，记下ax0, ay0, az0；计算e = [ax0, ay0, az0 - 2048]；再把 ex、ey、ez 写回 0x05、0x06、0x07，低字节在前、高字节在后；最后发0xff 0xaa 0x00 0x00 0x00保存。
这里最需要验证的是符号。不同固件对 offset 的约定可能是“输出减去偏移”，也可能是“输出加上偏移”。输入给出的流程是按这套指令表的约定写的补偿量，但你在实际模块上写入后，一定要回读水平放置的 az：如果 az 从 2100 变成 2048 附近，说明符号和量纲都对；如果从 2100 变成 2152，说明补偿方向反了，应该写负值或调整固件约定。不要只凭公式想当然，传感器寄存器里的符号约定是黑匣子，回读才是证据。
多读平均的另一个作用是判断稳定性。连续读若干次，如果ax0在几个 LSB 内跳，平均值可信；如果跳动很大，先查供电、振动和安装，不要急着写偏移。写入的 ex、ey、ez 是整数偏移，通常按有符号 16 位处理，低字节在前、高字节在后。你算出来是浮点，写入前要转成整数；转的时候注意负数的补码表示，别把 -5 写成 65531 的低字节还怪模块不认。代码里用value & 0xFFFF就是为了把有符号值压进两个字节。
3.3 写偏移帧：地址、低字节、高字节
模块的写寄存器帧格式是0xff 0xaa addr dataL dataH。帧头两个字节固定，addr是寄存器地址，dataL是数据低字节，dataH是高字节。比如写 X 轴加速度偏移到 0x05，就是0xff 0xaa 0x05 exL exH；写 Y 轴到 0x06，写 Z 轴到 0x07。磁场偏移对应 0x0b、0x0c、0x0d。保存配置是0xff 0xaa 0x00 0x00 0x00，地址 0x00 对应 SAVE。
关键寄存器可以整理成下面这张表，调试时对着看比翻长附表快：
| 寄存器 | 地址 | 用途 |
|---|---|---|
| SAVE | 0x00 | 保存当前配置 |
| AXOFFSET | 0x05 | X 轴加速度偏移 |
| AYOFFSET | 0x06 | Y 轴加速度偏移 |
| AZOFFSET | 0x07 | Z 轴加速度偏移 |
| HXOFFSET | 0x0b | X 轴磁场偏移 |
| HYOFFSET | 0x0c | Y 轴磁场偏移 |
| HZOFFSET | 0x0d | Z 轴磁场偏移 |
| READADDR | 0x27 | 设置要读取的起始寄存器地址 |
构造写帧的代码不复杂，但字节序和负数处理必须一次写对：
def write_reg_frame(addr, value): # value 按有符号 16 位处理，低字节在前、高字节在后 v = value & 0xFFFF return bytes([0xFF, 0xAA, addr, v & 0xFF, (v >> 8) & 0xFF]) # 写 X 轴加速度偏移 -5，等价于补码 0xFFFB frame = write_reg_frame(0x05, -5) print(frame.hex()) # ffaa05fbff这段代码的输出是ffaa05fbff，其中fb是低字节，ff是高字节。如果你把高低字节写反，模块收到的值会变成 0xFBFF，偏移直接跑飞。每个写指令之间留 100ms，是为了给模块留处理时间；连续猛发，容易出现“最后一条生效、前面几条丢了”的现象。写完后不要立刻断电，先回读确认，再发保存指令。
3.4 READADDR 与 0x55 0x5f 返回包
读寄存器的机制是“先写地址，再收数据”。往 READADDR（0x27）写入要读取的起始地址，比如读 0x05，就发0xff 0xaa 0x27 0x05 0x00。模块收到后返回一个数据包：0x55 0x5f D1L D1H D2L D2H D3L D3H D4L D4H SUM。其中 D1 是刚才写入的寄存器的内容，D2、D3、D4 分别是 D1 后面的寄存器内容。比如起始地址是 0x05，那么 D1 是 AXOFFSET（0x05），D2 是 AYOFFSET（0x06），D3 是 AZOFFSET（0x07），D4 是 GXOFFSET（0x08）。
这个“一次读四个寄存器”的设计很实用：你写一次 READADDR，就能连续拿到四个地址的值，减少串口往返。解析时先检查帧头0x55 0x5f，再按两个字节一组还原成有符号 16 位整数，最后处理 SUM。SUM 的具体算法输入没有展开，常见实现思路是把帧头到 D4H 逐字节累加取低 8 位；如果你按这个算对不上，先不要怀疑数据错，查一下模块协议版本或校验范围，别把校验字节当成数据。
def parse_read_packet(buf): # 返回包长度固定为 11：2 字节帧头 + 4 个 16 位寄存器 + 1 字节 SUM assert len(buf) == 11 assert buf[0] == 0x55 and buf[1] == 0x5F values = [] for i in range(2, 10, 2): # 小端、有符号 16 位；D1..D4 对应起始地址及其后三个寄存器 values.append(int.from_bytes(buf[i:i + 2], "little", signed=True)) # 常见 SUM：前 10 字节累加取低 8 位；具体以模块协议为准 return values, buf[10]解析代码里用signed=True是因为偏移值可能是负数。values[0]对应 D1，values[1]对应 D2，以此类推。读 0x05 时，values依次是 AXOFFSET、AYOFFSET、AZOFFSET、GXOFFSET；读 0x0b 时，依次是 HXOFFSET、HYOFFSET、HZOFFSET、D0MODE。读之前先想清楚起始地址和后面三个寄存器是什么，别读到跨功能区的值还当成偏移用。返回包对不上时，先抓原始十六进制，确认帧头、长度、字节序，再谈算法。
3.5 保存配置：0x00 不是可省略的一步
写偏移和保存配置是两件事。写 0x05、0x0b 这些寄存器，改变的是当前运行配置；发0xff 0xaa 0x00 0x00 0x00才是保存到模块的非易失存储。很多人调完偏移，读回来是对的，断电重启又回到旧值，就是因为少了保存指令。保存不是“写完了顺便发一下”，它是校准流程的独立阶段：先写偏移，回读确认，再保存，保存后等模块处理完再断电。
保存指令同样要留时间。发完0xff 0xaa 0x00 0x00 0x00立刻拔电，模块可能还没把配置写进去；表现就是“有时候保存成功，有时候丢失”，看起来像玄学。稳妥做法是保存后延时一段时间，再重新上电回读寄存器。回读不仅能确认保存成功，还能发现写入值被截断、符号反了、高低字节颠倒这些问题。校准的最后一公里不是算公式，是确认配置真的落盘。
4. 避坑与排查：校准结果漂移、符号反了、保存失效怎么定位
4.1 现象：写完偏移，读数像没变
现象是发完写偏移指令，回读寄存器也显示新值，但输出数据几乎没变化。原因通常有三类：旧偏移没有清零，新偏移只是在旧值上叠加；写入地址和读取地址不是同一个功能区，比如把磁场偏移写到了加速度偏移；指令间隔不够，模块丢帧，最后一条生效、前面几条没生效。解决时先把三轴偏移全部写 0，等 100ms，再回读确认清零成功；然后逐轴写偏移，每写一条回读一条；最后保存并重新上电验证。不要一次连发六条指令再回头查，出了问题根本不知道丢的是哪一条。
4.2 现象：水平放置 az 仍显著偏离 2048
现象是加速度校准后水平放置，az 还是 2100 多或者 1990 多，X、Y 也不接近 0。原因可能是符号约定反了、写入值没有按有符号 16 位小端处理、模块没有真正水平、或者读取平均时桌面有振动。解决时先看写入前后的 az 变化方向：如果越补越远，说明符号反了，试写相反数；如果变化很小，检查高低字节是否颠倒；如果三轴都偏，先用水平仪确认安装面。加速度校准最怕把倾斜当零偏，桌面不平带来的 X、Y 分量会被永久写进偏移，后面怎么调都不对。
4.3 现象：磁力计航向随位置变化
现象是平面校准后，模块稍微俯仰或滚转，航向就漂。原因是平面校准只绕 Z 轴采集，Z 轴极值覆盖不足，HzOffset 不可信；或者设备实际俯仰、滚转变化大，已经超出平面校准的适用边界。解决时改用三维校准，按绕 X、绕 Y、绕 Z 再随意旋转的顺序采集，确认三轴极值都稳定后再算中点。如果三维校准后还漂，查周围磁干扰和软铁形变：min/max 中点只补平移，补不了椭圆。校准环境要带着最终安装的磁体，线缆和金属件位置固定，别在校准后随手挪动。
4.4 现象：READADDR 返回包对不上
现象是发0xff 0xaa 0x27 0x05 0x00后，收到的数据帧头不是0x55 0x5f，长度不对，或者 SUM 校验失败。原因可能是 READADDR 地址写错、串口波特率或帧间隔不匹配、返回包被截断、SUM 算法按错范围算。解决时先抓原始字节，不要只打印解析后的数值；确认帧头、长度 11 字节、D1 到 D4 的小端顺序；再用已知寄存器做对照，比如读 0x05 应该拿到 AXOFFSET、AYOFFSET、AZOFFSET、GXOFFSET。如果 SUM 对不上但数据看起来合理，先查协议校验范围，别急着重写解析器。
4.5 现象：重启后校准丢失
现象是校准完读回来都对，断电重启又回到旧偏移。原因通常是没有发保存指令，或者保存后立刻断电，模块还没写完；也可能是保存前没有回读确认，写进去的值本来就是错的。解决时把流程固定成：清零、采集、计算、写偏移、逐轴回读、发保存、延时、重新上电回读。保存指令0xff 0xaa 0x00 0x00 0x00不是可选项，校准的“后悔药”就是保存后还能回读验证。别在保存后马上拔电，这个习惯能省很多莫名其妙的返工。
5. 设计取舍：为什么偏移校准不替你做完整椭球拟合
输入给出的校准算法是极值中点法，不是完整椭球拟合。这个取舍很清楚：极值中点只需要统计最大、最小，计算量小，逻辑可解释，适合资源有限的嵌入式场景；它补的是硬铁平移，对安装偏移、芯片失调这类常值误差有效。完整椭球拟合会同时估计球心、轴缩放和旋转，能补软铁形变，但需要更密集的采样、更复杂的数值计算，还要处理异常点和病态矩阵。对很多只要求航向大致稳定的设备来说，min/max 中点已经够用，复杂拟合反而增加调试成本。
| 方法 | 补什么 | 代价 | 适用边界 |
|---|---|---|---|
| 极值中点 | 硬铁平移 | 低，易实现 | 采样覆盖完整、软铁干扰小 |
| 椭球拟合 | 平移加软铁形变 | 高，需数值求解 | 干扰复杂、精度要求高 |
真正需要警惕的是把简单方法用在不匹配的场景：平面校准拿去补大俯仰，极值没覆盖就写偏移；加速度只读一次就写零偏，把噪声固化；写完不保存、不回读，把时序问题当成算法问题。我的习惯是每次校准都强制走一遍“清零、采集、回读、保存、重启验证”，不管模块看起来多听话。从那以后我每次做这类校准，都会先把偏移清零和回读验证做成固定步骤，再谈精度。希望帮到你。
本文还有配套的精品资源，点击获取
