JY901九轴模块校准实战：磁力计与加速度计零偏修正及寄存器写入

简介：这份资源围绕JY901（MPU9050）传感器的校准算法展开，面向嵌入式开发、姿态解算与惯性导航方向的工程师及学生，解决模块磁场与加速度输出存在零偏、影响姿态精度的问题。包内为1个docx文档，压缩包约16KB，篇幅精炼但内容完整，适合边看边对照寄存器操作。文档系统梳理了磁场校准与加速度校准两条主线：磁场部分涵盖平面校准与三维校准两种方式，并给出最大值最小值统计、偏移值计算及写入寄存器的完整指令；加速度部分说明水平放置读取均值、以【0,0,2048】为基准求常值偏差并写入偏移寄存器。此外还整理了READADDR读取寄存器的方法、返回数据包格式以及SAVE、CALSW、AXOFFSET等寄存器地址附表，便于快速查阅。目前已有701人学习下载，可作为JY901调试与校准的实用参考。

1. 拿到 jy901 校准算法先别急着烧录：它到底解决什么问题

模块装到设备上，静止放在桌面，Yaw 角却像喝醉一样慢慢漂；明明水平放着，Pitch 和 Roll 也有几度偏差。这类现象十有八九不是姿态解算算法写错了，而是磁力计和加速度计没做校准。jy901 校准算法针对的正是 MPU9050 这类九轴模块的原始零偏问题，通过统计磁场三轴的最大最小值算出硬磁偏移，再通过水平静置读取加速度输出算出零偏，最后把偏移量写回寄存器并保存。它适合做嵌入式姿态采集、云台稳定、机器人航向估计的从业者，尤其是那些发现“数据能读、角度不准”的开发者。整套流程不依赖上位机软件，纯串口指令就能完成，但前提是你得理解每一步在干什么，否则很容易把校准做成玄学。

2. 磁场校准：从平面到三维的偏移量计算与寄存器写入

2.1 为什么磁场校准必须先清零再统计极值

磁力计输出的是三轴磁场强度，理想情况下模块旋转一圈，每个轴的输出应该是一个以零为中心的正弦波。但实际模块受硬磁干扰（比如附近有扬声器磁铁、螺丝、电池）影响，正弦波会整体偏移一个直流分量。这个直流分量就是硬磁偏移，表现为 HxOffset、HyOffset、HzOffset。校准的本质就是把这个偏移找出来，让波形重新回到零中心。

算法要求先把三轴偏移寄存器写 0，目的是让模块输出原始未补偿值，这样统计到的最大值和最小值才反映真实硬磁干扰。如果跳过清零，模块内部可能还残留上一次的偏移，统计出来的极值会偏小，算出的新偏移就不准。清零指令间隔 100ms 是给模块内部 EEPROM 或寄存器写入留出处理时间，发太快会丢指令。

# 三轴磁场偏移清零，每条间隔 100ms ff aa 0b 00 00 # HXOFFSET 清零 ff aa 0c 00 00 # HYOFFSET 清零 ff aa 0d 00 00 # HZOFFSET 清零

这三条指令的帧头都是 0xff 0xaa，第三个字节是寄存器地址，后两个字节是写入值。0x0b、0x0c、0x0d 分别对应 HXOFFSET、HYOFFSET、HZOFFSET。注意这里写的是 0x00 0x00，表示偏移量为零。

2.2 平面校准与三维校准的适用边界

平面校准适用于模块在设备中基本保持水平、俯仰和滚转变化不超过 ±10° 的场景，比如扫地机器人、平衡车。操作时把模块放平，绕 Z 轴缓慢旋转 360°，同时用代码记录三轴磁场强度的最大值和最小值。旋转要慢，因为磁力计输出速率有限，转太快会漏掉极值点。判断标准是最大值和最小值不再变化，通常转两到三圈就能稳定。

三维校准适用于俯仰和滚转变化较大的场景，比如手持云台、无人机。操作顺序是绕 X 轴转 360°，再绕 Y 轴转 360°，再绕 Z 轴转 360°，最后随意翻转几圈。每一步都要缓慢，并且持续更新极值。三维校准能覆盖整个球面，算出的偏移更准确，但耗时更长，对操作者耐心有要求。

# 伪代码：统计三轴磁场极值 hx_max = hx_min = hy_max = hy_min = hz_max = hz_min = None def update_mag_extremes(hx, hy, hz): global hx_max, hx_min, hy_max, hy_min, hz_max, hz_min hx_max = hx if hx_max is None else max(hx_max, hx) hx_min = hx if hx_min is None else min(hx_min, hx) hy_max = hy if hy_max is None else max(hy_max, hy) hy_min = hy if hy_min is None else min(hy_min, hy) hz_max = hz if hz_max is None else max(hz_max, hz) hz_min = hz if hz_min is None else min(hz_min, hz) # 每次读取到磁场数据后调用 # 当极值连续 N 次不再变化时停止

这段逻辑的关键是持续更新，而不是只读一次。实际实现时，串口每收到一帧磁场数据就调用一次 update_mag_extremes，同时用一个计数器判断极值是否稳定。稳定判据可以设为连续 50 帧极值不变。

2.3 偏移量计算公式与高低字节拆分

偏移量公式是Offset = (Max + Min) / 2。这个公式的物理意义是：硬磁偏移让正弦波中心偏离零点的距离，正好等于最大值和最小值的算术平均。算出偏移后，需要拆成低字节和高字节写入寄存器。

def split_offset(offset): # 偏移量可能是负数，先转成 16 位补码 if offset < 0: offset = 0x10000 + offset offset_l = offset & 0xFF offset_h = (offset >> 8) & 0xFF return offset_l, offset_h hx_offset = (hx_max + hx_min) // 2 hy_offset = (hy_max + hy_min) // 2 hz_offset = (hz_max + hz_min) // 2 hx_l, hx_h = split_offset(hx_offset) hy_l, hy_h = split_offset(hy_offset) hz_l, hz_h = split_offset(hz_offset)

注意 Python 里整数除法用//，避免浮点误差。如果偏移量是负数，比如 -15，直接取低八位会出错，必须先转成 16 位补码。写入指令格式是ff aa 0b HxOffsetL HxOffsetH，其中 0x0b 是 HXOFFSET 寄存器地址，后面两个字节分别是低字节和高字节。三条写入指令同样间隔 100ms。

2.4 保存配置：为什么最后一条指令不能省

写完偏移值后，必须发送保存指令ff aa 00 00 00。0x00 是 SAVE 寄存器，写入任意值触发保存动作。如果不发这条，模块断电后偏移值丢失，下次上电又回到未校准状态。很多新手调试时发现“校准完当时准，重启就漂”，就是漏了这一步。保存操作需要几十毫秒，建议发完后延时 200ms 再断电或继续其他操作。

3. 加速度校准：水平静置取平均与常值偏差计算

3.1 加速度校准的物理前提：为什么必须是水平

加速度计测量的是重力加速度在三个轴上的分量。模块水平放置时，理想输出是 X 轴 0g、Y 轴 0g、Z 轴 1g。对应到 MPU9050 的 16 位输出，1g 对应 2048。所以水平静置时，三轴加速度理论值应该是 [0, 0, 2048]。实际模块因为焊接应力、芯片封装偏差，输出会偏离这个值，偏离量就是常值偏差。

校准的前提是模块必须严格水平。如果模块倾斜 1°，Z 轴输出会变化约 2048 × (1 - cos1°) ≈ 0.3，看起来不大，但 X 和 Y 轴会引入约 35 的偏差，直接污染校准结果。常见做法是用水平仪确认，或者放在大理石平台上。我一般会读十次取平均，减少噪声影响。

3.2 清零、读取、计算偏差的完整流程

先发三条清零指令，把 AXOFFSET、AYOFFSET、AZOFFSET 写 0。然后水平静置，连续读取加速度值。读取方式有两种：直接读 AX、AY、AZ 寄存器（0x34、0x35、0x36），或者用 READADDR 批量读。批量读效率更高，一次能拿四个寄存器。

# 读取加速度并取平均 import serial import struct ser = serial.Serial('COM3', 9600, timeout=0.1) def read_accel_avg(samples=10): ax_sum = ay_sum = az_sum = 0 for _ in range(samples): # 发送读取 AX 寄存器指令 ser.write(bytes([0xff, 0xaa, 0x27, 0x34, 0x00])) resp = ser.read(11) # 0x55 0x5f + 4*2 数据 + SUM if len(resp) == 11 and resp[0] == 0x55 and resp[1] == 0x5f: ax = struct.unpack('<h', resp[2:4])[0] ay = struct.unpack('<h', resp[4:6])[0] az = struct.unpack('<h', resp[6:8])[0] ax_sum += ax ay_sum += ay az_sum += az return ax_sum // samples, ay_sum // samples, az_sum // samples ax0, ay0, az0 = read_accel_avg(10) ex = ax0 - 0 ey = ay0 - 0 ez = az0 - 2048

这段代码先发 READADDR 指令，地址写 0x34（AX 寄存器），模块返回从 0x34 开始的四个寄存器内容：AX、AY、AZ、GX。我们只取前三个。struct.unpack('<h', ...)按小端模式解析有符号 16 位整数。取 10 次平均是为了平滑噪声，如果环境振动大，可以增加到 50 次。

3.3 偏差写入与保存的注意事项

算出的 ex、ey、ez 同样要拆成低字节和高字节。写入指令格式是ff aa 05 exL exH，0x05 是 AXOFFSET。三条写完后再发ff aa 00 00 00保存。这里有个容易翻车的点：加速度偏差和磁场偏移的寄存器地址不同，不要搞混。AXOFFSET 是 0x05，HXOFFSET 是 0x0b，中间隔了 GXOFFSET、GYOFFSET、GZOFFSET 三个陀螺仪偏移寄存器。

提示：如果写入后读取寄存器验证，发现值不对，先检查高低字节顺序。模块内部是小端存储，低字节在前。

4. 寄存器读取与验证：用 READADDR 批量回读校准结果

4.1 READADDR 指令格式与返回包解析

READADDR 寄存器地址是 0x27。要读取某个寄存器，先往 0x27 写目标地址，模块会返回从目标地址开始的连续四个寄存器内容。指令格式ff aa 27 目标地址 00，返回包格式55 5f D1L D1H D2L D2H D3L D3H D4L D4H SUM。SUM 是从 0x55 到 D4H 所有字节的累加和取低八位。

比如要验证磁场偏移是否写入成功，可以发ff aa 27 0b 00，返回的 D1 就是 HXOFFSET，D2 是 HYOFFSET，D3 是 HZOFFSET，D4 是 D0MODE。这样一次就能读完三个轴的偏移，效率比逐个读高。

def read_registers(start_addr): ser.write(bytes([0xff, 0xaa, 0x27, start_addr, 0x00])) resp = ser.read(11) if len(resp) != 11 or resp[0] != 0x55 or resp[1] != 0x5f: return None # 校验 SUM calc_sum = sum(resp[0:10]) & 0xFF if calc_sum != resp[10]: return None d1 = struct.unpack('<h', resp[2:4])[0] d2 = struct.unpack('<h', resp[4:6])[0] d3 = struct.unpack('<h', resp[6:8])[0] d4 = struct.unpack('<h', resp[8:10])[0] return d1, d2, d3, d4 # 验证磁场偏移 hx_off, hy_off, hz_off, _ = read_registers(0x0b) print(f"HXOFFSET={hx_off}, HYOFFSET={hy_off}, HZOFFSET={hz_off}")

校验 SUM 是必要步骤，串口通信可能受干扰导致数据错位。如果校验失败，重发指令即可。读取到的值应该和写入的偏移量一致，如果差很多，检查写入时的高低字节拆分是否正确。

4.2 校准效果验证：看 Yaw 漂移和 Roll/Pitch 静态误差

写完偏移并保存后，把模块重新水平静置，读取 Roll、Pitch、Yaw 三个角度寄存器（0x3d、0x3e、0x3f）。Roll 和 Pitch 应该在 0° 附近，波动不超过 ±0.5°。Yaw 角因为没有绝对参考，上电时会初始化为 0，但缓慢旋转模块时应该跟得上，不会出现跳变或卡死。

磁场校准效果可以通过旋转模块看 Yaw 是否线性变化来验证。如果 Yaw 在某个角度突然跳变，说明该方向的磁场极值没统计到，需要重新做三维校准。加速度校准效果可以通过倾斜模块看 Roll/Pitch 是否跟实际角度一致来验证，误差应在 1° 以内。

5. 避坑与排查：校准过程中最常见的五个翻车点

5.1 指令间隔不够导致寄存器写入失败

现象：发完清零指令后读回寄存器，发现值还是旧的。原因：模块内部处理指令需要时间，连续发送间隔小于 100ms 时，后一条指令可能在前一条还没写完时到达，被丢弃。解决：每条指令之间强制延时 100ms，保存指令后延时 200ms。用串口调试助手时，手动发送也要遵守这个间隔。

5.2 磁场校准旋转太快导致极值漏采

现象：校准后 Yaw 角在某些方向仍然不准，或者旋转时角度跳变。原因：磁力计输出速率通常 100Hz 左右，如果旋转速度超过每秒一圈，极值点可能落在两次采样之间，统计到的最大值偏小。解决：缓慢旋转，每秒不超过 90°，并且每个方向至少转两圈。用代码统计时，判断极值稳定的条件设为连续 50 帧不变。

5.3 加速度校准未水平导致 Z 轴偏差过大

现象：校准后 Roll 和 Pitch 静态误差超过 2°。原因：模块放置不水平，Z 轴输出偏离 2048，算出的 ez 包含了倾斜分量。解决：用水平仪确认模块水平，或者读取 Roll/Pitch 确认在 ±0.5° 以内再开始校准。如果条件有限，可以在校准后手动微调 ez，但不如重新水平放置来得准。

5.4 高低字节拆分错误导致偏移量写入异常

现象：写入偏移后读回，发现值变成很大的数或者符号相反。原因：负数偏移没有转成 16 位补码，直接取低八位导致高位丢失。解决：拆分前先判断符号，负数加 0x10000 再拆分。写入后立即用 READADDR 回读验证，发现不对就重新算。

5.5 忘记保存配置导致断电丢失

现象：校准完当时准确，模块断电重启后角度又漂了。原因：偏移值只写进了临时寄存器，没有触发 SAVE 保存到 Flash。解决：每次写完偏移后必须发ff aa 00 00 00，并且延时 200ms 再断电。可以在代码里把保存指令封装成函数，写完偏移自动调用。

6. 进阶技巧：把校准流程封装成可复用的自动化脚本

手动发指令校准一次还行，但批量生产或频繁调试时，手动操作容易漏步骤。我一般会把整个流程写成 Python 脚本，串口连接后自动完成清零、统计、计算、写入、保存、验证六个步骤。关键是把旋转统计做成交互式：脚本提示“请绕 Z 轴缓慢旋转”，同时后台持续读取磁场数据并更新极值，当极值稳定后自动进入下一步。

import serial import struct import time class JY901Calibrator: def __init__(self, port, baud=9600): self.ser = serial.Serial(port, baud, timeout=0.1) self.hx_max = self.hx_min = None self.hy_max = self.hy_min = None self.hz_max = self.hz_min = None def send_cmd(self, cmd_bytes, delay=0.1): self.ser.write(bytes(cmd_bytes)) time.sleep(delay) def clear_mag_offset(self): self.send_cmd([0xff, 0xaa, 0x0b, 0x00, 0x00]) self.send_cmd([0xff, 0xaa, 0x0c, 0x00, 0x00]) self.send_cmd([0xff, 0xaa, 0x0d, 0x00, 0x00]) def update_extremes(self, hx, hy, hz): self.hx_max = hx if self.hx_max is None else max(self.hx_max, hx) self.hx_min = hx if self.hx_min is None else min(self.hx_min, hx) self.hy_max = hy if self.hy_max is None else max(self.hy_max, hy) self.hy_min = hy if self.hy_min is None else min(self.hy_min, hy) self.hz_max = hz if self.hz_max is None else max(self.hz_max, hz) self.hz_min = hz if self.hz_min is None else min(self.hz_min, hz) def read_mag(self): self.ser.write(bytes([0xff, 0xaa, 0x27, 0x3a, 0x00])) resp = self.ser.read(11) if len(resp) == 11 and resp[0] == 0x55 and resp[1] == 0x5f: hx = struct.unpack('<h', resp[2:4])[0] hy = struct.unpack('<h', resp[4:6])[0] hz = struct.unpack('<h', resp[6:8])[0] return hx, hy, hz return None def calibrate_mag_3d(self): self.clear_mag_offset() print("请绕 X 轴缓慢旋转 360°，然后按回车") input() print("请绕 Y 轴缓慢旋转 360°，然后按回车") input() print("请绕 Z 轴缓慢旋转 360°，然后按回车") input() print("请随意翻转几圈，然后按回车") input() # 实际脚本中这里应该持续读取，简化版用固定采样 for _ in range(500): data = self.read_mag() if data: self.update_extremes(*data) time.sleep(0.01) hx_off = (self.hx_max + self.hx_min) // 2 hy_off = (self.hy_max + self.hy_min) // 2 hz_off = (self.hz_max + self.hz_min) // 2 self.write_offset(0x0b, hx_off) self.write_offset(0x0c, hy_off) self.write_offset(0x0d, hz_off) self.send_cmd([0xff, 0xaa, 0x00, 0x00, 0x00], delay=0.2) print(f"磁场校准完成: HX={hx_off}, HY={hy_off}, HZ={hz_off}") def write_offset(self, reg_addr, offset): if offset < 0: offset = 0x10000 + offset low = offset & 0xFF high = (offset >> 8) & 0xFF self.send_cmd([0xff, 0xaa, reg_addr, low, high]) if __name__ == "__main__": cal = JY901Calibrator('COM3') cal.calibrate_mag_3d()

这个脚本把三维磁场校准的交互流程固定下来，避免手动发指令时漏掉某一步。实际使用时，可以把input()换成定时器，或者用陀螺仪数据判断旋转是否覆盖了各个方向。加速度校准也可以类似封装，水平静置后自动读取 50 次取平均，算偏差写入保存。

验证环节我习惯在脚本最后加一段回读：用 READADDR 读 0x0b 和 0x05，确认写入的偏移和计算值一致。如果回读值不对，脚本直接报错退出，不进入下一步。从那以后我每次校准完都强制走一遍回读验证，再也没出现过“当时准、重启漂”的情况。希望帮到你。

本文还有配套的精品资源，点击获取