Hallo andi,

so ganz verstehe ich dein Prog nicht.

Rein formal:
1. Mit initSERVO() must du ALLE Servos, die du angeschlossen hast, in der Main (also VOR der while(1)-Schleife!) EINMAL definieren. Wenn du also Servos an 1, 3 und 4 hast, dann steht da:
initSERVO(SERVO1 | SERVO3 | SERVO4);
In einer Funktion (und bes. in einer Schleife) hat initSERVO nichts zu suchen.

2. Wenn sich der Arm bewegen soll, müßtest du die Servopositionen für eine bestimmte Bewegung z.B. in einer Funktion (Armrunter, Armhoch, Handauf ...) zusammen fassen. Das sind dann mehrere Positionen pro Bewegung, zwischen denen je eine Pause liegt.

Gruß Dirk