Brauchst du es überhaupt so rum? Du willst doch vermutlich einen bestimmten Punkt im Raum anfahren und musst dafür die Soll-Position der drei Achsen berechnen.