servo motor initial code