Update main.ino

Servo alustus ja pientä siistintää.