Simple solution:

Code:
For position=start to finish
    pause 100 
    gosub Servo_Control
Next position
Ioannis