... und bei
void ServoInit(void);

das Semikolon gehört da nicht hin - dürfte so eigentlich nicht fehlerfrei übersetzt werden.