Koordinatentransformationen im Raum

**Alsen** · 22.04.2018, 01:43

Guten Tag,

undzwar habe ich folgendes Problem. In meiner Roboterzelle befindet sich ein Roboter und quaderförmige Objekte. Die Objekte sind als Punktewolken modelliert und auf ihren Oberflächen ist ein Koordinatensystem aufgespannt. Nun möchte ich das Koordinatensystem des Robotergreifers (Tool-KS)
so verschieben, dass es über dem Objekt-KS liegt. Das heisst der Greifer soll normal zur Fläche des Objektes auf dem das KS aufgespannt ist stehen.
Beide KS befinden sich in einem WELT-KS.
Ich weiß wie man über Transformationsmatrizen Punkte verschiebt und rotiert entlang von Koordinatenachsen, aber wie kann ich denn im WELT-KS mein TOOL-KS auf das Objekt-KS bewegen?
Würde das ganze in C++ programmieren.

Danke im voraus.
Beste Grüße Alsen

shedepe · 22.04.2018, 08:45

Hallo prinzipiell (wenn ich dich richtig verstanden habe) fragst du ja nicht nach einer Koordinatentransformation sondern eher danach: Wie plane ich einen Weg so dass TOOL-KS über Objekt-KS liegt? Also ein Problem der Bahnplanung nicht des Rechnens.
Das jedoch wesentlich kompliziert (Je nachdem wie deine Robotergeometrie ist) weil du musst für deinen Roboterarm von seinem Startpunkt zu seinem Zielpunkt bewegen, dazu musst du in der Regel eine abfolge von erlaubten Gelenkwinkelkonfiguriationen generieren, die der Arm abfahren kann.

Um das ganze kurz zu umreißen: (Für eine fertige Lösung ist das Problem meiner Ansicht nach zu kompliziert)
1. Die gewünsche Zielpose des Arms im WELT-KS ausdrücken. Dazu kannst du die Normale zu der Flächeberechnen (Das zeigt dir Wikipedia: https://de.wikipedia.org/wiki/Normalenvektor). Dann wählst du z.B. den Mittelpunkt der Fläche aus und verschiebst ihn in Richtung des Normalenvektors soweit, wie du den Abstand zwischen Zentrum deines Tool-KS und deines Object-KS haben willst. Deine Orientierung ist die gleiche wie die des Objeckt-KS relativ zum Welt-KS.
2. Du musst irgendwie eine Bahn zwischen Start Pose deines Arms und ZIel Pose (die du in Schritt 1 erstellt hast) berechnen. Dazu gibt es z.B. in ROS fertige Bahnplaner. Aber einfach sind die nicht zu verwenden weil sie zwangsweise ein Kinematisches Modell des Arms brauchen.
3. Die berechnete Trajektorie musst du in erlaubte Gelenkwinkelkonfigurationen via Inverser Kinematik umrechnen (Bzw. viele Bahnplaner suchen auch nur im Gelenkwinkelraum nach Trajektorien)
4. Diese Trajektorie die als Abfolge von Gelenkwinkeln ausgedrückt ist, kannst du dann ausführen.

**Alsen** · 23.04.2018, 19:37

Ich danke dir vielmals für deine schnelle Antwort!

Nach Absprache mit meinem Chef weiss ich nun, dass die Punktwolke mir für die einzelnen Punkte 6 Freiheitsgrade gibt, weswegen ich mit den rotatorischen Freiheitsgraden den Greifer automatisch ausrichten kann.
Demnach erspart mir das sehr viel Arbeit.

Danke dennoch für deine Mühen.

**i_make_it** · 24.04.2018, 07:01

Das ganze erinnert mich an einen Teil des Leistungsumfangs von COSIMIR
https://de.wikipedia.org/wiki/COSIMIR

Ggf. hilft es sich mal da die Diplom und Doktorarbeiten anzusehen und deren Litteratur Verzeichnisse.
Bsp.:
https://eldorado.tu-dortmund.de/bits...ssertation.pdf

Dort wurde die (Roboter)Zelle als Basis genommen, da sich ja der Roboter und jedes Objekt darin befinden.
Alle KS wurden also ins Welt-KS transformiert.
Wobei es damals (bei der Version mit der ich gearbeitet habe) noch keine Kollisionserkennung gab für Teile des Roboter die nicht zum Greifer gehörten.

Jedes Objekt wurde in COSIMIR als hiraschischer Baum aus 4x4 Matritzen beschrieben, so das man den Objektursprung in allen 6 Freiheitsgraden auf den Welt-KS Ursprung bezog und auf den Objektursprung dann Punkte und Flächen der Objekte.
Bei einem Roboter selbst wurde so dann auch die kinematische Kette von der Basis bis zum TCP aufgebaut.
Für inverse Kiniematik und Endstellungen waren dann Eigenschaften in den entsprechenden Objekten hinterlegt.

**Alsen** · 28.04.2018, 17:45

Danke dir,

werde mir das ganze mal anschauen.
Letztendlich muss ich die inverse Kinematik in meinen C++ Code einbauen, da ich kaum was bisher programmiert habe könnte das schwer werden.

Kennt ihr denn vllt. fertigen Code für die inverse Kinematik, wo ich als Input nur die Objektkoordinaten brauche und dieser mir dann die Gelenkwinkel des Roboters wieder gibt ?
Anderweitig werde ich mich wohl mit Denavit Hartenberg auseinander setzen müssen und das ganze selber implementieren.
Koordinatentransformationen gehen in C++ denke ich mal über die Bibliothek eigen oder ?

Beste Grüße
Alsen