4-DOF-Roboterarm bauen: PCA9685, Servos, Kinematik

Ein Roboterarm ist das erste Projekt, in dem ein Roboter aufhört, herumzufahren, und anfängt, etwas mit der Welt zu tun. Ein Linienfolger folgt; ein Ausweicher weicht aus; ein Arm erreicht, positioniert und greift. Dieser Wechsel – vom Fahren zum Handhaben – bringt die eine Idee mit sich, auf der jeder Manipulator aufbaut: Kinematik, die Geometrie, die befehlbare Winkel mit dem gewünschten Raumpunkt verbindet.

Dieser Lernpfad behandelt den Arm genau so: als Kinematiklektion zum Anfassen. Du beginnst damit zu verstehen, wie ein Zwei-Link-Arm Gelenkwinkel in eine Werkzeugposition und zurück verwandelt, sammelst die Bauteile, die ein Servoarm braucht, und lernst, was jedes tut – dann erkundest du, bevor du etwas ausgibst oder ein Zahnrad abreißt, im Browser-Simulator die Reichweite, die zwei Ellbogenlösungen und die unerreichbaren Posen. Erst dann verdrahtest du den echten Arm, kalibrierst seine Servos von Hand und lässt die inverse Kinematik auf Hardware laufen.

Folge dem Technikbaum unten von oben nach unten. Jeder Knoten öffnet sich, sobald seine Voraussetzungen erfüllt sind, und dein Fortschritt wird auf diesem Gerät gespeichert, sodass du den Arm über ein Wochenende bauen kannst, ohne den Faden zu verlieren.

Stückliste

Gesamt: ca. $40–60.

Zwei Käufe verdienen Nachdenken statt Standardwahl. Ein MG90S mit Metallgetriebe an der Schulter kostet einen Dollar mehr und ist das Gelenk, das das Gewicht jedes anderen Gelenks trägt – Nylon- Zahnräder dort reißen unter Dauerlast, nicht bei Stoß. Und eine auf Blockierstrom dimensionierte Versorgung, denn der typische Armfehler ist: Kollidiert er mit seinem eigenen Gestell oder greift er etwas Festes, blockieren alle Servos auf einmal.

Miss deinen Arm, bevor du Code schreibst

Inverse Kinematik ist Arithmetik auf Armlängen. Diese vier Zahlen sind der gesamte Input, und sie aus einer Produktliste statt vom Lineal zu nehmen, ist der häufigste Grund, warum ein Arm selbstbewusst an die falsche Stelle greift.

Diese letzte Zeile leistet mehr, als es aussieht. „Der tatsächliche Greifpunkt des Greifers“ wandert beim Schließen der Backen, und den Greifer selbst zu dimensionieren ist ein separates Problem vom Positionieren – mit eigenen Wänden, eigener Arithmetik und eigenen Fehlermodi. Greift dein Arm das Teil und lässt es dann fallen oder zerdrückt es, steht die Antwort nicht auf dieser Seite: Beginne beim Greifer-Simulator. | h | Tischfläche | Schultergelenkachse | 50–70 mm | | d | Fußdrehachse | Schulterachse, horizontal | 0–15 mm |

Miss zwischen Gelenkachsen, nicht Gestellkanten. Die Achse ist die Mitte der Servo- Abtriebswelle, oft 5–10 mm innerhalb der sichtbaren Halterung. Bei einem 95-mm-Link sind 10 mm Fehler über 10 %, und das ergibt einen Arm, der systematisch zu kurz greift – keine Verstärkung korrigiert das.

Diese zwei Längen liefern sofort den Arbeitsraum:

maximum reach = L1 + L2          e.g. 100 + 90 = 190 mm
minimum reach = |L1 - L2|        e.g. |100 - 90| = 10 mm

Der Arbeitsraum ist ein Kreisring, keine Scheibe. In der Mitte liegt ein Loch, das der Arm physisch nicht erreicht – und ein Ziel nahe dem Fuß, das „unerreichbar“ meldet, ist korrektes Verhalten statt eines Bugs.

Baue ihn in Meilensteinen

Die Montagereihenfolge enthält einen Schritt, der fast nicht rückgängig zu machen ist – Schritt 2.

Meilenstein 2 lässt sich später nicht nachholen. Ein Servohorn ist verzahnt – rund 20 Zähne –, passt also nur in diskreten Stellungen etwa 18° auseinander. Erst montieren, dann kalibrieren, und du findest womöglich ein Gelenk, dessen nutzbarer Bereich um 40° versetzt ist, ohne mechanische Abhilfe. Jeden Servo bestromen, 90° befehlen, dann das Horn aufdrücken.

Bewege ihn immer sanft

Ein Servo, dem ein neuer Winkel befohlen wird, fährt dorthin mit voller Geschwindigkeit. An einem Arm bedeutet das eine gewaltsame Bewegung, eine Stromspitze über alle vier Servos und einen mechanischen Stoß durch Nylon- Zahnräder, mit der Hebelwirkung des Arms multipliziert.

// Interpolate every joint together, so the tool takes a sensible path and
// no single servo carries the whole transition.
void moveTo(float base, float shoulder, float elbow, int steps, int stepMs) {
  static float cur[3] = {0, 0, 0};
  const float target[3] = {base, shoulder, elbow};

  for (int s = 1; s <= steps; s++) {
    const float t = (float)s / steps;
    for (int j = 0; j < 3; j++) {
      const float a = cur[j] + (target[j] - cur[j]) * t;
      pwm.setPWM(JOINT[j].channel, 0, countsFor(JOINT[j], a));
    }
    delay(stepMs);
  }
  memcpy(cur, target, sizeof(cur));
}

Alle Gelenke gemeinsam zu interpolieren zählt so viel wie das Glätten selbst. Gelenke einzeln nacheinander zu bewegen schickt das Werkzeug auf einem seltsamen Bogen durch den Arbeitsraum – langsamer und weit eher kollidierend auf dem Weg.

Wie gut aussieht

Die Lücke zwischen den zwei Wiederholbarkeitszeilen ist das Spiel, und es ist die größte einzelne Fehlerquelle an einem Hobbyarm. Vier Grad Spiel an der Schulter sind bei 190 mm Reichweite über 13 mm am Greifer. Die praktische Antwort ist keine bessere Mathematik – sondern ein Ziel immer aus derselben Richtung anzufahren, was den Vorzeichenwechsel vollständig entfernt und aus einem ±13-mm-Fehler einen wiederholbaren Offset macht, den du herauskalibrieren kannst.

Fehlersuche

Wie es weitergeht

Geradenfahrt hinzufügen. In Gelenkraum zu interpolieren wie im Code oben lässt das Werkzeug einer Kurve folgen. In kartesischem Raum zu interpolieren – IK an jedem Schritt entlang einer Geraden zu rechnen – lässt es gerade fahren, was jeder echte Pick-and-Place braucht. Kleine Änderung, und hier hören Singularitäten auf, theoretisch zu sein: Eine Gerade durch Nahe-Vollstreckung verlangt enorme Gelenkgeschwindigkeiten.

Kamera hinzufügen und den Kreis schließen. Alles hier ist offener Kreis: Der Arm fährt, wohin man ihm sagt, und prüft nie. Eine Kamera, die einen ArUco-Marker auf dem Objekt liest, lässt den Arm den Fehler aus Spiel und Durchhang korrigieren – so wird aus einem billigen Arm ein genauer.

Hardware hochrüsten, wenn die Decke erreicht ist. Aluminiumlinks nehmen den größten Teil der Biegung, MG90S- Servos den größten Teil des Spiels, und ein 6-DOF-Arm fügt ein Handgelenk hinzu, sodass der Anfahrwinkel des Werkzeugs dir gehört. Nichts ändert die Mathematik: Der Zwei-Link-Solver, den du hier geschrieben hast, ist derselbe, den ein besserer Arm nutzt – genau deshalb hat sich das billige Gestell als Erstes gelohnt.