Control servo motor with arduino