Motion control system with adaptive deceleration

• US 4,506,321 A
• Filed: 09/08/1982
• Issued: 03/19/1985
• Est. Priority Date: 09/08/1982
• Status: Expired due to Fees

• Current Assignee: Imec Vzw
• Original Assignee: Imec Vzw
• Inventors: Fulton, Donald E., Curtiss, William P., Comstock, Robert H.
• Primary Examiner(s): Smith, Jerry
• Assistant Examiner(s): NOT, DEFINED
• Application Number:
  US06/416,357
• Time in Patent Office: 923 Days
• Field of Search: 364/174, 364/167, 364/183, 364/400, 318/561, 318/571, 318/39, 318/593
• US Class Current: 700/69
• CPC Class Codes: G05B 19/232 with speed feedback only
• CPC Class Codes: G05B 19/416 characterised by control of velocity, acceleration or deceleration G05B19/19 takes precedence
• CPC Class Codes: G05B 2219/34215 Microprocessor
• CPC Class Codes: G05B 2219/41419 Resolution of feedback of incremental position decreases with velocity speed
• CPC Class Codes: G05B 2219/42237 Pwm pulse width modulation, pulse to position modulation ppm
• CPC Class Codes: G05B 2219/43034 Form of profile, ramp, trapezoid, S-curve, exponential
• CPC Class Codes: G05B 2219/43093 Speed pattern, table together with timing data in ram
• CPC Class Codes: G05B 2219/43097 Table, rom, ram speed table

Abstract

A microprocessor-based motor control system operates the rapid advance motor on a slide transfer machine to carry out rapid traverse motions in minimal time. A velocity profile is stored during the acceleration portion of the move and this data is employed to determine when deceleration should begin and to control velocity during the deceleration portion of the move. A position feedback circuit having programmable resolution is employed to develop the velocity profile.

Claims

1. A control system for a movable element on a machine, the combination comprising:

a motor coupled to the movable element for moving the same;

a motor control coupled to the motor to operate it in response to a motion command signal;

acceleration control means coupled to the motor control for generating motion signals which accelerate the movable element from a start position to a rapid traverse velocity and which includes;

(a) velocity table storage means, and

(b) means for storing numbers in the velocity table storage means, which numbers are indicative of the motion generated by the acceleration control means during successive portions of the acceleration;

indicating means coupled to the motor control for sensing the velocity of the movable element and providing an indication when rapid traverse velocity is reached;

distance measuring means coupled to the movable element for indicating the distance traveled from its start position;

means enabled by the indicating means and coupled to the motor control for generating motion command signals which move the movable element at the rapid traverse velocity;

calculating means coupled to the indicating means and the distance measuring means for calculating a deceleration position which is a function of the distance traveled by the movable element during its acceleration from the start position to the position at which it reached rapid traverse velocity; and

deceleration control means coupled to the distance measuring means and the calculating means for generating motion command signals to the motor control which decelerate the movable element from its rapid traverse velocity when the movable element reaches the calculated deceleration position, and in which

the deceleration control means includes means for reading successive numbers from the velocity table storage means to generate motion command signals during the deceleration of the movable element.

2. The control system as recited in claim 1 in which each number stored in the velocity table storage means is indicative of the time interval required for a present increment of motor motion.

3. The control system as recited in claim 2 in which the present increment of motor motion is altered by the means for storing numbers in the velocity table storage means to increase the present increment as the velocity of the movable element increases.

4. The control system as recited in claim 1 in which the deceleration control means alters each number read from the velocity table storage means to alter the deceleration profile of the movable element from its acceleration profile.

5. An incremental position feedback system which comprises:

transducer means for generating a succession of feedback signals, each feedback signal being indicative of a fixed increment of distance;

counter means for receiving the feedback signals and accumulating a count which is indicative of the number of received feedback signals;

selector means coupled to the counter means and being operable in response to an interval number received at its select inputs to select an accumulated count in the counter means which will generate an interval output signal;

timer means for measuring the time interval between generated interval output signals; and

adjustment means coupled to the timer means and being operable to generate an interval number to the selector means, the generated interval number being altered when the measured time interval drops below a minimum level and the generated interval number being altered when the measured time interval increases above a maximum level, whereby the resolution of the incremental position feedback system is automatically reduced at higher velocities and automatically increased at lower velocities.

6. The incremental position feedback system as recited in claim 5 which includes means for calculating velocity that comprises:

a look-up table for storing a set of uncompensated velocity numbers;

first calculator means coupled to receive the measured time interval, and in response thereto, read a corresponding uncompensated velocity number from the look-up table; and

second calculator means coupled to the first calculator means and to the adjustment means for altering the value of the uncompensated velocity number read from the look-up table by an amount determined by the generated interval number.

7. A control system for an induction motor, the combination comprising:

motor drive means responsive to a command signal (SIN θ

) to provide an armature current I_o (SIN θ

) which is applied to the induction motor;

table storage means (SINTBL) for storing values of SIN for successive values of θ

;

means for storing an index (SINARG);

output means responsive to the value of the index (SINARG) to read a value from the table storage means (SINTBL) and output the same as a command signal (SIN θ

) to the motor drive means;

phase interrupt means coupled to the induction motor and the index storage means, and being operable each time the induction motor rotates a preselected means (Δ

θ

₁) to change the stored index (SINARG) by a corresponding amount;

timed interrupt means coupled to the index storage means and being operable to periodically change the stored index (SINARG) by an amount (Δ

θ

₂) which is determined by the desired motor torque and slip.

8. The control system as recited in claim 7 in which the output means operates each time the phase interrupt means changes the stored index (SINARG).

9. The control system as recited in claim 8 in which the output means operates each time the timed interrupt means changes the stored index (SINARG).