简介面向 STM32 嵌入式开发者MPU6050/MPU9150 驱动代码是一套可直接运行的传感器实验工程主要用于解决六轴/九轴惯性数据的读取、姿态解算与运动跟踪问题适合无人机、机器人、VR 等项目的入门与二次开发。压缩包共 177 个文件包含 .c/.h 源程序、Keil 工程配置文件、编译生成的 .hex/.axf 可执行文件及 .map 映射文件整体约 3.62MB工程目录完整便于对照原理查看寄存器配置与回调逻辑。资源不仅涵盖 I2C 初始化、寄存器读写、数据解析和滤波处理还加入 DMP 功能配置与中断处理示例能够帮助开发者快速掌握运动传感器的驱动思路。目前已有 467 人学习下载对正在学习 STM32 外设驱动或准备做惯性导航项目的读者来说是一份贴近实战的参考资料。 MPU6050 配合 STM32 做姿态检测算得上嵌入式入门里最经典的一课了。我之前做小车倾斜检测和手势控制时都栽过跟头问题往往不在算法而在最基础的驱动代码——I2C 读不到设备、寄存器配置不对、数据全是乱跳这类问题能把人磨到怀疑人生。这篇文章就把 MPU6050 模块在 STM32 上的驱动代码完整拆开讲从硬件接线、HAL 库底层读写到原始数据换算、DMP 四元数解算再到常见的坑和排查方法一气呵成。适合刚接触 STM32 想第一次跑通 IMU 的初学者也适合想从标准外设库换成 HAL 库、把代码整理成可复用模块的开发者。1. 项目整体思路与关键技术选型1.1 先搞懂 MPU6050 内部到底在算什么MPU6050 把一颗三轴加速度计和一颗三轴陀螺仪封装在同一颗芯片里另外还带了一个温度传感器。加速度计测量的是“比力”在静止状态下它最能反映重力方向所以俯仰角、横滚角可以由加速度值推算出来陀螺仪测量的是绕各轴的角速度对角速度积分可以得到角度变化但积分会随着时间漂移。单独用任何一种都有硬伤加速度计对震动和运动加速度非常敏感稍微一晃数据就飞了陀螺仪长期积分则会产生明显的零漂累积。MPU6050 聪明的地方在于内部集成了一颗数字运动处理器 DMP硬件上就能把两种数据融合成四元数输出。主控只需要通过 I2C 把四元数读出来再做一次简单的数学转换就能拿到姿态角。选它做项目的原因其实很现实便宜、资料多、模块化程度高。淘宝上一块八九块钱的模块就能出数据配套的代码和踩坑经验几乎全网都是特别适合作为 STM32 驱动开发的第一块 IMU。1.2 驱动方案选型为什么我建议走 HAL 库这条路MPU6050 的驱动方式有三条路可以走直接操作寄存器、标准外设库、HAL 库。直接操作寄存器代码最短但寄存器手册要翻到吐而且平台移植性差标准外设库在 STM32F1 时代很流行官方已经基本停止维护HAL 库配合 CubeMX 生成的初始化代码几乎零错误虽然代码看起来多了几层封装但可读性和可维护性是最好的。我推荐的组合是STM32CubeMX 生成工程 HAL 库 I2C 官方 Motion Driver 库移植。实际用下来HAL_I2C_Mem_Read这种接口天然支持“先指定寄存器地址再连续读数据”和 MPU6050 这种寄存器型传感器的读取方式完全匹配不需要自己实现 I2C 时序比裸写 GPIO 模拟 I2C 省太多事。DMP 这段则直接用 InvenSense 官方提供的 Motion Driver。初次上手不建议自己写互补滤波或卡尔曼滤波一个是调参周期长另一个是官方库已经把陀螺仪和加速度计的融合做好了直接拿四元数结果来用完全能满足小车、机械臂、手势控制这类项目需求。2. 硬件连接与 HAL 库底层读写2.1 引脚分配与接线六根线就能跑MPU6050 模块的排针通常引出 8 个引脚实际驱动只需要其中 6 个VCC、GND、SCL、SDA、AD0、INT。XDA 和 XCL 是用来外接磁力计的辅助 I2C 接口做基础姿态检测用不到。我用 STM32F103C8T6 为例I2C1 的默认引脚是 PB6SCL和 PB7SDA这是 CubeMX 里最省事的接法不用再手动映射 GPIO。模块引脚STM32 引脚说明VCC3.3V必须接 3.3V不能接 5VGNDGND共地SCLPB6I2C1 时钟线SDAPB7I2C1 数据线AD0GND拉低时 I2C 地址为 0x68INTPB0可选数据就绪中断引脚这里强调一下VCC 接 5V 的板子偶尔也能跑但长时间工作会发热极端情况下会烧坏模块内部的稳压电路。电源不稳时强烈建议在 VCC 和 GND 之间加一个 100nF 去耦电容离模块引脚越近越好。2.2 CubeMX 配置 I2C1 的步骤在 CubeMX 里选好 STM32 芯片型号后把 PB6、PB7 配置为 I2C1_SCL、I2C1_SDA然后在 Connectivity 选项卡里打开 I2C1把 Speed Mode 设为 Fast Mode频率设为 400kHz。MPU6050 的 I2C 时钟最高支持 400kHz这个值可以直接吃满。生成工程后I2C 的初始化代码会自动出现在main.c里不需要手动改。时钟树方面如果使用外部晶振注意 HCLK 不要超频如果使用内部时钟I2C 也能工作只是时序精度稍差调试阶段问题不大。2.3 封装两个底层读写函数后面全靠它们HAL 库里有HAL_I2C_Mem_Write和HAL_I2C_Mem_Read这两个函数专为寄存器型器件设计。我习惯把它们再包一层后面所有 MPU6050 操作都只调用这两个函数代码会清爽很多。#define MPU6050_ADDR 0xD0 // 8位设备地址AD00时对应7位地址0x68左移一位 uint8_t MPU_Write_Reg(uint8_t reg, uint8_t data) { return HAL_I2C_Mem_Write(hi2c1, MPU6050_ADDR, reg, I2C_MEMADD_SIZE_8BIT, data, 1, 100); } uint8_t MPU_Read_Regs(uint8_t reg, uint8_t *buf, uint8_t len) { return HAL_I2C_Mem_Read(hi2c1, MPU6050_ADDR, reg, I2C_MEMADD_SIZE_8BIT, buf, len, 100); }这里最容易被坑的是地址。DMP 库和大部分网上例程用的是 7 位地址 0x68但 HAL 库的DevAddress参数需要的是 8 位地址也就是 0x68 左移一位得到 0xD0。有些人直接填 0x68结果 I2C 总线上根本扫描不到设备。调试时先用一个 I2C 扫描程序把所有设备地址打印出来能省非常多时间。2.4 硬件层最容易踩的两个坑第一SCL 和 SDA 必须接上拉电阻。MPU6050 模块上有些自带 4.7k 上拉有些没有。如果你用的是裸芯片或者某些精简模块I2C 总线上没有上拉读回来的数据就是 0xFF。第二不要用 GPIO 模拟 I2C 去读 DMP 的 FIFO速率跟不上会导致丢包四元数会跳变得很厉害。建议直接用硬件 I2C 外设时序稳定且不占用 CPU 去死等。3. 初始化寄存器与原始数据换算3.1 唤醒芯片并配置量程寄存器序列MPU6050 上电后默认处于睡眠模式要往电源管理寄存器 0x6B 写 0 来唤醒。之后依次配置采样率分频、数字低通滤波器 DLPF、陀螺仪量程和加速度计量程。每次写寄存器之间最好加一点小延时让芯片内部稳定。void MPU6050_Init(void) { HAL_Delay(50); MPU_Write_Reg(0x6B, 0x00); // PWR_MGMT_1 退出睡眠使用内部时钟 MPU_Write_Reg(0x19, 0x00); // SMPLRT_DIV 采样率不分频保持默认 MPU_Write_Reg(0x1A, 0x03); // CONFIG DLPF 开启带宽约 44Hz MPU_Write_Reg(0x1B, 0x08); // GYRO_CONFIG 陀螺仪量程 ±500dps MPU_Write_Reg(0x1C, 0x00); // ACCEL_CONFIG 加速度计量程 ±2g HAL_Delay(50); }DLPF 带宽选 44Hz 是个比较通用的值能把高频机械振动和电源噪声滤掉同时保留足够快的姿态响应。如果你做的是快速旋转的机械臂可以把带宽调高到 98Hz 或 188Hz做静态倾角检测调到 10Hz 都行。量程方面普通平路小车用 ±500dps 和 ±2g 足够如果模块装的部位震动大加速度计量程可以提到 ±4g 甚至 ±8g换取更大的动态范围。3.2 读取六轴原始值连续读 14 个字节MPU6050 的加速度计、温度、陀螺仪数据从寄存器 0x3B 开始连续排列直接用MPU_Read_Regs一次读 14 个字节比分别读每一个寄存器更高效也能避免读取过程中数据被更新导致的错位问题。typedef struct { int16_t accel_x; int16_t accel_y; int16_t accel_z; int16_t temp; int16_t gyro_x; int16_t gyro_y; int16_t gyro_z; } MPU6050_Raw; MPU6050_Raw raw; void MPU_Read_Raw(MPU6050_Raw *raw) { uint8_t buf[14]; MPU_Read_Regs(0x3B, buf, 14); raw-accel_x (buf[0] 8) | buf[1]; raw-accel_y (buf[2] 8) | buf[3]; raw-accel_z (buf[4] 8) | buf[5]; raw-temp (buf[6] 8) | buf[7]; raw-gyro_x (buf[8] 8) | buf[9]; raw-gyro_y (buf[10] 8) | buf[11]; raw-gyro_z (buf[12] 8) | buf[13]; }注意数据类型必须用int16_t不能只用一个short就完事不同编译器下 short 的位数有差异。数据合并时先读高字节再低字节这个顺序取决于寄存器地址的排列0x3B 是高位所以buf[0] 8 | buf[1]。3.3 原始值到底代表什么LSB 到物理量的换算初始化里配置了不同的量程对应的灵敏度就不同。灵敏度表示“1g 或 1°/s 对应多少个 LSB”。换算关系很简单物理量 原始值 / 灵敏度。加速度计量程灵敏度 (LSB/g)陀螺仪量程灵敏度 (LSB/°/s)±2g16384±250°/s131±4g8192±500°/s65.5±8g4096±1000°/s32.8±16g2048±2000°/s16.4我上面的初始化里加速度计是 ±2g所以灵敏度过 16384陀螺仪是 ±500°/s灵敏度为 65.5。换算代码非常简单float accel_x_g raw.accel_x / 16384.0f; float gyro_x_dps raw.gyro_x / 65.5f;验证数据是否合理的方法把模块平放在桌面上静止不动。此时加速度计 z 轴应该在 16384 左右x、y 轴接近 0陀螺仪三轴都接近 0但可能有几十 LSB 的零漂偏差这是正常的。如果 z 轴读数明显不对很可能量程配置和换算表对不上。4. DMP 姿态解算与完整流程4.1 移植 Motion Driver文件结构和 I2C 回调InvenSense 官方的 Motion Driver 是一个压缩包里面核心文件是inv_mpu.c、inv_mpu_dmp_motion_driver.c还有对应的头文件inv_mpu.h、inv_mpu_dmp_motion_driver.h。网上有些魔改版本集成了 I2C 实现真正用的时候需要把库文件里自带的 I2C 读写函数注释掉替换成自己的 HAL 实现。库文件内部是通过i2c_write和i2c_read两个回调函数访问传感器的默认的形参地址是 7 位地址。我在inv_mpu.c开头改这两个函数时会额外做一个地址转换避免后面每次调用都踩坑int i2c_write(unsigned char addr, unsigned char reg, unsigned char *data, unsigned short len) { return HAL_I2C_Mem_Write(hi2c1, addr 1, reg, I2C_MEMADD_SIZE_8BIT, data, len, 100); } int i2c_read(unsigned char addr, unsigned char reg, unsigned char *data, unsigned short len) { return HAL_I2C_Mem_Read(hi2c1, addr 1, reg, I2C_MEMADD_SIZE_8BIT, data, len, 100); }库内默认地址是 7 位 0x68addr 1之后传给 HAL 的 0xD0 就是正确的 8 位地址。很多人移植不成功十有八九就卡在这一步。4.2 DMP 初始化官方流程按顺序来DMP 初始化有一套固定的调用顺序不能乱。完整流程一般在主函数上电延时后执行一次#define DEFAULT_MPU_HZ 100 void MPU_DMP_Init(void) { if (mpu_init(NULL) ! 0) { while (1); } mpu_set_sensors(INV_XYZ_GYRO | INV_XYZ_ACCEL); mpu_configure_fifo(INV_XYZ_GYRO | INV_XYZ_ACCEL); mpu_set_sample_rate(DEFAULT_MPU_HZ); dmp_load_motion_driver_firmware(); dmp_set_fifo_rate(DEFAULT_MPU_HZ); mpu_set_dmp_state(1); }mpu_init内部会配置芯片的基础状态参数传 NULL 表示使用默认配置。dmp_load_motion_driver_firmware是把 DMP 固件通过 I2C 写入 MPU6050 内部的 RAM这个过程需要几十毫秒期间不能被打断如果 I2C 速度太慢或总线上有其他设备抢资源可能导致固件加载失败。dmp_set_fifo_rate设置 DMP 输出频率100Hz 足够大部分应用调太高 FIFO 会溢出调太低姿态感觉迟钝。4.3 读取四元数并转换成欧拉角DMP 输出的是四元数保存在一个long quat[4]数组里单位是 Q14 定点格式。所谓 Q14 就是实际浮点值等于原始整数除以 2 的 14 次方也就是 16384。四元数转欧拉角的公式是固定的我直接贴出能用版本void MPU_Read_Euler(float *roll, float *pitch, float *yaw) { long quat[4]; short gyro[3], accel[3]; unsigned long timestamp; unsigned char more; int sensors; if (dmp_read_fifo(gyro, accel, quat, timestamp, sensors, more) 0) { if (sensors INV_WXYZ_QUAT) { float q0 quat[0] / 16384.0f; float q1 quat[1] / 16384.0f; float q2 quat[2] / 16384.0f; float q3 quat[3] / 16384.0f; *roll atan2f(2 * (q0 * q1 q2 * q3), 1 - 2 * (q1 * q1 q2 * q2)) * 57.2958f; *pitch asinf(2 * (q0 * q2 - q3 * q1)) * 57.2958f; *yaw atan2f(2 * (q0 * q3 q1 * q2), 1 - 2 * (q2 * q2 q3 * q3)) * 57.2958f; } } }dmp_read_fifo的返回值判断很关键只有返回 0 才表示读取成功。sensors变量里带有标志位只有INV_WXYZ_QUAT被置位时quat数组才有效否则可能拿到的是上一帧残留数据。pitch 角用asin计算范围限制在 -90 度到 90 度做平衡车足够如果需要万向节无死角姿态建议直接用四元数运算不要转到欧拉角。5. 常见故障排查与项目扩展5.1 我实际遇到过的坑问题速查表在多个项目里折腾过 MPU6050 之后我发现大部分问题都集中在几个固定位置顺手整理成一个排查表。遇到问题先对照这个表查比漫无目的地读寄存器靠谱得多。现象可能原因处理方法I2C 扫描不到 0x68 设备SCL/SDA 接反或上拉电阻缺失检查接线确认模块是否自带 4.7k 上拉必要时外加上拉能读到寄存器但数据全是 0xFFHAL 库设备地址填成了 7 位将 DevAddress 改成 0xD0即 0x68 左移一位静止时加速度 z 轴明显不为 1g量程配置与灵敏度换算不对应确认 ACCEL_CONFIG 的寄存器按表格对应灵敏度换算姿态角缓慢漂移没有上 DMP或者 DMP 输出频率太低开启 DMP提高 FIFO 读取频率DMP 初始化返回 -1I2C 回调地址偏移错误或固件加载被中断检查addr 1确保初始化期间 I2C 不会被其他任务抢占角度在某个位置跳变 180 度欧拉角万向节锁定或 arctan 象限判断不准改用四元数形式输出还有一类问题很隐蔽I2C 总线上挂了多个设备另外某个设备的地址恰好和 MPU6050 冲突或者从设备在初始化阶段把 SDA 拉死导致后续所有 I2C 通信失败。解决办法是把 MPU6050 单独接到一组 I2C或者用 I2C MUX 芯片做隔离。5.2 进阶玩法INT 中断、OLED 显示与互补滤波基础驱动跑通之后可以尝试几个方向扩展。第一个是使用 INT 引脚。MPU6050 的数据就绪引脚在 FIFO 有新数据时会拉高把 INT 接到 STM32 的 EXTI 中断中断标志发生时再读 FIFO可以避免主循环里反复查询带来的 CPU 浪费。配置方法是mpu_set_int_level(1)和mpu_set_int_enable(1)具体实现可以参考 Motion Driver 里的mpu_get_int_status。第二个是把数据可视化。用 SSD1306 的 OLED 屏搭配 I2C 或 SPI 显示当前姿态角调试效率比串口打印高得多尤其是做平衡车的时候能直观看到模块姿态和实际车体的对应关系。OLED 驱动网上很多不用自己造轮子。第三个是如果不想用 DMP也可以自己写互补滤波。互补滤波的原理很简单陀螺仪积分短期可信加速度计测角长期可信两者通过一个系数融合。核心代码大概长这样float angle 0.98f * (angle gyro_dps * dt) 0.02f * accel_angle;这个 0.98 和 0.02 就是互补系数具体值要根据你的 DLPF 带宽和采样周期微调。DMP 方案省事互补滤波方案灵活新手建议先跑通 DMP 再回头研究滤波会对传感器融合理解得更深。5.3 从模块到手写板移植的注意事项很多人跑通模块之后会想着把代码移植到自制的 PCB 板上。这个时候要额外注意几条MPU6050 芯片下方的 PCB 上最好铺一块完整的地不要走其他信号线因为芯片内部对机械应力敏感PCB 形变会直接影响加速度计输出芯片的焊接温度不能过高回流焊次数多了会影响内部传感器精度VCC 处再加一个 10uF 钽电容和 0.1uF 陶瓷电容并联电源纹波对陀螺仪的影响比加速度计大得多。我自己的习惯是拿到一个新模块先不急着上 DMP先把原始数据读出来在串口或者 OLED 上看着静止状态的数值确认量程、符号都对再上 DMP。这一步能帮你排除掉大部分硬件问题。另外一个建议是如果是要做产品别在 DMP 这条路上死磕官方库在老型号上确实够稳但换成新品 IMU 时优先考虑厂家新库。最后提醒一句I2C 总线上如果还有其他设备一定要把速率降到 100kHz 或者做好设备地址区分否则 MPU6050 被总线拖垮是常事。先把原始读数和上位机显示做扎实后续的算法和产品化都会顺畅很多。本文还有配套的精品资源点击获取