ABE?
Code:
...
Enable Interrupts

Servo(1) = 180
Wait 1
Servo(1) = 40
Wait 1

Do

...