Controller with drop prevention function for gap control axis

Abstract

A controller performs gap control such that a Z-axis position of a tip of a cutting head of the machine is not below a preset lower limit position while keeping the distance between the tip of the cutting head and a workpiece constant. The numerical controller calculates a substantial lower limit position based on a detected state of the workpiece and the preset lower limit position. If the Z-axis position of the tip of the cutting head is below the calculated substantial lower limit position, it is compensated so as not to be below the substantial lower limit position.

Claims

1. A controller for controlling a machine which performs cutting of a workpiece, the controller being configured to perform gap control such that a Z-axis position of a tip of a cutting head of the machine is not below a preset lower limit position while keeping the distance between the tip of the cutting head and the workpiece constant and comprising: a workpiece state detection unit configured to detect a state of the workpiece; and a lower limit position limiting unit configured to compensate the Z-axis position of the tip of the cutting head so as not to be below a substantial lower limit position calculated based on the state of the workpiece and the preset lower limit position if the Z-axis position of the tip of the cutting head is below the substantial lower limit position, wherein the state of the workpiece is information on an inclination of the workpiece, and the lower limit position limiting unit is configured to calculate the substantial lower limit position by transforming the preset lower limit position based on the information on the inclination of the workpiece.

2. A controller for controlling a machine which performs cutting of a workpiece, the controller being configured to perform gap control such that a Z-axis position of a tip of a cutting head of the machine is not below a preset lower limit position while keeping the distance between the tip of the cutting head and the workpiece constant and comprising: a workpiece state detection unit configured to detect a state of the workpiece; and a lower limit position limiting unit configured to compensate the Z-axis position of the tip of the cutting head so that the coordinate values of a substantial position of the tip of the cutting head relative to the workpiece transformed based on the state of the workpiece are not below the preset lower limit position if the coordinate values of the substantial position of the tip of the cutting head are below the preset lower limit position, wherein the state of the workpiece is information on an inclination of the workpiece, and the lower limit position limiting unit is configured to calculate the substantial the coordinate values of the position of the tip of the cutting head by transforming the coordinate values of the position of the tip of the cutting head based on the information on the inclination of the workpiece.

Description

BRIEF DESCRIPTION OF THE DRAWINGS

(1) The above and other objects and features of the present invention will be obvious from the ensuing description of embodiments with reference to the accompanying drawings, in which:

(2) FIGS. 1A and 1B are diagrams showing setting of the lower limit of a movable area of a cutting head performed by a controller according to the present invention;

(3) FIG. 2 is a diagram illustrating a calculation method for inclining the lower limit of the movable area of the cutting head;

(4) FIG. 3 is a diagram illustrating a method for transforming the coordinate values of a tip point of the cutting head;

(5) FIG. 4 is a diagram illustrating the effect of control of the cutting head in flat plane machining using the controller according to the present invention;

(6) FIG. 5 is a diagram illustrating the definition of the movable area of the cutting head for the case in which a workpiece is a square pipe;

(7) FIG. 6 is a diagram showing a calculation method for inclining the lower limit of an area set as the movable range of the cutting head for the case in which the workpiece is a square pipe;

(8) FIG. 7 is a diagram illustrating the definition of the movable area of the cutting head for the case in which the workpiece is a round pipe;

(9) FIG. 8 is a diagram illustrating the effect of control of the cutting head in pipe machining using the controller according to the present invention;

(10) FIG. 9 is a schematic block diagram of a controller according to one embodiment of the present invention;

(11) FIG. 10 is a flowchart showing an operation in which a machine is controlled by the controller of FIG. 9 to machine a flat workpiece;

(12) FIG. 11 is a flowchart showing an operation in which the machine is controlled by the controller of FIG. 9 to machine a pipe-shaped workpiece;

(13) FIG. 12 is a diagram illustrating a problem of gap control;

(14) FIG. 13 is a diagram illustrating a conventional cutting head drop prevention function of a controller;

(15) FIG. 14 is a diagram illustrating a first problem of the prior art drop prevention function; and

(16) FIG. 15 is a diagram illustrating a second problem of the prior art drop prevention function.

DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS

(17) First, setting of the lower limit of a movable area of a cutting head performed by a controller according to the present invention will be described with reference to FIGS. 1A and 1B.

(18) The controller (not shown) according to the present invention sets a lower limit L of the movable area of the cutting head (not shown) to maintain the height level of the cutting head. FIG. 1A shows the lower limit L of the movable area of the cutting head (not shown) set when a workpiece 5 is not inclined.

(19) If the controller detects that the workpiece 5 is inclined before machining based on gap control is started, it inclines an area (a lower limit L of the movable area of the cutting head) set as the movable range of the cutting head in accordance with the inclination of the workpiece 5. The inclination of the workpiece 5 can be calculated based on the coordinate values of three optional points (A, B and C) on the workpiece that are measured before the machining, for example.

(20) FIG. 2 is a diagram illustrating a calculation method for inclining the lower limit of the area set as the movable range of the cutting head.

(21) When the lower limit L of the movable area of the cutting head is on a horizontal plane Z, as shown in FIG. 2, the Z-axis height of the plane Z is given as z. When the lower limit L of the movable area of the cutting head is inclined, three points A, B and C on the inclined plane L defined as a plane ABC are measured. If the inclination to the plane Z is represented by rotation angles (, , ) about X-, Y-, and Z-axes of a workpiece coordinate system, a rotation matrix P for transforming the plane Z into the plane ABC can be given as follows:

(22) $\begin{array}{cc}P=\left(\begin{array}{ccc}\cos \cos -\sin \sin & \cos \cos +\sin \cos & -\cos \cos \\ -\sin \cos -\cos \sin & -\sin \cos -\cos \cos & \sin \sin \\ \sin \cos & \sin \sin & \cos \end{array}\right)& \left(1\right)\end{array}$

(23) In performing gap control of a cutting head 3, in the controller of the present invention, coordinate values (x1, y1, z1) are calculated by transforming coordinate values (x1, y1, z1) of the tip of the cutting head 3 during machining by an inverse matrix P.sup.1 of the rotation matrix P, as shown in FIG. 3. The control is performed so that the calculated Z-axis coordinate value z1 is not lower than a height level z set as the lower limit. Alternatively, a plane Z may be obtained such that the horizontal plane Z indicative of the lower limit L of the movable area of the cutting head is transformed by the rotation matrix P, whereby the coordinate values (x1, y1, z1) of the tip of the cutting head during the machining can be controlled so as not to be below the plane Z.

(24) By performing the gap control of the cutting head 3 as described above, the movable area of the cutting head 3 (lower limit L of the movable area of the cutting head) can be inclined in accordance with the inclination of the set workpiece 5, as shown in FIG. 4, even when the workpiece is inclined. Thus, a drop prevention function can be used without causing the cutting head 3 to drop or producing an area subject to defective machining.

(25) Moreover, in the controller according to the present invention, if the workpiece is a square or round pipe, the movable area of the cutting head is defined based on a case in which the rotation angle of the pipe is 0.

(26) FIG. 5 is a diagram illustrating the definition of the movable area of the cutting head for the case in which the workpiece is a square pipe.

(27) If a workpiece 6 is a square pipe, four points A, B, C and D on the workpiece 6 as viewed from an X-Z plane are defined using distances (<1>, <3>, <2> and <4>) from a rotation center O of the workpiece 6. Four points A, B, C and D are obtained by rotating the defined four points A, B, C and D in accordance with a rotation angle of the workpiece 6.

(28) FIG. 6 is a diagram showing a calculation method for inclining the lower limit L of the area set as the movable range of the cutting head for the workpiece 6 of FIG. 5.

(29) The controller controls the Z-axis coordinate value of the cutting head so as to satisfy the following expressions.
=0:
ZStraight line BA(xbXxa).(1)
0<<90:
ZStraight line BA(xbXxa),
ZStraight line AD(xaXxd).(2)
=90:
ZStraight line AD(xaXxd).(3)
90<<180:
ZStraight line AD(xaXxd),
ZStraight line DC(xdXxc).(4)
=180:
ZStraight line DC(xdXxc).(5)
180<<270:
ZStraight line DC(xdXxc),
ZStraight line CB(xcXxb).(6)
=270:
ZStraight line CB(xcXxb).(7)
270<<360:
ZStraight line CB(xcXxb),
ZStraight line BA(xbXxa).(8)

(30) FIG. 7 is a diagram illustrating the definition of the movable area of the cutting head for the case in which the workpiece is a round pipe.

(31) If a workpiece 7 is a round pipe, the distance between a coordinate E (xe, ze) of the cutting head tip and the rotation center O (x1, z1) is calculated. The controller holds the cutting head in place by controlling the Z-axis coordinate value of the cutting head so as to satisfy expression (2) as follows:
<5>{square root over ((xex1).sup.2+(zez1).sup.2)}(2)

(32) In expression (2) above, <5> is the distance from the rotation center of the workpiece 7 (round pipe) to the lower limit L of the movable area of the cutting head, as shown in FIG. 7.

(33) By performing the gap control of the cutting head 3 in the manner described above, the drop prevention function of the cutting head 3 of the controller of the present invention can be used without causing the cutting head to drop or producing an area subject to defective machining even in pipe machining, as shown in FIG. 8.

(34) FIG. 9 is a schematic block diagram of a controller according to one embodiment of the present invention for the gap control described above.

(35) A controller 1 comprises a control unit 10, gap control unit 11, and motor control unit 12. The control unit 10 analyzes a machining command 20 and generates move command data for each axis motor to be controlled. The gap control unit 11 compensates a Z-axis stroke based on the move command data so as to keep the distance between the cutting head 3 and the workpiece 5 constant, based on a signal fed back from a sensor 4 for detecting the amount of gap between the cutting head 3 and the workpiece 5. The motor control unit 12 controls a Z-axis motor 2 for controlling the Z-axis position of the cutting head 3. Typical constituent elements of the controller, such as various axis motors for controlling the relative positions of the cutting head 3 and the workpiece 5 in various axis directions, e.g., the X- and Y-axis directions, and axis motor control units for controlling the motors are not shown in FIG. 5.

(36) The controller 1 shown in FIG. 9 further comprises a workpiece state detection unit 13 and a lower limit position limiting unit 14. The workpiece state detection unit 13 detects the state of the workpiece 5 based on information detected by a sensor and information including the coordinate values of the axes from the motor control units for axes other than the Z-axis. The lower limit position limiting unit 14 obtains the lower limit L of the movable area of the cutting head by the aforementioned calculation method, based on the state of the workpiece 5 detected by the workpiece state detection unit 13, and limits the Z-axis stroke in the move command data compensated by the gap control unit 11 based on the lower limit L. The motor control unit 12 controls the Z-axis motor 2 based on the move command data in which the Z-axis stroke is limited by the lower limit position limiting unit 14.

(37) The state of the workpiece detected by the workpiece state detection unit 13 is the inclination of the workpiece 5 calculated based on the coordinate values of the three points (A, B and C in FIG. 1B) from the surface of the workpiece 5 by a touch sensor or distance sensor (not shown) as mentioned before, if the workpiece is a flat plate. Moreover, if the workpiece is a square pipe, the workpiece state is the rotation angle of the workpiece 6 obtained from the coordinate values of corner points of the workpiece 6 detected by a sensor or the like and the axis motor control units.

(38) FIG. 10 is a flowchart showing an operation in which a machine (cutting head 3) is controlled by the controller 1 of FIG. 9 to machine the flat workpiece 5.

(39) [Step SA01] The lower limit position limiting unit 14 calculates a transformation matrix P based on the inclination of the workpiece 5 detected by the workpiece state detection unit 13.

(40) [Step SA02] The control unit 10 determines whether or not the machining of the workpiece 5 is being performed. If the machining is being performed, the processing proceeds to Step SA03. If not, this processing ends.

(41) [Step SA03] The control unit 10 analyzes the machining command 20 and generates and outputs the move command data for the axes.

(42) [Step SA04] The gap control unit 11 determines whether or not the gap control is on. If the gap control is on, the Z-axis stroke based on the gap control is compensated, whereupon the processing proceeds to Step SA05. If the gap control is off, the move command data is output directly to the motor control unit 12, whereupon the processing proceeds to Step SA02.

(43) [Step SA05] The lower limit position limiting unit 14 acquires the coordinate values of the tip point of the cutting head 3 from the move command data and inversely transforms (transforms by an inverse matrix) the acquired coordinate values of the tip point of the cutting head 3 by the matrix P calculated in Step SA01.

(44) [Step SA06] The lower limit position limiting unit 14 determines whether or not the lower limit L of the movable area of the cutting head 3 is reached by the tip point of the cutting head 3, based on the Z-axis coordinate value of the coordinate values inversely transformed in Step SA05. If the lower limit L is reached, the processing proceeds to Step SA07. If not, the processing proceeds to Step SA08.

(45) [Step SA07] The lower limit position limiting unit 14 limits the Z-axis stroke compensated by the gap control unit 11 so that the cutting head tip point does not reach the lower limit L of the movable area of the cutting head 3, whereupon the processing returns to Step SA02.

(46) [Step SA08] The lower limit position limiting unit 14 removes the limit on the Z-axis stroke compensated by the gap control unit 11, whereupon the processing returns to Step SA02.

(47) FIG. 11 is a flowchart showing an operation in which the machine (cutting head 3) is controlled by the controller 1 of FIG. 9 to machine a pipe-shaped workpiece.

(48) [Step SB01] The control unit 10 determines whether or not the machining is being performed. If the machining is being performed, the processing proceeds to Step SB02. If not, this processing ends.

(49) [Step SB02] The control unit 10 analyzes the machining command 20 and generates and outputs the move command data for each axis.

(50) [Step SB03] The gap control unit 11 determines whether or not the gap control is on. If the gap control is on, the Z-axis stroke based on the gap control is compensated, whereupon the processing proceeds to Step SB04. If the gap control is off, the move command data is output directly to the motor control unit 12, whereupon the processing proceeds to Step SB01.

(51) [Step SB04] The lower limit position limiting unit 14 determines whether or not the workpiece is a square pipe or a round pipe, based on the setting of the controller 1 or the like.

(52) [Step SB05] The lower limit position limiting unit 14 calculates the coordinate values obtained by rotating the respective coordinate values of the four corner points (A, B, C and D) of the workpiece 6 at the rotation angle of the workpiece 6, based on each piece of information detected by the workpiece state detection unit 13.

(53) [Step SB06] The lower limit position limiting unit 14 calculates a line equation for obtaining the lower limit of the movable area of the cutting head, based on the coordinate values after the rotation of the four corner portions calculated in Step SB05.

(54) [Step SB07] The lower limit position limiting unit 14 calculates the distance between the rotation center of the workpiece 7 and the coordinate values of the tip point of the cutting head 3, whereupon the processing proceeds to Step SB08.

(55) [Step SB08] The lower limit position limiting unit 14 determines whether or not the lower limit L of the movable area of the cutting head 3 is reached by the tip point of the cutting head 3, based on the result of the calculation in Step SB06 or SB07. If the lower limit L is reached, the processing proceeds to Step SB09. If not, the processing proceeds to Step SB10.

(56) [Step SB09] The lower limit position limiting unit 14 limits the Z-axis stroke compensated by the gap control unit 11 so that the head tip point of the cutting head 3 does not reach the lower limit L of the movable area of the cutting head, whereupon the processing returns to Step SB01.

(57) [Step SB10] The lower limit position limiting unit 14 removes the limit on the Z-axis stroke compensated by the gap control unit 11, whereupon the processing returns to Step SB01.

(58) While an embodiment of the present invention has been described herein, the invention is not limited to the above-described embodiment and may be suitably modified and embodied in various forms.