das habe ich doch gerade erklärt: über eine PID-Steuerung.
Ich habe den Eindruck, du hast überhaupt keine praktische Erfahrung, und aus einem rein theoretischen Ansatz heraus wirst du hier nicht weiterkommen, fürchte ich.

Hast du überhaupt jemals praktisch einen Roboterarm programmiert?
Wenn ja, welchen (Hardware) und mit welcher Programmiersprache (Software)?

Wenn du tatsächlich noch keine praktische Erfahrung hast: Kauf dir mal einen Arduino Mega und einen Arduino Braccio Roboterarm, und dann fang einfach mal an.