Arduino changed to avoid servo stuttering