MPU-6050 IMU

Was es ist

Die MPU-6050 ist, wie ein Roboter seine Eigenbewegung fühlt. Sie ist eine 6-Achsen-Trägheitsmesseinheit – Gyroskop und Beschleunigungssensor auf einem Chip –, die meldet, wie der Roboter geneigt ist, wie schnell er sich dreht und wie er beschleunigt. Wo ein Ultraschallsensor nach außen auf die Welt schaut, schaut eine IMU nach innen auf den Roboterkörper – was ein selbstbalancierender Roboter oder ein Koppelnavigator braucht.

Wie es funktioniert

Darin stecken zwei Sensoren. Der Beschleunigungssensor misst lineare Beschleunigung auf X, Y und Z – im Ruhezustand ist das nur Schwerkraft, die dem Roboter sagt, wo unten ist (seine Neigung). Das Gyroskop misst, wie schnell sich der Roboter um jede Achse dreht. Beide liest man über I²C (SCL/SDA) aus.

Kein Sensor reicht allein: Das Gyro zum Winkel integriert driftet langsam; dem Beschleunigungssensor vertraut ist verrauscht, sobald sich der Roboter bewegt. Die Lösung ist Sensorfusion – beide so mischen, dass der Beschleunigungssensor die Gyrodrift korrigiert und das Gyro das Beschleunigungsrauschen glättet. Genau diese Technik behandelt Sensorrauschen, Bias und Filterung.

Wann man ihn verwendet

Zur MPU-6050 greifen, wenn ein Roboter eigene Lage oder Bewegung kennen muss:

• Selbstbalancierende Roboter – der Neigungswinkel, den die Regelschleife auf null zu halten kämpft.
• Kurs und Koppelnavigation – Drehungen spüren, um Odometrie zwischen Encoderlesungen zu verbessern.
• Bewegungserkennung / Gesten – auf Aufnehmen, Kippen oder Schütteln reagieren.

Zum Messen von Entfernung zu Dingen (Wänden, Hindernissen) stattdessen einen Entfernungssensor wie HC-SR04 oder VL53L0X nehmen – eine IMU spürt den Roboter, nicht die Welt.

Verdrahtung und Fallstricke

• I²C, 3,3–5 V. Die meisten Breakouts (das lila GY-521) haben einen Regler, also sind 5 V in Ordnung; der nackte Chip ist nur 3,3 V.
• Gyro und Accel fusionieren – nicht auf einem rohen Messwert lenken. Ein einzelner Beschleunigungsmesswert unter Bewegung ist als Neigungswinkel unbrauchbar.
• Gier driftet ohne Magnetometer; die MPU-6050 für Nick/Roll und kurzfristige Drehungen nutzen, nicht für absoluten Kompasskurs.
• Steif und waagerecht montiert halten; ein lockerer Sensor fügt Vibration hinzu, die kein Filter entfernt.

Pinbelegung

Das lila GY-521-Breakout ist die Platine, die fast alle mit „MPU-6050“ meinen. Acht Pins, und vier davon bleiben meist unverbunden.

AD0 ist der Pin, der zwei MPU-6050 an einem Bus möglich macht – und der Grund, warum die Adresskollision hier eine leichte Antwort hat, die die meisten Sensoren nicht bieten.

An einen Arduino verdrahten

Eine Feinheit, die man an einem 5-V-Arduino kennen sollte: Die Pull-up-Widerstände des GY-521 gehen auf seine geregelte 3,3-V-Schiene – die I²C-Leitungen liegen also auf 3,3 V, nicht 5 V. Ein ATmega328P liest high oberhalb 0,6 × Vcc = 3,0 V – 3,3 V schafft die Schwelle also, aber nur um 0,3 V. In der Praxis funktioniert es zuverlässig und ist ein Grund, warum sich eine lange oder verrauschte I²C-Strecke auf diesem Board früher danebenbenimmt als auf einem 5-V-Board.

Auslesen: die Register, auf die es ankommt

Man kann diesen Sensor mit Bibliothek treiben und nie ein Register sehen – aber vier davon erklären fast jedes Problem, das Leute damit haben.

Die beiden Konfigregister setzen den Skalfaktor, durch den man Rohzählwerte teilt – und ihn falsch zu haben ist die häufigste Quelle für „meine Winkel sind viermal zu groß“:

Den kleinsten Bereich wählen, der nicht sättigt. Ein Balancierroboter überschreitet selten ±250 °/s, und der enge Bereich liefert gratis vierfache Auflösung gegenüber ±1000 °/s.

Minimal funktionierender Code

Keine Bibliothek – das ist das Ganze, und es lohnt sich einmal zu fahren, damit man weiß, was die Bibliothek für einen tut.

#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);
}

Zwei Dinge, die das bewusst nicht tut: Es fusioniert die beiden Sensoren nie und zieht nie einen Bias ab. Beides kommt als Nächstes.

Kalibrierung: die zwanzig Zeilen, auf die es am meisten ankommt

Im Ruhezustand liest ein Gyro nicht null. Es liest einen kleinen, recht konstanten Offset – und weil man das Gyro zum Winkel integriert, integriert sich dieser Offset zu einem stetig wachsenden Fehler. Ein Bias von nur 2 °/s unkorrigiert sind 120° Drift nach einer Minute.

Wenige hundert Messwerte bei völlig stillem Sensor mitteln, dann abziehen:

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

Drei praktische Hinweise, die kein Datenblatt verrät:

• Bei jedem Einschalten tun, nicht einmal. Gyrobias wandert mit der Temperatur – und ein Roboter, der zehn Minuten läuft, ist nicht der kalt kalibrierte Roboter.
• „Still“ heißt still. Eine Kalibrierung, aufgenommen während jemand am Tisch lehnt, brennt diese Bewegung dauerhaft in den Bias ein.
• Der Beschleunigungssensor braucht eine Waagerecht-Referenz, keine Null. Er sollte 1 g auf der Achse lesen, die nach unten zeigt. Liest er 0,97 g, ist das dein Skalenfehler – und er zeigt sich als Neigungswinkel, der konstant ein paar Grad danebenliegt.

Warum ein Sensor nie reicht

Die beiden Sensoren versagen auf exakt gegensätzliche Arten – was ihre Fusion so gut funktionieren lässt.

Ein Komplementärfilter nimmt von jedem die gute Hälfte – dem Gyro kurzfristig trauen, den Schätzwert vom Beschleunigungssensor langsam zur Wahrheit zurückziehen lassen:

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

Diese 0,98 setzt die Grenzfrequenz. Höher traut dem Gyro länger – glatter, aber driftet mehr; niedriger antwortet auf das Beschleunigungsrauschen. Das Komplementärfilter-Tutorial arbeitet durch, wie man sie bewusst statt nach Gefühl wählt.

Fehlersuche

MPU-6050 oder etwas Neueres?

Die MPU-6050 ist beim Hersteller abgekündigt und trotzdem die meistverwendete IMU der Hobbyrobotik – weil billig, überall dokumentiert und von jeder Bibliothek unterstützt.

Die ehrliche Zusammenfassung: Braucht dein Roboter Nick und Roll – was Balancieren braucht –, reicht die MPU-6050 völlig und die Fusion ist gut selbst geschrieben zu haben. Braucht er absoluten Kurs, holt keine Filterung das aus sechs Achsen – dann willst du ein Magnetometer.