Roboterarm-Simulator für Kinematik und Planung

Steuerung

Der Simulator bietet Gelenkschieber, ein ziehbares Werkzeugziel, Rahmen-Overlays und Gliedmaßsteuerung, mit zentrierter Basis, sodass der volle 360°-Arbeitsraum sichtbar ist. Der Vorwärtsmodus rechnet die Werkzeugpose aus deinen Gelenkwinkeln. Der Inversmodus folgt einem Ziel, das du ziehst — löst live nach Gelenkwinkeln und meldet unerreichbare oder mehrdeutige Ziele statt lautlos einzurasten. Ein dritter Pick-and-Place-Modus lässt dich Aufnahme- und Zielpunkt setzen und fährt dann den ganzen Auftrag: zum Objekt fahren, greifen, tragen und in der Dropzone ablegen — der kanonische Job jedes echten Manipulators.

Theorie

Jedes Gelenk steuert eine Transformation zwischen Koordinatenrahmen bei. Diese Transformationen von Basis zu Werkzeug multipliziert ergeben die Vorwärtskinematik-Pose. Inverse Kinematik arbeitet rückwärts und kann keine, eine oder mehrere Lösungen haben.

Nahe einer Singularität kann kleine Werkzeugbewegung sehr große Gelenkbewegung verlangen. Ein Planer muss zudem Positions-, Geschwindigkeits-, Beschleunigungs-, Moment- und Kollisionsgrenzen achten. Geometrische Reichweite allein macht keine Trajektorie sicher.

Algorithmus

1. Gliedlängen, Gelenkachsen, Home-Transformationen und Gelenkgrenzen definieren.
2. Vorwärtskinematik für den aktuellen Gelenkzustand rechnen.
3. Aktuelle Werkzeugpose mit angefordertem Ziel vergleichen.
4. Per analytischem oder numerischem Löser Posefehler innerhalb der Grenzen reduzieren.
5. Kollidierende oder singuläre Kandidaten verwerfen und stetige Lösung wählen.
6. Pfad zeitparametrieren und synchronisierte Sollwerte an Gelenkregler senden.

Quellcode

Ein planarer Zweigelenkarm hat ein kompaktes Vorwärtsmodell:

from math import cos, sin

def forward_kinematics(theta_1, theta_2, link_1, link_2):
    elbow = (link_1 * cos(theta_1), link_1 * sin(theta_1))
    tool = (
        elbow[0] + link_2 * cos(theta_1 + theta_2),
        elbow[1] + link_2 * sin(theta_1 + theta_2),
    )
    return elbow, tool

Valdiere für physische Arme jede geplante Trajektorie in begrenzter, kollisionsbewusster Umgebung, bevor du Aktorleistung freigibst.

Annahmen und Unterschiede zur Hardware

Der Arm ist planar mit zwei oder drei Drehgelenken, perfekt starren Gliedern, instantaner Geschwindigkeitsantwort und ohne Schwerkraft, Dynamik oder Kollision — du kannst von Ellbogen-hoch nach Ellbogen-runter schwenken ohne Momentgrenze. Echte Servos haben Positions- und Tempolimits, Getriebespiel, strombegrenztes Moment und lastabhängiges Durchhängen, und ein 6-Achs-Arm muss zudem Orientierung, Singularitäten und Arbeit nahe Gelenkgrenzen managen. Dieses Labor zeigt dir, warum ein Ziel im Ring zwei Lösungen haben kann und warum ein Ziel an seiner Kante singulär ist, bevor du die Dynamik dazunimmst, die diese Posen schwer haltbar macht.

Schaltplan

Trenne hochstromige Aktorleistung von Rechenleistung und behalte dabei die Referenz- und Sicherheitssignale, die die gewählte Hardware verlangt.

Geführte Experimente

Ein Ziel herumzuziehen ist der schnellste Weg zu Intuition für Dinge, die auf Papier mühsam zu beweisen und auf Hardware teuer zu entdecken sind.

1. Form des Arbeitsraums finden

Ziehe das Ziel langsam nach außen, bis der Löser unerreichbar meldet, und trace diese Grenze ganz herum. Ziehe nun nach innen zur Basis.

Mit ungleichen Gliedlängen findest du zwei Grenzen: einen Außenkreis bei L1 + L2 und einen inneren bei |L1 − L2|. Der Arbeitsraum ist ein Kreisring, keine Scheibe — mit einem Loch in der Mitte, das der Arm physisch nicht erreicht.

Die letzte Zeile ist eine echte nützliche Entwurfsweisheit: Gleiche Gliedlängen entfernen die Totzone ganz. Muss dein Arm nah an der eigenen Basis arbeiten, ist das der Grund dafür.

2. Beobachten, wie beide Lösungen verschmelzen

Schalte zwischen Ellbogen-hoch- und Ellbogen-runter-Zweig an einem Ziel in Arbeitsraummitte: zwei klar verschiedene Armposen, die denselben Punkt erreichen.

Ziehe dieses Ziel nun nach außen zur Grenze. Beide Posen konvergieren, bei Vollstreckung werden sie dieselbe Pose. Das ist eine Singularität — dort verliert der Arm die Fähigkeit, das Werkzeug in eine Richtung zu bewegen, egal was die Gelenke tun.

3. Fühlen, was eine Singularität kostet

Ziehe das Ziel auf gerader Linie nahe an Vollstreckung vorbei, langsam und stetig. Beobachte die Gelenkwinkel statt den Arm.

Das Werkzeug bewegt sich konstant; die Gelenke nicht. Nahe der Grenze verlangt kleine Werkzeugbewegung enorme Gelenkbewegung — ein glatter kartesischer Pfad wird heftige Gelenkfahrt. Auf Hardware ist das ein Servo, das an seine Grenze knallt.

Halte geplante Pfade innerhalb etwa 95 % Maximalreichweite, und das hört auf, ein Problem zu sein.

4. Zweiggrenze queren und Flip beobachten

Setze den Löser auf immer Ellbogen-hoch und ziehe das Ziel durch einen Bereich, wo dieser Zweig an eine Gelenkgrenze läuft und der Löser schaltet. Der Arm flippt durch eine große, schnelle, völlig ungeplante Bewegung.

Darum ist die richtige Voreinstellung Minimalbewegung — wähle den Zweig nächst der aktuellen Pose — statt festem Zweig. Ein stiller Zweigwechsel mitten im Pfad ist auf echter Hardware alarmierend und kann zerstörerisch sein.

Was du beobachten solltest

Umsetzung auf Hardware

Die Geometrie überträgt sich exakt. Nichts sonst, und die Lücke ist es, wo ein erster Armbau seine Zeit verbringt:

Zwei Zahlen machen den Punkt. Vier Grad Spiel an der Schulter über 190 mm Reichweite sind mehr als 13 mm am Greifer — größer als jeder Fehler, den die Mathematik einführt. Und 10 mm zu lang gemessenes Glied an 95-mm-Glied ist 10 % systematischer Fehler, den keine Abstimmung entfernt.

Die praktische Folge: Hardware-Genauigkeit kommt aus Kalibrierung und konsistenter Anfahrrichtung, nicht aus besserer Kinematik. Fahre ein Ziel immer aus derselben Richtung an, und das Spiel wird ein wiederholbarer Offset, den du abziehen kannst. Der volle Löser mit jedem behandelten Fehlerfall steht in Inverse Kinematik für einen Zweigelenkarm.