serial prints added and work. Servo not working.