STM32CubeMX实战：I2C驱动MPU6050实现姿态数据采集

1. 项目背景与硬件准备

MPU6050作为一款集成了三轴加速度计和三轴陀螺仪的六轴运动传感器，在无人机、平衡车、手机姿态检测等领域应用广泛。我第一次接触这个传感器是在做一个自平衡机器人项目时，当时为了读取姿态数据折腾了好几天。后来发现用STM32CubeMX配置I2C接口来驱动MPU6050，整个过程能简化不少。

你需要准备的硬件包括：

• 任意一款STM32开发板（我用的F103C8T6最小系统板，成本不到20元）
• MPU6050模块（淘宝上10元左右就能买到）
• 杜邦线若干
• USB转TTL串口模块（用于调试输出）

硬件连接非常简单，只需要4根线：

1. VCC接3.3V
2. GND接地
3. SCL接PB6（I2C1时钟线）
4. SDA接PB7（I2C1数据线）

这里有个小细节要注意：虽然MPU6050支持5V供电，但建议使用3.3V，因为大多数STM32的IO口都是3.3V电平。我曾经因为用了5V供电导致通信不稳定，数据时不时出现乱码，排查了好久才发现是电平不匹配的问题。

2. STM32CubeMX工程配置

2.1 创建基础工程

打开STM32CubeMX，选择对应的MCU型号（我的是STM32F103C8）。在Pinout界面，先配置好系统时钟：

1. 在RCC里启用外部高速时钟(HSE)
2. 在SYS里选择Serial Wire调试模式
3. 配置时钟树，让主频达到72MHz

这些是STM32的标准配置，如果不太熟悉可以看我之前写的STM32CubeMX时钟配置教程。有个小技巧：配置完时钟树后，记得检查一下APB1总线的时钟频率，因为I2C1是挂载在APB1上的，它的时钟不能超过36MHz。

2.2 I2C外设配置

在Connectivity选项卡下找到I2C1：

1. 将模式设置为"I2C"
2. 参数保持默认即可（标准模式100kHz）
3. 自动分配的引脚应该是PB6(SCL)和PB7(SDA)

这里有个容易踩的坑：I2C的时钟速度要根据实际需求选择。如果你需要高速读取数据，可以选择快速模式(400kHz)，但要注意线长不能太长，否则会出现信号完整性问题。我在一个项目中使用20cm的杜邦线连接MPU6050，在400kHz下通信失败，后来改用100kHz就稳定了。

2.3 串口配置

为了能看到传感器数据，我们还需要配置一个串口：

1. 在Connectivity下选择USART1
2. 模式选择"Asynchronous"
3. 波特率设置为115200
4. 其他参数保持默认

记得在Project Manager里给工程起个有意义的名字，比如"MPU6050_I2C_Demo"，然后选择MDK-ARM作为Toolchain/IDE。建议勾选"Generate peripheral initialization as a pair of '.c/.h' files per peripheral"，这样代码结构会更清晰。

3. 驱动代码实现

3.1 MPU6050寄存器定义

在生成的工程里新建一个mpu6050.h文件，首先定义器件地址和常用寄存器：

#define MPU6050_ADDR 0xD0 // 左移后的地址 #define MPU_PWR_MGMT1_REG 0x6B #define MPU_ACCEL_CFG_REG 0x1C #define MPU_GYRO_CFG_REG 0x1B #define MPU_ACCEL_XOUTH_REG 0x3B #define MPU_GYRO_XOUTH_REG 0x43

注意这里的地址0xD0是经过左移的。MPU6050的原始地址是0x68，但HAL库要求地址左移一位，最低位表示读写操作（0写/1读）。所以写地址是0xD0，读地址是0xD1。

3.2 初始化函数

在mpu6050.c中添加初始化代码：

uint8_t MPU6050_Init(I2C_HandleTypeDef *hi2c) { uint8_t check; uint8_t Data; // 检查设备ID HAL_I2C_Mem_Read(hi2c, MPU6050_ADDR, 0x75, 1, &check, 1, 100); if(check != 0x68) return 1; // 不是MPU6050 // 唤醒设备 Data = 0; HAL_I2C_Mem_Write(hi2c, MPU6050_ADDR, MPU_PWR_MGMT1_REG, 1, &Data, 1, 100); // 设置加速度计量程±2g Data = 0x00; HAL_I2C_Mem_Write(hi2c, MPU6050_ADDR, MPU_ACCEL_CFG_REG, 1, &Data, 1, 100); // 设置陀螺仪量程±250°/s Data = 0x00; HAL_I2C_Mem_Write(hi2c, MPU6050_ADDR, MPU_GYRO_CFG_REG, 1, &Data, 1, 100); return 0; }

初始化时我通常会做三件事：检查设备ID、唤醒设备、设置量程。量程的选择很重要，±2g和±250°/s是常用配置，如果你需要测量更大的加速度或角速度，可以修改这两个寄存器的值。

3.3 数据读取函数

添加读取加速度和陀螺仪数据的函数：

void MPU6050_Read_All(I2C_HandleTypeDef *hi2c, int16_t *acc, int16_t *gyro) { uint8_t buf[14]; // 一次性读取所有数据寄存器 HAL_I2C_Mem_Read(hi2c, MPU6050_ADDR, MPU_ACCEL_XOUTH_REG, 1, buf, 14, 100); // 加速度数据 acc[0] = (int16_t)(buf[0] << 8 | buf[1]); // X轴 acc[1] = (int16_t)(buf[2] << 8 | buf[3]); // Y轴 acc[2] = (int16_t)(buf[4] << 8 | buf[5]); // Z轴 // 陀螺仪数据 gyro[0] = (int16_t)(buf[8] << 8 | buf[9]); // X轴 gyro[1] = (int16_t)(buf[10] << 8 | buf[11]); // Y轴 gyro[2] = (int16_t)(buf[12] << 8 | buf[13]); // Z轴 }

这里我优化了数据读取方式，一次性读取14个字节（6字节加速度+2字节温度+6字节陀螺仪），而不是分多次读取。这样做的好处是减少了I2C通信次数，提高了数据采集效率。在实际测试中，这种方式能让采样率从原来的50Hz提升到200Hz左右。

4. 主程序实现

4.1 变量定义与初始化

在main.c中添加以下代码：

// 定义全局变量 int16_t acc[3], gyro[3]; char msg[64]; // 在main函数中初始化 if(MPU6050_Init(&hi2c1) != 0) { printf("MPU6050 Init Failed!\r\n"); while(1); } printf("MPU6050 Init Success!\r\n");

初始化失败最常见的原因是I2C线路连接问题。建议在调试时先确认I2C通信是否正常，可以用逻辑分析仪抓取波形，或者简单点，在初始化失败时让一个LED闪烁。

4.2 主循环实现

在主循环中添加数据读取和打印代码：

while (1) { MPU6050_Read_All(&hi2c1, acc, gyro); sprintf(msg, "Acc: %6d %6d %6d | Gyro: %6d %6d %6d\r\n", acc[0], acc[1], acc[2], gyro[0], gyro[1], gyro[2]); HAL_UART_Transmit(&huart1, (uint8_t*)msg, strlen(msg), 100); HAL_Delay(50); // 20Hz采样率 }

这里我设置了一个20Hz的采样率，对于大多数应用来说已经足够。如果你需要更高的采样率，可以减小延时时间，但要注意两点：一是I2C通信需要一定时间，二是串口输出会成为瓶颈。在我的测试中，去掉串口输出后，采样率可以轻松达到500Hz以上。

5. 数据处理与校准

5.1 原始数据转换

MPU6050输出的原始数据需要根据量程设置进行转换：

// 加速度转换为g值（±2g量程） float acc_g[3]; acc_g[0] = acc[0] / 16384.0f; acc_g[1] = acc[1] / 16384.0f; acc_g[2] = acc[2] / 16384.0f; // 陀螺仪转换为°/s（±250°/s量程） float gyro_dps[3]; gyro_dps[0] = gyro[0] / 131.0f; gyro_dps[1] = gyro[1] / 131.0f; gyro_dps[2] = gyro[2] / 131.0f;

这些转换系数来自MPU6050的数据手册。不同量程对应的系数不同，如果你修改了量程设置，记得也要调整这些系数。

5.2 传感器校准

传感器通常会有零点偏移，需要进行校准：

// 校准参数（需要通过校准程序获取） float acc_offset[3] = { -123.5f, 45.2f, 89.7f }; float gyro_offset[3] = { 12.3f, -8.7f, 4.5f }; // 应用校准 acc_g[0] -= acc_offset[0]; acc_g[1] -= acc_offset[1]; acc_g[2] -= acc_offset[2] - 1.0f; // Z轴减去1g重力加速度 gyro_dps[0] -= gyro_offset[0]; gyro_dps[1] -= gyro_offset[1]; gyro_dps[2] -= gyro_offset[2];

校准方法很简单：将传感器静止放置，采集100-200个样本，计算平均值就是偏移量。对于加速度计，Z轴要特别注意减去1g的重力加速度。

6. 常见问题排查

6.1 I2C通信失败

如果初始化失败或读取的数据全是0，可能是以下原因：

1. 线路连接错误：检查SCL/SDA是否接反
2. 上拉电阻缺失：I2C总线需要4.7kΩ上拉电阻
3. 地址错误：确认AD0引脚电平，决定地址是0x68还是0x69
4. 电源问题：确保供电稳定，最好加一个0.1μF去耦电容

6.2 数据异常跳动

如果数据出现随机跳动：

1. 检查电源稳定性，可以用示波器看3.3V电源纹波
2. 缩短I2C线缆长度，过长会导致信号衰减
3. 降低I2C时钟速度，从400kHz降到100kHz
4. 添加适当的软件滤波，比如滑动平均滤波

6.3 采样率上不去

如果发现实际采样率低于预期：

1. 减少HAL_Delay的时间
2. 优化代码结构，减少不必要的操作
3. 考虑使用DMA传输数据
4. 关闭调试输出，串口打印会占用大量时间

7. 进阶应用

7.1 使用中断模式

前面的例子使用的是轮询方式，实际应用中更推荐使用中断：

// 在CubeMX中启用I2C中断 // 然后使用以下函数读取数据 HAL_I2C_Mem_Read_IT(&hi2c1, MPU6050_ADDR, MPU_ACCEL_XOUTH_REG, 1, buf, 14); // 在回调函数中处理数据 void HAL_I2C_MemRxCpltCallback(I2C_HandleTypeDef *hi2c) { if(hi2c == &hi2c1) { // 处理数据... } }

中断方式能更高效地利用CPU资源，特别是在需要高采样率时。不过要注意中断服务函数中不要做太耗时的操作。

7.2 结合DMA传输

对于要求更高的应用，可以结合DMA：

// 在CubeMX中启用I2C DMA // 定义DMA缓冲区 __ALIGN_BEGIN uint8_t dma_buf[14] __ALIGN_END; // 启动DMA传输 HAL_I2C_Mem_Read_DMA(&hi2c1, MPU6050_ADDR, MPU_ACCEL_XOUTH_REG, 1, dma_buf, 14); // DMA传输完成回调 void HAL_I2C_MemRxCpltCallback(I2C_HandleTypeDef *hi2c) { // 处理数据... }

DMA方式几乎不占用CPU资源，可以实现非常高的采样率。我在一个四轴飞行器项目中使用了这种方式，采样率达到了1kHz。

8. 实际项目经验

在最近的一个手势识别项目中，我遇到了一个有趣的问题：当设备快速移动时，加速度计数据会出现明显的失真。经过分析发现是电源管理的问题，MPU6050在快速变化时供电不足。解决方案是在VCC引脚就近加了一个47μF的钽电容，同时将I2C时钟降到50kHz。

另一个经验是关于数据融合的。单纯依靠加速度计或陀螺仪都有明显缺陷：加速度计在动态情况下不准，陀螺仪会有漂移。后来我采用了互补滤波算法，将两者的数据融合，得到了更稳定的姿态估计。核心代码很简单：

float angle = 0.98f * (angle + gyro_dps * dt) + 0.02f * atan2(acc_y, acc_z);

这个公式中0.98和0.02是滤波系数，dt是采样间隔时间。通过调整这两个系数，可以在响应速度和稳定性之间取得平衡。