企业官网建设流程全解析

做嵌入式这几年，被问到最多的传感器大概就是 MPU6050。这颗六轴芯片配合 STM32 的 IIC 接口，几乎是所有姿态相关项目的标准开局：两轮自平衡、云台增稳、手势遥控、跌倒检测……不管你是刚入门的新手，还是在做毕业设计的同学，迟早都要跟它打交道。

这篇文章不打算给你抄一份现成代码就完事，而是想把你从“用库函数读寄存器”带到“知道自己在读什么、为什么这么读”的层面。我会从选型逻辑、电路连接、IIC 时序、寄存器配置、姿态解算一路讲到调试中真正会遇到的坑。全程按我平时做项目的习惯来，适合第一次碰 MPU6050 的人，也适合已经跑通 Demo 但发现数据不稳、角度乱飘的人。

先说结论：MPU6050 本身不复杂，真正的复杂度全在时序、信号质量和数据处理上。你把这三样理顺了，后面做平衡车、云台、体感控制都会顺很多。

1. 为什么是这个组合：需求、选型与 IIC 的适配逻辑

1.1 六轴传感器到底解决什么问题

经常有人把 MPU6050 当成“角度传感器”，这个理解并不准确。它实际包含两个测量单元：三轴加速度计和三轴陀螺仪。加速度计测的是三轴上的加速度分量，包含重力，所以静态时它可以通过重力在三个轴上的投影估算出当前倾斜角；陀螺仪测的是三轴角速度，对角速度积分就能得到角度增量。

关键是，这两者单独用都有明显缺陷。加速度计对振动和运动加速度非常敏感，你在静止状态算出的角度很准，但一旦带着设备走动或者电机转动，算出来的俯仰角、翻滚角会剧烈抖动。陀螺仪的积分不受运动加速度影响，响应也快，但积分会把零偏误差不断累积，几分钟之后角度就开始飘，而且越飘越远。

六轴组合的价值就在于把两者融合起来：陀螺仪负责短期变化，加速度计负责长期修正。这也是为什么 MPU6050 能成为平衡车、云台、手势识别这些项目的首选。它本质上解决的是“如何稳定、低延迟地获得物体姿态”的问题，而不是单纯“测加速度”或“测角速度”。

我经常用一句话解释给同事听：加速度计像你闭眼站在原地感知重力的方向，噪声大但不会跑偏；陀螺仪像你的内耳前庭，能快速感知旋转，但时间长了会晕、会累积误差。六轴融合就是让它们互相纠正，一个管快，一个管稳。

1.2 通信接口选型：IIC 为什么是默认选项

MPU6050 支持 IIC 和 SPI 两种通信方式，很多模块上两种接口都会引出。实际项目中我绝大多数时间用 IIC，原因很实际：只需要两根信号线，而且几乎每一颗 STM32 芯片都带硬件 I2C 外设，驱动代码也成熟，不占用额外引脚资源。

有人会问：SPI 不是更快吗？对，SPI 时钟可以跑到 1MHz 以上，但我用 MPU6050 做姿态解算时，数据量其实很小。六轴原始数据 14 个字节，就算按 1kHz 采样率读取，IIC 100kHz 模式也完全够用。我用 400kHz 快速模式读一次数据，实际占用总线时间不到 1ms，对大多数控制循环来说压力很小。只有在需要频繁读取 FIFO 且要求极低延迟的场景下，SPI 的优势才明显，而且那样会多占两根引脚。

另外一个不能忽略的点是模块生态。市面上几乎所有 MPU6050 模块都把 SCL、SDA、VCC、GND 引出，板载还带稳压和上拉电阻，接线非常统一。哪怕你自己画板，IIC 接口也只需要从主控引出两根线，布线简单得多。

IIC 在调试上的可观测性也更好。你可以用逻辑分析仪直接抓 SCL 和 SDA 上的波形，看起始条件、设备地址、ACK/NACK 标志，问题定位很快。SPI 虽然也能抓，但四根线加片选，分析起来要麻烦不少。

1.3 数据链路全景：从寄存器到角度输出

很多人第一次接触 MPU6050 容易一头扎进代码里，先看函数调用，再看寄存器读写，最后发现数据出来还是乱的。我建议先建立一张数据链路的图景，后面所有操作都是在往这条链路的各个节点填细节。

整个链路是这样的：传感器内部的 MEMS 结构感知物理运动，模拟信号经过片内 AD 转换变成数字量，持续更新到一组数据寄存器中；主控通过 IIC 总线读出这些寄存器字节；然后根据量程配置把原始整数换算成有物理单位的加速度和角速度；接着通过互补滤波或 DMP 解算成姿态角；最后姿态角进入控制算法或者通过串口送到上位机显示。

这个过程里，寄存器、IIC 读写、单位换算、姿态融合，每个环节都可能出问题。我以前遇到过一个调试案例：数据读回来了，但角度明显偏置，查到最后是加速度计量程配置和换算灵敏度对不上。这类问题不会报错，只能靠你对整条链路的理解去排查。所以后面几节我会按这条链路一步步展开，每步都讲清楚为什么这么做。

2. 电路连接与 IIC 时序：信号质量决定调试效率

2.1 接线和上拉电阻：两个最容易出问题的位置

软件写了一大堆，结果模块一点反应都没有，这种问题十有八九出在硬件连接上。MPU6050 模块的接线不复杂，就四根线：VCC 接 3.3V、GND 接地、SCL 接主控的 I2C 时钟引脚、SDA 接数据引脚。

但这里有几个细节需要注意。第一，MPU6050 芯片的 VLogic 供电范围是 1.71V 到 3.45V，设计上是 3.3V 供电，不要图省事直接接 5V，长期超压会损坏芯片。市面模块如果标注支持 5V，通常是因为板上有稳压芯片，你看清楚模块的稳压器型号再决定。我调试时习惯统一用 3.3V，这样最不容易出错。

第二，IIC 总线上必须要有上拉电阻。这是因为 IIC 协议要求 SDA 和 SCL 都是开漏结构，只能拉低，不能主动拉高。模块出厂时一般已经焊好了上拉电阻，常见阻值是 4.7kΩ 或 2.2kΩ。但如果你的板子是自己画的，或者模块被阉割过，上拉电阻缺失会导致通信完全失败，表现为 IIC 设备地址扫描不到。

上拉电阻阻值选择也有讲究。阻值太大，总线上升沿变慢，高波特率下波形方波变成斜坡，时序就乱了；阻值太小，总线灌电流偏大，增加功耗。100kHz 模式用 4.7kΩ 没问题，400kHz 快速模式建议用 2.2kΩ，如果总线挂载设备多、走线长，还得适当减小阻值。

第三，不要用超过 20cm 的杜邦线去接 SCL 和 SDA。IIC 对分布电容敏感，线越长波形越差。我真的见过有人用 30cm 杜邦线连接模块，100kHz 下还能勉强工作，切到 400kHz 直接通信失败。这时要么缩短走线，要么保持低速模式，要么用屏蔽线。还有供电稳定性：MPU6050 内部有模拟测量电路，电源纹波太大会反映在数据上。电机启动瞬间电压跌落，加速度计数据经常乱跳，根源就在这里。建议在模块电源引脚旁放一个 100nF 电容，如果系统里有电机，最好单独供电或加滤波。

2.2 IIC 协议的几个关键时刻：起始、地址、应答、数据、停止

了解了接线，接下来要明白总线上到底在发生什么。IIC 协议本身不复杂，核心就几个时刻。

首先是起始条件：SCL 保持高电平期间，SDA 由高拉低，这表示总线开始传输。然后是设备地址字节，MPU6050 的 7 位 IIC 地址默认是 0x68，但这 7 位需要左移一位再加上读写标志才能拼成总线上传输的 8 位地址。写操作是 0xD0，读操作是 0xD1。很多人被 HAL 库的地址参数搞懵，其实就是这个左移关系。

地址字节之后，被寻址设备会在第 9 个时钟周期拉低 SDA 作为 ACK 应答。如果总线上没有这个设备，或者地址不对，主控收不到 ACK，这次通信就会失败。这也是为什么读 WHO_AM_I 寄存器是最快的探路方式——能读到 0x68，说明设备地址和基本通信都通。

接下来是寄存器地址和数据传输阶段。读操作通常要分两步：先写要读取的寄存器地址，等设备把地址指针指到正确位置，再发重复起始条件，然后读取数据。如果读取多个连续寄存器，可以用连续读方式，设备会自动把地址指针递增，这样一次就能把加速度、温度、陀螺仪的数据全部搬回来。

最后是停止条件：SCL 高电平期间，SDA 由低拉高，总线释放。最后读取的字节主控要回一个 NACK，表示不用再继续发了。

我用逻辑分析仪看过无数次这些波形。说实话，不需要把时序细节背得滚瓜烂熟，但知道每个阶段在波形上长什么样，对排查通信问题是质的提升。否则你只能对着代码干瞪眼，完全不知道设备有没有响应。

2.3 STM32 硬件 I2C 初始化设置：三个容易被忽略的细节

用 STM32 的硬件 I2C 外设，配置起来不算难，但有几个细节容易踩坑。

第一个细节是 GPIO 模式。SCL 和 SDA 引脚必须配置为开漏输出，并且可以同时开启内部上拉。很多人按普通推挽输出的习惯去配置，结果总线拉高能力不够，波形变形。开漏模式配合外部上拉电阻，才是 IIC 的正确工作方式。

第二个细节是时钟频率。第一次调模块时不要上来就设 400kHz，先用 100kHz 跑通，确认波形没问题再提速。我遇到过模块、代码都正常，但频率一上去就通信失败的情况，后来查出来是上拉电阻太大加上杜邦线太长，上升沿时间超标。

第三个细节是 HAL 库函数里面的设备地址参数。比如HAL_I2C_Mem_Read，它的DevAddress参数要求传入的是左移后的 8 位地址，也就是 0xD0 或 0xD1。很多新人直接传 0x68，结果返回超时错误。

初始化代码大致是这样：

static void MX_I2C1_Init(void) { hi2c1.Instance = I2C1; hi2c1.Init.ClockSpeed = 100000; // 先跑 100kHz，稳定后再提速 hi2c1.Init.DutyCycle = I2C_DUTYCYCLE_2; hi2c1.Init.OwnAddress1 = 0; hi2c1.Init.AddressingMode = I2C_ADDRESSINGMODE_7BIT; hi2c1.Init.DualAddressMode = I2C_DUALADDRESS_DISABLE; hi2c1.Init.GeneralCallMode = I2C_GENERALCALL_DISABLE; hi2c1.Init.NoStretchMode = I2C_NOSTRETCH_DISABLE; if (HAL_I2C_Init(&hi2c1) != HAL_OK) { Error_Handler(); } }

GPIO 配置里，关键是这两个引脚要设成开漏且带上拉：

GPIO_InitStruct.Pin = GPIO_PIN_6 | GPIO_PIN_7; // I2C1_SCL, I2C1_SDA GPIO_InitStruct.Mode = GPIO_MODE_AF_OD; // 复用开漏输出 GPIO_InitStruct.Pull = GPIO_PULLUP; // 内部上拉 GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_HIGH; HAL_GPIO_Init(GPIOB, &GPIO_InitStruct);

跑通之后如果要在中断服务函数里读数据，记得给HAL_I2C_Mem_Read设置合理的超时时间，不要用无限阻塞，否则总线异常时程序会直接卡死。

3. 寄存器配置与数据读取：把六轴原始值变成物理量

3.1 器件地址与关键寄存器表

通信没问题之后，就要开始操作寄存器了。MPU6050 的寄存器映射很规整，最关键的也就那么几个。

器件地址前面说过，由 AD0 引脚电平决定：AD0 接地或悬空时地址是 0x68，AD0 接高电平则变成 0x69。如果总线上同时挂两个 MPU6050，可以把它们设成不同地址，分别读取。

下面是操作中最常用的几个寄存器：

这里要提醒一点：WHO_AM_I 的返回值高两位可能因为芯片版本不同有差异，我见过返回 0x70 的 MPU6050 变体。判断设备在线时，建议只屏蔽高两位后和 0x68 比较，或者直接看是否有 ACK，不要死板地要求必须等于 0x68。

3.2 初始化顺序：先唤醒、再时钟、最后量程

MPU6050 上电后默认处于睡眠模式，这是很多新手数据读回全零的原因。所以初始化顺序很重要，我一般是这么走的：

第一步复位芯片，往 PWR_MGMT_1 写 0x80，让所有寄存器恢复默认状态。延时 100ms 等内部完成复位。第二步再次操作 PWR_MGMT_1，写入 0x01，作用是退出睡眠，同时把时钟源选为 MPU 内部的 PLL，以 X 轴陀螺仪作为参考时钟。理论上不配置时钟源也能工作，但我遇到过用内部振荡器时数据温度特性变差的情况，所以这一步别省。

第三步配置采样率，写 SMPLRT_DIV。MPU6050 的采样率计算公式是采样率 = 陀螺仪输出率 / (1 + SMPLRT_DIV)，默认陀螺仪输出率是 1kHz。比如我想要 100Hz，SMPLRT_DIV 就写 9。注意这个分频器最终会受到 DLPF 带宽的影响，实际工程中我常用 50Hz 到 200Hz 之间的采样率，太低动态响应差，太高对主控压力大。

第四步配置 CONFIG 寄存器里的数字低通滤波器，即 DLPF。它用来滤掉传感器输出中的高频噪声，但带宽越低延迟越大。比如 DLPF 设置为 44Hz 时延迟接近 5ms，平衡车这种需要快速响应的场合就不合适。我一般先设成 94Hz 对应的配置值，保证噪声和延迟平衡，等后面看实际效果再调。

第五步配置量程。GYRO_CONFIG 和 ACCEL_CONFIG 两个寄存器分别控制角速度和加速度的满量程范围，这也决定了后面单位换算时的灵敏度。配置越大量程，灵敏度越低，测量范围越大。低速平衡场景我常用陀螺仪 ±500dps、加速度计 ±4g，兼顾分辨率和范围。

初始化的代码骨架如下：

uint8_t MPU6050_Init(I2C_HandleTypeDef *hi2c) { uint8_t val; // 1. 复位 val = 0x80; HAL_I2C_Mem_Write(hi2c, 0xD0, 0x6B, I2C_MEMADD_SIZE_8BIT, &val, 1, 100); HAL_Delay(100); // 2. 退出睡眠，设置时钟源为 PLL X 轴陀螺 val = 0x01; HAL_I2C_Mem_Write(hi2c, 0xD0, 0x6B, I2C_MEMADD_SIZE_8BIT, &val, 1, 100); // 3. 采样率 1kHz / (1 + 9) = 100Hz val = 0x09; HAL_I2C_Mem_Write(hi2c, 0xD0, 0x19, I2C_MEMADD_SIZE_8BIT, &val, 1, 100); // 4. DLPF 设置为 44Hz val = 0x06; HAL_I2C_Mem_Write(hi2c, 0xD0, 0x1A, I2C_MEMADD_SIZE_8BIT, &val, 1, 100); // 5. 陀螺仪量程 ±500dps，加速度计 ±4g val = 0x08; HAL_I2C_Mem_Write(hi2c, 0xD0, 0x1B, I2C_MEMADD_SIZE_8BIT, &val, 1, 100); HAL_I2C_Mem_Write(hi2c, 0xD0, 0x1C, I2C_MEMADD_SIZE_8BIT, &val, 1, 100); return 0; }

这里用HAL_I2C_Mem_Write的好处是库函数内部帮你处理了写入寄存器地址的时序，不用手动拼写读写的状态机逻辑，对新手友好很多。

3.3 连续读取 14 字节与单位换算

初始化完成之后，读数据就变得很简单了。加速度数据从 0x3B 开始，到 0x40 结束，共 6 个字节；温度从 0x41 开始，占两个字节；陀螺仪从 0x43 开始，到 0x48 结束，又是 6 个字节。所以一次连续读 14 个字节，正好把六轴数据和温度全读出来。

读取代码示例：

typedef struct { int16_t ax_raw; int16_t ay_raw; int16_t az_raw; int16_t gx_raw; int16_t gy_raw; int16_t gz_raw; float ax_g; float ay_g; float az_g; float gx_dps; float gy_dps; float gz_dps; } MPU6050_Data; uint8_t MPU6050_ReadAll(MPU6050_Data *data) { uint8_t buf[14]; if (HAL_I2C_Mem_Read(&hi2c1, 0xD0, 0x3B, I2C_MEMADD_SIZE_8BIT, buf, 14, 100) != HAL_OK) return 1; >float acc_pitch = atan2f(ax_g, sqrtf(ay_g * ay_g + az_g * az_g)) * 57.2958f;

完整的互补滤波代码也不长。假设采样周期 dt 固定为 10ms：

#define FILTER_COEF 0.98f float pitch = 0.0f, roll = 0.0f; float dt = 0.01f; void ComplementaryFilter(float gx_dps, float gy_dps, float ax_g, float ay_g, float az_g) { float acc_pitch = atan2f(ax_g, sqrtf(ay_g * ay_g + az_g * az_g)) * 57.2958f; float acc_roll = atan2f(ay_g, sqrtf(ax_g * ax_g + az_g * az_g)) * 57.2958f; pitch = FILTER_COEF * (pitch + gx_dps * dt) + (1.0f - FILTER_COEF) * acc_pitch; roll = FILTER_COEF * (roll + gy_dps * dt) + (1.0f - FILTER_COEF) * acc_roll; }

注意方向和坐标系符号要和你实际安装方式对齐，轴向装反了，角度符号就会反，这不是代码逻辑问题，而是坐标定义问题。

调参时系数不能随便乱来。系数越接近 1，系统越相信陀螺仪，角度对振动的抵抗力越强，但长期跟随加速度计校正的速度越慢，动态回中也就越慢。我现在调平衡车时一般从 0.98 起步，如果发现角度有高频抖动就适当降低到 0.95 左右，如果发现角度回中太慢就再升一点。整个过程需要在真实运动场景里看效果，不要只静止躺着看波形。

还有一个重要细节：dt 要尽量精确。如果你在定时器中断里调用这个函数，dt 就是定时器周期；如果你在主循环里轮询调用，中断和循环之间的延迟会带来不确定性，角度就容易一抖一抖。这也是为什么做姿态解算一定要把它放进固定频率的中断或者使用带时间戳的调度方式，而不是在主循环里随手调用。

5. 实测排查链路：读不到设备、数据全零、角度漂移

5.1 第一步：WHO_AM_I 读不回来，别急着改代码

代码写好了，上电发现HAL_I2C_Mem_Read返回超时，WHO_AM_I 一直读不回来。这种时候先别改代码，从头排查硬件链路。

排查顺序我通常是这样：先用万用表量模块 VCC 引脚对地电压，确认是不是 3.3V；再量 GND 通不通，这个听起来可笑，但杜邦线接触不良太常见了。接着检查 SCL、SDA 有没有接反，有没有虚焊或松动。如果模块上 AD0 有跳线焊盘，确认它的电平符合预期，否则地址就不是默认的 0x68。

接下来用逻辑分析仪或者示波器抓 SDA 和 SCL。重点看几个点：有没有起始条件？总线上有没有地址字节波形？地址之后有没有出现 ACK 的低电平？如果地址发了但设备没有回应，一般是设备没通电、地址不对、或者从设备压根没在工作。如果总线上连波形都没有，那多半是引脚配置或接线问题。

如果你没有逻辑分析仪，可以先把 I2C 频率降到 100kHz 试试。再不行，就换一种验证方式：把 SDA 和 SCL 配成普通 GPIO，手动拉引脚模拟写一个字节，观察模块是否有反应。这一步能区分“IIC 外设没配好”和“外部硬件有问题”。

我遇到过一次非常郁闷的情况：代码、模块、接线全没问题，但就是读取超时，后来发现是模块上的 SDA 和 SCL 焊盘被上一块板子的排针短路了。所以提醒一句，排查到最后还是不行，换一块模块或者换一套杜邦线，这个成本最低。

5.2 第二步：数据全零或某轴恒为 0

WHO_AM_I 能读到了，说明通信没问题，但读回来的六轴数据全为零。这种情况下，问题往往出在初始化或读取方式上。

最典型的坑是芯片没退出睡眠模式。复位之后 PWR_MGMT_1 的 SLEEP 位处于置位状态，如果初始化的时候没有写 0x01 把它唤醒，主控能通信但传感器不工作，数据寄存器一直保持零。检查一下初始化代码里有没有这一步，没有就补上。

其次是数据寄存器读取方式的问题。如果你没有连续读取，而是一次只读两个字节，并且每次都从同一个起始地址开始，读到的可能不是最新数据，或者直接读到零。另外，读陀螺仪数据时，起始地址写成了 0x43 却不连读，中间漏掉了温度寄存器的地址偏移，也可能导致字节错位。最省心的方案就是一次连续读 14 字节，从 0x3B 开始。

还有一种情况是数据拼接的符号位丢了。静止放置时，水平轴加速度理论上接近零，但如果代码把原始值当无符号数处理，所有轴都可能显示成 65535 附近的值。这种问题出现在你读出的数值“看起来很大且不稳定”的时候，优先检查转换类型。

最后，学会用静止状态判断数据合理性。模块水平放平，在 ±2g 量程下，X 轴和 Y 轴的加速度原始值应该在 0 附近波动，Z 轴应该在 16384 附近，陀螺仪三轴都应该接近 0。如果 Z 轴读出来是 0，说明加速度计数据链路有问题；如果陀螺仪某轴读数一直固定在一个非零值，可能是零偏太大，但至少说明传感器在工作。

5.3 第三步：数据乱跳与角度漂移

通信正常、数据也正常，但角度输出不稳定或者慢慢飘，这是最折磨人的阶段，因为问题不是“坏了”，而是“没调好”。

数据乱跳优先查电源和连接。电机驱动的系统里面，主控和电机共用一个电源，电机启动瞬间母线电压大幅跌落，传感器数据会跟着抽风。解决办法是给 MPU6050 独立供电或者加强滤波电容，以及确保主控和模块共地。我见过一个项目，模块数据在电机启动时剧烈跳变，加了共地之后问题瞬间消失。

如果供电没问题，再看线束长度和屏蔽。SDA、SCL 在电机驱动线附近走线时，会受到 PWM 噪声耦合。这种情况在电路板布局阶段就要注意，把传感器信号线尽量远离大电流回路，必要时加 RC 滤波或屏蔽层。

角度漂移主要是陀螺仪零偏导致的。任何陀螺仪在静止时输出并不严格为零，而是有一个固定偏置，比如 +0.5dps。积分一秒就多出 0.5 度，一分钟漂 30 度，非常吓人。解决办法是开机后静止时采集几百个样本求平均，作为偏移量，在读取数据后减去这个偏移再积分。

不过零偏并不是恒定的，它随温度变化。所以更稳的做法是每次上电后都做一次短时校准，而不是把校准值写死在 Flash 里用一年。如果你的设备在运行中会长时间静止，还可以设计一个检测逻辑：当加速度计检测到模块持续静止超过阈值，自动更新陀螺仪零偏。这个技巧我在自稳云台项目里用过，漂移改善非常明显。

除了零偏，采样间隔抖动也会让积分结果不准确。如果每次循环取 dt 用的是HAL_GetTick()差值，而主循环里还有别的耗时任务，dt 会忽大忽小，角度自然抖动。解决方案就是把姿态解算放进固定周期的定时器中断，用常数 dt，不要依赖主循环的实时性。

6. 我踩过坑之后沉淀的几个习惯

6.1 调试期用软件模拟 IIC，功能验证后切硬件 I2C

如果你用的是 STM32 的硬件 I2C 外设，代码本身可能没问题，但新手对 HAL 库的寄存器状态机不熟，一旦通信失败，往往分不清是外设配置问题还是传感器问题。我在早期调试时经常被这个问题卡住，后来养成了一个习惯：第一步先用软件模拟 IIC 把模块跑通。

软件模拟 IIC 的好处是可以把 SCL 和 SDA 当作普通 GPIO 手动控制，每一步都清清楚楚。你可以主动翻转电平，打印每一步的状态，写死板调试非常方便。等软件模拟方式确认了模块没问题、寄存器逻辑正确之后，再切换到硬件 I2C 外设，这时候出问题，你至少知道锅大概率在硬件外设配置上。

我现在做一个抽象层，把读写函数封装成统一的接口，底层可以是软件模拟也可以是硬件 I2C，切换的时候应用层代码不用动。这样前期调试和后期的性能优化可以分开进行，建议你也这样组织代码。

6.2 零偏校准要等上电稳定，不要上电立刻做

很多人做零偏校准的方式是：上电之后立刻采集 N 个样本求平均，保存在全局变量里。这个做法有问题。MPU6050 上电瞬间内部晶振还在起振，电源电压还没稳定，此时采集到的数据包含大量瞬态偏移，校准出的零偏反而会带偏后续所有积分。

我的做法是：上电后先延时一到两秒，确保内部状态稳定，再开始采集样本。采集过程中最好做简单的异常剔除，比如计算标准差，把明显偏离的样本丢掉。校准过程中确保模块完全静止，千万不要用手拿着，手本身的微颤会混进零偏里。

校准值存哪里也值得想一想。如果每次开机都自动校准，那存不存 Flash 都无所谓；但如果你的设备要求开机后尽快进入工作，每次等一两秒又太久，那可以把上次校准结果存到外部 Flash 或芯片内部 Flash，开机快速加载，同时在后台静默校准。这样兼顾快速启动和长期漂移修正。

6.3 滤波参数不是越小越好，关键看动态响应

我见过不少人看到数据有噪声，就不断调低 DLPF 带宽，或者把互补滤波系数改得越来越接近 1，结果角度曲线看起来平滑得像丝绸，但实际控制时根本跟不上动作。

滤波的本质是让有用信号通过、滤除噪声，但绝大多数滤波器会引入相位延迟。DLPF 设到 44Hz，信号延迟接近 5ms；互补滤波系数太高，角度回中速度变慢，表现在平衡车上就是车身姿态变化后，角度反馈滞后，控制量反应迟钝，整车容易出现低频振荡。

判断滤波参数是否合适，不要只看静止时的噪声幅度，那没有意义。我的测试方法很简单：快速倾斜模块到某个角度再恢复，观察角度波形能不能快速跟上且不过冲。如果波形跟不上，说明延迟太大；如果波形毛刺明显，说明滤波不足。这样调出来的参数，才真正满足实际控制需求。

最后说一点我的体会。用 STM32 配合 IIC 驱动 MPU6050，本质上不是一个“把寄存器读出来”的任务，而是一个信号链路的系统工程。它要求你先懂一点 MEMS 传感器原理，再懂 IIC 总线时序，还要懂数据融合的基本思想。三个环节里任何一个出了问题，最后的表现都是同样的症状：角度不对。所以别怕慢，把 WHO_AM_I 检查、上拉电阻、醒来配置、连续读、零偏校准这几件事一步步做扎实，姿态数据自然就稳了。这套方法用熟了，之后再接 ICM 系列新传感器、或者换 SPI 接口、或者跑卡尔曼滤波，你都会发现底层思路完全一样，只是换了外设和寄存器罢了。