Hallo Sigo
Es ist ebenfalls ein modifizierter mehrstufiger PID-Regler. Mit unterlagerter Drehmoment, Drehzahl und Stromregelung.
Da bist Du ja gut drauf im Programmieren
In was programmierst Du und würdest Du den Quellcode eventuell auch weiter geben?

l.G. Roberto