STM32F103C8T6+MPU6050姿态解算工程：I2C到滤波实战

简介：面向STM32初学者与嵌入式开发者的MPU6050姿态解算完整工程，基于STM32F103C8T6平台，已配置好可直接编译下载的Keil工程环境，可用于飞行器、机器人、智能穿戴与健康监测等场景的姿态数据采集和控制验证，省去从零搭建外设与工程模板的时间。压缩包共188个文件，约6.16MB，以32个.c源文件、35个.h头文件为核心，配有.s汇编启动文件、Keil工程与目标配置文件，以及编译生成的.o、.d、.crf等中间文件和.hex可执行固件，目录涵盖STM32标准外设库、I2C与MPU6050驱动及主程序模块。已有2619人学习下载，适合用来对照工程结构理解外设初始化、传感器读取和姿态解算流程，也可作为课程设计、毕业设计或项目原型的起步模板，减少环境配置与底层联调成本。

1. 先别急着烧录：这套 STM32F103C8T6+MPU6050 工程真正省掉的是哪几步

STM32F103C8T6 加 MPU6050 的组合，最难的不是写一行姿态解算源码，而是把时钟、I2C、串口、寄存器配置、零偏校准和主循环节拍一次性串顺。这套完整工程的价值就在这里：它把“模块能读到数”到“串口能输出角度”之间的脏活累活先做成了可编译的底稿。你拿到手可以直接编译下载，先看原始数据，再改解算参数。适合正在做课程设计、平衡车或云台入门的开发者，也适合手里只有模块和杜邦线、不想从新建工程开始踩坑的人。它不是算法教科书，但能让你少走几天弯路。

2. 工程结构与数据链路：从 I2C 寄存器到串口角度值

2.1 目录分层：先认清哪一层在动硬件

拿到一套能直接编译的 STM32F103C8T6+MPU6050 工程，第一件事不是打开 main.c 找姿态解算，而是看目录分层。常见做法是把工程分成启动与时钟、外设初始化、传感器驱动、姿态解算、应用输出几块。启动文件负责中断向量和复位入口，时钟配置决定 I2C 和串口能不能跑在预期频率，外设初始化把 GPIO 复用成 I2C1 的 SCL/SDA 和 USART1 的 TX/RX，传感器驱动只做寄存器和原始数据，姿态解算单独放一个文件，主循环负责定时采样和打印。这样分的好处是排错时能快速定位：WHO_AM_I 读不到就查 I2C 和供电，角度漂就查零偏和解算周期，串口乱码就查波特率和时钟。

我一般会先看工程里有没有独立的 MPU6050 驱动文件。如果寄存器读写、量程换算、校准全挤在 main.c 里，后面改量程容易翻车。分层清楚的工程，驱动层只暴露MPU6050_Init、MPU6050_ReadRaw、MPU6050_CalibrateGyro这类接口，解算层只吃原始数据和 dt，输出层只负责格式化。这样你把互补滤波换成四元数时，不用动 I2C 时序；把串口输出改成 CSV 时，也不用碰寄存器配置。C8T6 只有 64KB Flash 和 20KB RAM，分层不会明显增加开销，反而让编译产物更好查。

还有一类工程会把 MPU6050 的 DMP 固件也塞进来。DMP 能直接输出四元数，省掉主控解算，但移植时对 I2C 时序和固件加载顺序要求更高，第一次上手不建议一上来就调 DMP。先把原始数据链路跑通，确认加速度计和陀螺仪三轴方向、量程、零偏都对，再决定要不要上 DMP。这套工程如果默认走的是主控解算，那它的教学价值大于直接产品价值，改参数和换滤波都更方便。

2.2 上电后的数据流：谁先初始化、谁在定时采样

上电顺序是有讲究的。先复位外设和 SysTick，再配 72MHz 主频，然后初始化 GPIO、I2C、串口，接着复位 MPU6050、唤醒、写量程和 DLPF，最后做静止零偏校准。校准没做完就进主循环，陀螺仪零偏会被直接积分进角度，表现就是静止时角度缓慢往一个方向跑。很多“姿态解算不准”的问题，根子不在滤波系数，而在上电后没有给模块足够的静止时间。

下面这段初始化顺序是这类工程里最常见的骨架，函数名按你手里的工程实际替换即可：

/* main.c 里的初始化顺序，函数名按工程实际替换 */ int main(void) { HAL_Init(); // 复位外设、初始化 SysTick SystemClock_Config(); // 72 MHz 主频，I2C 和串口都依赖它 MX_GPIO_Init(); // 指示灯、I2C 引脚复用 MX_I2C1_Init(); // 先 100 kHz，稳定后再试 400 kHz MX_USART1_UART_Init(); // 115200 8N1，方便看原始数据 MPU6050_Init(); // 复位、唤醒、配置量程和 DLPF MPU6050_CalibrateGyro(800); // 静止采样 800 次，求陀螺零偏 while (1) { MPU6050_ReadRaw(&raw); // 一次突发读 14 字节 MPU6050_UpdateAttitude(&raw, dt); printf("roll=%.2f pitch=%.2f yaw=%.2f\r\n", roll, pitch, yaw); HAL_Delay(10); // 实际工程建议用定时器节拍 } }

这段代码里，HAL_Init和SystemClock_Config决定后续延时和 I2C 时钟是否准确；MX_I2C1_Init里的 I2C 速率建议先设 100kHz，杜邦线长、上拉弱的时候 400kHz 容易通信失败；MPU6050_CalibrateGyro(800)的 800 是采样次数，按 5ms 一次算大约 4 秒，按 10ms 一次算大约 8 秒，时间不够零偏均值会抖；HAL_Delay(10)只适合验证，真正做姿态解算要用定时器中断或 SysTick 固定节拍，否则 dt 不准，互补滤波和四元数都会跟着漂。

主循环里一次突发读 14 字节，顺序通常是加速度 X/Y/Z、温度、陀螺仪 X/Y/Z，每个轴高字节在前。读完后先做原始数据到物理单位的换算，再进姿态解算，最后输出。不要一边读一边打印，串口打印本身会拖慢采样周期；调试阶段可以每 10 次采样打印一次，或者用定时器打时间戳。工程里如果已经带了dt计算，优先用它，不要自己再估一个固定值。

2.3 编译环境与下载配置：能编译不等于能跑

工程能编译通过，只说明语法和链接没问题，不代表下载后能跑。C8T6 的 BOOT0 要拉低，复位后从主 Flash 启动；下载方式常见是 SWD，SWDIO 和 SWCLK 两根线要接对，目标板共地。串口能出数据但全是乱码，先查波特率是不是 115200、时钟是不是真跑到 72MHz、串口引脚有没有被别的外设占用。I2C 能读但偶尔失败，先降速到 100kHz，再看 SDA/SCL 上拉电阻，很多模块自带上拉，但杜邦线一长，波形边沿会变差。

编译选项里还要注意优化等级。调试阶段建议先关高等级优化，或者至少保证volatile用在中断和主循环共享的变量上，比如定时采样标志、原始数据缓存。优化开太高时，编译器可能把循环里的寄存器读操作优化掉，表现就是串口一直输出同一个值。堆栈也要留够，姿态解算里如果用了浮点 printf，栈别设得太小。C8T6 资源不宽裕，但把串口打印和浮点运算同时开起来，20KB RAM 仍然够用，前提是别在中断里做大面积浮点格式化。

提示：第一次下载后先只打印 WHO_AM_I 和原始六轴数据，确认 I2C 通信和方向映射，再打开姿态解算输出。这样出问题时能快速判断是驱动层还是解算层。

3. MPU6050 寄存器配置：量程、DLPF 与零偏校准的实操顺序

3.1 上电默认值与量程选择：±2g 还是 ±8g

MPU6050 上电后默认处于睡眠状态，PWR_MGMT_1 的 SLEEP 位是 1，直接读传感器数据可能全是 0。初始化第一步通常是写 0x6B 寄存器，先给 0x80 复位，延时后写 0x00 唤醒，再写 0x01 选择陀螺仪 X 轴 PLL 作为时钟源。时钟源稳定的情况下，陀螺仪零偏会比内部 8MHz 振荡器小一些。复位后不要立刻连续写配置，给器件一点启动时间，常见做法是延时 50ms 到 100ms。

量程选择要看应用。做静态倾角、慢速云台，加速度计量程用 ±2g 足够，灵敏度 16384 LSB/g，分辨率高；做剧烈运动或冲击检测，±4g 或 ±8g 更安全，但分辨率下降。陀螺仪做姿态解算常用 ±2000dps，灵敏度 16.4 LSB/(°/s)，量程大不容易饱和，代价是小角速度分辨率变粗；慢速应用可以用 ±500dps 或 ±250dps，零偏和噪声表现会好一些。工程里如果默认是 ±2g 加 ±2000dps，这是比较通用的入门组合。

配置寄存器写入顺序建议是：PWR_MGMT_1 复位并唤醒，SMPLRT_DIV 设采样分频，CONFIG 设 DLPF，GYRO_CONFIG 设陀螺量程，ACCEL_CONFIG 设加速度量程。顺序反了不一定报错，但 DLPF 改变后采样率会变，校准和 dt 要跟着改。下面这张表是常用配置的对照，改量程时直接查灵敏度：

采样分频不是越小越好。DLPF 打开后，陀螺输出率会降到 1kHz，SMPLRT_DIV=9对应 100Hz 采样，主循环 10ms 读一次刚好匹配。如果主循环 5ms 读一次，就把分频改成 4，对应 200Hz。读得比配置快，会重复读到旧数据；读得比配置慢，会丢样本，姿态解算的 dt 就不均匀。很多“角度抖动”不是滤波没调好，而是采样率和主循环节拍对不上。

3.2 寄存器写入与突发读取：I2C 地址别左移错

MPU6050 的 7 位地址由 AD0 决定，AD0 接地是 0x68，接高是 0x69。用 HAL 的HAL_I2C_Mem_Write时，传入的是 8 位地址，也就是 0x68 左移一位后的 0xD0；读的时候是 0xD1。有些工程宏定义直接写0xD0，有些写0x68再在函数里左移，改代码前先看驱动层怎么处理。地址错了，WHO_AM_I 读回 0x00 或 0xFF，很多人会误判为模块坏了。

下面这段是寄存器写和突发读的常见写法，MPU6050_ADDR按工程实际填 0xD0 或 0x68 左移后的值：

/* 寄存器写：HAL 的 Mem_Write 内部会处理寄存器地址 */ static void MPU6050_WriteReg(uint8_t reg, uint8_t val) { HAL_I2C_Mem_Write(&hi2c1, MPU6050_ADDR, reg, I2C_MEMADD_SIZE_8BIT, &val, 1, 50); } /* 一次读 14 字节：加速度 6 + 温度 2 + 陀螺 6 */ void MPU6050_ReadRaw(MPU6050_Raw *raw) { uint8_t buf[14]; HAL_I2C_Mem_Read(&hi2c1, MPU6050_ADDR, 0x3B, I2C_MEMADD_SIZE_8BIT, buf, 14, 50); raw->ax = (int16_t)((buf[0] << 8) | buf[1]); raw->ay = (int16_t)((buf[2] << 8) | buf[3]); raw->az = (int16_t)((buf[4] << 8) | buf[5]); raw->gx = (int16_t)((buf[8] << 8) | buf[9]); raw->gy = (int16_t)((buf[10] << 8) | buf[11]); raw->gz = (int16_t)((buf[12] << 8) | buf[13]); }

0x3B是加速度 X 轴高字节，连续读 14 字节刚好覆盖到陀螺仪 Z 轴低字节。温度在buf[6]和buf[7]，做温度补偿时用得上。int16_t强转不能省，高字节左移后先拼成 16 位再转有符号数，直接按无符号打印会出现几万的大数。I2C 超时时间 50ms 对 100kHz 来说够用，如果总线上有多个从机，读失败时先看 HAL 返回状态，不要只判断数据。

3.3 零偏校准：静止采样取均值，别把桌子震动算进去

陀螺仪零偏是姿态漂移的头号来源。校准方法不复杂：模块静止放在水平桌面上，连续读 N 次原始数据，每个轴求平均，把这个平均值存成gyro_bias_x/y/z，后续解算时先减掉再积分。采样次数常见 500 到 1000 次，间隔 5ms 到 10ms。次数太少，均值受噪声影响；次数太多，校准时间太长，温度已经变了。校准期间不要碰桌子，风扇吹着、电脑震动都会进均值。

加速度计也可以做零偏校准，但更推荐六面校准，因为加速度计不仅存在零偏，还有比例误差和轴间误差。入门阶段先把陀螺零偏扣掉，加速度计只用来看倾角，效果已经能接受。校准代码里要判断数据是否稳定，比如连续几次采样的最大值和最小值差超过阈值就重新开始，或者直接提示“请保持静止”。工程里如果只做一次上电校准，温度变化大的场景会慢慢漂，后面可以加温度补偿或运行时零偏估计。

/* 静止采样求陀螺零偏，采样间隔由调用者控制 */ void MPU6050_CalibrateGyro(uint16_t samples) { int32_t sum_gx = 0, sum_gy = 0, sum_gz = 0; MPU6050_Raw raw; for (uint16_t i = 0; i < samples; i++) { MPU6050_ReadRaw(&raw); sum_gx += raw.gx; sum_gy += raw.gy; sum_gz += raw.gz; HAL_Delay(5); } gyro_bias_x = (float)sum_gx / samples; gyro_bias_y = (float)sum_gy / samples; gyro_bias_z = (float)sum_gz / samples; }

这段代码把零偏存成原始 LSB 单位，后面换算成 dps 时再统一减。也可以先换算再求平均，结果一样，但要注意量程灵敏度。samples取 800 时，5ms 间隔大约 4 秒，校准期间串口不要频繁打印，打印会拖慢采样。校准完成后建议把零偏值打印一次，换模块或换量程时对比一下，零偏大得离谱通常意味着模块焊接、供电或 I2C 时序有问题。

4. 姿态解算源码拆解：互补滤波的 alpha 和四元数的 dt 怎么定

4.1 原始数据换算：LSB 灵敏度与单位统一

姿态解算的第一步不是滤波，而是把原始整数换成物理单位。加速度计按量程除以灵敏度，±2g 是 16384 LSB/g，±4g 是 8192，±8g 是 4096，±16g 是 2048。陀螺仪 ±250dps 是 131 LSB/(°/s)，±500 是 65.5，±1000 是 32.8，±2000 是 16.4。换算后的加速度单位是 g，陀螺仪单位是 °/s。后面如果要用四元数，陀螺仪还要转成 rad/s，乘 0.0174533。

单位不统一是新手最容易翻车的地方。有人把陀螺仪原始值直接当 °/s 用，积分出来角度大得离谱；有人把加速度计原始值直接送进 atan2，虽然角度比例对，但阈值判断和滤波系数会完全错位。我的习惯是驱动层只输出ax_g、ay_g、az_g、gx_dps、gy_dps、gz_dps，解算层不再碰 LSB。这样换量程时只改一个宏，不用在滤波函数里到处找除数。

/* 原始值转物理单位，量程变了只改这两个宏 */ #define ACC_LSB_PER_G 16384.0f // ±2g #define GYRO_LSB_PER_DPS 16.4f // ±2000dps void MPU6050_RawToUnit(const MPU6050_Raw *raw, float *ax, float *ay, float *az, float *gx, float *gy, float *gz) { *ax = raw->ax / ACC_LSB_PER_G; *ay = raw->ay / ACC_LSB_PER_G; *az = raw->az / ACC_LSB_PER_G; *gx = (raw->gx - gyro_bias_x) / GYRO_LSB_PER_DPS; *gy = (raw->gy - gyro_bias_y) / GYRO_LSB_PER_DPS; *gz = (raw->gz - gyro_bias_z) / GYRO_LSB_PER_DPS; }

这里的gyro_bias_x是原始 LSB 单位，所以先减再除。如果校准函数存的是 dps 单位，顺序就要反过来。换算完的加速度模值应该在 1g 附近，静止时sqrt(ax*ax+ay*ay+az*az)在 0.95 到 1.05 之间算正常；偏差太大先查量程配置和模块是否倾斜。陀螺仪静止时三轴应在 0 附近，偶尔有几个 LSB 跳动是噪声，不用追求绝对零。

4.2 互补滤波：陀螺仪积分会漂，加速度计负责拉回来

互补滤波的思路很直白：陀螺仪动态响应好，但积分会漂；加速度计静态准，但振动噪声大。用高通滤陀螺仪、低通滤加速度计，合起来就是angle = alpha * (angle + gyro * dt) + (1 - alpha) * acc_angle。alpha常见 0.95 到 0.98，越大越信陀螺仪，动态跟随快，但漂移修正慢；越小越信加速度计，静态稳，但振动时角度会抖。dt必须和采样周期一致，10ms 采样就传 0.01，不能随手写 1。

加速度计算倾角时，roll 用atan2(ay, az)，pitch 用atan2(-ax, sqrt(ay*ay+az*az))，结果转成角度。符号取决于模块安装方向，换板子后角度反了，先调符号，不要急着改滤波。yaw 没有磁力计参考，只能靠陀螺仪 Z 轴积分，时间一长必然漂，这是原理限制，不是代码写错。做平衡车只用 roll 和 pitch，yaw 可以不用；做云台航向，要么加磁力计，要么接受缓慢漂移并定期回正。

/* 互补滤波更新 roll 和 pitch，dt 单位秒 */ #define ALPHA 0.96f #define RAD_TO_DEG 57.29578f void Attitude_Update(const MPU6050_Raw *raw, float dt) { float ax, ay, az, gx, gy, gz; MPU6050_RawToUnit(raw, &ax, &ay, &az, &gx, &gy, &gz); float acc_roll = atan2f(ay, az) * RAD_TO_DEG; float acc_pitch = atan2f(-ax, sqrtf(ay * ay + az * az)) * RAD_TO_DEG; roll = ALPHA * (roll + gx * dt) + (1.0f - ALPHA) * acc_roll; pitch = ALPHA * (pitch + gy * dt) + (1.0f - ALPHA) * acc_pitch; /* yaw 只能积分，没有磁力计会漂 */ yaw += gz * dt; }

ALPHA取 0.96 时，时间常数大约几十毫秒到几百毫秒，具体看 dt。10ms 采样下，0.96 对应修正比较慢，静态稳但上电对齐要等一会儿；0.98 跟随快，振动时更容易把噪声带进角度。atan2f和sqrtf用单精度浮点，C8T6 没有硬件 FPU，计算开销要靠采样周期摊掉，10ms 一次完全够用。如果主循环里还有串口 printf，建议把打印降到 100ms 一次，避免解算周期被拖长。

4.3 四元数更新：一阶积分够用，但归一化不能省

当姿态要参与三维旋转或避免万向锁时，四元数比欧拉角更合适。MPU6050 没有磁力计，四元数更新通常只用陀螺仪角速度，加速度计用来修正 roll 和 pitch，yaw 仍然没有绝对参考。一阶龙格库塔积分在 100Hz 到 200Hz 采样下够用，代码量也不大。关键是每步更新后做归一化，否则数值误差累积，四元数模长慢慢偏离 1，角度就会越算越歪。

四元数微分方程里，q0是标量部分，q1/q2/q3是向量部分，陀螺仪角速度要先转成 rad/s。更新时用临时变量保存旧四元数，避免边算边覆盖。下面这段只给更新骨架，加速度计修正可以后加：

/* 四元数一阶积分，gx/gy/gz 单位 rad/s，dt 单位秒 */ void Quat_Update(float gx, float gy, float gz, float dt) { float q0 = quat[0], q1 = quat[1], q2 = quat[2], q3 = quat[3]; quat[0] += (-q1 * gx - q2 * gy - q3 * gz) * 0.5f * dt; quat[1] += ( q0 * gx + q2 * gz - q3 * gy) * 0.5f * dt; quat[2] += ( q0 * gy - q1 * gz + q3 * gx) * 0.5f * dt; quat[3] += ( q0 * gz + q1 * gy - q2 * gx) * 0.5f * dt; float norm = sqrtf(quat[0]*quat[0] + quat[1]*quat[1] + quat[2]*quat[2] + quat[3]*quat[3]); quat[0] /= norm; quat[1] /= norm; quat[2] /= norm; quat[3] /= norm; }

dt不稳定时，四元数积分误差比互补滤波更明显。主循环用HAL_Delay(10)只能算近似 10ms，串口打印一多就变成 12ms、15ms，角度会跟着抖。常见做法是用定时器中断置标志位，主循环检测到标志再读传感器和解算，dt用定时器周期。四元数转欧拉角时注意公式里的符号和奇异点，pitch 接近 ±90° 时 roll 和 yaw 会耦合，这是欧拉角本身的局限，不是解算错了。

5. 避坑与排查：读不到 ID、角度漂移、数据乱跳的 5 个现场

5.1 现象：WHO_AM_I 读回 0x00 或 0xFF

现象很直接：串口打印 WHO_AM_I，预期是 0x68，实际一直是 0x00 或 0xFF，后面所有原始数据也是死的。原因通常分三类：供电和地没接好，I2C 从机地址不对，总线被拉死。MPU6050 模块有的带稳压，有的直接 3.3V 供电，先量 VCC 和 GND 之间电压，再看 SDA/SCL 静态电平是不是被上拉到 3.3V。地址方面，AD0 接地是 0x68，接高是 0x69，HAL 里传 8 位地址时是 0xD0 或 0xD1，传 7 位地址的驱动则写 0x68。地址左移错一位，读回值就全是 0xFF。

解决办法是先写一个 I2C 扫描小程序，从 0x08 到 0x77 逐个地址发空写，看哪个地址有应答。扫描不到任何设备，查接线和上拉；扫描到 0x68 但 WHO_AM_I 不对，查寄存器地址是不是写成了 0x75 以外的值。SDA 被从机拉死时，可以断电重启，或者在 SCL 上手动发 9 个时钟脉冲解锁。血泪经验是：杜邦线接触不良比代码错误更常见，尤其是排针氧化后，万用表量通断都正常，一上电就时好时坏。

5.2 现象：角度静止时缓慢漂移

静止放在桌上，roll 和 pitch 每隔几秒漂零点几度，yaw 漂得更快。原因首先是陀螺仪零偏没扣干净，其次是校准期间桌子有震动，最后是温度变化。MPU6050 的陀螺仪零偏随温度会有小幅变化，上电校准一次只能管一段时间。如果校准采样时电脑风扇对着吹，或者手还放在桌上，均值会把震动吃进去，解算后就会往一个方向积分。

解决顺序是：校准前静置 30 秒，确认串口原始陀螺仪三轴在零附近跳动；校准采样 800 次以上，采样间隔固定；校准后打印零偏值，换模块对比。静止漂移仍然明显，可以在主循环里做运行时零偏估计：当加速度计模值接近 1g 且陀螺仪角速度很小时，缓慢更新零偏。这个做法不能太激进，否则真实缓慢转动会被当成零偏吃掉。yaw 漂移没有磁力计就无解，只能接受或加磁力计。

5.3 现象：串口有数据但姿态抖动大

角度能出来，但数值上下跳，手不碰模块也在抖。常见原因有三个：DLPF 带宽太高，加速度计把桌面高频振动吃进来；采样周期不稳定，dt忽大忽小；互补滤波的 alpha 太小，过度相信加速度计。先看原始数据，如果加速度计三轴静止时跳动几十个 LSB，先查供电和模块固定，软胶垫或海绵能滤掉一部分机械振动。DLPF 设到 3 档，加速度 44Hz、陀螺 42Hz，对入门场景够用。

采样周期方面，把HAL_Delay(10)换成定时器节拍，串口打印改成 100ms 一次，观察角度是否立刻变稳。alpha 从 0.96 往 0.98 调，动态跟随变快，但静态修正变慢；如果抖动是加速度计噪声引起的，调大 alpha 会明显改善。还要注意浮点 printf 在小容量芯片上的开销，打印本身可能拖慢主循环，形成“越打印越抖”的循环。先把打印关掉看原始波形，再决定要不要改滤波参数。

5.4 现象：编译通过但下载后不运行

编译零错误，下载也提示成功，但串口没输出，指示灯不亮。先查 BOOT0 是不是拉低，复位引脚是不是被外部电路拉住，SWD 下载后有没有勾选复位运行。C8T6 的启动模式由 BOOT0 和 BOOT1 决定，BOOT0 高电平会进系统存储器，程序不跑。电源方面，有些下载器只给 3.3V 小电流，模块一加上去电压就掉，表现就是下载成功但运行复位。

还有一类是工程配置问题：启动文件选错、堆栈太小、中断向量表偏移不对。串口 printf 重定向没开，也会看起来“没输出”。排查时先点灯，确认主循环在跑；再打印一个固定字符串，确认串口和时钟；最后读 WHO_AM_I。顺序不要反，否则会在 I2C 和下载配置之间来回怀疑。黑匣子思路在这里很有用：把每个阶段的状态码打到串口，哪一步停住一目了然。

5.5 现象：换一块板子数据就反了

同一套代码，换一块 MPU6050 模块，roll 和 pitch 方向反了，或者 yaw 转向相反。原因通常是模块安装方向不同、AD0 电平不同、量程配置没跟着改。MPU6050 的 X/Y/Z 轴定义固定在芯片上，模块焊在板子哪一面、怎么摆，决定了你看到的正方向。换模块后先看原始数据：倾斜模块，哪个轴的加速度变化符合预期，再决定要不要在解算前乘 -1。

解决方法是固定一套机体坐标系，在驱动层做轴映射，不要在滤波函数里到处改符号。比如规定 X 向前、Y 向右、Z 向下，模块装反了就交换轴或取反，映射表写清楚。量程换了，灵敏度宏也要换，否则角度比例会错。校准零偏也要重新做，不同模块的零偏不一样。踩坑最多的情况是只看欧拉角输出，不看原始数据，结果符号改来改去，最后自己也说不清哪一轴反了。

6. 进阶验证：六面静态校准与串口 CSV 波形自查

调姿态解算不能只看串口数字“像不像”，要有可重复的验证方法。我常用六面静态校准：把模块分别按六个面朝下放在水平桌面上，每个面静止 5 秒，记录加速度计三轴平均值和解算出的 roll/pitch。如果某个面角度偏差超过 2°，先查模块是否真的水平、量程是否配置正确、轴映射有没有错。六面数据还能用来估加速度计零偏和比例误差，入门阶段至少能确认方向映射是对的。

串口输出改成 CSV，用表格软件或串口波形工具看曲线，比盯着一行行文字有效。下面这段每 100ms 打一行，包含时间戳、原始加速度、原始陀螺仪和角度，方便回放：

/* CSV 输出：时间戳, ax, ay, az, gx, gy, gz, roll, pitch, yaw */ printf("%lu,%.3f,%.3f,%.3f,%.2f,%.2f,%.2f,%.2f,%.2f,%.2f\r\n", HAL_GetTick(), ax, ay, az, gx, gy, gz, roll, pitch, yaw);

看波形时重点看三件事：静止时角度是否收敛到一条水平线，快速倾斜后角度是否跟随且不过冲，回到静止后是否在几秒内稳住。如果快速倾斜时角度滞后严重，alpha 往大调；如果静止时来回摆，alpha 往小调或加大 DLPF。每次只改一个参数，改完重新做六面静态，别一次动三个地方。从那以后我每次拿到新的 MPU6050 模块，都先做一遍静态六面校验再上整机，不然调姿态解算就是纯玄学。需要对照原工程的话，按资源页的下载入口取一份即可，拿到后先跑通串口原始数据，再动解算参数。希望帮到你。

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