Passenden Code gibt es im RN-Wissen unter Servoansteuerung.