Numerical controller performing speed control that suppresses excessive positioning deviation

Abstract

A numerical controller sets a parameter actually used for servo control on the basis of command data generated by analyzing a machining program. Based on the set parameter and a predefined allowable position deviation amount, a feed speed which is given by a position deviation not exceeding the predefined allowable position deviation amount is calculated. Then, when a feed speed commanded by the command data is larger than the calculated feed speed, the feed speed commanded by the command data is clamped at the calculated feed speed.

Claims

1. A numerical controller which controls a machine on the basis of a machining program, the numerical controller comprising: a program analysis unit that analyzes the machining program to generate command data; a parameter setting unit that sets a parameter actually used for servo control on the basis of the command data; a servo control unit that controls a servo motor; and a speed control unit that obtains a feed speed which is given by a position deviation not exceeding an actually used allowable position deviation amount on the basis of an allowable position deviation amount calculated based on the parameter actually used for servo control, the set parameter, and a predefined allowable position deviation amount, wherein when a feed speed commanded by the command data is larger than the obtained feed speed, the speed control unit is configured to clamp the feed speed commanded by the command data to be equal to the obtained feed speed, wherein the servo control unit controls the servo motor based on the feed speed commanded by the command data, and wherein the speed control unit obtains the feed speed which is given by a position deviation not exceeding the actually used allowable position deviation amount, as a maximum speed which satisfies the expression:
VERRPG/(1) where V is the feed speed which is given by a position deviation not exceeding the actually used allowable position deviation amount, ERR is the allowable position deviation amount, PG is a position gain of a servo, and is a feedforward coefficient.

Description

BRIEF DESCRIPTION OF THE DRAWINGS

(1) The aforementioned and other objects and features of the present invention will be apparent from the following description of embodiments with reference to the appended drawings, in which:

(2) FIG. 1 is a functional block diagram of a numerical controller according to a first embodiment of the present invention;

(3) FIG. 2 is a flowchart illustrating a flow of processing performed on the numerical controller in FIG. 1;

(4) FIG. 3 is a functional block diagram of a numerical controller according to a second embodiment of the present invention; and

(5) FIG. 4 is a flowchart illustrating a flow of processing performed on the numerical controller in FIG. 3.

DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS

(6) In the present invention, a feed speed which is given by a position deviation not exceeding a predefined allowable position deviation amount is obtained based on a position gain of a servo actually used in a movement command, a feedforward coefficient actually used in the movement command, and the predefined allowable position deviation amount, in executing the movement command. Then, when a command speed in the movement command is larger than a feed speed which is given by a position deviation not exceeding the predefined allowable position deviation amount, the command speed is clamped at the feed speed which is given by a position deviation not exceeding the predefined allowable position deviation amount to execute the movement command. Moreover, by performing the clamping of the command speed before performing acceleration/deceleration, operation at a set acceleration/deceleration can be achieved.

(7) First, a numerical controller according to a first embodiment of the present invention is described using FIG. 1 and FIG. 2.

(8) As illustrated in FIG. 1, a numerical controller 1 according to the embodiment includes a program analysis unit 11, a parameter setting unit 12, a speed control unit 13, an interpolation unit 14, an acceleration/deceleration unit 15 and a servo control unit 16.

(9) The program analysis unit 11 reads and analyzes a command block from a machining program 21 stored in a memory (not shown), and generates and outputs command data.

(10) The parameter setting unit 12 determines whether or not a loop gain PG of a servo and a feedforward coefficient are needed to be changed in accordance with a movement command commanded by the command data, on the basis of the command data output by the program analysis unit 11. When needed to be changed, the parameter setting unit 12 changes the loop gain PG of the servo and the feedforward coefficient .

(11) The speed control unit 13 calculates a speed V which is given by a position deviation not exceeding the predefined allowable position deviation amount ERR, using the expression (2) below, on the basis of the loop gain (position gain of the servo) PG and the feedforward coefficient which are set by the parameter setting unit 12 and actually used in the movement command commanded by the command data, and the allowable position deviation amount ERR which is predefined.
VERRPG/(1)(2)

(12) Then, the speed control unit 13 compares the calculated speed V with a command speed in the movement command commanded by the command data. When the command speed is larger than the speed V, the speed control unit 13 changes (clamps) the feed speed in the movement command commanded by the command data so as to be V.

(13) The interpolation unit 14 generates data obtained by performing interpolation calculation of points on a command path for an interpolation period on the basis of the movement command commanded by the command data and the speed determined by the speed control unit 13.

(14) The acceleration/deceleration unit 15 performs acceleration/deceleration processing on the basis of the interpolation data output by the interpolation unit 14 to calculate the speed of each drive axis for each interpolation period, and outputs the calculated speed data to the servo control unit 16.

(15) Then, the servo control unit 16 controls a servo motor 2 on the basis of the output of the acceleration/deceleration unit 15 and the parameters such as the loop gain PG of the servo and the feedforward coefficient which are set by the parameter setting unit 12.

(16) FIG. 2 is a flowchart illustrating a flow of processing performed for each control cycle of the numerical controller 1 on the numerical controller 1 in FIG. 1. The processing is explained below according to respective steps [Step SA01] The program analysis unit 11 reads and analyzes the command block from the machining program 21 and generates the command data. [Step SA02] The parameter setting unit 12 determines, based on the command data generated in step SA01, whether or not the loop gain PG of the servo is needed to be changed in accordance with the movement command commanded by the command data. When the loop gain PG is needed to be changed, the process proceeds to step SA03, and when not needed, the loop gain PG is set to the servo control unit 16 and the process proceeds to step SA04. [Step SA03] The parameter setting unit 12 changes the loop gain PG to a loop gain of the servo used in the movement command and sets the changed loop gain PG to the servo control unit 16. [Step SA04] The parameter setting unit 12 determines, based on the command data generated in step SA01, whether or not the feedforward coefficient is needed to be changed in accordance with the movement command commanded by the command data. When the feedforward coefficient is needed to be changed, the process proceeds to step SA05, and when not needed to be changed, the feedforward coefficient is set to the servo control unit 16 and the process proceeds to step SA06. [Step SA05] The parameter setting unit 12 changes the feedforward coefficient to a feedforward coefficient used in the movement command to set it to the servo control unit 16. [Step SA06] The speed control unit 13 acquires the predefined allowable position deviation amount ERR and sets it to the servo control unit 16. [Step SA07] The speed control unit 13 determines whether or not the feedforward coefficient used in the movement command commanded by the command data is 1. When the feedforward coefficient is 1, the process proceeds to step SA10, and otherwise, the process proceeds to step SA08. [Step SA08] The speed control unit 13 calculates, based on the allowable position deviation amount ERR set in step SA06, and the loop gain PG and the feedforward coefficient which are used in the movement command commanded by the command data, the speed which is given by a position deviation not exceeding the predefined allowable position deviation amount, by using the expression (2) above. The calculated speed is set as V. [Step SA09] The speed control unit 13 determines whether or not the command speed in the movement command commanded by the command data is larger than the speed V calculated in step SA08. When larger than the calculated speed V, the process proceeds to step SA10, and otherwise, the process proceeds to step SA11. [Step SA10] The speed control unit 13 determines the command speed in the movement command commanded by the command data as the speed V. [Step SA11] The interpolation unit 14 performs the interpolation processing on the basis of the movement command commanded by the command data and the speed V defined by the speed control unit 13, and creates the interpolation data. [Step SA12] The acceleration/deceleration unit 15 performs the acceleration/deceleration processing on the basis of the interpolation data created in step SA11, and outputs the result data to the servo control unit 16.

(17) The basic configuration and processing flow in the numerical controller of the present invention have been described so far. Hereafter, more specific embodiments in the numerical controller of the present invention are presented.

(18) A numerical controller according to a second embodiment of the present invention is described using FIG. 3 and FIG. 4.

(19) The numerical controller 1 according to the present embodiment is configured to perform acceleration/deceleration before interpolation and acceleration/deceleration after interpolation and includes an acceleration/deceleration before interpolation unit 17 and an acceleration/deceleration after interpolation unit 18 as illustrated in FIG. 3, in place of the acceleration/deceleration unit 15 of the numerical controller 1 in the first embodiment (FIG. 1).

(20) Functions of individual elements constituting this numerical controller 1 illustrated in FIG. 3 are similar to the functions of the corresponding elements in the numerical controller 1 illustrated in FIG. 1 except for those of the interpolation unit 14, the acceleration/deceleration before interpolation unit 17 and the acceleration/deceleration after interpolation unit 18.

(21) When the acceleration/deceleration before interpolation is enabled, the acceleration/deceleration before interpolation unit 17 performs the acceleration/deceleration before interpolation processing on the basis of the movement command commanded by the command data and the speed defined by the speed control unit 13, and outputs the result data to the interpolation unit 14.

(22) The interpolation unit 14 generates data obtained by interpolation of the points on the command path for the interpolation period, on the basis of the result data output by the acceleration/deceleration before interpolation unit 17 in the case where the acceleration/deceleration before interpolation is enabled, or on the basis of the movement command commanded by the command data and the speed defined by the speed control unit 13 in the case where the acceleration/deceleration before interpolation is disabled.

(23) Then, when the acceleration/deceleration after interpolation is enabled, the acceleration/deceleration after interpolation unit 18 performs the acceleration/deceleration after interpolation processing on the basis of the interpolation data output by the interpolation unit 14 to calculate the speed of each drive axis for each interpolation period, and outputs the result data to the servo control unit 16. When the acceleration/deceleration after interpolation is disabled, the output of the interpolation unit 14 is output to the servo control unit 16.

(24) FIG. 4 is a flowchart illustrating a flow of processing performed for each control cycle of the numerical controller 1 on the numerical controller 1 in FIG. 3. In this processing, it is assumed that the acceleration/deceleration after interpolation processing is enabled at all times.

(25) Since processes in step SB01 to step SB06 in this flowchart of FIG. 4 are similar to the processes in step SA01 to step SA06 in the flowchart of FIG. 2, their description is omitted here. Then, processes in step SB07 to step SB15 are hereafter described. [Step SB07] The speed control unit 13 determines whether or not the feedforward coefficient used in the movement command commanded by the command data is 1. When the feedforward coefficient is 1, the process proceeds to step SB11, and otherwise, the process proceeds to step SB08. [Step SB08] The speed control unit 13 calculates, based on the allowable position deviation amount ERR set in step SB06 and the loop gain PG and the feedforward coefficient which are used in the movement command commanded by the command data, the speed which is given by a position deviation not exceeding the predefined allowable position deviation amount, by using the expression (2) above. The calculated speed is set as the speed V. [Step SB09] The speed control unit 13 determines whether or not the command speed in the movement command commanded by the command data is smaller than the speed V calculated in step SB08. When being smaller than the calculated speed V, the process proceeds to step SB11, and otherwise, the process proceeds to step SB10. [Step SB10] The speed control unit 13 defines the speed V calculated in step SB08 as the feed speed F. [Step SB11] The speed control unit 13 defines the command speed in the movement command commanded by the command data as the feed speed F. [Step SB12] It is determined whether or not the acceleration/deceleration before interpolation is enabled. When enabled, the process proceeds to step SB14, and otherwise, the process proceeds to step SB13. [Step SB13] The interpolation unit 14 performs, based on the movement command commanded by the command data and the speed defined by the speed control unit 13, the interpolation processing to generate the interpolation data. The process proceeds to step SB15. [Step SB14] The acceleration/deceleration before interpolation unit 17 performs, based on the movement command commanded by the command data and the speed defined by the speed control unit 13, the acceleration/deceleration before interpolation processing. The interpolation unit 14 performs, based on the result data of the acceleration/deceleration before interpolation processing, the interpolation processing and generates the interpolation data. [Step SB15] The acceleration/deceleration after interpolation unit 18 performs, based on the generated interpolation data, the acceleration/deceleration after interpolation processing and outputs the result data to the servo control unit 16.

(26) A numerical controller according to a third embodiment of the present invention is described.

(27) The numerical controller 1 according to the present embodiment performs control in which movement commands different in loop gain of the servo and in feedforward coefficient, such as cutting feed and rapid traverse, overlap.

(28) When a movement command of the cutting feed and a movement command of the rapid traverse overlap, loop gains of the servo and/or feedforward coefficients are switched in switchover between the cutting feed and the rapid traverse, during movement in the overlapping.

(29) In the numerical controller of the present embodiment, even before and after loop gains of the servo and/or feedforward coefficients are switched in the switchover, on the basis of the position gain of the servo and the feedforward coefficient which are actually used and the predefined allowable position deviation amount, the feed speed which is given by a position deviation not exceeding the predefined allowable position deviation amount is sequentially obtained. When the feed speed to be output is larger than the speed which is given by a position deviation not exceeding the predefined allowable position deviation amount, the speed obtained by clamping at the speed which is given by a position deviation not exceeding the predefined allowable position deviation amount is set as the feed speed. Then, similarly to the aforementioned numerical controller according to the first embodiment, the speed control processing, the acceleration/deceleration processing and the interpolation processing are performed.

(30) As described above, in the present embodiment, in the case where a movement command of the cutting feed and a movement command of the rapid traverse overlap, even when loop gains of the servo and/or feedforward coefficients are switched during a movement in overlapping, the speed which is given by a position deviation not exceeding the predefined allowable position deviation amount is sequentially calculated. Further, the speed is controlled based on the calculated speed. Hence, the position deviation amount excess alarm can be beforehand suppressed from arising. Moreover, the movement command according to the set acceleration/deceleration value can be achieved.

(31) A numerical controller according to a fourth embodiment of the present invention is described.

(32) The numerical controller 1 according to the present embodiment performs control in which the loop gain of the servo is varying with the position of the servo motor during the movement performed by one movement command, and is mainly applied to control of a press machine and the like.

(33) In the numerical controller according to the present embodiment, based on the loop gain of the servo which is actually used and is varying with the position, the feedforward coefficient actually used, and the predefined allowable position deviation amount, the feed speed which is given by a position deviation not exceeding the predefined allowable position deviation amount is sequentially obtained. When the feed speed to be output is larger than the speed which is given by a position deviation not exceeding the predefined allowable position deviation amount, the speed obtained by clamping at the speed which is given by a position deviation not exceeding the predefined allowable position deviation amount is set as the feed speed. Then, similarly to the numerical controller according to the first embodiment, the speed control processing, the acceleration/deceleration processing and the interpolation processing are performed.

(34) As described above, in the present embodiment, even when as in a function used in a press machine and the like, the loop gain of the servo is varying with the position of the servo motor during the movement performed by one movement command, the speed which is given by a position deviation not exceeding the predefined allowable position deviation amount is sequentially obtained. As the speed is controlled based on that calculated speed, the position deviation amount excess alarm can be beforehand suppressed from arising and the movement command according to the set acceleration/deceleration value can be achieved.

(35) As described above, the embodiments of the present invention have been described. The present invention is not limited to the examples in the aforementioned embodiments but can be implemented in various modes with proper modifications added thereto.