Multiple axis motion control system

• US 5,025,385 A
• Filed: 05/25/1990
• Issued: 06/18/1991
• Est. Priority Date: 04/15/1988
• Status: Expired due to Fees

• Current Assignee: Froyd, Stanley G.
• Original Assignee: Froyd, Stanley G.
• Inventors: Froyd, Stanley G.
• Primary Examiner(s): RUGGIERO, JOSEPH F
• Application Number:
  US07/529,132
• Time in Patent Office: 389 Days
• Field of Search: 364/474.11, 364/474.3, 364/164, 364/165, 364/167.01, 364/513, 318/568, 318/18, 318/615-618
• US Class Current: 700/169
• CPC Class Codes: G05B 19/41 characterised by interpolation, e.g. the computation of intermediate points between programmed end points to define the path to be followed and the rate of travel along that path G05B19/25, G05B19/31, G05B19/37, G05B19/39, G05B19/40 take precedence
• CPC Class Codes: G05B 2219/31368 MAP manufacturing automation protocol
• CPC Class Codes: G05B 2219/35386 Look ahead processing of plural block data from buffer
• CPC Class Codes: G05B 2219/41437 Feedforward of speed
• CPC Class Codes: G05B 2219/42184 Master slave with feedforward for compensation of contour error
• CPC Class Codes: G05B 2219/43162 Motion control, movement speed combined with position
• CPC Class Codes: G05B 2219/49164 Corner, making corner

Abstract

The invention is directed to an improved motion control system for controlling multiple motion actuators associated with different axes for moving a member along a defined path. The system is intended to move a member along the defined path as a result of the coordinated motion of two or more essentially independent motion actuators. In accordance with the invention, instead of responding to a servo lag error between a commanded and actual position, the velocity along each axis for each path segment is established by a feedforward data file generated by "looking ahead" at input describing the full path and processing this data, together with machine specific data specifying the operational characteristics (or capabilities) of the machine (e.g. milling machine) to be operated.

Claims

1. A system for controlling a plurality of machines, each machine including multiple independent actuators for moving a member along a path with respect to multiple axes, said system comprising:

input means for supplying a part program for each of said machines, each part program defining the terminal coordinates of successive path portions;

host computer means;

program means for operating said host computer means to generate with respect to each machine, a feedforward data file based on said part program input means comprised of a series of data blocks, each data block defining a profile of position and velocity versus time with respect to a linear path segment, said program means including means for looking ahead at the direction and magnitude of subsequent path portions to generate the data block defining each path segment;

a plurality of machine control units, each connected to a different machine;

means for distributing each data file generated by said host computer means to one of said machine control units;

each of said machine control units including;

position commander means responsive to each data block for generating a plurality of command position signals each associated with a different actuator;

velocity profiler means responsive to each data block for generating a plurality of feedforward velocity signals, each associated with a different actuator;

each actuator having associated therewith;

position sensor means for generating an actual position signal with respect to the associated actuator;

means for summing the command position and actual position signals generated with respect to the associated actuator for producing a position error signal for that actuator; and

means for summing said command position error and feedforward velocity signals generated with respect to each actuator for producing a command velocity signal with respect to that actuator.

2. The system of claim 1 wherein at least some of said plurality of machine control units are physically located remote from said host computer means;

and wherein

said means for distributing includes data network means for communicating digital data between said host computer means and said machine control units.

3. The system of claim 1 wherein said input means also supplies target machine specification data;

and wherein

said program means is additionally responsive to said target machine specification data for generating said feedforward data file.