Added delay back between servos and clean up