arduino waveshield - servo motor problem