fein fein,
ich bin zwar nicht der Knaller in C, aber ich glaube ich versteh's.

Wirst du eine Rückwärtskinematik umsetzen?