基于STM32的MPU6050传感器应用实战：IIC通信与姿态解算详解

1. 项目概述与核心价值

搞嵌入式这几年，传感器项目十有八九都会碰到MPU6050这颗六轴惯性传感器。它内部集成了三轴加速度计和三轴陀螺仪，还自带一个温度传感器，通过IIC接口就能把九路原始数据读出来。我之前做过一个基于STM32的平衡小车姿态检测模块，核心就是这颗芯片。当时踩了不少坑，从IIC时序到寄存器配置，从数据毛刺到姿态解算，每一步都有值得记录的细节。这篇博客就围绕“基于STM32的MPU6050传感器应用（IIC）”这个项目，把我实际调试过程中的完整思路、代码实现和排障经验整理出来，希望能帮到正在做同类项目的朋友。

这个项目适合这几类人：刚入手STM32想玩传感器的初学者，需要给机器人、云台、穿戴设备做姿态检测的开发者，还有那些已经在读原始数据但发现结果抖动难看的工程师。读完你能搞懂IIC通信怎么在STM32上跑通，MPU6050的寄存器怎么配置，原始数据怎么转换和滤波，以及怎么避免那些网上教程不会明说的坑。

1.1 为什么选STM32和MPU6050这对组合

选择STM32作为主控，是因为它便宜、稳定、生态成熟。我用的是一块板载STM32F103C8T6的核心板，主频72MHz，硬件IIC外设和GPIO模拟IIC都能支持。对于MPU6050这种100kHz到400kHz的从设备来说，STM32的IIC速率完全够用。更重要的是，STM32的HAL库和标准库都有现成的IIC驱动模板，不用从零撸协议。

MPU6050之所以被广泛采用，一是它把加速度计和陀螺仪封装在同一个芯片里，省去了两个传感器之间的时间对齐麻烦；二是它内部有一个DMP（数字运动处理器），能直接输出四元数，省去自己搞姿态解算的功夫。不过DMP固件有点老，而且需要在库里面鼓捣，很多人更愿意自己用原始数据算角度，这样可控性更强。我后面会两种思路都提到，但核心还是围绕最基础的IIC读原始数据展开。

1.2 IIC通信基础速览

IIC是两线制通信：SCL（时钟线）和SDA（数据线）。所有设备挂在同一条总线上，每个设备有自己的地址。MPU6050的IIC地址是由AD0引脚决定的，AD0接地时地址是0x68，接高电平时是0x69。多数模块默认AD0接地，所以我代码里用的从地址是0x68。

IIC协议关键点就几个：起始条件（SCL高时SDA拉低）、停止条件（SCL高时SDA拉高）、字节传输高位在前、应答位由接收方拉低SDA。STM32的硬件IIC外设已经把这些封装好了，但很多人反映硬件IIC有bug，尤其在读MPU6050时容易卡死在busy状态。我实测下来，用GPIO模拟IIC反而更稳，代码也不复杂。后面我会给出模拟IIC的完整实现，这样不管换什么主控都能直接移植。

2. 硬件准备与连接细节

2.1 元器件清单

我的配置很简单：一块STM32F103C8T6核心板、一个MPU6050模块（市面上常见的GY-521模块都行）、4根杜邦线、一个面包板和一块3.3V稳压芯片。这里有个重点：MPU6050的工作电压是3.3V，但很多模块板载了稳压电路，可以兼容5V供电。如果你的模块上标着VCC接5V，那它内部已经处理好了；如果没标，老老实实接3.3V，否则芯片直接烧掉。

连接关系如下表所示：

2.2 接线与上拉的注意事项

MPU6050模块上通常已经焊了上拉电阻（一般是4.7kΩ到10kΩ），所以你不需要额外加上拉。但如果用模拟IIC，我建议检查一下SDA和SCL线上是否真的能拉到高电平。如果模块精简版没上拉，你得在GPIO配置时开启内部上拉，或者在外部接两个4.7kΩ电阻到3.3V。

另一个容易忽略的点是：STM32的IO口电平是3.3V，MPU6050也是3.3V电平，所以不要用5V单片机直连。如果主控是5V的，必须加电平转换模块，否则长期运行可能损坏传感器。

供电方面，我实测过，如果MPU6050和STM32共用同一个USB供电的3.3V电源，那完全没问题。但如果你接了舵机、电机之类的大电流外设，一定要给MPU6050单独供电或者用电容滤波，否则加速度计数据会随电机电流波动产生明显的随机关噪声。

2.3 模拟IIC还是硬件IIC？

这是新手最容易纠结的问题。我的结论：先上模拟IIC。原因有三：第一，模拟IIC用GPIO翻转实现，时序完全可控，不会出现硬件外设的奇怪中断问题；第二，代码可读性高，方便调试；第三，不管是标准库还是HAL库，模拟IIC函数都十几行就能写完，性能损耗对MPU6050读数据来说可以忽略。

硬件IIC的优势是CPU占用很低，适合需要在后台持续高速读取的场景。但STM32F1系列的硬件IIC在部分硅版本上确实有known issues，主要表现为总线busy状态卡死。我见过太多人在这个上面耗了一整天，最后换模拟IIC一分钟就通了。所以这篇教程统一用模拟IIC，稳字当头。

3. 软件开发环境与核心代码实现

3.1 初始化流程

初始化分两部分：GPIO初始化和MPU6050初始化。GPIO初始化就是把PB6和PB7都设为开漏输出模式，并开启内部上拉。开漏输出模拟IIC是标准做法，因为IIC协议要求多设备共享总线，开漏加上拉才能实现线与逻辑。

MPU6050初始化其实是往几个关键寄存器写值。我用HAL库的朋友可以直接看代码注释。核心寄存器如下：

• 电源管理寄存器1（0x6B）：bit7是设备复位，置1后复位，复位完成后自动清零。bit6是sleep模式，置0表示正常唤醒。
• 采样率分频寄存器（0x19）：控制陀螺仪输出速率，计算公式是OutputRate = 1kHz / (1 + SMPLRT_DIV)。我设成0x07，采样率就是125Hz，够用且不丢数。
• 配置寄存器（0x1A）：设置数字低通滤波器（DLPF）带宽。我设成0x06，对应带宽5Hz，数据最平滑，但实时性差一点。追求响应的可以设0x03（44Hz）。
• 陀螺仪配置寄存器（0x1B）：选择量程，我用的±2000°/s，对应灵敏度16.4 LSB/(°/s)。
• 加速度计配置寄存器（0x1C）：选择量程，我用的±2g，对应灵敏度16384 LSB/g。

初始化顺序很重要。我的代码是先复位芯片，再唤醒，然后配置采样率和滤波器，最后配置量程。如果复位和唤醒的顺序反了，芯片可能退回sleep状态，后续寄存器写入无响应。

void MPU6050_Init(void) { // 唤醒传感器：关闭睡眠模式 IIC_WriteReg(0x68, 0x6B, 0x00); // 配置采样率分频器，125Hz IIC_WriteReg(0x68, 0x19, 0x07); // 配置DLPF，5Hz带宽 IIC_WriteReg(0x68, 0x1A, 0x06); // 陀螺仪量程±2000dps，灵敏度16.4 LSB/dps IIC_WriteReg(0x68, 0x1B, 0x18); // 加速度计量程±2g，灵敏度16384 LSB/g IIC_WriteReg(0x68, 0x1C, 0x00); }

3.2 模拟IIC读写函数

模拟IIC的代码我写了很多遍，核心就是四个：起始、停止、发送字节、接收字节。下面是我简化过的版本，已经过实战验证。

#define SCL_PIN GPIO_PIN_6 #define SDA_PIN GPIO_PIN_7 #define SCL_H() HAL_GPIO_WritePin(GPIOB, SCL_PIN, GPIO_PIN_SET) #define SCL_L() HAL_GPIO_WritePin(GPIOB, SCL_PIN, GPIO_PIN_RESET) #define SDA_H() HAL_GPIO_WritePin(GPIOB, SDA_PIN, GPIO_PIN_SET) #define SDA_L() HAL_GPIO_WritePin(GPIOB, SDA_PIN, GPIO_PIN_RESET) #define SDA_READ() HAL_GPIO_ReadPin(GPIOB, SDA_PIN) void IIC_Start(void) { SDA_H(); SCL_H(); delay_us(5); SDA_L(); delay_us(5); SCL_L(); } void IIC_Stop(void) { SDA_L(); SCL_H(); delay_us(5); SDA_H(); delay_us(5); } void IIC_WriteByte(uint8_t data) { for (int i = 0; i < 8; i++) { if (data & 0x80) SDA_H(); else SDA_L(); data <<= 1; SCL_H(); delay_us(2); SCL_L(); delay_us(2); } // 释放SDA，读应答 SDA_H(); SCL_H(); delay_us(2); if (SDA_READ()) { // 无应答，可在这里置错误标志 } SCL_L(); delay_us(2); } uint8_t IIC_ReadByte(void) { uint8_t data = 0; SDA_H(); // 切换为输入模式前先释放 for (int i = 0; i < 8; i++) { data <<= 1; SCL_H(); delay_us(2); if (SDA_READ()) data |= 0x01; SCL_L(); delay_us(2); } return data; }

有个细节必须提醒：在发送字节函数里读应答时，要把SDA设为输入模式或者直接释放（开漏模式下写1就是释放）。我见过很多人忘了这一步，导致SDA一直被拉低，后续通信全部失败。

3.3 读取原始数据的流程

MPU6050的加速度计和陀螺仪数据都是16位有符号数，存成两个相邻寄存器（高字节在前）。所以读取时要先发送从机地址加写位，然后发送目标寄存器地址，重新发送起始条件，再发送从机地址加读位，连续读取6个字节（加速度）或6个字节（陀螺仪）。

我封装了一个读多字节的函数，一次性把6个加速度寄存器（0x3B~0x40）和6个陀螺仪寄存器（0x43~0x48）读出来。这里为什么要先写寄存器地址再重复起始？因为MPU6050的数据指针是自动递增的，但如果你直接读，会从上次结束的位置开始，所以必须显式指定起始地址。

void MPU6050_ReadRaw(int16_t *accel, int16_t *gyro, int16_t *temp) { uint8_t buf[14]; IIC_Start(); IIC_WriteByte(0x68 << 1); // 写地址 IIC_WriteByte(0x3B); // 温度高字节地址，也是加速度计起始地址 IIC_Start(); IIC_WriteByte((0x68 << 1) | 0x01); // 读地址 for (int i = 0; i < 14; i++) { buf[i] = IIC_ReadByte(); // 除了最后一个字节，其余都要发送应答ACK if (i < 13) { SDA_L(); // 产生ACK SCL_H(); delay_us(2); SCL_L(); } } IIC_Stop(); // 组合高字节和低字节 accel[0] = (buf[0] << 8) | buf[1]; accel[1] = (buf[2] << 8) | buf[3]; accel[2] = (buf[4] << 8) | buf[5]; temp[0] = (buf[6] << 8) | buf[7]; gyro[0] = (buf[8] << 8) | buf[9]; gyro[1] = (buf[10] << 8) | buf[11]; gyro[2] = (buf[12] << 8) | buf[13]; }

注意最后一个字节要发送NAK，表示读完了。如果你偷懒全部回ACK，设备会继续发送data，导致总线节奏错乱。这是IIC规范里容易被忽略的点。

4. 数据转换、校准与滤波处理

4.1 原始值换算成物理量

读出来的原始值只是LSB，必须除以灵敏度才能变成有单位的物理量。加速度除以16384得到g值，陀螺仪除以16.4得到°/s，温度换算公式是Temp = raw / 340 + 36.53。

我做了个表方便查：

换算代码很简单：

float ax = accel[0] / 16384.0f; float ay = accel[1] / 16384.0f; float az = accel[2] / 16384.0f; float gx = gyro[0] / 16.4f; float gy = gyro[1] / 16.4f; float gz = gyro[2] / 16.4f;

4.2 零飘校准的笨办法与聪明办法

陀螺仪零飘是永恒的话题。芯片静止时，理论输出应该全是0，但实际不是，每个轴会有一个偏置。最笨的办法是开机时读取100次数据取平均，然后每次读数都减去这个平均值。我最初就这么干的，效果还行，但有一个问题：偏置会随温度漂移。

我后来用的办法是每次上电后做500ms的静止校准，取平均作为偏置值。这个办法够用，但前提是设备在开机时确实静止。如果你的设备开机就在动，可以用动态校准算法，比如滑动窗口内取最小值，但那是另一个复杂度了。

加速度计的偏置校准也类似，但更推荐采集多组数据做最小二乘法，或者直接用芯片的出厂自校准，不折腾。MPU6050有个厉害的寄存器组0x06~0x0D可以写入自校准偏移，但说实话，用软件减偏置更直观。

4.3 低通滤波的经典实现

光靠DLPF还不够，实际数据仍然会有高频噪声，尤其是加速度计。我习惯再加一层软件低通滤波，最常用的一阶互补滤波或者滑动平均。下面这个一阶低通滤波我用了很久：

float alpha = 0.2f; float filtered; filtered = alpha * raw_physical + (1.0f - alpha) * last_filtered;

alpha越大，跟随越快，噪声越大；alpha越小，数据越平，但滞后越多。我平衡车项目里取alpha=0.2，实测响应和稳定性兼顾。如果只是做显示，alpha取0.1都行。

滑动平均也很稳：维护一个环形缓冲区，每次取最近N个值平均。N取10到20效果就不错。缺点是有固定延迟，但N小的话延迟可以接受。

5. 从原始数据到姿态角：两种入门方法

5.1 加速度计计算倾角

加速度计可以直接算横滚角（roll）和俯仰角（pitch）。公式很经典：

roll = atan2f(ay, az) * 180.0f / PI; pitch = atan2f(-ax, sqrt(ay*ay + az*az)) * 180.0f / PI;

注意公式里的方向依赖于重力方向。如果你的模块安装方向和我不同，正负号要根据实际调。这个方法对静态很准，但动态一加速就会受到运动加速度干扰，导致角度乱跳。所以加速度计算角度只适合慢速或静止场景。

5.2 陀螺仪积分与互补滤波

陀螺仪测的是角速度，对角速度积分能得到角度，但积分会累积漂移，几秒钟就有明显偏差。加速度计短期不准但长期稳，陀螺仪短期准但长期漂，所以两者互补。

最简单的互补滤波就是加权融合：

angle = 0.98 * (last_angle + gyro_rate * dt) + 0.02 * accel_angle;

0.98和0.02这两个系数，表示相信我更多信任陀螺仪的短期积分，同时用加速度计慢慢修正漂移。dt是采样周期，假设你定时器1ms读一次数据，dt=0.001。

这个办法实现简单，我已经在项目里跑通，效果比单纯加速度计好太多。但如果设备长期高速运动，加速度计还是会被运动加速度污染，这时候就该上Madgwick或者Mahony算法了。那些算法网上有现成源码，我推荐Madgwick，代码量和性能都很均衡。

6. 常见问题与排查技巧实录

6.1 IIC通信失败：第一次读就卡死

现象：程序执行到读数据函数时，SDA一直为高，读取永远返回0xFF。排查方向：

• 检查接线：SCL和SDA有没有接反？我接过反一次，现象就是这样。
• 检查上拉：确认SDA和SCL有上拉，或者GPIO开了内部上拉。
• 检查从机地址：MPU6050的地址是7位0x68，但是在IIC传输时，写地址是0xD0，读地址是0xD1。很多人直接用0x68当8位地址传，那是错的。我代码里用的是0x68 << 1，这样才符合规范。

6.2 数据全是0或4096

如果加速度计读出来都是0，大概率是地址不对或者芯片没被唤醒。检查0x6B寄存器的值。如果陀螺仪读出来都是4096，那是量程配置寄存器没写进去，灵敏度用错了。

6.3 模拟IIC的延时到底要多长

很多人问延时怎么选。答：主要看SCL高低电平的最小周期。MPU6050在快速模式下要求SCL频率400kHz，慢速模式100kHz。GPIO翻转本身很快，但加上读取SDA的时间，实际频率可能每秒几十万次，已经超过了400kHz。所以你必须在每次SCL翻转之间加delay，我代码里的2微秒延时，实测SCL频率在80kHz左右，完全满足慢速模式。

有个偷懒的办法：直接用delay_us(5)，SCL频率降到40kHz，更稳。数据更新率125Hz，这点延迟不算事。

6.4 角度跳变问题

跳变通常来自两个原因：一是滤波器系数调得太激进，二是传感器本身受震动影响。解决方法是先用一个软件低通滤波，然后调大alpha值，最后检查机械固定是否牢固。我之前用面包板插线，稍微碰一下桌子数据就飞了，后来换成排针焊接才稳定。

6.5 温度数据读出来怪怪的

温度寄存器的换算公式是raw / 340 + 36.53，单位是摄氏度。如果你直接用有符号数算，注意先转成float再除，否则整数除法会丢掉小数。再一个，芯片内部温度比环境温度高8到15度很正常，别拿它当精密温度计。

7. 扩展玩法与工程化建议

7.1 接入DMP输出四元数

如果你的应用需要完整的欧拉角，不想自己写解算，可以用MPU6050的DMP功能。它的DMP固件能把IMU数据融合成四元数，直接从FIFO里读出来。不过DMP库对STM32F1支持很好，代码略多。我个人的建议是：如果只想做一个演示，原始数据加互补滤波就够了；如果要上产品，直接研究DMP或Madgwick，别在简单滤波上浪费时间。

7.2 低功耗设计

如果你的项目用电池供电，MPU6050的功耗其实很小（亚毫安级别），大头在STM32和无线模块。MPU6050有一个低功耗模式，设置0x6C寄存器来关闭ACC和GYRO的部分轴可以省电。但注意，低功耗模式下输出速率会受限，微乎其微，实际项目里可以不管它。

7.3 多传感器级联

IIC总线可以挂多个MPU6050吗？可以，但前提是每个传感器的AD0引脚必须不一样，一个接0x68，一个接0x69。再多就没有地址位了，得换其他方案，或者用IIC多路开关。不过一般项目一个IMU够了。

7.4 真实项目的性能考量

如果你的主循环里有其他重活，比如跑LCD刷新或者无线通信，建议把读取MPU6050的任务放到定时器中断里，用标志位通知主循环取数据。我实际做平衡车时就踩过坑：主循环里用HAL_Delay(5)延时，结果MPU6050读取间隔不稳定，导致互补滤波的dt取值不准，角度出现振荡。后来改为定时器5ms中断触发读取，数据稳定多了。

另外一个细节：读取MPU6050的原始数据时，用DMA也可以，但要注意缓存一致性和多线程互斥。对普通项目来说，阻塞式读取完全够快——一次读14字节，GPIO模拟IIC耗时不到1ms，真没必要为了那点时间把代码搞复杂。

做这个项目的过程中，我最深的体会是：先把通信调通，再谈算法。很多人一上来就想往DMP里钻，结果连原始数据都没看到，白费一堆时间。先把模拟IIC跑通，用示波器或者逻辑分析仪确认SCL和SDA波形正确，然后一个一个寄存器去调试，你会发现其实每一步都有迹可循。踩过一次坑以后，遇到其他IIC从设备（比如OLED、温度传感器）基本都能很快上手。

最后再分享一个小技巧：如果你手头有逻辑分析仪，强烈建议在调试IIC时挂上去看波形。它能让你直接看到ACK有没有回、时序对不对，比猜代码快十倍。等你看过几次正确的波形，以后再遇到通信问题，脑子里就会有个画面，排查效率会高很多。