MPU-6050 IMU

Что это такое

MPU-6050 позволяет роботу ощущать собственное движение. Это 6-осевой инерциальный измерительный модуль — гироскоп и акселерометр на одной микросхеме, — сообщающий о наклоне робота, скорости вращения и ускорении. Если ультразвуковой датчик смотрит наружу на мир, то 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

На Arduino 5 V есть тонкость. Подтягивающие резисторы 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 полностью достаточен, и объединение данных полезно написать самостоятельно. Если нужен абсолютный курс, никакая фильтрация не выведет его из шести осей — потребуется магнитометр.