Servo control system operable on digital basis with limit cycle suppressed

• US 4,259,626 A
• Filed: 06/07/1979
• Issued: 03/31/1981
• Est. Priority Date: 06/09/1978
• Status: Expired due to Term

• Current Assignee: Nippon Electric Company Limited (NEC Corporation)
• Original Assignee: Nippon Electric Company Limited (NEC Corporation)
• Inventors: Inada, Hiroshi, Nomura, Tadashi
• Primary Examiner(s): Dobeck, B.
• Application Number:
  US06/046,291
• Time in Patent Office: 663 Days
• Field of Search: 318/603, 318/599, 318/608, 318/561, 318/600, 400/144.2, 400/163
• US Class Current: 318/599
• CPC Class Codes: B41J 1/24 the plane of the type or die face being perpendicular to the axis of rotation B41J1/60 takes precedence
• CPC Class Codes: B41J 19/202 Drive control means for carriage movement
• CPC Class Codes: G05B 19/232 with speed feedback only
• CPC Class Codes: G05B 2219/37313 Derive speed from position
• CPC Class Codes: G05B 2219/41247 Servo lock
• CPC Class Codes: G05B 2219/42104 Loop switch, speed loop then position loop, mode switch
• CPC Class Codes: H02P 23/22 Controlling the speed digitally using a reference oscillator, a speed proportional pulse rate feedback and a digital comparator

Abstract

In a digital servo control system (31) for a carriage of a serial printer or a like movable element, a control signal (125) digitally represents a reference angular velocity for a motor (26) until an instant at which a displacement from a current position of the element to a commanded position decreases to a predetermined value, a positional error during a preselected interval following the instant, and an integrated value (52) of a position error between the current and the commanded positions to suppress limit cycle after the interval. A PWM signal (56-57) is derived from the control signal and position pulses (62 or 63) representative of a variation in the current position. Preferably, small-amplitude limit cycle is forced to occur during the interval with the positional error indicated by a modified signal (182) derived by adding unity to positive and zero position errors.

Claims

1. A digital servo control system responsive to a command signal indicative of a commanded position of a movable element and a pair of incremental position signals having polarities variable with a phase difference therebetween in response to a predetermined incremental angle of rotation of a motor rotatable with a variable angular velocity to vary a present position of said element, for producing a motor drive signal for controllably driving said motor to position said element at said commanded position, said angular velocity having either of two senses at a time, said phase difference being representative of the sense of said angular velocity, said system comprising position pulse producing means responsive to said incremental position signals for producing position pulses representative of a variation in said current position, wherein the improvement comprises:

control signal producing means responsive to said command signal and said position pulses for calculating a displacement from said present position to said commanded position and for producing a control signal digitally representative of a reference angular velocity selected for said motor in consideration of said displacement until an instant at which said displacement is reduced in absolute value to a predetermined value, a first positional error determined by said displacement during a prescribed interval of time following said instant, and a second positional error having a value increasing in absolute value with relation to said displacement when a predetermined interval of time lapses after said instant, said prescribed interval being not longer in duration than said predetermined interval, said movable element being positioned substantially at said commanded position within said predetermined interval; and

motor drive signal producing means responsive to said control signal and said position pulses for producing said motor drive signal.

2. A digital servo control system as claimed in claim 1, wherein said control signal producing means comprises:

first signal producing means responsive to said command signal and said position pulses for calculating said displacement to produce a mode signal indicative of a velocity control mode and a position control mode until said instant and at and after said instant, respectively, and to produce a first digital signal representative of said reference angular velocity until said instant, said first positional error during said prescribed interval, and a difference error corresponding to said displacement after lapse of said predetermined interval;

second signal producing means responsive to said mode signal and said first digital signal for producing a second digital signal representative of zero during the time that said mode signal indicates said velocity control mode during said prescribed interval and for integrating said difference error after lapse of said predetermined interval to make said second digital signal represent the integrated difference error as said second positional error after lapse of said predetermined interval; and

means for calculating a sum of said first and said second digital signals to produce said control signal.

3. A digital servo control system as claimed in claim 2, said displacement having a magnitude equal to one of positive integers, zero, and negative integers at a time, wherein said first signal producing means produces said first digital signal by rendering from moment to moment said first positional error equal to the magnitude of the displacement by which said first positional error is determined at the moment.

4. A digital servo control system as claimed in claim 2, wherein said first signal producing means comprises:

first means responsive to said command signal and said position pulse for calculating said displacement to produce said mode signal and a digital control signal representative of said reference angular velocity until said instant and a position error corresponding to said displacement at and after said instant; and

second means responsive to said mode signal and said digital control signal for merely transmitting said digital control signal as the first digital signal representative of said reference angular velocity when said mode signal indicates said velocity control mode, for modifying the position error to said first positional error during said prescribed interval to produce the first digital signal representative of said first positional error, and for again merely transmitting the digital control signal representative of said position error as the first digital signal representative of said difference error after lapse of said predetermined interval.

5. A digital servo control system as claimed in claim 4, said displacement having a magnitude equal to one of positive integers, zero, and negative integers at a time, wherein said second means comprises:

means responsive to said mode signal and said digital control signal for merely transmitting said digital control signal as the first digital signal representative of said reference angular velocity and said difference error when said mode signal indicates said velocity control mode and after lapse of said predetermined interval; and

means responsive to said mode signal and said digital control signal for modifying the position error into said first positional error during said prescribed interval by adding one to the position error corresponding to one of the positive integers and zero and leaving untouched the position error corresponding to one of the negative integers.

6. A digital servo control system as claimed in claims 1, 2, 3, 4, or 5, wherein said motor drive signal producing means comprises:

pulse width modulating means responsive to an input signal having a level variable with time for producing a pulse width modulated signal having a pulse width variable in proportion to said level;

means responsive to said pulse width modulated signal for producing said motor drive signal; and

input signal producing means responsive to said control signal and said position pulses for producing said input signal.

7. A digital servo control system as claimed in claim 6, wherein said input signal producing means comprises:

means responsive to said position pulses for producing a velocity signal representative of said variable angular velocity; and

means responsive to said control signal and said velocity signal for producing said input signal.