Method and apparatus for sub-span interpolation
AssigneeCincinnati Milacron Inc.
InventorRobert M. Crovella
Life of this patent
Estimating the term…
Abstract
A method for efficiently interpolating sub-span position commands for control of a machine member. The method includes storing a set of coefficients defined by a parametric function relating member position and time, calculating the distance between a target coordinate axis position command and a current coordinate axis position command, generating first and second command modifiers from the stored coefficients, the calculated distance, and a current coordinate axis position command, and summing the current coordinate axis position command and the first and second command modifiers to generate a subspan position command.
Claims7
A method for controlling motion of a machine member to effect motion of a workpoint along a predetermined path wherein coordinate axis position commands defining path points are periodically produced at a predetermined time interval, the method comprising the steps of:
- selecting a number of sub-intervals for calculating sub-span position command;
- producing a set of values of coefficients of coordinate axis position commands in an expression of machine member position, the coefficients being defined for each selected sub-interval, the expression being derived from a predetermined parametric function relating machine member position and time defined by three successive coordinate axis position commands;
- generating a first coordinate distance as the difference between a current coordinate axis position command and a next coordinate axis positon command;
- generating a second coordinate distance as the difference between the current coordinate axis position command and a prior coordinate axis position command;
- generating a first command modifier for each selected sub-interval from a first coefficient from the set of values of coefficients and the first coordinate distance;
- generating a second command modifier for each selected sub-interval from a second coefficient from the set of values of coefficients and the second coordinate distance summing the present coordinate axis position command and the first and second command modifiers to produce a sub-span position command for each selected sub-interval;
- and
- moving the machine member in response to the sub-span position commands at a rate defined by the sub-interval.
A device for controlling motion of a machine member comprising:
- means for periodically producing coordinate axis position commands for moving the machine member to path points at a first predetermined time interval;
- means for selecting a number of sub-intervals;
- means for producing a set of values of coefficients for each selected sub-interval;
- means for generating a first coordinate distance from a present coordinate axis position command and a target coordinate axis position command for the first predetermined time interval;
- means for generating a second coordinate distance having a predetermined relationship between the present coordinate axis position command and a prior coordinate axis position command for the predetermined time interval;
- means for periodically calculating sub-span position commands for moving the machine member intermediate the path points at a predetermined sub-interval less than the predetermined time interval, the sub-span position commands being the sum of calculating a product of one of the coefficient values and the first coordinate distance for each sub-interval and a product of another of the coefficient values and the second coordinate distance for each sub-interval;
- and
- means for moving the machine member in response to the sub-span position commands at a rate defined by the sub-interval.
Dependencies are inferred from the claim text.