Eine frage @ Radbruch

in deinem Programm verstehe ich leider nur den ersten teil den komplexeren teil verstehe ich nicht, da die demo mit meinen roboterarm wesentlich besser lief würde ich gerne wissen wie ich es anpassen könnte

mfg
martin