Added delay for MOV. Added cleanup code for Servo.