Hi,

ich habe in der Elektor 05/2005 einen Servo Controller gefunden. Da ist auch ein Source Code dabei. Leider nicht in C.
Evtl. helfen Dir aber die Sourcen weiter.