Servo configuration
Remove atmega code