【内含安装包】2 个函数搞定 MPU6050 姿态解算:STM32 HAL 库移植 DMP 完整案例
【内含安装包】2 个函数搞定 MPU6050 姿态解算:STM32 HAL 库移植 DMP 完整案例
这个仓库是 STM32 DMP库移植的完整工程:把 MPU6050 的 DMP 驱动接到 HAL 框架的 I2C 上,调两个函数就能读出 Pitch、Roll、Yaw。下文按 I2C 对接、DMP 初始化、读取姿态的顺序讲清楚怎么集成。
姿态解算自己写,有多麻烦
- 陀螺仪原始数据带漂移:传感器静止时角度会慢慢漂走,得自己做互补或卡尔曼滤波融合
- 四元数换算公式不好写对,定标也容易弄错——DMP 输出用的是 2^30 定点数,手工换算容易丢精度
- 要高频读原始数据,换一块板子还要重新调滤波参数
这个例子的思路是:把数学计算交给传感器内部的 DMP 完成,MCU 只负责定期取结果。
DMP 是什么:传感器里的"第二块 CPU"
DMP 是 MPU6050 内部的数字运动处理器,把固件写进芯片后,四元数融合全部在芯片内部算完。
MCU 不用再跑任何滤波算法,也不用高频轮询原始数据,定期把算好的姿态取走就行。
结果放在 DMP 的 FIFO 里,一次 dmp_read_fifo 调用同时拿到陀螺仪、加速度和姿态四元数。
🧩 集成走一遍:从 I2C 到出角度
第 1 步:HAL I2C 对接,3 个参数不能错
示例基于 STM32F1 的 I2C1:SCL 接 PB6、SDA 接 PB7,时钟 100kHz,7 位寻址。
MPU6050 的默认从机地址是 0x68(AD0 接地时)。
inv_mpu.c 里的底层读写被直接替换为 HAL_I2C_Mem_Read / HAL_I2C_Mem_Write,这是移植的核心改动。
第 2 步:DMP 初始化,一次配齐 10 件事
MPU6050_DMP_Init() 按顺序做 10 件事:芯片初始化、开启陀螺仪和加速度计、FIFO 与采样率设为 100Hz、加载 DMP 固件、设置安装方向、使能六轴低通四元数和陀螺仪校准、跑自检并把偏差回写、最后打开 DMP。
每步失败返回不同的负数,从 -1 到 -10,出问题时能直接定位卡在哪一步。
第 3 步:主循环里读姿态
main.c 里主循环每 100ms 调一次 MPU6050_DMP_Get_Data(&Pitch,&Roll,&Yaw)。
函数内部先 dmp_read_fifo 取出四元数,再换算成角度,结果经 printf 从 USART1(115200 波特率)打印出来观察。
初始化失败不会卡死程序:示例会每秒重试一次初始化,直到成功。
⚙️ 拿到数据后怎么调稳
返回的三个角度单位都是度:Pitch 俯仰、Roll 翻滚、Yaw 偏航。
DMP 是六轴方案(无磁力计),Yaw 长时间会缓慢漂移,需要长期稳定航向时要自己融合磁力计。
想调参有两个入口:mpu6050.c 里的 DEFAULT_MPU_HZ 控制采样率,gyro_orientation 数组控制安装方向。
角度还抖的话,可在 MCU 侧再叠加一阶低通,或检查自检偏差标定的效果。
它适合谁
- 想用 HAL 直接读出姿态的 STM32F1 新手
- 平衡车、智能小车开发阶段需要快速看到姿态角
- 小型无人机或姿态仪表,不想花时间调融合算法
- 手势互动、动作捕捉这类演示类项目
❓ 常见问题
Q:mpu_init 一直报错? 先用工具确认能不能扫到 0x68 这个地址,再查 SCL/SDA 接线和上拉电阻。
Q:角度单位是弧度吗? 不是,代码里已换算成角度(×57.3)。
Q:能换到其他 STM32 上吗? 可以,用 HAL 重新生成 I2C 即可,保持 inv_mpu.c 里的底层调用一致。
完整工程在仓库根目录的 mpu6050_test.rar:解压后是可编译的 MDK-ARM 工程,.ioc 文件可用 CubeMX 打开。
想看封装层,读 APP/MPU6050/mpu6050.c(仅两个函数);想看移植细节,读 inv_mpu.c 里的 I2C 底层调用。