Control solution of step-servo motor