MPU-6050 惯性测量单元

它是什么

MPU-6050 是机器人感知自己运动的方式。六轴惯性测量单元——一颗芯片上陀螺仪加加速度计——报告倾斜、多快转、怎么加速。超声波看外面世界，IMU 看里面自己身体，自平衡车、航位推算导航要的就是它。

工作原理

里面两个传感器。加速度计量 X、Y、Z 线加速度——静止就是重力，告诉机器人哪边是下（倾角）。陀螺仪量绕各轴转多快。都经 I²C（SCL/SDA）读。

两个传感器单独用都不够：把陀螺仪积分成角度，它会慢慢漂移；完全相信加速度计，机器人一动读数就充满噪声。解法是传感器融合——把两者混合起来，让加速度计纠正陀螺仪的漂移，让陀螺仪抹平加速度计的噪声。传感器噪声、偏置与滤波讲的正是这项技术。

什么时候用它

机器人要知道自己朝向或运动时请 MPU-6050：

• 自平衡车——控制环拼命保持零的倾角。
• 航向和航位推算——编码器读数之间感知转弯改进里程计。
• 运动检测 / 手势——被拿起、放倒、摇晃有反应。

量到东西的距离（墙、障碍）换测距传感器 HC-SR04 或 VL53L0X——IMU 感知机器人，不感知世界。

接线与坑

• **I²C，3.3–5 V。**大多数转接板（紫色的 GY-521）带稳压器，所以 5 V 没问题；裸芯片只能 3.3 V。
• 陀螺仪和加速度计要做融合——别拿原始读数去控制转向。运动中的单次加速度计采样没法当作倾角使用。
• 偏航无磁力计会漂；MPU-6050 管俯仰横滚和短期转弯，不管绝对罗盘航向。
• 刚性水平安装；松动的传感器加滤波去不掉的振动。

引脚

紫色 GY-521 转接板就是大家说的“MPU-6050”。八脚，一般四个悬空。

AD0 正是让一条总线上能挂两颗 MPU-6050 成为可能的那个引脚，也正因为它，地址冲突在这里有了一个大多数传感器都不提供的简单解法。

接到 Arduino

在 5 V 的 Arduino 上有个微妙之处。GY-521 的上拉电阻接到它自己稳压出的 3.3 V 电源轨，所以 I²C 线的空闲电平是 3.3 V 而不是 5 V。ATmega328P 的高电平门限是 0.6 × Vcc = 3.0 V，3.3 V 刚好越过——只富余 0.3 V。实践中它工作可靠，而这也正是长线或嘈杂的 I²C 在这块板子上比在纯 5 V 板子上更早出问题的原因之一。

读它：要紧的寄存器

库驱动一辈子不见寄存器，但四个解释了几乎所有问题。

这两个配置寄存器决定你用哪个缩放系数去除原始计数，而配错它正是“我的角度大了四倍”最常见的来源：

选不爆表最小量程。平衡车很少超 ±250 °/s，窄量程白送 ±1000 °/s 四倍分辨率。

能跑的最小代码

无库——全部就这些，值得跑一遍知道库替你干了什么。

#include <Wire.h>

const uint8_t MPU = 0x68;          // 0x69 if AD0 is tied high

void setup() {
  Serial.begin(115200);
  Wire.begin();

  Wire.beginTransmission(MPU);
  Wire.write(0x6B);                 // PWR_MGMT_1
  Wire.write(0);                    // wake up — the chip boots asleep
  Wire.endTransmission(true);
}

void loop() {
  Wire.beginTransmission(MPU);
  Wire.write(0x3B);                 // ACCEL_XOUT_H
  Wire.endTransmission(false);      // repeated start, do not release the bus
  Wire.requestFrom(MPU, (uint8_t)14);

  int16_t ax = Wire.read() << 8 | Wire.read();
  int16_t ay = Wire.read() << 8 | Wire.read();
  int16_t az = Wire.read() << 8 | Wire.read();
  Wire.read(); Wire.read();         // temperature, discarded here
  int16_t gx = Wire.read() << 8 | Wire.read();
  int16_t gy = Wire.read() << 8 | Wire.read();
  int16_t gz = Wire.read() << 8 | Wire.read();

  // Default ranges: +/-2 g and +/-250 deg/s
  float pitch = atan2(ax, sqrt((float)ay * ay + (float)az * az)) * 57.2958f;
  float rateY = gy / 131.0f;        // deg/s

  Serial.print(pitch); Serial.print(' '); Serial.println(rateY);
  delay(20);
}

故意没做的两件事：不融合两传感器，不减偏置。都是下一步。

标定：最重要的二十行

静止时陀螺仪读数并不是零，而是一个小而相当稳定的偏置；由于你是靠积分陀螺仪来得到角度的，这个偏置也会被积分成一个持续增长的误差。只要 2 °/s 的偏置没被修正，一分钟后就是 120° 的漂移。

传感器纹丝不动平均几百采样，再减：

long sum = 0;
for (int i = 0; i < 500; i++) { sum += readGyroY(); delay(3); }
const float gyroBias = sum / 500.0f;   // subtract from every later reading

手册不写的三条实践：

• **每次上电做，不是一次。**陀螺偏置随温度走，跑十分钟的车不是冷标定的车。
• **“静止”就得是真的静止。**在有人靠着桌面时做标定，那点运动会永久地被烙进偏置里。
• **加速度计需要的是水平参考，不是零。**朝下的那个轴应该读出 1 g。如果读数是 0.97 g，那就是你的缩放误差，表现出来就是倾角总是差那么两三度。

为什么一个传感器永远不够

两个传感器的失效方式恰好相反，这正是把它们融合起来能做得这么好的原因。

互补滤波取两者各自擅长的那一半——短期信陀螺仪，同时让加速度计慢慢把估计值拉回真实值：

angle = 0.98f * (angle + rate * dt) + 0.02f * accelAngle;

这个 0.98 决定了交叉频率。取更大的值会更长时间地相信陀螺仪，更平滑但漂移更多；取更小的值则会去跟随加速度计的噪声。互补滤波教程讲的是怎么有意识地选它，而不是凭感觉。

故障排查

MPU-6050 还是更新的？

MPU-6050 在原厂已经停产，却仍然是入门机器人里用得最广的 IMU，因为它便宜、到处都有文档，而且每个库都支持它。

老实话：车要俯仰横滚——平衡要的——MPU-6050 完全够，融合自己写一遍是好事。要绝对航向，六轴滤波到死没有，要磁力计。