Numerical control device

• US 8,478,438 B2
• Filed: 09/16/2008
• Issued: 07/02/2013
• Est. Priority Date: 09/16/2008
• Status: Expired due to Fees

• Current Assignee: Shin Nippon Koki Co., Ltd.
• Original Assignee: Shin Nippon Koki Co., Ltd.
• Inventors: Nishibashi, Nobutaka
• Primary Examiner(s): PATEL, RAMESH B
• Application Number:
  US13/119,001
• Publication Number:
  US 20110166693A1
• Time in Patent Office: 1,750 Days
• Field of Search: 700159-160, 700/181, 700/184, 700187-189, 700192-194, 318/567, 318/568.1, 318/568.11, 31856817-56819, 318/568.23
• US Class Current: 700/159
• CPC Class Codes: G05B 19/4086 Coordinate conversions; Other special calculations
• CPC Class Codes: G05B 19/4103 Digital interpolation
• CPC Class Codes: G05B 19/414 Structure of the control system, e.g. common controller or multiprocessor systems, interface to servo, programmable interface controller
• CPC Class Codes: G05B 19/416 characterised by control of velocity, acceleration or deceleration G05B19/19 takes precedence
• CPC Class Codes: G05B 2219/33269 Convert cartesian to machine coordinates
• CPC Class Codes: G05B 2219/33271 Convert workpiece to machine coordinates
• CPC Class Codes: G05B 2219/34202 Reusable software, generic resource model library
• CPC Class Codes: G05B 2219/36231 Translate, convert machine independent to machine dependent program
• CPC Class Codes: G05B 2219/36504 Adapt program to real coordinates, shape, dimension of tool, offset path
• CPC Class Codes: G05B 2219/41405 Inverse kinematic, dynamic
• CPC Class Codes: G05B 2219/49121 C-axis for turning, fifth axis for milling
• CPC Class Codes: G05B 2219/50162 Stewart platform, hexapod construction
• CPC Class Codes: G05B 2219/50165 Axis nc machine cooperates with two axis rotary table

Abstract

A main control process is made common to all machine tools by describing in a NC program a tool trajectory including a change in posture in a coordinate system (30) fixed to a machining object (W), fixedly arranging a preparatory reference coordinate system (20) on a machine table (2), representing an installation position of the machining object (W) and a position of a spindle (91) on which a tool (11) is mounted in the preparatory reference coordinate system (20), and containing portions relating to a configuration of axes in a conversion function group of correlation between the position (q) of the spindle (91) and an axis coordinate (r). Thus, the processes of reading the NC program, correction of the tool trajectory and conversion into the trajectory of a spindle position based on the installation position of the machining object, the tool shape, and tool dimensions are made completely common.

Claims

1. A numerical control device that controls a machine tool having at least a spindle for mounting a tool, a spindle head that fixedly holds the spindle, a machine table on which a machining object is fixedly disposed, the relative positional relationship between the spindle head and the machine table including a rotation posture being controlled about a plurality of axes for driving, and motors adapted for drive about each of axes, with a preparatory reference coordinate system, in which orientations of coordinate axes and a position of an original point are fixed, being set on the machine table,

the numerical control device having a preparation unit, a first control unit, a second control unit, and a third control unit;

wherein the preparation unit has at least an NC program management unit, a preparatory information management unit, and a tool information management unit as segmentalized sub-means;

the NC program management unit stores in a preparation information memory unit a NC program having described therein a trajectory of a tool position, which is a position including a tool posture in a program coordinate system fixed to the machining object, a tool path formed of a tool feed speed command indicating a feed speed thereof, and an as-needed tool path correction command;

the preparatory information management unit stores in the preparation information memory unit preparatory information, which is information on a position that is in the preparatory reference coordinate system and composed of original point coordinate in the program coordinate system and posture angles indicating orientations of coordinate axis cosines, as an arrangement position including a posture of the machining object to the machine table;

the tool information management unit stores in the preparation information memory unit tool information including a shape of the tool used, a length of the tool, and dimensional information on a correction amount of a tool radius;

the first control unit has as segmentalized sub-means an NC program read unit and a tool path correction unit;

the NC program read unit reads the tool path and the tool path correction command described in the NC program and stores the tool path and the tool path correction command in a path computation memory unit;

the tool path correction unit corrects the tool path according to the tool path correction command;

the second control unit finds an axis path corresponding to a trajectory of axis coordinates, which are position coordinates about all axes for driving, from the tool path on the basis of the preparatory information and the tool information by taking into account specific features of configuration of the axes for driving, and stores the found axis path in the path computation memory unit;

the third control unit finds a movement amount about each axis for driving for each interpolation period from the axis path and outputs the found movement amounts to the motors;

the preparation unit further has an axis configuration management unit as segmentalized sub-means;

the axis configuration management unit stores in a machine information memory unit a spindle-axis conversion function that converts into the axis coordinates the spindle position based on an inverse kinematic relationship that is determined by the configuration of the axes for driving, the relationship indicating a correlation between the axis coordinates and a spindle position, which is position information obtained by representing a position of the spindle, including the rotation posture thereof, in the preparatory reference coordinate system;

the second control unit has a spindle path calculation unit and an axis path calculation unit as segmentalized sub-means;

the spindle path calculation unit converts the tool path into a spindle path, which is a trajectory of the spindle position, on the basis of the preparatory information and the tool information, irrespectively of the configuration of the axes for driving, and stores the spindle path in the path computation memory unit; and

the axis path calculation unit converts the spindle path into the axis path by using the spindle-axis conversion function, and stores the axis path in the path computation memory unit.

2. The numerical control device according to claim 1, wherein

the preparation unit further has a redundancy restraint condition addition unit as a segmentalized sub-unit;

the redundancy restraint condition addition unit stores in the path computation memory unit a redundancy restraint condition, which is an additional condition that, when this condition is added to the inverse kinematic function, can regulate to one the number of axis coordinates corresponding to the spindle position in the case in which the machine tool has an axis configuration having a redundancy such that when the axis coordinates corresponding to the spindle position are found on the basis of the inverse kinematic relationship, an infinite number of solutions is obtained, and

the spindle-axis conversion function is a function for calculating the one axis coordinate corresponding to the spindle position by using together the inverse kinematic function and the redundancy restraint condition stored in the path computation memory unit.

3. The numerical control device according to claim 1, wherein

the preparation unit further has a feed control condition management unit as segmentalized control means;

the feed control condition management unit stores axis acceleration/deceleration conditions including allowed maximum values of speed, acceleration, and jerk about each axis for driving obtained by taking first-order derivative, second-order derivative, and third-order derivative of each axis coordinate with respect to time;

the first control unit further has a tool path intervening variable representation unit as segmentalized sub-means;

the tool path intervening variable representation unit represents the tool trajectory included in the tool path by a function having s, which is an integral length of a movement distance including posture variations of the tool trajectory, as an intervening variable, converts the tool feed speed command into a speed of the s, and converts the tool path into a tool path represented as a function having the s as an intervening variable;

the spindle path calculation unit finds a spindle path functionally represented with the s as an intervening variable;

the axis path calculation unit finds an axis path functionally represented with the s as an intervening variable;

the third control unit has as segmentalized sub-means an acceleration/deceleration interpolation control unit and a pulse interpolation unit;

the acceleration/deceleration interpolation control unit determines values of the s at various points of time on the basis of the tool feed speed command and the axis acceleration/deceleration condition;

the pulse interpolation unit finds values of the s for each interpolation period on the basis of the determined values of the s at various points of time, finds axis coordinates corresponding to the found values of s for each interpolation period, calculates a movement amount about each axis for driving for each of the interpolation periods from the axis coordinates, and outputs the movement amounts to the motors;

the axis configuration management unit stores in the machine information memory unit an axis partial derivative value acquisition function for determining values of first-order, second-order, and third-order partial derivatives of the axis coordinates taken with respect to components of the spindle position on the basis of the inverse kinematic relationship in addition to the spindle-axis conversion function, and stores, for each axis for driving, in the preparation information memory unit an axis path correction allowed error, which is a position error allowed for correction of the axis path;

the acceleration/deceleration interpolation control unit includes as further segmentalized sub-means a block smooth interpolation unit, a corner smooth interpolation unit, a feed control condition transform unit, and an intervening variable acceleration/deceleration determination unit;

the block smooth interpolation unit determines whether or not at least either of a start point and an end point is smoothly connected to an adjacent block for each command block and each axis for driving, and when smooth connection is realized in the start point, finds a first-order derivative value and a second-order derivative value obtained with respect to the adequate s common to the start point of the present block for which the determination has been performed and an end point of a block immediately preceding the present block, stipulates the found derivative values as a start point connection condition, while when smooth connection is realized in the end point, finds a first-order derivative value and a second-order derivative value obtained with respect to the adequate s common to the end point of the present block and a start point of a block immediately following the present block, stipulates the found derivative values as an end point connection condition, finds a smooth block curve having a first-order derivative value and a second-order derivative value stipulated by at least either of the start point connection conditions and the end point connection condition, and performs correction of an axis path by replacing the present block with the smooth block curve; and

the corner smooth interpolation unit determines whether or not the first-order derivative value and the second-order derivative value obtained with respect to the s in the end point of each command block of the axis path match respective values in the start point of the next command block in a series of axis paths that should be performed continuously and have been found by the block smooth interpolation unit, and when either of the first-order derivative value and the second-order derivative value does not match, finds a smooth corner curve that has a first-order derivative value and a second-order derivative value matching the first-order derivative value and the second-order derivative value of the command block for which matching of the derivative values has been checked and the command block following this command block, and that has an error with respect to the original axis path equal to or less than the axis path correction allowed error, and also has continuously changing first-order derivative value and second-order derivative value in order to eliminate a discontinuous variation portion of the first-order derivative value and the second-order derivative value of each axis path obtained with respect to the s, and performs correction of the axis path by replacing with the smooth corner curve an axis path between a contact point of the smooth corner curve with the command block for which matching of the derivative values has been checked and a contact point of the smooth corner curve with the next command block;

the feed control condition transform unit derives an intervening variable acceleration/deceleration condition, which is a condition equation for the s, a speed of the s, an acceleration of the s, and a jerk of the s in each portion of the axis path, by using the spindle-axis conversion function and the axis partial derivative value acquisition function under the axis acceleration/deceleration condition;

the intervening variable acceleration/deceleration determination unit finds an intervening variable time function s(t), which is a functional representation of the s with time on the basis of the intervening variable acceleration/deceleration condition and the conditions under which the s is within the feed speed command range and the highest speed of the s is attained; and

the pulse interpolation unit calculates a movement amount about each axis for driving for each interpolation period on the basis of the intervening variable time function and outputs the calculated movement amounts to the motors.

4. The numerical control device according to claim 3, wherein

when a first-order derivative value and a second-order derivative value are stipulated in both the start point and the end point of the block, the smooth block curve is obtained by connecting three curves represented by third-order polynomials of the s so that the first-order derivative value and the second-order derivative value change continuously;

and

the smooth corner curve is constituted by connecting the three curves represented by third-order polynomials of the s so that the first-order derivative value and the second-order derivative value change continuously.