control servomotor