mhhh. Ich weiss nicht, ob ich das richtig verstanden habe: Du sollst die Spitze des Armes von A nach B bewegen und brauch daher die Bewegungs-Funktionen für die einzelnen Motoren ?
A u. B sind als x,y,z angegeben ?