用PlatformIO+Arduino搞定MPU6050：3行代码读取姿态角（附ROS串口转发脚本）

用PlatformIO+Arduino搞定MPU6050：3行代码读取姿态角（附ROS串口转发脚本）

如果你玩过机器人或者无人机，肯定对姿态传感器不陌生。MPU6050这款六轴传感器几乎是每个创客的入门标配——三轴加速度计加上三轴陀螺仪，价格便宜，性能也够用。但说实话，很多朋友第一次接触它的时候，都被那些复杂的寄存器配置和I2C通信搞得头大，更别提后面的姿态解算了。网上能找到的教程，动不动就是几十行的底层驱动代码，看得人眼花缭乱。

今天我想分享一个完全不同的思路：用PlatformIO和Arduino生态，三行代码直接读出欧拉角。不需要你手动配置任何一个寄存器，也不用自己写复杂的滤波算法。我们直接调用现成的库，让传感器内部的DMP（数字运动处理器）帮我们完成所有计算。最后，我还会提供一个Python脚本，把数据无缝转发到ROS的/tf话题，让你能直接在Rviz里看到实时的3D姿态。这套方案特别适合做机器人头部姿态控制、VR手柄原型，或者任何需要快速验证传感器功能的项目。

1. 环境搭建：告别手动配置的繁琐

以前用MPU6050，你得先搞清楚I2C总线怎么初始化，然后对着数据手册一个个寄存器去写。加速度计量程选多少？陀螺仪采样率设多大？数字低通滤波器用哪个参数？光是这些配置就能写一大段代码。现在，我们换个玩法。

PlatformIO是一个跨平台的嵌入式开发工具，它最大的好处是依赖管理。你不需要手动下载库文件，复制到正确的目录，再担心版本冲突。在platformio.ini文件里声明你需要什么库，PlatformIO会自动帮你下载安装。对于MPU6050，我们主要用两个库：

• bolderflight/MPU：一个维护得很好的现代库，支持DMP解算。
• Wire：Arduino的I2C库，PlatformIO已经内置了。

你的platformio.ini文件可以简单成这样：

[env:uno]
platform = atmelavr
board = uno
framework = arduino
lib_deps =
    bolderflight/MPU@^2.5.0

这里我以Arduino Uno为例，实际上PlatformIO支持上百种开发板，从ESP32到STM32蓝莓派，你只需要改一下board参数就行。库的版本号（@^2.5.0）建议指定，避免未来库更新导致代码不兼容。

硬件连接更是简单到极致。MPU6050模块一般有六个引脚：VCC、GND、SDA、SCL、INT、AD0。对于快速验证，你只需要接前四根线：

注意：虽然MPU6050兼容5V逻辑电平，但供电最好用3.3V，更稳定。SDA和SCL线上通常需要接上拉电阻（4.7kΩ到10kΩ），不过很多模块已经内置了，如果你的模块没有，记得自己加上。

接好线，打开PlatformIO，创建一个新项目，把上面的配置粘贴进去。环境就算准备好了。你会发现，我们一行驱动代码都还没写，但所有必要的工具和库已经就位。这就是现代开发流程的效率。

2. 核心代码：三行读取姿态角的秘密

接下来是重头戏。传统方法里，你得先初始化I2C，然后初始化MPU6050，设置各种参数，最后才能开始读数据。而且读出来的还是原始的加速度和角速度值，得自己用互补滤波或者卡尔曼滤波去算角度。这个过程没个一两百行代码下不来。

而用bolderflight/MPU这个库，配合传感器自带的DMP，代码可以精简到不可思议的程度。DMP是MPU6050内部的一个小型处理器，专门用来做姿态解算。它直接输出四元数或者欧拉角，省掉了主控器大量的计算负担。

看看我们完整的Arduino代码有多短：