wie kann ich die funktionen in andere Dateien auslagern
Na, einfach die Funktionen in eine z.B. servo.c auslagern und die Definitionen dazu in eine servo.h

Die kann man dann in andere Projekte includen.

Gruß Dirk