Hallo David,

oben sieht jetzt alles gut aus.

VOR der While(true) Schleife (genauer: Vor stopSERVO()!) must du ja noch den Init Befehl stellen:
initSERVO(SERVO1);

IN der While(true) Schleife muss servo1_position = pos; raus.

Zwischen die letzten beiden "}" muss wieder return 0; rein.

Gruß Dirk