Zum Errechnen der Achsen 2,3 und die Achse vom Handgelenk, die zu den beiden parallel ist, hab ich eine Idee. Diese Achsen müssen wirklich parallel sein.
Voraussetzung ist, dass alle Längen bekannt sind.
Dazu wird ein zylindrisches Koordinatensystem (R/α/Z) unter den Drehpunkt der 1. Achse gelegt.
In den Greifer kommt eine Zeigespitze (Bleistift).
Ein Punkt auf dem Koordinatensystem wird angefahren. (Zeigespitze auf einer Höhe von z=0)
Die Achsen werden genullt. Entfernung zischen Spitze und 0 notieren
Ein neuer Punkt wird angefahren. (Z=0 /α=konst.)
Winkeländerung der Achsen und Entfernung notieren.
Ein neuer Punkt wird angefahren. (Z=0 /α=konst.)
Winkeländerung (in Bezug auf Nullung) der Achsen und Entfernung notieren.
Und schon haben wir ein Gleichungssystem, denke ich
Notfalls kann man dieses Problem mit einem CAD Programm lösen, wozu gibt es denn Rechner.
Ich kenn mich noch nicht sonderlich mit DH-Matrizen aus, aber daraus lässt sich doch bestimmt auch ein Gleichungssystem mit 6 Variablen bauen. Man muss es ja nicht im Kopf rechnen. Dafür bräuchte man doch ein kartesisches Koordinatensystem, um sich die Umrechnung zu sparen, oder?
Lesezeichen