Problems with serial print (using a input sensor & Servomotor)