Гироскоп/акселерометр (MPU6050) через I2C: измерение наклона и движения

Введение

Гироскопический модуль из набора (обычно на базе чипа MPU6050 или аналогичного) — комбинированный датчик, объединяющий трёхосевой акселерометр (измерение ускорения, включая гравитацию — что позволяет определить наклон) и трёхосевой гироскоп (измерение угловой скорости вращения) в одном модуле, подключаемом через I2C, аналогично подходу из основного цикла статей (про RTC через I2C).

Концепция

Акселерометр измеряет ускорение по трём осям (X, Y, Z), и в статичном состоянии (без явного движения) показания акселерометра отражают распределение силы тяжести между осями в зависимости от ориентации модуля в пространстве — это позволяет вычислить угол наклона относительно горизонта через простую тригонометрию. Гироскоп измеряет угловую скорость (как быстро меняется ориентация), но накопленная (интегрированная по времени) угловая скорость подвержена дрейфу (накопление ошибки измерения со временем) — на практике для надёжного определения ориентации комбинируют данные обоих датчиков (sensor fusion), либо используют специализированную библиотеку, реализующую такое комбинирование.

Пример кода

// Чтение "сырых" данных MPU6050 через I2C-регистры (без специализированной библиотеки —
// для понимания базового принципа; для production-кода стоит использовать готовую библиотеку,
// см. подводные камни)
#include <Wire.h>

const int MPU6050_ADDR = 0x68;
const int ACCEL_XOUT_H = 0x3B;

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

    // Вывод MPU6050 из спящего режима — обязательный шаг после включения питания
    Wire.beginTransmission(MPU6050_ADDR);
    Wire.write(0x6B); // регистр управления питанием (PWR_MGMT_1)
    Wire.write(0);     // запись 0 — выход из спящего режима
    Wire.endTransmission(true);
}

void loop() {
    Wire.beginTransmission(MPU6050_ADDR);
    Wire.write(ACCEL_XOUT_H);
    Wire.endTransmission(false);
    Wire.requestFrom(MPU6050_ADDR, 6, true); // 6 байт: X, Y, Z по 2 байта каждый

    int16_t accelX = Wire.read() << 8 | Wire.read();
    int16_t accelY = Wire.read() << 8 | Wire.read();
    int16_t accelZ = Wire.read() << 8 | Wire.read();

    // Преобразование в "g" (единицы гравитации) — делитель зависит от настроенного диапазона
    // чувствительности (по умолчанию ±2g, делитель 16384.0 согласно даталисту MPU6050)
    float gX = accelX / 16384.0;
    float gY = accelY / 16384.0;
    float gZ = accelZ / 16384.0;

    // Вычисление угла наклона по осям X и Y через тригонометрию
    float angleX = atan2(gY, gZ) * 180.0 / PI;
    float angleY = atan2(-gX, sqrt(gY * gY + gZ * gZ)) * 180.0 / PI;

    Serial.print("ANGLE_X:");
    Serial.print(angleX);
    Serial.print(",ANGLE_Y:");
    Serial.print(angleY);
    Serial.println();

    delay(100);
}

// Использование готовой библиотеки (рекомендуемый подход для production) —
// концептуальный пример с MPU6050 library, упрощающей sensor fusion
#include <MPU6050.h>

MPU6050 mpu;

void setupWithLibrary() {
    Wire.begin();
    mpu.initialize();

    if (!mpu.testConnection()) {
        Serial.println("Ошибка: MPU6050 не обнаружен");
    }
}

void loopWithLibrary() {
    int16_t ax, ay, az, gx, gy, gz;
    mpu.getMotion6(&ax, &ay, &az, &gx, &gy, &gz); // акселерометр + гироскоп за один вызов
    // Библиотека также может предоставлять встроенные алгоритмы sensor fusion (DMP),
    // дающие готовый, отфильтрованный угол ориентации без ручной тригонометрии
}

Пояснения к коду

Запись нулевого значения в регистр 0x6B (PWR_MGMT_1) — обязательный, легко забываемый шаг инициализации: MPU6050 по умолчанию после включения питания находится в спящем режиме энергосбережения и не выполняет измерений, пока явно не выведен из него этим вызовом. Формулы atan2(gY, gZ)/atan2(-gX, sqrt(gY*gY+gZ*gZ)) вычисляют угол наклона по осям, опираясь на то, что в статичном состоянии вектор измеренного ускорения почти полностью определяется гравитацией, направленной вертикально вниз — наклон модуля относительно горизонтали меняет, какая доля этой гравитации проецируется на каждую из трёх измеряемых осей, что и позволяет восстановить угол через тригонометрию.

Подводные камни

Вычисление угла наклона исключительно по акселерометру без учёта реального движения объекта — формулы из примера предполагают, что единственное ускорение, действующее на датчик — гравитация (статичное состояние), и при реальном движении объекта (вибрация, ускорение/торможение, для проектов на колёсной платформе или дроне) показания акселерометра искажаются дополнительным, не связанным с наклоном ускорением, что делает вычисленный «угол» неточным именно в моменты активного движения — для движущихся объектов нужно либо дополнительно использовать гироскоп для краткосрочной коррекции, либо применять более развитые алгоритмы фильтрации (комплементарный фильтр, фильтр Калмана).
Использование показаний гироскопа без коррекции дрейфа для долговременного определения ориентации — простое интегрирование угловой скорости гироскопа со временем накапливает систематическую ошибку (дрейф), и для проектов, нуждающихся в стабильной, долговременной оценке ориентации (не только краткосрочной), необходимо периодически корректировать накопленное значение через данные акселерометра (или магнитометра, если он присутствует в конкретном модуле), что и есть основная задача sensor fusion алгоритмов.
Ручная реализация sensor fusion с нуля без использования готовой, проверенной библиотеки, особенно для проектов, где точность ориентации критична (балансирующие роботы, дроны) — корректная реализация комплементарного фильтра или фильтра Калмана требует понимания достаточно тонких деталей и подбора параметров фильтрации, и для большинства практических проектов готовая библиотека (использующая, например, встроенный в сам чип MPU6050 модуль цифровой обработки движения DMP) даёт значительно более надёжный результат с меньшими усилиями, чем самостоятельная реализация с нуля.
Игнорирование необходимости калибровки нулевой точки (offset) конкретного физического экземпляра датчика — реальные MPU6050-модули обычно имеют небольшое систематическое смещение показаний даже в полностью неподвижном, горизонтальном положении, и без калибровки этого смещения (определяемого через усреднение множества показаний в известном, контролируемом положении при инициализации) вычисленные углы будут содержать постоянную, систематическую ошибку даже при идеально правильной остальной логике обработки.