企业官网建设流程全解析

简介：这份资源围绕JY901模块的校准算法展开，面向使用MPU9050传感器进行姿态解算的嵌入式开发者与飞控爱好者，重点解决磁场与加速度输出存在零偏、导致航向角与姿态角不准的问题。内容以磁场校准和加速度校准两条主线组织，涵盖偏移值置零、最大最小值统计、偏移量计算、寄存器写入与配置保存等完整流程，并区分平面校准与三维校准两种适用场景，同时给出READADDR读取寄存器的指令格式与返回数据包解析方式，附有从SAVE到READADDR等寄存器地址定义表，便于直接对照开发。资源包为1个docx文档，大小约16KB，结构紧凑、查阅方便。目前已有699人学习下载，适合需要快速完成传感器校准、排查磁干扰与零偏问题的中初级开发者参考使用。

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

模块装到设备上，静止时航向角却慢慢漂移，水平放置时俯仰角读数不是零，这种问题在姿态传感器调试里太常见了。jy901 校准算法针对的就是这类零偏问题，它面向 MPU9050 这类带磁力计和加速度计的九轴模块，通过磁场校准和加速度校准两步，把三轴磁场偏移值和三轴加速度常值偏差写进模块寄存器，让输出数据回到可信区间。这套算法适合做嵌入式姿态解算、云台稳定、机器人航向控制的从业者，尤其是那些发现模块出厂校准不够用、现场安装后磁干扰严重、或者换了安装位置后数据明显跑偏的人。它不涉及复杂的滤波理论，核心就是统计极值、算中点、写寄存器，但每一步的时序和字节序都有讲究，下面把整个流程拆开讲清楚。

2. 磁场校准：平面法和三维法怎么选、极值怎么统计

磁场校准的本质是找硬磁干扰的偏移量。模块周围如果有铁质结构、电机、扬声器，磁场分布会被扭曲，三轴读数不再以零为中心，而是整体平移了一个固定值。校准就是把这个平移量测出来，写进 HXOFFSET、HYOFFSET、HZOFFSET 三个寄存器，模块在输出前会自动减掉这个偏移。

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

平面校准适用于模块在平面内工作、俯仰和滚转变化很小的场景，比如地面机器人、扫地机、AGV 小车。操作时把模块放平，绕 Z 轴缓慢旋转 360 度，同时统计三轴磁场最大值和最小值，直到极值不再变化。三维校准则用于俯仰和滚转变化较大的场景，比如手持云台、无人机、机械臂末端。操作顺序是绕 X 轴缓慢转 360 度，再绕 Y 轴转 360 度，再绕 Z 轴转 360 度，最后随意翻转几圈，同样统计极值直到稳定。

选哪种方法不看模块型号，看实际工况。如果设备在运行中俯仰角不超过正负 15 度，平面校准足够；如果会大角度倾斜甚至倒置，必须用三维校准，否则 Z 轴偏移量算不准，航向角在倾斜时会出现明显误差。常见做法是先在平面校准一遍，再拿三维校准复核，如果两者算出的 HxOffset 差异超过 50 个 LSB，说明安装环境磁干扰复杂，建议直接采用三维校准结果。

2.2 统计极值的实操细节与代码框架

统计极值不是简单读几次就行，需要持续采样并更新最大最小值。下面是一段常见的处理逻辑，跑在 MCU 上，通过串口读模块输出帧，解析出 HX、HY、HZ 原始值后更新极值。

// 磁场极值统计结构体 typedef struct { int16_t hx_max, hx_min; int16_t hy_max, hy_min; int16_t hz_max, hz_min; } MagExtremes; MagExtremes mag_ext = {0}; // 初始化时把极值设成相反边界 void mag_extremes_init(void) { mag_ext.hx_max = -32768; mag_ext.hx_min = 32767; mag_ext.hy_max = -32768; mag_ext.hy_min = 32767; mag_ext.hz_max = -32768; mag_ext.hz_min = 32767; } // 每读到一帧磁场数据就调用一次 void mag_extremes_update(int16_t hx, int16_t hy, int16_t hz) { if (hx > mag_ext.hx_max) mag_ext.hx_max = hx; if (hx < mag_ext.hx_min) mag_ext.hx_min = hx; if (hy > mag_ext.hy_max) mag_ext.hy_max = hy; if (hy < mag_ext.hy_min) mag_ext.hy_min = hy; if (hz > mag_ext.hz_max) mag_ext.hz_max = hz; if (hz < mag_ext.hz_min) mag_ext.hz_min = hz; } // 判断极值是否稳定：连续 N 次更新极值变化小于阈值 uint8_t mag_extremes_stable(void) { static int16_t last_hx_max = 0, last_hx_min = 0; static int16_t last_hy_max = 0, last_hy_min = 0; static int16_t last_hz_max = 0, last_hz_min = 0; static uint8_t stable_cnt = 0; int16_t delta = 0; delta += abs(mag_ext.hx_max - last_hx_max); delta += abs(mag_ext.hx_min - last_hx_min); delta += abs(mag_ext.hy_max - last_hy_max); delta += abs(mag_ext.hy_min - last_hy_min); delta += abs(mag_ext.hz_max - last_hz_max); delta += abs(mag_ext.hz_min - last_hz_min); last_hx_max = mag_ext.hx_max; last_hx_min = mag_ext.hx_min; last_hy_max = mag_ext.hy_max; last_hy_min = mag_ext.hy_min; last_hz_max = mag_ext.hz_max; last_hz_min = mag_ext.hz_min; if (delta < 10) { // 阈值根据实际噪声调整 stable_cnt++; if (stable_cnt >= 20) return 1; } else { stable_cnt = 0; } return 0; }

这段代码的关键参数是稳定判定阈值和连续稳定次数。阈值设太小，噪声会让判定永远不通过；设太大，极值还没采全就提前结束。我一般先用 10 和 20 试，如果模块噪声大就放宽到 20 和 30。另外注意，旋转速度要慢，每秒 30 到 60 度比较合适，太快会漏掉极值点。

2.3 偏移量计算与寄存器写入

极值稳定后，按公式算偏移量：

int16_t hx_offset = (mag_ext.hx_max + mag_ext.hx_min) / 2; int16_t hy_offset = (mag_ext.hy_max + mag_ext.hy_min) / 2; int16_t hz_offset = (mag_ext.hz_max + mag_ext.hz_min) / 2;

然后拆成高低字节写入。发送指令前，先把三个偏移寄存器清零，指令间隔 100ms：

# 清零磁场偏移寄存器 0xff 0xaa 0x0b 0x00 0x00 0xff 0xaa 0x0c 0x00 0x00 0xff 0xaa 0x0d 0x00 0x00

写入时，HxOffsetL 是低字节，HxOffsetH 是高字节：

uint8_t hx_l = hx_offset & 0xFF; uint8_t hx_h = (hx_offset >> 8) & 0xFF; // 同理算 hy_l, hy_h, hz_l, hz_h

发送写入指令：

0xff 0xaa 0x0b hx_l hx_h 0xff 0xaa 0x0c hy_l hy_h 0xff 0xaa 0x0d hz_l hz_h

最后保存配置：

0xff 0xaa 0x00 0x00 0x00

注意每条指令间隔 100ms，这个延时不能省。模块内部处理指令需要时间，连续发送会导致部分指令被丢弃，表现就是写进去的偏移量不对，或者保存失败。

3. 加速度校准：水平放置与 2048 基准的换算逻辑

加速度校准比磁场校准简单，因为重力方向固定，只需要水平放置一次就能算出零偏。但简单不代表没坑，水平基准的精度直接决定后续姿态解算的准确性。

3.1 为什么基准是 2048 而不是 0

模块水平放置时，三轴加速度输出理论值是 0g、0g、1g。模块内部 ADC 是 16 位，量程正负 2g 对应 32768 个 LSB，所以 1g 对应 16384 个 LSB？这里容易搞混。实际上 jy901 系列在默认配置下，加速度输出值是以 2048 对应 1g 的，这是模块固件的标定基准，不是原始 ADC 值。所以水平时 Z 轴应该是 2048，X 和 Y 轴是 0。误差就是实测值减去理论值：

int16_t ex = ax0 - 0; int16_t ey = ay0 - 0; int16_t ez = az0 - 2048;

如果模块输出的是原始 ADC 值，基准会不同，但按项目正文的说明，这里统一用 2048 作为 1g 的对应值。

3.2 多次读取取平均的代码实现

单次读取受噪声影响大，常见做法是连续读 50 到 100 次，去掉最大最小各 10%，剩下的取平均。下面是一个简化版：

#define SAMPLE_NUM 64 int16_t acc_sample(int16_t *buf, uint8_t n) { int32_t sum = 0; // 简单排序后去掉两端各 6 个 for (int i = 0; i < n - 1; i++) { for (int j = 0; j < n - 1 - i; j++) { if (buf[j] > buf[j+1]) { int16_t tmp = buf[j]; buf[j] = buf[j+1]; buf[j+1] = tmp; } } } for (int i = 6; i < n - 6; i++) { sum += buf[i]; } return (int16_t)(sum / (n - 12)); }

调用时分别对 AX、AY、AZ 采样：

int16_t ax_buf[SAMPLE_NUM], ay_buf[SAMPLE_NUM], az_buf[SAMPLE_NUM]; for (int i = 0; i < SAMPLE_NUM; i++) { ax_buf[i] = read_register16(AX); ay_buf[i] = read_register16(AY); az_buf[i] = read_register16(AZ); delay_ms(10); } int16_t ax0 = acc_sample(ax_buf, SAMPLE_NUM); int16_t ay0 = acc_sample(ay_buf, SAMPLE_NUM); int16_t az0 = acc_sample(az_buf, SAMPLE_NUM);

采样间隔 10ms 是为了让每次读取独立，避免连续读取时数据寄存器还没更新。如果模块输出速率是 100Hz，10ms 刚好对应一个输出周期。

3.3 写入加速度偏移寄存器

清零指令：

0xff 0xaa 0x05 0x00 0x00 0xff 0xaa 0x06 0x00 0x00 0xff 0xaa 0x07 0x00 0x00

写入误差值：

0xff 0xaa 0x05 ex_l ex_h 0xff 0xaa 0x06 ey_l ey_h 0xff 0xaa 0x07 ez_l ez_h

保存：

0xff 0xaa 0x00 0x00 0x00

同样每条间隔 100ms。写完后重新读取 AXOFFSET、AYOFFSET、AZOFFSET 寄存器验证，读回来的值应该和写入的一致。

4. 寄存器读写与验证：READADDR 的用法和返回帧解析

校准写完不代表结束，必须读回来验证。jy901 的寄存器读取机制是两段式：先往 READADDR 写目标地址，模块返回一个包含连续四个寄存器内容的数据包。

4.1 读取指令的构造与返回帧格式

要读 0x05 寄存器，发送：

0xff 0xaa 0x27 0x05 0x00

模块返回：

0x55 0x5f D1L D1H D2L D2H D3L D3H D4L D4H SUM

D1 是 0x05 的内容，D2 是 0x06，D3 是 0x07，D4 是 0x08。SUM 是从帧头到 D4H 的校验和，取低八位。解析时先找 0x55 0x5f 帧头，再读 8 个数据字节，最后校验。

uint8_t parse_read_response(uint8_t *buf, int16_t *d1, int16_t *d2, int16_t *d3, int16_t *d4) { if (buf[0] != 0x55 || buf[1] != 0x5f) return 0; uint8_t sum = 0; for (int i = 0; i < 10; i++) sum += buf[i]; if (sum != buf[10]) return 0; // 校验失败 *d1 = (int16_t)((buf[3] << 8) | buf[2]); *d2 = (int16_t)((buf[5] << 8) | buf[4]); *d3 = (int16_t)((buf[7] << 8) | buf[6]); *d4 = (int16_t)((buf[9] << 8) | buf[8]); return 1; }

注意字节序是小端，低字节在前。校验和是累加取低八位，不是异或。

4.2 验证校准结果的三个检查点

写完偏移量后，至少做三个验证。第一，读回偏移寄存器，确认写入值和计算值一致。第二，把模块水平静止放置，读加速度输出，AX 和 AY 应该接近 0，AZ 接近 2048，偏差在正负 20 以内算正常。第三，缓慢旋转模块一圈，读航向角，如果航向角线性变化且没有跳变，说明磁场校准有效。

如果读回的偏移值和写入值不一致，先检查指令间隔是否够 100ms，再检查保存指令是否发送成功。保存指令 0xff 0xaa 0x00 0x00 0x00 必须在校准数据写入后发送，否则断电后配置丢失。

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

5.1 现象：写入偏移后数据反而更偏

原因：高低字节搞反了。比如偏移量是 0x012C，低字节是 0x2C，高字节是 0x01，如果发成 0x01 0x2C，模块解析出的偏移量完全错误。

解决：写个打印函数，把计算出的偏移量按十六进制打印出来，再对照发送的指令逐字节核对。常见做法是先把偏移量转成 uint16_t，再用位运算取高低字节，不要手动拆分。

5.2 现象：极值统计永远不稳定

原因：旋转速度太快，或者模块安装松动导致额外振动噪声。另外，如果周围有电机或扬声器在工作，磁场本身在变化，极值也会一直更新。

解决：旋转速度控制在每秒 30 到 60 度，校准期间关闭周围的大功率设备。如果条件不允许，把稳定判定阈值从 10 放宽到 30，连续稳定次数从 20 降到 10，牺牲一点精度换稳定性。

5.3 现象：加速度校准后水平放置仍有较大偏差

原因：模块没有真正水平，或者水平基准面本身有倾斜。另一个常见原因是采样时模块还在晃动，平均值不能代表静止状态。

解决：用气泡水平仪确认安装面水平，采样前等待模块静止至少 2 秒。如果安装面无法调整，记录倾斜角度，在后续姿态解算里做补偿，而不是强行用加速度校准去修正。

5.4 现象：保存指令发送后断电，配置丢失

原因：保存指令没有真正执行，或者模块供电在保存过程中掉电。jy901 保存配置需要一定时间，发送保存指令后至少等待 200ms 再断电。

解决：发送保存指令后，读一次 SAVE 寄存器确认状态，或者延时 500ms 再断电。如果模块有复位引脚，保存后执行一次软复位，再读寄存器确认配置还在。

5.5 现象：READADDR 返回的数据包校验失败

原因：串口波特率不匹配，或者读取时模块正在输出其他数据帧，导致帧头错位。另外，如果 READADDR 写入的地址超过有效范围，模块可能返回异常数据。

解决：确认串口波特率和模块配置一致，读取寄存器前先暂停模块的连续输出模式，或者用中断接收完整数据包再解析。地址范围参考寄存器表，0x00 到 0x63 是有效地址，超出范围不要写。

6. 把校准参数固化到产线流程：一个可复用的自动化脚本思路

单次手动校准只能解决一台设备的问题，如果做小批量生产，每台都要重复旋转、统计、写入，效率太低。我一般会写一个上位机脚本，通过串口自动完成整个流程，操作员只需要按提示旋转模块。

脚本的核心逻辑分四步：第一步，发送清零指令，把六个偏移寄存器全部置零。第二步，进入极值统计循环，每 50ms 读一次磁场和加速度数据，更新极值，同时检测稳定条件。第三步，稳定后计算偏移量，按协议写入并保存。第四步，读回寄存器验证，打印校准报告。

下面是一个 Python 脚本的骨架，用 pyserial 实现：

import serial import time import struct ser = serial.Serial('COM3', 9600, timeout=0.1) def send_cmd(cmd_bytes): ser.write(bytes(cmd_bytes)) time.sleep(0.1) # 指令间隔 100ms def read_mag(): # 发送读取 HX 寄存器指令，HX=0x3a send_cmd([0xff, 0xaa, 0x27, 0x3a, 0x00]) resp = 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(): # 清零 send_cmd([0xff, 0xaa, 0x0b, 0x00, 0x00]) send_cmd([0xff, 0xaa, 0x0c, 0x00, 0x00]) send_cmd([0xff, 0xaa, 0x0d, 0x00, 0x00]) hx_max = hy_max = hz_max = -32768 hx_min = hy_min = hz_min = 32767 stable_count = 0 last_ext = (0, 0, 0, 0, 0, 0) print("请绕 X 轴缓慢旋转 360 度...") while True: data = read_mag() if data is None: continue hx, hy, hz = data hx_max = max(hx_max, hx); hx_min = min(hx_min, hx) hy_max = max(hy_max, hy); hy_min = min(hy_min, hy) hz_max = max(hz_max, hz); hz_min = min(hz_min, hz) cur_ext = (hx_max, hx_min, hy_max, hy_min, hz_max, hz_min) delta = sum(abs(a - b) for a, b in zip(cur_ext, last_ext)) last_ext = cur_ext if delta < 10: stable_count += 1 if stable_count > 20: break else: stable_count = 0 time.sleep(0.05) hx_off = (hx_max + hx_min) // 2 hy_off = (hy_max + hy_min) // 2 hz_off = (hz_max + hz_min) // 2 # 写入偏移量 for reg, val in [(0x0b, hx_off), (0x0c, hy_off), (0x0d, hz_off)]: low = val & 0xFF high = (val >> 8) & 0xFF send_cmd([0xff, 0xaa, reg, low, high]) send_cmd([0xff, 0xaa, 0x00, 0x00, 0x00]) print(f"磁场校准完成: HxOffset={hx_off}, HyOffset={hy_off}, HzOffset={hz_off}")

这个脚本的关键参数是稳定判定阈值 delta 和连续稳定次数。实际跑的时候，如果模块噪声大，把 delta 调到 20 到 30。另外，read_mag 函数里每次读取都发送 READADDR 指令，会占用串口带宽，如果模块输出速率高，可以改成监听模式，直接解析模块主动输出的数据帧，效率更高。

加速度校准的自动化更简单，因为不需要旋转，只需要水平放置后采样。把采样、平均、写入、保存串起来就行。产线使用时，建议把磁场校准和加速度校准分开做，先做加速度校准，再做磁场校准，因为磁场校准需要旋转，可能影响加速度的静止状态。

从那以后我每次做现场校准，都会先跑一遍自动化脚本，把校准报告存档，再手动复核关键寄存器。这样即使后面数据出问题，也能快速定位是校准环节还是解算环节。希望帮到你。

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