JP6490368B2 - Machine tool control device, machine tool control method, and program - Google Patents

Description

  The present invention relates to a machine tool control apparatus, a machine tool control method, and a program that can realize a suitable machining force estimation technique without using an additional sensor and applied to a ball screw drive stage.

In a machine tool that performs cutting and grinding, it is useful to monitor a processing force such as a cutting force in order to determine vibration during processing and a state of a tool. Conventionally, a technique using an additional sensor such as a force sensor is generally employed to monitor the processing force.
However, such a general technique causes an increase in cost and a decrease in mechanical rigidity.
For this reason, the present inventors have developed the technique of the processing force estimation which does not require an additional sensor (refer patent document 1).

JP 2010-271880 A

However, the processing force estimation technique described in Patent Document 1 is suitable for application to a linear motor stage, but is suitable for application to a ball screw drive stage that is widely employed as a drive mechanism for machine tools. It was hard to say.
For this reason, it is desired to realize a technique for estimating a machining force that is suitable for application to a ball screw drive stage without using an additional sensor.

  The present invention has been made in view of such a situation, and an object of the present invention is to realize a technique for estimating a suitable working force by applying it to a ball screw drive stage without using an additional sensor. To do.

A machine tool control device according to one aspect of the present invention is provided.
A drive mechanism for driving a machining tool of a machine tool or a stage loaded with the work as a load, and generating a torque corresponding to an electric current, and converting a rotational motion in the motor into a linear motion in a predetermined direction. A machine tool control device that performs control on a drive mechanism including a linear motion mechanism that moves the load in the predetermined direction.
And the machine tool control device of one aspect of the present invention is:
As the output information of the drive mechanism, the position of the load in the predetermined direction is acquired, the state information indicating the internal state of the drive mechanism is acquired, and based on the output information and the state information, the drive mechanism Position control means for controlling the position of the load in the predetermined direction by changing the command value of the current as input information;
A machining force estimation means for estimating a machining force on the workpiece by the machining tool based on a multi-inertia model of the drive mechanism using the output information, the state information, and the input information as parameters.
It is characterized by providing.

Here, in the machine tool control device of one aspect of the present invention,
The machining force estimation means further estimates the machining force using a low-pass filter for suppressing high frequency noise,
You can also

In the machine tool control device according to one aspect of the present invention,
The low pass filter is a Butterworth filter;
You can also

Furthermore, in the machine tool control device according to one aspect of the present invention,
The machining force estimation means further estimates the machining force using a delay compensation filter that compensates for a delay due to pseudo differentiation included in the multi-inertia model and an electrical delay of the torque of the motor.
It can also be done.

In the machine tool control device according to one aspect of the present invention,
The machining force estimation means further estimates the machining force using a dead time element.
You can also

Furthermore, the machine tool control device according to one aspect of the present invention provides:
Compensation means for estimating a disturbance based on the output information, the state information, and the input information, and compensating a command value of the current based on the estimated disturbance,
Can be further provided.

In the machine tool control device according to one aspect of the present invention,
The machining force estimation means further uses a rotation angle converted into linear motion in the linear motion mechanism as the state information.
You can also

  Each of the machine tool control method and program according to one aspect of the present invention is a method and program corresponding to the above-described machine tool control device according to one aspect of the present invention.

  According to the present invention, it is possible to realize a suitable machining force estimation technique that is applied to a ball screw drive stage without using an additional sensor.

It is a mimetic diagram showing an outline of a machine tool system containing a controller concerning a 1st embodiment of a machine tool control device of the present invention. It is a block diagram which shows the structure of the hardware of a controller among the machine tool systems of FIG. It is a functional block diagram which shows a functional structure in the case of performing position control and cutting force estimation among the functional structures of the controller of FIG. It is a figure for demonstrating the outline | summary of the cutting force estimation method to which this invention is applied, Comprising: It is the figure which showed the force which acts on a ball screw drive stage, when cutting with the machine tool system of FIG. It is a functional block diagram which shows the detailed functional structure of the cutting force observer among the controllers of FIG. It is a result of the simulation of the machine tool system of FIG. 1, and is a diagram showing a gain characteristic of an estimated value of a cutting force with respect to an input frequency. It is a figure which shows the result of the test by an actual machine in case the feed speed is constant and the command of a tool rotation speed is made low among the tests by the actual machine of the machine tool system of FIG. It is a figure which shows the result of the test by an actual machine in case the feed speed is constant and the command of a tool rotation speed is made high among the tests by the actual machine of the machine tool system of FIG. It is a figure which shows the time transition of the said feed rate employ | adopted when the test of the feed rate accompanying acceleration / deceleration was done as a test by the real machine of the machine tool system of FIG. It is a figure which shows the result of the test by an actual machine at the time of making it the feed speed with acceleration / deceleration and making the command of tool rotation speed low among the tests by the actual machine of the machine tool system of FIG. It is a figure which shows the test result by the actual machine at the time of making the command of tool rotation speed into the feed speed accompanying acceleration / deceleration among the tests by the actual machine of the machine tool system of FIG. It is a functional block diagram which shows the detailed functional structure of the cutting force observer which concerns on 2nd Embodiment. It is a Bode diagram which shows the theoretical calculation result of the transfer function between the signals concerning 2nd Embodiment. It is a figure which shows an example of the measured value of the signal used for the estimation which concerns on 2nd Embodiment. It is a figure which shows the comparison result of the estimation precision by the presence or absence of the delay compensation using the dead time element which concerns on 2nd Embodiment. It is a figure which shows the comparison result of the estimation precision of 1 inertial system at the time of performing delay compensation using the dead time element which concerns on 2nd Embodiment, and 2 inertial system. It is a block diagram which shows the functional structure of a controller with the structure of the ball screw drive stage which concerns on 3rd Embodiment. It is the figure which showed the force which acts on the ball screw drive stage which concerns on 3rd Embodiment. It is a functional block diagram which shows the detailed functional structure of the cutting force observer which concerns on 3rd Embodiment. It is a figure which compares and shows the estimation result of the cutting force when the cutting force observer which concerns on 3rd Embodiment is designed as a 1 inertia system, a 2 inertia system, and a 3 inertia system.

[First Embodiment]
Hereinafter, a first embodiment of the present invention will be described with reference to the drawings.

  FIG. 1 is a schematic diagram showing an outline of a machine tool system 1 including a controller 11 according to an embodiment of a machine tool control apparatus of the present invention.

  As shown in FIG. 1, the machine tool system 1 of the present embodiment includes a controller 11, a servo amplifier 12, and a ball screw drive stage 13.

  The controller 11 is a control device (servo controller) capable of performing position control on the ball screw drive stage 13 via the servo amplifier 12 and estimating a cutting force described later.

  The servo amplifier 12 drives the motor 21 for driving the ball screw drive stage 13 by passing a current Ia corresponding to a command value from the controller 11 to control the magnitude of the torque of the motor 21. It is. Hereinafter, the torque of the motor 21 is referred to as “motor torque” in order to distinguish it from the friction torque.

  The ball screw drive stage 13 includes a motor 21, a rotary encoder 22, a coupling 23, a ball screw 24, a bearing 25, a stage 26, and a linear encoder 27.

The motor 21 rotates the screw shaft of the ball screw 24 via the coupling 23 by generating a motor torque corresponding to the current Ia from the servo amplifier 12.
The rotary encoder 22 detects the rotation angle θm of the motor 21 and uses the rotation angle θm as information indicating the internal state of the ball screw drive stage 13 (hereinafter referred to as “state information”) via the servo amplifier 12. Feedback to the controller 11.
The coupling 23 connects one end of the rotating shaft of the motor 21 and one end of the screw shaft of the ball screw 24.
In the ball screw 24, both ends of the screw shaft are supported by bearings 25, nuts are attached to the stage 26, and the rotational motion transmitted from the motor 21 via the coupling 23 is converted into a linear motion, whereby the stage 26 is moved along the screw axis.
Hereinafter, a direction parallel to the screw axis of the ball screw 24 (lateral direction in FIG. 1) is referred to as an “x direction”.
The bearing 25 supports the screw shaft of the ball screw 24.
The stage 26 loads a workpiece W shown in FIG. 3 to be described later, and moves in the x direction by the ball screw 24.
The linear encoder 27 detects the position xt of the stage 26 in the x direction, and feeds back the position xt to the controller 11 as output information of the ball screw drive stage 13.

  FIG. 2 is a block diagram showing a hardware configuration of the controller 11 in the machine tool system 1 of FIG.

  The controller 11 includes a CPU (Central Processing Unit) 31, a ROM (Read Only Memory) 32, a RAM (Random Access Memory) 33, a bus 34, an input / output interface 35, an input unit 36, an output unit 37, A storage unit 38, a communication unit 39, and a drive 40.

The CPU 31 executes various processes according to a program recorded in the ROM 32 or a program loaded from the storage unit 38 to the RAM 33.
The RAM 33 appropriately stores data necessary for the CPU 31 to execute various processes.

  The CPU 31, ROM 32, and RAM 33 are connected to each other via a bus 34. An input / output interface 35 is also connected to the bus 34. An input unit 36, an output unit 37, a storage unit 38, a communication unit 39, and a drive 40 are connected to the input / output interface 35.

The input unit 36 includes a keyboard, a mouse, and the like, and inputs various types of information according to user instruction operations.
The output unit 37 includes a display, a speaker, and the like, and outputs an image and sound.
The storage unit 38 is configured with a hard disk or the like, and stores data of various types of information.
The communication unit 39 controls communication performed with another terminal (not shown) via the network, and outputs a command value for the servo amplifier 12 as shown in FIG. The communication for inputting feedback information from the servo amplifier 12 or the linear encoder 27 is controlled.

  A removable medium 51 composed of a magnetic disk, an optical disk, a magneto-optical disk, a semiconductor memory, or the like is appropriately attached to the drive 40. The program read from the removable medium 51 by the drive 40 is installed in the storage unit 38 as necessary. The removable media 51 can also store various data stored in the storage unit 38 in the same manner as the storage unit 38.

  FIG. 3 is a functional block diagram showing a functional configuration in the case of executing position control and cutting force estimation among the functional configurations of the controller 11 of FIG.

  When position control and cutting force estimation are executed by the controller 11, as shown in FIG. 3, a functional block including a position controller 101, a disturbance observer 102, and a cutting force observer 103 is included in the CPU 31 and the like (see FIG. Function in 2).

  When the position control by the controller 11 is executed, the stage 26 on which the workpiece W is loaded moves in the x direction, and is independently provided with a z-axis stage (not shown, but the same configuration as the x-axis stage 26) And the position of the tool spindle C attached to the z-axis direction is adjusted, and the workpiece W is cut by the cutting tool D.

Specifically, such position control is executed mainly by the position controller (including the PID controller + feedforward function) 101 in the controller 11.
That is, the position controller 101 obtains the rotation angle θm of the motor 21 as state information from the rotary encoder 22 (via the servo amplifier 12 not shown in FIG. 3), and the position xt of the stage 26 in the x direction. Obtained from the linear encoder 27 as output information. The position controller 101 outputs a command value for the current Ia of the motor 21 in order to control the position xt of the stage 26 in the x direction based on the state information and the output information.

Here, the command value itself output from the position controller 101 may be adopted as input information for the ball screw drive stage 13.
However, in the present embodiment, a value obtained by adding the compensation current generated by the disturbance observer 102 to the command value output from the position controller 101 is employed as input information. Hereinafter, the command value of the current Ia of the motor 21 which is input information is particularly referred to as “current reference value Iaref”.

That is, the disturbance observer 102 estimates the disturbance based on the current reference value Iaref (input information), the rotation angle θm (state information) of the motor 21 and the position xt (output information) of the stage 26 in the x direction, and the disturbance To generate a compensation torque for improving the robustness of the system. Thus, the compensation torque generated by the disturbance observer 102 is multiplied by (1 / Kt) as shown in FIG.
For further details of the disturbance observer 102, refer to Japanese Patent Application Laid-Open No. 2010-271880 that has already been filed and published by the present applicant.

When the position control of this embodiment is performed and the workpiece W loaded on the stage 26 moves in the x direction and hits the blade of the cutting tool D, the cutting tool D generates a cutting force Fcut. The workpiece W is cut by the cutting force.
The cutting force observer 103 estimates this cutting force Fcut.
Here, as position control with respect to the ball screw drive stage 13 of the present embodiment, not only the rotation angle θm (state information) of the motor 21 is fed back, but also the position x (output information) of the stage 26 in the x direction is linear. Control that is directly detected and fed back by the encoder 27, that is, full-closed control is employed.
Therefore, the cutting force observer 103 has internal information of the ball screw drive stage 13, that is, a current reference value Iaref (input information), a position xt in the x direction of the stage 26 (output information), and a rotation angle θm (state of the motor 21) Information) can be used to estimate the cutting force Fcut. As described above, the cutting force observer 103 can significantly improve the estimation accuracy by using these three pieces of internal information as compared with the conventional cutting force estimation method using a disturbance observer using only input / output information.

Further, a cutting force estimation method employed in such a cutting force observer 103, that is, a cutting force estimation method to which the present invention is applied will be described with reference to FIG.
FIG. 4 is a diagram for explaining the outline of the cutting force estimation method to which the present invention is applied, and shows the force acting on the ball screw drive stage 13 when cutting with the machine tool system 1 of FIG. It is a figure.

In FIG. 4, the ball screw drive stage 13 is expressed as a two-inertia model in which the rotary motor 21 and the linear motion stage 26 (a state in which the workpiece W is loaded), which is a load, are inertial. ing. The friction torque Tfric exists for the rotational movement of the motor 21 by the motor torque Kt × Ia (Kt is a torque constant), and the frictional force Ffric exists for the linear motion of the stage 26 in the x direction. Is assumed.
Under such a premise, the rotational motion of the shaft of the motor 21 is converted into a linear motion in the x direction parallel to the screw shaft in the ball screw 24 (FIG. 3 and the like), and the load of the mass Mt (the workpiece W is reduced). The loaded stage 26) moves by the movement amount xt. At that time, a cutting force Fcut is generated by cutting the cutting tool D into the workpiece W.

The equations of motion for the two-inertia system model of FIG. 4 are as shown in the following equations (1) and (2).

  In equations (1) and (2), Jr represents the moment of inertia, Kr represents the axial rigidity of the screw shaft of the ball screw 24, and R represents the conversion coefficient between the rotating system and the linear motion system. In the formula (1), Ia with ref added as an upper right subscript indicates a current reference value Iaref.

Furthermore, the reaction force term can be eliminated by combining the equations (1) and (2), and the cutting force Fcut is expressed by the following equation (3).

式（４）においては、推定値を示すパラメータには、推定であることを示す「ハット」が付されている。ｇｃｕｔは、切削力オブザーバ１０３の遮断周波数を示しており、各パラメータの右下添え字ｎは、ノミナル値を示す。 Furthermore, by using the friction torque Tfric and the frictional force Ffric estimated in advance and using a low-pass filter for suppressing high-frequency noise, the estimated value of the cutting force Fcut is expressed by the following equation (4). . That is, the functional block for estimating the cutting force Fcut according to the equation (4) is the cutting force observer 103 in FIG.

In equation (4), the parameter indicating the estimated value is given a “hat” indicating that the parameter is estimated. gcut indicates the cutoff frequency of the cutting force observer 103, and the lower right subscript n of each parameter indicates a nominal value.

As described above, since the position control of the present embodiment is fully closed control, the controller 11 adds the linear encoder 27 (in addition to the current reference value Iaref (input information) and the rotation angle θm (state information) of the motor 21). The position xt (output information) of the stage 26 supplied from FIG. 3) can also be measured.
Thereby, the cutting force observer 103 of the controller 11 can estimate the cutting force Fcut in the ball screw drive stage 13 with high accuracy without using an additional sensor such as a force sensor according to the equation (4).
Furthermore, in this embodiment, the disturbance observer 102 (FIG. 3) is also provided as described above. By the cancellation by the disturbance observer 102, the influence of parameter fluctuation can be reduced, and as a result, the estimation accuracy of the cutting force observer 103 is further improved.

  FIG. 5 is a functional block diagram showing a detailed functional configuration of such a cutting force observer 103.

The current reference value Iaref (input information) passes through the function block 112 via the function block 111 and is supplied to the function block 115 as an estimated value of the motor torque Tm (= Ktn × Ia).
Here, the functional block 111 includes a functional block 131 that compensates for a delay due to pseudo-differentiation included in the model, and a functional block that compensates for an electrical delay of the motor torque Tm (first-order delay with wcc as the bandwidth of the current control system). 132. That is, the functional block 111 functions as a delay compensation filter that compensates for the delay due to pseudo differentiation included in the model and the electrical delay of the motor torque Tm. By applying such a delay compensation filter, the high-frequency component estimation accuracy is further improved.

  The rotation angle θm (state information) of the motor 21 passes through the function block 113 and the function block 114, is second-order differentiated, and is multiplied by the moment of inertia Jr.

  In the function block 115, the output of the function block 114 is subtracted from the output of the function block 112, and is further multiplied by (1 / Rn) in the function block 116, whereby the first term in the curly braces of the equation (4) is obtained. Calculated.

  The position xt (output information) in the x direction of the stage 26 passes through the function block 117 and the function block 118, is second-order differentiated, and is multiplied by the mass Mt. That is, the second term in the curly braces of the equation (4) is calculated.

In function block 119, the second term in curly braces of equation (4), which is the output of function block 118, is subtracted from the first term in curly braces of equation (4), which is the output of function block 116, and In the function block 120, the value of the third term 121 (preliminarily estimated value 121) in the curly braces of the equation (4) is subtracted to calculate the braces of the equation (4).
The output of the function block 120 (the calculated value of the curly braces of the equation (4)) is output as an estimated value of the cutting force Fcut by passing through the function block 122 and suppressing high frequency noise. That is, the functional block 122 functions as a low-pass filter for suppressing high frequency noise.

The machine tool system 1 of the present embodiment has been described above with reference to FIGS.
In order to verify the effectiveness of the cutting force observer 103 in the machine tool system 1 of the present embodiment, the present inventors performed a simulation and a test using an actual machine.
First, the simulation will be described with reference to FIG. 6, and then the test using the actual machine will be described with reference to FIGS.

FIG. 6 is a diagram showing the gain characteristics of the estimated value of the cutting force Fcut with respect to the input frequency as a result of the simulation.
In FIG. 6, a solid line “Proposed method” indicates the characteristic of the cutting force observer 103 of the present embodiment. The dotted line “Previous method” indicates the characteristics of the conventional cutting force observer. Here, the conventional cutting force observer refers to a model in which the motion of the ball screw driving stage 13 is regarded as a single inertia system, and the cutting force is estimated using only input information and output information (state information is included). Absent).
The cutoff frequency gcut of the cutting force observer 103 of this embodiment and the conventional cutting force observer was set to 3000 rad / s.
The resonance frequency ωs in the direction of the screw axis (x direction) of the ball screw drive stage 13 is 445 Hz.
At the resonance frequency ωs, the gain is increased (has a peak) in the conventional cutting force observer, whereas the gain is not increased (has no peak) in the cutting force observer 103 of the present embodiment.
As described above, the cutting force observer 103 according to the present embodiment can estimate the cutting force Fcut that is not affected by resonance, that is, estimate the cutting force Fcut in a higher band.

  Next, a test using an actual machine will be described with reference to FIGS.

First, the present inventors set the feed speed of the stage 26 constant, use an end mill for the cutting tool D, and set the command of the tool spindle C to a low speed of 1000 min-1 and a high speed of 10,000 min-1. Each of these was subjected to a grooving test with an actual machine.
FIG. 7 shows a test result using an actual machine when the feed rate is constant and the command for rotating the tool is set to a low speed of 1000 min-1.
FIG. 8 shows a test result using an actual machine when the feed rate is constant and the tool rotation command is set to a high speed of 10,000 min-1.

  7 and 8, the solid line “this method” indicates the estimated value of the cutting force Fcut of the cutting force observer 103 of the present embodiment, and the dotted line “conventional method” indicates the cutting force Fcut of the conventional cutting force observer. As the estimated value, the “measured value” indicated by a one-dot chain line indicates the measured value of the cutting force Fcut by the force sensor. These points are the same in FIGS. 10 and 11 described later.

As shown in FIG. 7, when the feed rate is constant and the command for the rotational speed of the tool spindle C is 1000 min−1, which is a low speed, the cutting force observer 103 of this embodiment also has the conventional cutting force. Also for the observer, the estimated value of the cutting force Fcut is close to the actually measured value, and the estimation accuracy does not change much.
However, as shown in FIG. 8, when the feed rate is constant and the command for the rotational speed of the tool spindle C reaches 10000 min−1, which is a high speed, the cutting force observer 103 of the present embodiment is more conventional. It can be seen that the estimated value of the cutting force Fcut is close to the actually measured value, that is, the estimated accuracy is higher than that of the force observer.

  Next, the inventors set the rotation speed command of the tool spindle C to a low speed of 1000 min-1 and a high speed of 10,000 min-1 at a feed speed accompanied by acceleration / deceleration to the stage 26 as shown in FIG. For each of the cases, a grooving test using an actual machine was performed using an end mill as the cutting tool D.

  FIG. 9 shows the time transition of the feed speed given to the stage 26. As shown in FIG. 9, a 5 Hz sine wave having an average value of 30 mm / min and a fluctuation range of about 20 mm / min was adopted as the waveform of the feed rate. Adopting the feed speed with acceleration / deceleration as a command value in this way means that the control system receives an inertial force. Therefore, it can be verified by this test whether the cutting force Fcut can be accurately estimated without being influenced by the inertial force.

FIG. 10 shows a test result by an actual machine in the case where the feed speed accompanied by acceleration / deceleration and the command of the rotation speed of the tool spindle C is set to a low speed of 1000 min-1.
FIG. 11 shows a test result using an actual machine in the case where the feed speed accompanied by acceleration / deceleration and the command of the rotational speed of the tool spindle C is set to a high speed of 10,000 min-1.

As shown in FIG. 10, when the feed speed accompanied by acceleration / deceleration and the command of the rotational speed of the tool spindle C is 1000 min−1, which is a low speed, the cutting force observer 103 of the present embodiment also has the conventional cutting force. Also for the observer, the estimated value of the cutting force Fcut is close to the actually measured value, and the estimation accuracy does not change much. That is, both the cutting force observer 103 of the present embodiment and the conventional cutting force observer can accurately estimate the cutting force Fcut without being affected by the inertial force.
However, as shown in FIG. 11, when the feed speed with acceleration / deceleration and the command of the rotational speed of the tool spindle C is 10000 min−1, which is a high speed, the cutting force observer 103 of the present embodiment is the conventional cutting. It can be seen that the estimated value of the cutting force Fcut is close to the actually measured value, that is, the estimated accuracy is higher than that of the force observer. In other words, it can be seen that the cutting force observer 103 of the present embodiment compensates the inertial force more accurately than the conventional cutting force observer, and as a result, the cutting force Fcut can be estimated with high accuracy.

[Second Embodiment]
Hereinafter, a second embodiment of the present invention will be described with reference to the drawings. In addition, about the structure similar to 1st Embodiment, the same code | symbol is attached | subjected and description is abbreviate | omitted or simplified.
The present embodiment is configured to further improve the delay compensation performance and the high frequency noise suppression performance as compared with the first embodiment.

FIG. 12 is a functional block diagram showing a detailed functional configuration of the cutting force observer 103a.
In the present embodiment, functional blocks 123, 124, and 125 for dead time elements are further provided as compared to the first embodiment.

These dead time elements have a large dead time generated in the process of acquiring information in the control system, etc., so that the phase difference between the signals (Ia, θm, xt) used for estimation is large, and This is used when the first-order lag filter cannot be corrected sufficiently.
The dead times T1, T2, and T3 are identified and set based on the measurement results.

  In the present embodiment, a functional block 126 including a sixth-order Butterworth filter is provided instead of the functional block 122 as the first-order lag filter in the first embodiment. Thereby, the noise suppression performance in the high band is further improved.

FIG. 13 is a Bode diagram showing a theoretical calculation result of a transfer function between signals (Ia, θm, xt) used for estimation.
When the transfer function between the state information (θm) and the input information (Ia) and the transfer function between the output information (xt) and the input information (Ia) are compared, the phase difference approaches 0 at 100 to 200 Hz.

FIG. 14 is a diagram illustrating an example of a measurement value of a signal used for estimation.
This example shows experimental results of motor torque when a cutting force of 100 Hz is applied and acceleration of the stage 26 in the x direction. In this case, as shown in FIG. 13, the ideal phase difference is approximately 0, but a large phase difference occurs when the delay compensation by the dead time element is not performed (a).

Therefore, the cutting force observer 103a makes the phase difference close to 0 by delaying the signal (motor torque Kt × Iaref) whose phase is relatively advanced and performing delay compensation (b).
The cutting force observer 103a similarly performs delay compensation for the motor rotation angle θm.

FIG. 15 is a diagram illustrating a comparison result of estimation accuracy based on the presence or absence of delay compensation using a dead time element.
An estimated value by the cutting force observer 103a is drawn with respect to a machining test result (actual measurement value) at a spindle rotation speed of 4000 min-1 (frequency 133 Hz).

  When there was no delay compensation, a phase shift occurred and the estimated value was amplified due to this phase shift (a). On the other hand, when there was delay compensation, cutting force estimation with high accuracy was realized with respect to the actually measured value (b).

FIG. 16 is a diagram showing a comparison result of estimation accuracy between the 1 inertia system and the 2 inertia system when delay compensation using a dead time element is performed.
An estimated value by the cutting force observer 103a is drawn with respect to a machining test result (actual measurement value) at a spindle rotation speed of 6000 min-1 (frequency: 200 Hz).

  In the conventional method (a) of one inertia system, the estimation accuracy at a high rotational speed (6000 min-1) was not sufficient, but in the proposed method (b) of the two inertia system, high-precision cutting even at a high rotational speed. Force estimation was realized.

[Third Embodiment]
Hereinafter, a third embodiment of the present invention will be described with reference to the drawings. In addition, about the structure similar to 1st Embodiment, the same code | symbol is attached | subjected and description is abbreviate | omitted or simplified.

In the first and second embodiments, the rotation angle θm of the motor 21 is employed as the state information used for estimating the cutting force, but the number of state information is not particularly limited to one. For example, a rotary encoder is additionally provided on the opposite side of the ball screw 24 from the motor 21, and the rotation angle of the screw shaft of the ball screw 24 detected by the rotary encoder is input as state information together with the rotation angle θm of the motor 21. May be. In this case, the accuracy of estimating the cutting force can be further increased by expressing the ball screw drive stage 13 as a three-inertia model. In other words, the control target is not limited to the two-inertia model, and may be expressed as a multi-inertia model.
Here, a case where a three-inertia system model is applied will be described as an example.

  FIG. 17 is a block diagram showing the functional configuration of the controller 11b together with the configuration of the ball screw drive stage 13b.

  The ball screw drive stage 13b has a configuration in which the ball screw 24 is rotationally driven from both ends by the motor 21 and the motor 28, and a configuration in which a motor 28 and a rotary encoder 29 are further added to the first embodiment. It is.

  The position controller 101b acquires the rotation angle θm1 of the motor 21 from the rotary encoder 22 and the rotation angle θm2 of the motor 28 from the rotary encoder 22 as state information, and linearly uses the position xt of the stage 26 in the x direction as output information. Obtained from the encoder 27. The position controller 101b outputs a command value of the current Ia1 of the motor 21 and a command value of the current Ia2 of the motor 28 to control the position xt of the stage 26 in the x direction based on the state information and output information. .

  The cutting force observer 103b includes internal information of the ball screw drive stage 13b, that is, current reference values Ia1ref and Ia2ref (input information), the position xt (output information) of the stage 26 in the x direction, the rotation angle θm1 of the motor 21 and the motor. The cutting force Fcut is estimated using the rotation angle θm2 (state information) of 28. Thus, the cutting force observer 103b can remarkably improve the estimation accuracy of the cutting force by using the internal information.

Further, a cutting force estimation method employed in such a cutting force observer 103b, that is, a cutting force estimation method to which the present invention is applied will be described below with reference to FIG.
18 is a diagram for explaining the outline of the cutting force estimation method to which the present invention is applied, and is a diagram showing the force acting on the ball screw driving stage 13b of FIG.

In FIG. 18, the ball screw drive stage 13b is assumed to be driven by a stage 26 on which a workpiece W is loaded by motors 21 and 28 at both ends of the screw shaft. Examples of the elastically deforming element include a nut portion and a screw shaft. The deformation at the nut is modeled by a spring constant (axial rigidity) Kr, and the torsional deformation of the screw shaft is modeled by a torsional rigidity Kg.
This model assumes that the motor 28 and the screw shaft out of the four masses of the motor 21, the motor 28, the screw shaft, and the stage 26, and that the torsional deformation between them is very small (rigid). This is a three-inertia model represented by one.

Here, the moment of inertia of the motor A (motor 21) is Jm1, and the moment of inertia of the motor B is Jb + Jm2 obtained by adding the inertia moments of the screw shaft and the motor 28.
In the motor A, a friction torque Tfric1 in the motor is generated with respect to the rotational movement (rotation angle θm1) by the motor torque Kt1 × Ia1. Further, in the motor B, the friction torque Tfric2 inside the motor and the friction torque Tb inside the nut are generated with respect to the rotational movement (rotation angle θm2) by the motor torque Kt2 × Ia2.

  Under this situation, the rotational motion (θm2) of the motor B corresponding to the actual rotational amount of the screw shaft is converted into a linear motion (Rθm2) in the x direction in the ball screw 24, and the load of the mass Mt (the workpiece W is loaded). The stage 26) is moved by the movement amount xt. At that time, when the cutting tool D cuts into the workpiece W, a cutting force Fcut and a frictional force Ffirc are generated.

  17 and 18, the stage 26 on which the workpiece W is loaded is driven by the motor 21 and the motor 28 at both ends of the screw shaft. However, the tool spindle C is driven. Can be similarly modeled with the mass of the driven body as Mt.

Equations of motion for the three-inertia system model of FIG. 18 are as shown in the following equations (5) to (7).

Furthermore, by providing the equations (5) to (7) simultaneously, the reaction force term can be eliminated, and the cutting force Fcut is expressed by the following equation (8).

式（９）においては、推定値を示すパラメータには、推定であることを示す「ハット」が付されている。ｇｃｕｔは、切削力オブザーバ１０３ｂの遮断周波数を示しており、各パラメータの右下添え字ｎは、ノミナル値を示す。 Further, by using the friction torques Tb, Tfric1 and Tfric2 estimated in advance, and the frictional force Ffric, and using a low-pass filter for suppressing high-frequency noise, the estimated value of the cutting force Fcut is expressed by the following equation (9). As shown. That is, the functional block for estimating the cutting force Fcut according to the equation (9) is the cutting force observer 103b in FIG.

In equation (9), the parameter indicating the estimated value is given a “hat” indicating that the parameter is estimated. gcut indicates the cutoff frequency of the cutting force observer 103b, and the lower right subscript n of each parameter indicates a nominal value.

  FIG. 19 is a functional block diagram showing a detailed functional configuration of such a cutting force observer 103b.

  The current reference values Ia1ref and Ia2ref (input information) pass through the function block 112a and the function block 112b, respectively, and are estimated values of the motor torque Tm1 (= Kt1n × Ia1) and the motor torque Tm2 (= Kt2n × Ia2). It is supplied to the function block 115b.

The rotation angle θm1 (state information) of the motor A is second-order differentiated by passing through the function block 114a and multiplied by the moment of inertia Jm1.
Similarly, the rotation angle θm12 (state information) of the motor B passes through the function block 114b and is second-order differentiated and multiplied by the moment of inertia (Jb + Jm2).

  In the function block 115b, the outputs of the function block 114a and the function block 114b are subtracted from the sum of the outputs of the function block 112a and the function block 112a, and further multiplied by (1 / Rn) in the function block 116, thereby obtaining an expression ( The first term in the brackets of 9) is calculated.

  The position xt (output information) in the x direction of the stage 26 passes through the functional block 118b and is second-order differentiated and multiplied by the mass Mt. That is, the second term in the square brackets of equation (9) is calculated.

In function block 119, the second term in square brackets of equation (9), which is the output of function block 118b, is subtracted from the first term in square brackets of equation (9), which is the output of function block 116, and The function block 120 subtracts the value 121b (preliminarily estimated value 121b) of the third and fourth terms in the brackets of the equation (9) to calculate the brackets of the equation (9). The
The output of the functional block 120 (the calculated value of the square bracket in equation (9)) passes through the functional block 122, thereby suppressing high-frequency noise and being output as an estimated value of the cutting force Fcut. That is, the functional block 122 functions as a low-pass filter for suppressing high frequency noise.

FIG. 20 is a diagram showing comparison results of cutting force estimation results when the cutting force observer is designed as a one-inertia system, a two-inertia system, and a three-inertia system.
The 1-inertia model and the 2-inertia-system model are greatly affected in the vicinity of two resonance frequencies, and the band that can be estimated with sufficient accuracy is limited.

  On the other hand, the three-inertia system model can perform highly accurate estimation in a wider band without being affected by the resonance frequency. Thus, in the force estimation in the multi-inertia system, the estimation band is greatly improved by using the estimation method according to the degree of freedom of motion.

  In the present embodiment, the configuration in which the screw shaft is driven by the two motors 21 and 28 is modeled. However, for example, in the support portion of the bearing 25 on the side opposite to the motor 21 of the ball screw 24 in FIG. A configuration in which a rotary encoder is additionally provided and the rotation angle θm2 of the ball shaft of the ball screw 24 detected by the rotary encoder is input as state information together with the rotation angle θm1 of the motor 21 may be adopted. This configuration corresponds to the case where the current Ia2 = 0, which is one of the input information in the ball screw driving stage 13b of the present embodiment.

  As mentioned above, although embodiment of this invention was described, this invention is not limited to the above-mentioned embodiment. That is, the present invention includes modifications and improvements as long as the object of the present invention can be achieved.

For example, in the present embodiment, the series of processes by the controller 11 described above is mainly performed by the CPU 31 (FIG. 2). However, the present invention is not particularly limited thereto, and can be executed by hardware. It can also be executed by software.
In other words, it is sufficient that the machine tool system 1 has a function capable of executing a series of processes by the above-described units and means as a whole, and how each functional block is configured to realize this function. Is not particularly limited. That is, each functional block is not limited to the form shown in FIGS. 3 and 5, and the functional blocks shown in FIG. 3 or 5 can be arbitrarily divided or combined, or arbitrary functions can be deleted or added. Each functional block may be constituted by hardware alone, software alone, or a combination thereof.

When a series of processing is executed by software, a program constituting the software is installed on a computer such as the controller 11 from a network or a recording medium.
The computer may be a computer incorporated in dedicated hardware. The computer may be a computer capable of executing various functions by installing various programs, for example, a general-purpose personal computer.

  The recording medium including such a program is not only configured by the removable medium 51 (FIG. 2) distributed separately from the apparatus main body in order to provide the program to the user, but also in a state of being incorporated in the apparatus main body in advance. It is composed of a recording medium provided to the user. The removable medium 51 is composed of, for example, a magnetic disk (including a floppy disk), an optical disk, a magneto-optical disk, or the like. The optical disk is composed of, for example, a CD-ROM (Compact Disk-Read Only Memory), a DVD (Digital Versatile Disk), or the like. The magneto-optical disk is configured by an MD (Mini-Disk) or the like. Moreover, the recording medium provided to the user in a state of being incorporated in advance in the apparatus main body includes, for example, the ROM 32 shown in FIG.

  For example, in the above-described embodiment, the stage 26 on which the workpiece W can be mounted is employed. However, the present invention is not particularly limited thereto, and a stage on which the cutting tool D can be loaded may be employed. That is, the stage can take any configuration as long as the relative position between the workpiece W and the cutting tool D can be controlled.

  Further, for example, the ball screw 24 is employed in the above-described embodiment, but the present invention is not particularly limited thereto, and the rotational motion in the motor 21 is converted into the linear motion in the x direction and the load such as the stage 26 is moved in the x direction. Any linear motion mechanism that can be implemented can be employed.

  Further, for example, as the state information used for estimating the cutting force, the rotation angle θm of the motor 21 is employed in the present embodiment. However, the present invention is not particularly limited thereto, and information indicating an arbitrary state inside the ball screw driving stage 13. May be adopted.

  For example, in this embodiment, since the workpiece | work W was cut with the cutting tool D, the cutting force was estimated. However, the processing method of the workpiece by the machine tool is not particularly limited to cutting, and may be any method using the processing force of the processing tool, for example, grinding / polishing. That is, the estimation target is not particularly limited to the cutting force, and any processing force according to the processing method applied to the machine tool can be employed.

In summary, the machine tool control apparatus to which the present invention is applied only needs to have the following configuration, and various embodiments can be employed.
That is, the machine tool control device (for example, the controller 11 in FIG. 3) to which the present invention is applied is a machine tool processing tool (for example, the cutting tool D in FIG. 3) or a workpiece (for example, the workpiece W in FIG. 3). The position of the load is controlled with respect to a drive mechanism (for example, the ball screw drive stage 13 of FIG. 3 or the like) that drives the stage (for example, the stage 26 of FIG. Here, the drive mechanism converts a rotational motion in the motor (for example, the motor 21 in FIG. 3 and the like) that generates a torque corresponding to the current into a linear motion in a predetermined direction (for example, the x direction) and performs the predetermined motion. A linear motion mechanism (for example, a ball screw 24 in FIG. 3) that moves the load in a direction.
Such a machine tool control apparatus to which the present invention is applied includes the following means: a position control means (for example, the position controller 101 in FIG. 3) and a machining force estimation means (for example, the cutting in FIG. 3). Force observer 103).
The position control means obtains the position of the load in the predetermined direction (for example, the position xt of the stage 26 in FIG. 3 in the x direction) as output information of the drive mechanism, and indicates the internal state of the drive mechanism As the information, the rotation angle of the motor (for example, the rotation angle θm of the motor 21 in FIG. 3 or the like) is acquired, and based on the output information and the state information, the current command value (for example, the input information of the drive mechanism) The position of the load in the predetermined direction is controlled by changing the current reference value Iaref) in FIG.
The processing force estimation means uses the output information, the state information, and the input information as parameters, and based on a two-inertia system model (for example, see FIG. 4) of the drive mechanism, the processing force applied to the workpiece by the processing tool Is estimated.

  Thereby, the machine tool control apparatus to which the present invention is applied can realize a suitable technique for estimating the machining force without using an additional sensor and applying it to a drive mechanism such as the ball screw drive stage 13. The effect that can be produced.

Hereinafter, this effect will be further described.
Here, if the machining force is simply estimated, it can be realized by using at least one of state information and input information of a drive mechanism such as the ball screw drive stage 13.
For example, a technique for estimating the machining load using the current value of the servo motor as input information (hereinafter referred to as “first comparison technique”) can also be realized. However, this first comparative technique uses a quasi-static method, has low accuracy, and cannot be estimated in a high frequency band.
In addition, for example, the technology that estimates the machining force by the disturbance observer using the servo motor current command value as the input information and the servo motor rotation information as the status information (hereinafter referred to as “second comparison technology”) is also realized. it can. Although the second comparative technique is more accurate and has a higher frequency band than the first comparative technique, the drive system is modeled as a single inertia system, and therefore there is a location that deviates from the actual processing load. In particular, the shift near the resonance point of each mode becomes significant. That is, it is difficult to say that the second comparative technique is also suitable for application to a driving mechanism such as the ball screw driving stage 13.
In addition, for example, a technique for monitoring a machining state using only encoder information as the state information (hereinafter referred to as “third comparison technique”) can be realized. However, although this third comparative technique can determine the machining state by looking at fluctuations and dispersion of position information during machining and can read vibrations during machining, it cannot consider the DC component of the machining load. That is, it is difficult to say that the second comparative technique is also suitable for application to a driving mechanism such as the ball screw driving stage 13.
On the other hand, in the technique for estimating the machining force to which the present invention is applied, full-closed control is employed as position control for the drive mechanism such as the ball screw drive stage 13. For this reason, in addition to the state information and input information, stage position information (output information) can be used as internal information of the drive mechanism. Thereby, the estimation precision of a processing force improves.
In addition to the input information and the output information, the drive mechanism such as the ball screw drive stage 13 is modeled by a two-inertia system using state information indicating the rotation angle θm of the motor 21 that is an internal state. Thereby, the estimation accuracy of the machining force in the vicinity of the resonance point of the two-inertia system is remarkably improved (see the simulation result in FIG. 6).
In this way, a technique for estimating a machining force that is suitable for application to a driving mechanism such as the ball screw driving stage 13 without using an additional sensor is realized.

  Here, the machine tool control apparatus to which the present invention is applied can further estimate the machining force by using a low-pass filter for suppressing high-frequency noise (see, for example, the function block 122 in FIG. 5). Thereby, high frequency noise is suppressed and the estimation accuracy of the machining force is further improved.

  Further, the machine tool control apparatus to which the present invention is applied is a delay compensation filter (for example, the function block 111 in FIG. 5) that compensates for the delay due to pseudo-differentiation included in the two-inertia system model and the electrical delay of the motor torque. Can also be used to estimate the machining force. Thereby, the estimation accuracy of the high frequency component of the machining force is further improved.

  Furthermore, the machine tool control apparatus to which the present invention is applied is a compensation unit that estimates a disturbance based on output information, state information, and input information, and compensates a current command value based on the estimated disturbance (for example, The disturbance observer 102) of FIG. 3 may be provided. Due to the canceling effect of the compensation means, the influence of parameter fluctuation can be reduced, and as a result, the accuracy of estimating the machining force is further improved.

  DESCRIPTION OF SYMBOLS 1 ... Machine tool system, 11 ... Controller, 12 ... Servo amplifier, 13 ... Ball screw drive stage, 21 ... Motor, 22 ... Rotary encoder, 23 ... Coupling, 24 ... Ball screw, 25 ... Bearing, 26 ... Stage, 27 ... Linear encoder, 28 ... Motor, 29 ... Linear encoder, 31 ... CPU, 32 ... ROM 33 ... RAM, 34 ... bus, 35 ... input / output interface, 36 ... input unit, 37 ... output unit, 38 ... storage unit, 39 ... communication unit, 40・ ・ ・ Drive, 51 ・ ・ ・ Removable media, 101 ・ ・ ・ Position controller, 102 ・ ・ ・ Disturbance observer, 103 ・ ・ ・ Cutting force observer, C ・ ・ ・ Spindle, D ・ ・ ・ Cutting tool, ... work

Claims (8)

A drive mechanism for driving a machining tool of a machine tool or a stage loaded with the work as a load, and generating a torque corresponding to an electric current, and converting a rotational motion in the motor into a linear motion in a predetermined direction. In a machine tool control apparatus that performs control on a drive mechanism including a linear motion mechanism that moves the load in the predetermined direction,
Based on the output information and the state information, the position of the load in the predetermined direction is acquired as output information of the drive mechanism, and the rotation angle of the motor is acquired as state information indicating the internal state of the drive mechanism. Position control means for controlling the position of the load in the predetermined direction by changing a command value of the current as input information of the drive mechanism;
A machining force estimation means for estimating a machining force on the workpiece by the machining tool based on a multi-inertia model of the drive mechanism using the output information, the state information, and the input information as parameters.
Equipped with a,
The machining force estimation means further estimates the machining force using a delay compensation filter that compensates for a delay due to pseudo differentiation included in the multi-inertia model and an electrical delay of the torque of the motor. Machine tool control device. The machining force estimation means further estimates the machining force using a low-pass filter for suppressing high frequency noise,
The machine tool control device according to claim 1. The low pass filter is a Butterworth filter;
The machine tool control device according to claim 2. The machining force estimation means further estimates the machining force using a dead time element.
The machine tool control device according to claim 1 . Compensation means for estimating a disturbance based on the output information, the state information, and the input information, and compensating a command value of the current based on the estimated disturbance,
The machine tool control device according to any one of claims 1 to 4 , further comprising: The position control means further acquires a rotation angle converted into linear motion in the linear motion mechanism as the state information,
The working force estimating means, as the status information, the machine tool control apparatus according to any one of claims 1-5, further using the rotation angle is converted into linear motion in the linear motion mechanism. A drive mechanism for driving a machining tool of a machine tool or a stage loaded with the work as a load, and generating a torque corresponding to an electric current, and converting a rotational motion in the motor into a linear motion in a predetermined direction. A machine tool control method executed by a machine tool control device for a drive mechanism including a linear motion mechanism that moves the load in the predetermined direction,
Based on the output information and the state information, the position of the load in the predetermined direction is acquired as output information of the drive mechanism, and the rotation angle of the motor is acquired as state information indicating the internal state of the drive mechanism. A position control step for controlling a position of the load in the predetermined direction by changing a command value of the current as input information of the drive mechanism;
A machining force estimation step for estimating a machining force on the workpiece by the machining tool based on a multi-inertia model of the drive mechanism using the output information, the state information, and the input information as parameters.
Only including,
In the machining force estimation step, the machining force is further estimated using a delay compensation filter that compensates for a delay due to pseudo differentiation included in the multi-inertia model and an electrical delay of the torque of the motor. Machine tool control method. A drive mechanism for driving a machining tool of a machine tool or a stage loaded with the work as a load, and generating a torque corresponding to an electric current, and converting a rotational motion in the motor into a linear motion in a predetermined direction. A computer that performs control on a drive mechanism including a linear motion mechanism that moves the load in the predetermined direction;
Based on the output information and the state information, the position of the load in the predetermined direction is acquired as output information of the drive mechanism, and the rotation angle of the motor is acquired as state information indicating the internal state of the drive mechanism. A position control step for controlling a position of the load in the predetermined direction by changing a command value of the current as input information of the drive mechanism;
A machining force estimation step for estimating a machining force on the workpiece by the machining tool based on a multi-inertia model of the drive mechanism using the output information, the state information, and the input information as parameters.
Only including,
In the machining force estimation step, the machining force is further estimated using a delay compensation filter that compensates for a delay due to pseudo differentiation included in the multi-inertia model and an electrical delay of the torque of the motor. A program that executes control processing.

Images