Identification method and numerical control device
The method and device address the need for sensor-based thermal displacement correction in machine tools by analyzing motor torque and rotation angle to determine feed axis expansion and contraction, providing accurate and cost-effective thermal displacement correction and operational monitoring.
Patent Information
- Application Number
- JP2022190637
- Authority / Receiving Office
- JP · JP
- Patent Type
- Patents
- Current Assignee / Owner
- Filing Date
- 2022-11-29
- Publication Date
- 2026-11-11
- Estimated Expiration
- 2042-11-29
AI Technical Summary
Existing methods for correcting thermal displacement in machine tools require additional sensors, which increase costs and may fail, preventing accurate estimation of thermal displacement if the sensor malfunctions.
A method and device that determine the amount of feed axis extension or contraction by analyzing motor torque and rotation angle during tool mounting and detachment operations, using feature quantities and differential values to identify specific angles without a separate sensor, and correcting for thermal displacement based on these measurements.
Accurately determines feed axis expansion and contraction without sensors, reducing costs and ensuring reliable thermal displacement correction, while also detecting operational abnormalities.
Smart Images

Figure 0007947943000002 
Figure 0007947943000003 
Figure 0007947943000004
Abstract
Description
[Technical Field]
[0001] The present invention relates to a method for identification and a numerical control device. [Background technology]
[0002] Patent Document 1 discloses a correction method for correcting thermal displacement of a feed axis in a machine tool. A position detection sensor is provided on the column of the machine tool. The position detection sensor detects the position of the feed axis. Based on the position of the feed axis detected by the position detection sensor, the amount of thermal displacement in each section of the feed axis is estimated. Then, the amount that cancels out the estimated amount of thermal displacement is used as the thermal displacement correction amount, and the thermal displacement is corrected. [Prior art documents] [Patent Documents]
[0003] [Patent Document 1] Japanese Patent Publication No. 2012-101330 [Overview of the project] [Problems that the invention aims to solve]
[0004] The above correction method requires additional costs for the position detection sensor. Furthermore, if the position detection sensor fails, the position of the feed axis cannot be detected, potentially making it impossible to estimate the thermal displacement of the feed axis.
[0005] The object of the present invention is to provide a method for determining the amount of extension or contraction of a feed axis and a numerical control device that can determine the amount of extension or contraction of a feed axis without providing a sensor. [Means for solving the problem]
[0006] The method for specifying according to claim 1 is a method for specifying the amount of extension or retraction of the feed axis in a predetermined direction in a machine tool, which includes a spindle for mounting a tool, a feed axis extending in a predetermined direction, and a motor for rotating the feed axis around an axis extending in the predetermined direction, wherein the motor rotates the feed axis, thereby moving the spindle and mounting the tool to be gripped by a tool changer onto the spindle, and the method is characterized by including: an acquisition step of acquiring the torque of the motor and the rotation angle of the motor in a time series during at least one of the tool mounting operation or the tool detachment operation; a determination step of determining a specific angle from the rotation angle based on feature quantities of the time series data of the torque and rotation angle acquired in the acquisition step; and a specification step of specifying the amount of extension or retraction of the feed axis based on a first difference between the specific angle determined in the determination step and a reference specific angle that serves as a reference for the specific angle.
[0007] In the identification method, the amount of extension and retraction of the feed shaft is determined by the configuration for controlling the motor torque. As a result, the identification method can determine the amount of extension and retraction of the feed shaft without providing a separate sensor for determining the amount of extension and retraction.
[0008] In the identification method of claim 2, the feature quantity is the differential value f obtained by differentiating the torque obtained by the acquisition step, and the method further includes a differentiation step of calculating the differential value corresponding to the rotation angle from the torque obtained by the acquisition step, and the determination step may determine the identification angle based on the differential value calculated by the differentiation step and the rotation angle. At the identification angle, the variation in the differential value changes more significantly than the variation in torque. Therefore, the identification method can accurately determine the identification angle in the determination step.
[0009] In the identification method of claim 3, the determination step may determine the rotation angle corresponding to the differential value that represents either the maximum or minimum of the differential values calculated in the differentiation step as the identification angle. This allows the identification method to easily determine the identification angle in the determination step.
[0010] In the identification method of claim 4, the acquisition step may acquire the disturbance force acting on the motor as a reaction force to the motor's drive, which is included in the torque; the differentiation step may calculate the derivative value of the disturbance force obtained by differentiating the disturbance force acquired in the acquisition step; and the determination step may determine the rotation angle corresponding to the maximum or minimum of the derivative values of the disturbance force calculated in the differentiation step as the identification angle. The motor's torque includes not only disturbance forces but also inertial forces associated with the acceleration and deceleration of the motor. The identification method acquires the disturbance force included in the torque and determines the identification angle based on the derivative value of the disturbance force obtained by differentiating the disturbance force, thereby eliminating the influence of torque changes due to motor acceleration and deceleration and enabling accurate identification of the extension and contraction amount of the feed shaft.
[0011] In the identification method of claim 5, the differentiation step includes an interpolation step that generates an interpolated angle obtained by interpolating the rotation angle obtained by the acquisition step, and an interpolated torque that corresponds to the interpolation angle and is interpolated to the torque obtained by the acquisition step, and an interpolation differentiation step that differentiates the interpolated torque interpolated by the interpolation step to calculate an interpolated derivative value of the interpolated torque corresponding to the interpolation angle, and the determination step may determine the interpolation angle as the identification angle, which corresponds to the interpolated derivative value that shows either the maximum or minimum of the interpolated derivative values calculated by the interpolation differentiation step. In the identification method, the resolution of the identification angle depends on the acquisition period of the rotation angle and the torque. By interpolating the rotation angle of the motor and the torque corresponding to the rotation angle, the identification angle determined in the determination step can be more approximated to the actual identification angle without shortening the acquisition period. Therefore, the identification method can accurately identify the amount of extension and contraction of the feed axis even when the amount of extension and contraction is small.
[0012] The identification method of claim 6 includes a reference determination step in which the specific angle determined for the first time by the determination step is determined as the reference specific angle, and the identification step may specify the amount of expansion and contraction based on the first difference between the specific angle determined for the second time or later by the determination step and the reference specific angle determined by the reference determination step. The identification method specifies the amount of expansion and contraction using the specific angle initially determined by the determination step as the reference specific angle. As a result, the identification method can specify the amount of expansion and contraction of the feed axis from the initial state.
[0013] The identification method of claim 7 may include a determination step of determining an abnormality in the mounting operation or the detachment operation based on a second difference between the specific angle determined in the nth step (where n is an integer of two or more) by the determination step and the specific angle determined in the (n-1th step) by the determination step. An abnormality in the mounting operation or detachment operation may occur, for example, when chips get jammed between the spindle and the tool during the mounting operation, or when an abnormality occurs in the detachment of the tool from the spindle during the detachment operation, in which case the specific angle determined in the nth step changes excessively compared to the specific angle determined in the (n-1th step). Therefore, the identification method can determine an abnormality in the tool mounting operation or detachment operation based on the second difference.
[0014] The identification method of claim 8 includes a storage step for storing the first difference calculated based on the specific angle determined by the determination step, and the identification step may specify the amount of expansion and contraction based on the average of a plurality of the first differences stored by the storage step. By specifying the amount of expansion and contraction of the feed shaft based on the average of the first differences, the identification method can reduce errors in determining the specific angle due to variations in the mounting or detachment operation. Therefore, the identification method can reduce the error between the amount of expansion and contraction of the feed shaft specified in the identification step and the actual amount of expansion and contraction.
[0015] The identification method of claim 9 may involve the storage step storing the first difference for each tool mounted on the spindle, and the identification step identifying the amount of expansion and contraction based on the average of the multiple first differences stored for each tool by the storage step. This allows the identification step to suppress the effects of variations by identifying the amount of expansion and contraction of the feed axis based on the average of the first differences, even when there are variations in the first difference for each tool. Thus, the identification step can identify the amount of expansion and contraction of the feed axis with high accuracy.
[0016] The numerical control device according to claim 10 is a numerical control device that controls the operation of a machine tool, comprising a spindle for mounting a tool, a feed axis extending in a predetermined direction, and a motor for rotating the feed axis around the axis extending in the predetermined direction, wherein the motor rotates the feed axis to move the spindle and mount the tool gripped by a tool changer onto the spindle, and is characterized by comprising: an acquisition unit that acquires the torque of the motor and the rotation angle of the motor in a time series during at least one of the tool mounting operation or the tool detachment operation; a determination unit that determines a specific angle from the rotation angle based on feature quantities of the time series data of the torque and rotation angle acquired by the acquisition unit; and a determination step that determines the amount of extension and retraction of the feed axis in the predetermined direction based on a first difference between the specific angle determined by the determination unit and a reference specific angle that serves as a reference for the specific angle. The numerical control device has the same effect as the determination according to claim 1. [Brief explanation of the drawing]
[0017] [Figure 1] This is a perspective view of machine tool 1. [Figure 2] This is a longitudinal cross-sectional view of the area around the spindle head 7. [Figure 3] This is a longitudinal cross-section of the inside of the main shaft 9. [Figure 4] This is a block diagram showing the electrical configuration of the machine tool 1 and the numerical control device 30. [Figure 5] This graph shows the disturbance force F and its derivative f applied to the Z-axis motor 51, which vary according to the rotation angle θ of the Z-axis motor 51. [Figure 6] This diagram illustrates the generation of the interpolation angle θ and the interpolation disturbance force F. [Figure 7] This is a flowchart for the tool change procedure. [Figure 8] This is a flowchart showing the continuation of Figure 8. [Modes for carrying out the invention]
[0018] One embodiment of the present invention will be described with reference to the drawings. The following description will use the left / right, front / back, and up / down directions indicated by arrows in the drawings. The left / right direction, front / back direction, and up / down direction of the machine tool 1 are the X-axis direction, Y-axis direction, and Z-axis direction, respectively. The right direction, front direction, and up direction are positive directions, respectively, while the left direction, rear direction, and down direction are negative directions, respectively. The machine tool 1 shown in Figure 1 is a machine that performs cutting on a workpiece (not shown) using a tool 3. The numerical control device 30 controls the operation of the machine tool 1. In this embodiment, "ATC" is an abbreviation for "Automatic Tool Changer". Also, in this embodiment, "NC" is an abbreviation for "Numerical Control".
[0019] <Structure of machine tool 1> As shown in Figures 1 and 2, the machine tool 1 comprises a base 2, a column 5, a control box 6, a table device 10, a spindle head 7, a spindle 9, and a tool changer 20. The base 2 is a roughly rectangular metal base. The column 5 is fixed to the rear of the upper surface of the base 2. The column 5 is a vertical column extending in the vertical direction. The control box 6 is fixed to the rear of the column 5. The control box 6 houses a numerical control device 30.
[0020] The table apparatus 10 includes a Y-axis moving mechanism (not shown), a Y-axis table 12, a table 13, and an X-axis moving mechanism (not shown). The Y-axis moving mechanism is provided on the upper surface of the base 2 and in front of the column 5, and includes a Y-axis motor 54 (see FIG. 4). The Y-axis moving mechanism moves the Y-axis table 12 in the Y-axis direction in response to the drive of the Y-axis motor 54. The X-axis moving mechanism is provided on the upper portion of the Y-axis table 12, and includes an X-axis motor 53 (see FIG. 4). The X-axis moving mechanism moves the table 13 in the X-axis direction in response to the drive of the X-axis motor 53. Therefore, the table 13 can move above the base 2 in the X-axis direction and the Y-axis direction by the X-axis moving mechanism and the Y-axis moving mechanism.
[0021] <Structure of Z-axis moving mechanism 8> As shown in FIG. 2, a Z-axis moving mechanism 8 is provided at the front portion of the column 5. The Z-axis moving mechanism 8 includes a ball screw 41, bearing portions 42 and 43, a cam follower 49, and a Z-axis motor 51 (see FIG. 4). The ball screw 41 is provided at the front portion of the column 5 and extends in the Z-axis direction. The bearing portions 42 and 43 are inserted through the ball screw 41 and rotatably support the ball screw 41. The bearing portion 42 is provided above the bearing portion 43. The cam follower 49 is provided in front of the bearing portion 42. The cam follower 49 slides on the cam surface of a plate cam 47 of a spindle head 7, which will be described later.
[0022] The Z-axis motor 51 is fixed above the bearing portion 42. The ball screw 41 is coupled to the output shaft of the Z-axis motor 51 via a coupling (not shown). The ball screw 41 is rotated forward and reverse around the axis extending in the vertical direction by the drive of the Z-axis motor 51. A nut 44 is screwed onto the ball screw 41 between the bearing portions 42 and 43. The nut 44 is fixed to the rear end portion of the spindle head 7. When the Z-axis motor 51 rotates in the forward direction, the ball screw 41 rotates, and the nut 44 and the spindle head 7 rise integrally. When the Z-axis motor 51 rotates in the reverse direction, the ball screw 41 rotates reversely, and the nut 44 and the spindle head 7 descend integrally.
[0023] <Internal structure of spindle head 7> As shown in Figure 2, the spindle head 7 is located at the front of the column 5. The spindle head 7 is box-shaped. The spindle head 7 includes a spindle motor 52, a crank lever 45, a support shaft 46, and a coil spring 48. The spindle motor 52 is fixed to the front of the upper surface of the spindle head 7.
[0024] The support shaft 46 is fixed to the inside of the rear of the spindle head 7. The support shaft 46 is a rod-shaped object extending in the left-right direction. The crank lever 45 is provided on the top of the spindle head 7. The crank lever 45 is a plate that is roughly L-shaped when viewed from the left side. The support shaft 46 is inserted through the bent portion of the crank lever 45. The crank lever 45 is pivotable around the support shaft 46. The crank lever 45 has a plate cam 47. A cam surface is formed on the back of the plate cam 47. The cam surface of the plate cam 47 can move toward and away from the cam follower 49. The coil spring 48 is provided to the inside of the rear of the spindle head 7. The coil spring 48 extends in the front-rear direction. One end of the coil spring 48 is fixed to the back of the spindle head 7. The rear end of the coil spring 48 is fixed to the rear end of the crank lever 45 below the plate cam 47. The coil spring 48 constantly biases the crank lever 45 in a clockwise direction when viewed from the right side.
[0025] <Internal structure of the main spindle 9> As shown in Figures 2 and 3, the spindle 9 is located inside the front lower part of the spindle head 7 and is cylindrical in shape, extending vertically. The spindle 9 is supported by the spindle head 7. The spindle 9 is rotatably supported around an axis that extends vertically. The spindle 9 is connected to the output shaft of the spindle motor 52. The spindle 9 is rotated in forward and reverse directions around the axis that extends vertically by the drive of the spindle motor 52.
[0026] The spindle 9 has a shaft hole 91, a mounting hole 92, a space 93, a sliding hole 94, a clamp shaft 81, and a spring 82. The shaft hole 91 is formed from the upper end to the lower part of the spindle 9 and passes through the center of the spindle 9. The mounting hole 92 is formed at the lower end of the spindle 9. The tool 3 is mounted in the mounting hole 92. The space 93 is formed communicating with the upper part of the mounting hole 92. The sliding hole 94 is formed communicating between the shaft hole 91 and the space 93.
[0027] The clamp shaft 81 is provided inside the shaft hole 91 and is movable vertically relative to the shaft hole 91. The clamp shaft 81 has a support portion 83, a shaft portion 84, and a gripping portion 85. The support portion 83 is provided at the upper end of the clamp shaft 81 and is columnar in shape. The support portion 83 supports the pin 95. The pin 95 is provided protruding from the clamp shaft 81. The pin 95 is movable toward and away from the front end of the crank lever 45 located above the pin 95.
[0028] The shaft portion 84 is columnar and extends downward from the support portion 83. The gripping portion 85 is provided at the lower end of the shaft portion 84 and has a plurality of steel balls (not shown). The spring 82 is inserted inside the shaft hole 91. The upper end of the spring 82 engages with the support portion 83. The spring 82 constantly biases the clamp shaft 81 upward.
[0029] The spindle 9 is capable of mounting a tool 3. The tool 3 has a holder 14 and a cutting tool 4. One end of the holder 14 holds the cutting tool 4, and the other end of the holder 14 has a mounting portion 15 and a pull stud 17. The mounting portion 15 is conical in shape, tapering towards the other end of the holder 14. The pull stud 17 protrudes from the top of the mounting portion 15 toward the other end of the holder 14. The mounting portion 15 is mounted in the mounting hole 92.
[0030] When the clamp shaft 81 moves downward against the elastic force of the spring 82, the gripping portion 85 moves out of the sliding hole 94 into the space 93. The gripping portion 85 releases its grip on the pull stud 17 of the holder 14. When the clamp shaft 81 moves upward due to the elastic force of the spring 82 from its downward position, the gripping portion 85 moves out of the space 93 into the sliding hole 94. The gripping portion 85 grips the pull stud 17 with multiple steel balls.
[0031] <Structure of tool changing device 20> As shown in Figure 2, the tool changer 20 is located in front of the spindle head 7. The tool changer 20 is of the turret type. The tool changer 20 includes a tool magazine 21, a plurality of grip arms 23, and a magazine motor 55. The tool magazine 21 is roughly disc-shaped. The tool magazine 21 is rotatably supported around a pivot shaft 25 that extends forward and downward. Each grip arm 23 is provided at predetermined intervals around the outer circumference of the tool magazine 21. The plurality of grip arms 23 are provided so as to be able to swing in the front-rear direction of the tool magazine 21. The tips of the grip arms 23 detachably grip the holder 14 of the tool 3. The output shaft of the magazine motor 55 is connected to the pivot shaft 25. The tool magazine 21 rotates in forward and reverse directions around the pivot shaft 25 by the drive of the magazine motor 55.
[0032] <Attaching, detaching, and replacing tool 3> As shown in Figure 3, with the mounting portion 15 of the holder 14 mounted in the mounting hole 92 of the spindle 9, the Z-axis motor 51 rotates in the forward direction based on the control command of the numerical control device 30. The ball screw 41 rotates around its axis, and the spindle head 7 and spindle 9 rise from the machining origin of the table 13. The machining origin is the machine origin and is the uppermost position where the workpiece can be machined.
[0033] As the spindle head 7 and spindle 9 rise, the cam follower 49 contacts the plate cam 47 of the crank lever 45 and slides along the cam surface of the plate cam 47. The crank lever 45 rotates counterclockwise around the pivot shaft 46 in a right-side view against the elastic force of the coil spring 48. The front end of the crank lever 45 engages with the pin 95 from above and presses the clamp shaft 81 downward. The clamp shaft 81 biases the gripping portion 85 downward against the elastic force of the spring 82. The gripping portion 85 releases its grip on the pull stud 17.
[0034] The spindle 9 rises further to the ATC origin. The ATC origin is the position of the spindle 9, which is above the machining origin. When the spindle 9 is in the ATC origin position, the tool magazine 21 is rotatable.
[0035] When the spindle 9 rises, the tool 3 detaches from the mounting hole 92 of the spindle 9. The tool 3 detached from the spindle 9 is referred to as the first tool. Of the multiple grip arms 23 of the tool changer 20, one grip arm 23 at the tool change position (hereinafter referred to as the first grip arm) grips the first tool detached from the spindle 9. The tool change position is the lowest position of the tool magazine 21 and is close to and opposite the spindle 9.
[0036] When the spindle head 7 reaches the ATC origin, the tool changer 20 rotates the tool magazine 21 by driving the magazine motor 55 based on the control command of the numerical control device 30. The tool changer 20 positions the tool 3 (hereinafter referred to as the second tool) that holds the cutting tool 4 specified by the control command of the NC program to the tool change position. At this time, the tool magazine 21 rotates from the state where the first tool is in the tool change position to the state where the second tool is in the tool change position. The tool magazine 21 rotates with the first tool gripped by the first grip arm and the second tool gripped by the other grip arm 23 (hereinafter referred to as the second grip arm). The second tool, positioned in the tool change position, is located below the spindle head 7, which has moved to the ATC origin.
[0037] Next, based on the control command from the numerical control device 30, the Z-axis motor 51 rotates in the reverse direction. The ball screw 41 rotates in the reverse direction around its axis, and the spindle 9 descends from the ATC origin. The mounting portion 15 of the second tool enters the mounting hole 92 of the spindle 9.
[0038] With the mounting part 15 inserted into the mounting hole 92, the spindle 9 and spindle head 7 descend further. The cam follower 49 slides along the cam surface of the plate cam 47 and then separates from the plate cam 47. The crank lever 45 rotates clockwise around the pivot shaft 46 in a right-side view due to the elastic force of the coil spring 48. The front end of the crank lever 45 separates from the pin 95, releasing the downward pressure on the clamp shaft 81. The clamp shaft 81 releases the downward bias of the gripping part 85. The gripping part 85 moves from the space 93 to the sliding hole 94. The gripping part 85 grips the pull stud 17 of the second tool with multiple steel balls and pulls it up. The second grip arm of the tool changer 20 releases its grip on the holder 14 of the second tool. The mounting of the mounting part 15 into the mounting hole 92 of the spindle 9 is completed, and the mounting of the second tool to the spindle 9 is completed. The operation of the clamp shaft 81 and crank lever 45 when the tool 3 is mounted on the spindle 9 is called the mounting operation. The operation of the clamp shaft 81 and crank lever 45 when the tool 3 is removed from the spindle 9 is called the removal operation. The spindle head 7, crank lever 45, etc., which are driven by the rotation of the Z-axis motor 51 during the mounting operation are called the mounting mechanism.
[0039] <Electrical configuration of numerical control device 30 and machine tool 1> As shown in Figure 4, the numerical control device 30 includes a CPU 31, ROM 32, RAM 33, storage device 34, input / output interface 35, and drive circuits 61-65. The CPU 31 provides overall control of the numerical control device 30. The ROM 32 stores various programs. The RAM 33 stores various data during processing.
[0040] The storage device 34 is a non-volatile memory that stores NC programs and the like. The NC program is composed of multiple blocks. Each block contains at least one command, such as a tool change command.
[0041] The input / output interface 35 is electrically connected to the drive circuits 61-65, encoders 71-75, input unit 37, and display unit 38, and performs input and output of various signals. The input unit 37 and display unit 38 are provided on the control panel 36 of the machine tool 1. The control panel 36 is provided on the outer wall of the cover (not shown) that covers the machine tool 1. The input unit 37 receives input such as various information and operation instructions, and inputs them to the CPU 31 via the input / output interface 35. The display unit 38 displays various screens, error information, etc., based on commands input from the CPU 31 via the input / output interface 35.
[0042] The drive circuit 61 is electrically connected to the Z-axis motor 51. The drive circuit 62 is electrically connected to the spindle motor 52. The drive circuit 63 is electrically connected to the X-axis motor 53. The drive circuit 64 is electrically connected to the Y-axis motor 54. The drive circuit 65 is electrically connected to the magazine motor 55. Based on commands input from the CPU 31 via the input / output interface 35, the drive circuits 61, 62, 63, 64, and 65 output drive current to the Z-axis motor 51, spindle motor 52, X-axis motor 53, Y-axis motor 54, and magazine motor 55. The Z-axis motor 51, spindle motor 52, X-axis motor 53, Y-axis motor 54, and magazine motor 55 are servo motors that rotate according to the input drive current. The drive circuits 61, 62, 63, 64, and 65 output the drive current as a return value to the input / output interface 35.
[0043] The Z-axis motor 51 is equipped with an encoder 71. The spindle motor 52 is equipped with an encoder 72. The X-axis motor 53 is equipped with an encoder 73. The Y-axis motor 54 is equipped with an encoder 74. The magazine motor 55 is equipped with an encoder 75. Encoders 71, 72, 73, 74, and 75 are absolute value encoders and detect the rotation angles of the Z-axis motor 51, spindle motor 52, X-axis motor 53, Y-axis motor 54, and magazine motor 55, respectively. Encoders 71, 72, 73, 74, and 75 input the detected rotation angles to the input / output interface 35. The CPU 31 obtains the rotation angle of the Z-axis motor 51 detected by the encoder 71, estimates the rotation angle of the ball screw 41 connected to the Z-axis motor 51, and calculates the position of the spindle 9 in the Z-axis direction as it moves due to the rotation of the ball screw 41.
[0044] <Variations in disturbance forces and their derivatives during the wearing process> Figure 5(A) is a graph showing the relationship between the rotation angle of the Z-axis motor 51 (horizontal axis) and the disturbance force applied to the Z-axis motor 51 (vertical axis) during the mounting operation. Figure 5(A) has been processed with a low-pass filter to remove the natural vibrations of the machine tool 1 in order to eliminate the effects of vibrations of the machine tool 1. During the mounting operation, the rotation angle of the Z-axis motor 51 changes in the negative direction.
[0045] The disturbance force acting on the Z-axis motor 51 is a force acting on the Z-axis motor 51 as a reaction force to the drive of the Z-axis motor 51. The disturbance force is included in the torque of the Z-axis motor 51 and satisfies the following relationship, Equation 1.
number
[0046] The CPU 31 obtains the drive current of the Z-axis motor 51 from the drive circuit 61 and the rotation angle θ of the Z-axis motor 51 from the encoder 71, thereby obtaining the torque T of the Z-axis motor 51. m The CPU 31 then obtains the torque T of the Z-axis motor 51. m Based on the rotation angle θ, the disturbance force F is obtained.
[0047] The CPU 31 obtains the rotation angle θ of the Z-axis motor 51 from the encoder 71. Based on the obtained rotation angle θ and the lead of the ball screw 41, the CPU 31 calculates the position of the spindle 9 in the Z-axis direction.
[0048] Figure 5(B) is a graph showing the relationship between the rotation angle θ of the Z-axis motor 51 (horizontal axis) and the time derivative of the disturbance force F (hereinafter referred to as the derivative value f) (vertical axis) during the mounting operation. In Figure 5(B), the rotation angle θ of the Z-axis motor 51 at which the derivative value f is minimized during the mounting operation is called the peak angle φ. The timing at which the derivative value f is minimized during the mounting operation (i.e., the rotation angle θ becomes the peak angle φ) is the timing at which the plate cam 47 separates from the cam follower 49. It is assumed that the angular velocity of the Z-axis motor 51 is constant during the mounting operation. Thus, the fluctuating derivative value f during the mounting operation is a characteristic quantity that indicates the characteristics of the mounting operation.
[0049] <Interpolation of rotation angle θ and disturbance force F> When determining the peak angle φ, the CPU 31 of the numerical control device 30 interpolates the acquired rotation angle θ and disturbance force F in order to determine the peak angle φ with greater accuracy.
[0050] Refer to Figure 6 to explain the interpolation of rotation angle θ and disturbance force F. Figure 6(A) is a graph showing the relationship between the acquired rotation angle θ (horizontal axis) and disturbance force F (vertical axis). An example is given when CPU 31 continuously acquires rotation angles θ(1), θ(5), θ(9) and disturbance forces F(1), F(5), F(9). The disturbance forces F(1), F(5), and F(9) correspond to rotation angles θ(1), θ(5), and θ(9), respectively.
[0051] As shown in Figure 6(B), the CPU 31 connects the combinations of rotation angles θ and disturbance forces F acquired consecutively (θ(1), F(1)) and (θ(5), F(5)) with a straight line. The CPU 31 determines a plurality of points on the connected straight line that are arranged at equal time intervals in the horizontal direction. The CPU 31 determines the horizontal axis coordinates of each of these plurality of points as the rotation angles θ(2), θ(3), and θ(4). The CPU 31 determines the vertical axis coordinates of each of these plurality of points as the disturbance forces F(2), F(3), and F(4).
[0052] The CPU31 similarly determines the rotation angles θ(6), θ(7), θ(8) and the disturbance forces F(6), F(7), F(8) based on the combinations of rotation angles θ and disturbance forces F obtained consecutively (θ(5), F(5)) and (θ(9), F(9)). Hereafter, the obtained rotation angles θ(1), θ(5), θ(9) and the determined rotation angles θ(2)~θ(4), θ(6)~θ(8) will be collectively referred to as interpolated angles. The obtained disturbance forces F(1), F(5), F(9) and the determined disturbance forces F(2)~F(4), F(6)~F(8) will be collectively referred to as interpolated disturbance forces. Hereafter, unless otherwise specified, rotation angles and interpolated angles will be given the same sign (θ) and treated identically. Disturbance forces and interpolated disturbance forces will be given the same sign (F) and treated identically.
[0053] The CPU 31 applies a low-pass filter to the interpolated disturbance force F generated as described above, and then calculates the derivative value f by taking the time derivative. The CPU 31 associates the calculated derivative value f with the interpolation angle θ and stores it in the RAM 33. The CPU 31 determines the peak angle φ from the variation of the derivative value f stored in the RAM 33. Each time the mounting operation is performed, the CPU 31 associates the determined peak angle φ with the number of times the tool 3 has been mounted and sequentially stores it in the memory device 34.
[0054] <Expansion and contraction of ball screw 41> The ball screw 41 of the Z-axis movement mechanism 8, which moves the main spindle 9 in the Z-axis direction, is heated by the heat generated by the Z-axis motor 51 and the frictional heat with the nut 44. The ball screw 41 also dissipates heat due to the temperature difference with the ambient air. As a result, the temperature of the ball screw 41 changes due to external heating and heat dissipation. When a temperature change occurs, the ball screw 41 expands and contracts, particularly in the longitudinal direction, the Z-axis direction.
[0055] When the ball screw 41 extends or retracts, the timing at which the plate cam 47 separates from the cam follower 49 is equal to the amount of extension or retraction L of the ball screw 41. b It changes accordingly. That is, the amount of expansion and contraction L b The peak angle φ changes accordingly. When the tool is changed by the tool changer 20, the numerical control device 30 controls the amount of extension L of the ball screw 41 based on the change in the peak angle φ. b Identify.
[0056] More specifically, the numerical control device 30 acquires the rotation angle θ of the Z-axis motor 51 and the disturbance force F applied to the Z-axis motor 51 at a period of 0.5 ms (step P1). Here, 0.5 ms is the shortest control period in the numerical control device 30.
[0057] The CPU 31 interpolates the acquired rotation angle θ and disturbance force F to generate an interpolated angle θ and an interpolated disturbance force F (Step P2). The CPU 31 subjects the interpolated disturbance force F to processing by a low-pass filter (Step P3). The CPU 31 time-differentiates the interpolated disturbance force F to calculate a differential value f (Step P4). The CPU 31 associates the calculated differential value f with the interpolated angle θ and stores them in the RAM 33 (Step P5). The CPU 31 repeatedly executes Step P1 to Step P5 until the mounting operation is completed. In the present embodiment, the timing at which the mounting operation is completed is the timing at which the spindle 9 descending from the ATC origin reaches the machining origin.
[0058] The CPU 31 determines a peak angle φ based on the differential value f stored in the RAM 33 (Step P6). The CPU 31 stores the determined peak angle φ in the RAM 33 (Step P7). The peak angle φ1 in the mounting operation performed for the first time after the power of the machine tool 1 is turned on is referred to as the initial peak angle. The peak angle in the mounting operation performed for the n-th (n is an integer of 2 or more) time after the power of the machine tool 1 is turned on is denoted as φ n . The CPU 31 calculates a difference ρ between the initial peak angle φ1 and the peak angle φ determined from the second time onward, as shown in the following Equation 2 (Step P8). n [Equation 2] ρ=φ n -φ1
[0059] From the peak angle φ, the position of the spindle 9 at the timing when the plate cam 47 separates from the cam follower 49 is calculated. φ1 indicates the position of the spindle 9 at the timing when the plate cam 47 separates from the cam follower 49 in the mounting operation performed for the first time. φ n indicates the position of the spindle 9 at the timing when the plate cam 47 separates from the cam follower 49 in the mounting operation performed for the n-th time. That is, the difference ρ indicates the amount of change from the position of the spindle 9 at the first time to the position of the spindle 9 at the n-th time at the same timing.
[0060] Each time the mounting operation is performed, the CPU 31 stores the calculated difference ρ in the storage device 34, associating it with each tool 3 (step P9). The CPU 31 calculates the average of the difference ρ stored for each tool 3. Based on the calculated average difference ρ (rad), the CPU 31 calculates the amount of change in the position of the spindle 9 (m). The CPU 31 then calculates the amount of expansion and contraction L of the ball screw 41 based on the calculated amount of change in the position of the spindle 9. b Identify it as such (Step P10).
[0061] Furthermore, the CPU 31 determines an abnormality in the mounting operation based on the peak angle φ. An abnormality in the mounting operation is, for example, chip jamming that occurs between the spindle 9 and the tool 3. If chip jamming occurs, the peak angle φ determined on the nth attempt is used. n The peak angle φ was determined on the (n-1)th iteration. n-1 A predetermined threshold Δφ max It changes more significantly than that. CPU31 determines the peak angle φ on the nth time, as shown in equation 3 below. n And the φ of the (n-1)th peak angle n-1 The difference Δφ is calculated (step P11). The CPU 31 determines that the difference Δφ is the threshold Δφ. max If the value is greater than this, it is determined that an abnormality has occurred during the attachment process (step P12). [Math 3] Δφ = φ n -φ n-1
[0062] <Tool change procedure> Referring to Figures 7 and 8, the tool change process performed by the CPU 31 of the numerical control device 30 will be explained. In the tool change process, the CPU 31 controls the exchange of the tool 3 by the tool changer 20 and the extension / contraction amount L of the ball screw 41. bThe tool change command is identified. The operator operates the input unit 37. The input unit 37 sends a tool change command to the CPU 31 in response to the operator's operation. When the CPU 31 receives the tool change command, it reads the control program stored in the ROM 32 and executes it to start the tool change process. When the tool change process starts, the spindle 9 is positioned at the machining origin. The variable j used in the tool change process is an integer of 1 or more and indicates the number of times the tool change has been performed. The variable j is stored in the RAM 33 and its value is set to 1 after the machine tool 1 is powered on.
[0063] As shown in Figure 7, the CPU 31 rotates the Z-axis motor 51 in the forward direction and starts raising the spindle 9 (S1). Based on the rotation angle θ of the Z-axis motor 51 detected by the encoder 71, the CPU 31 determines whether or not the spindle 9 has reached the ATC origin (S2).
[0064] If the CPU 31 determines that the spindle 9 has not reached the ATC origin (S2: NO), it returns to processing S2. If the CPU 31 determines that the spindle 9 has reached the ATC origin (S2: YES), it stops the rotation of the Z-axis motor 51 and stops the upward movement of the spindle 9 (S3).
[0065] The CPU 31 acquires tool information indicating the tool 3 (second tool) to be mounted on the spindle 9 by tool change (S4). The CPU 31 drives the magazine motor 55 to rotate the tool magazine 21 and positions the grip arm 23 that holds the second tool at the tool change position (S5).
[0066] The CPU 31 rotates the Z-axis motor 51 in the reverse direction and starts the descent of the spindle 9 (S6). The CPU 31 starts acquiring the rotation angle θ and disturbance force F of the Z-axis motor 51 (S7). The process in S7 corresponds to process P1. After executing the process in S7, the CPU 31 acquires the rotation angle θ and disturbance force F of the Z-axis motor 51 every 0.5 ms.
[0067] The CPU 31 determines whether or not it has acquired the rotation angle θ and disturbance force F of the Z-axis motor 51 that were started in the S7 process (S8). If the CPU 31 determines that it has not acquired the rotation angle θ and disturbance force F (S8: NO), it returns to the S8 process. If the CPU 31 determines that it has acquired the rotation angle θ and disturbance force F in the S7 process (S8: YES), it determines whether or not the spindle 9 has reached the machining origin based on the acquired rotation angle θ (S9).
[0068] If the CPU 31 determines that the spindle 9 has not reached the machining origin (S9:NO), it interpolates the rotation angle θ and disturbance force F of the Z-axis motor 51 obtained in the S7 process to generate an interpolated angle θ and an interpolated disturbance force F (S10). The process in S10 corresponds to process P2. The CPU 31 applies a low-pass filter to the interpolated angle θ and interpolated disturbance force F generated in the S10 process (S11). The process in S11 corresponds to process P3.
[0069] The CPU 31 performs differentiation, taking the time derivative of the interpolated disturbance force F to calculate the derivative value f (S12). The process in S12 corresponds to process P4. The CPU 31 stores the interpolation angle θ and the derivative value f in RAM 33 (S13). The process in S13 corresponds to process P5. The CPU 31 returns to process S8.
[0070] If the CPU 31 determines that the spindle 9 has reached the machining origin (S9:YES), it stops acquiring the rotation angle θ and disturbance force F of the Z-axis motor 51, which were started in the S7 process (S14). The CPU 31 stops the rotation of the Z-axis motor 51 and stops the descent of the spindle 9 (S15).
[0071] The CPU 31 determines the interpolation angle θ corresponding to the minimum derivative value f stored in the RAM 33 as the peak angle φ. j This is determined (S16). The process in S16 corresponds to process P6. The CPU 31 determines the peak angle φ j The data is stored in RAM33 (S17). The CPU31 then proceeds to process S21 (see Figure 8).
[0072] As shown in Figure 8, the CPU 31 determines whether the tool change process currently being executed is the first process after the machine tool 1 is powered on (S21). In the process of S21, the CPU 31 makes this determination based on the value of the variable j stored in the RAM 33.
[0073] If the CPU 31 determines that the value of variable j is 1 and that the currently executing tool change process is the first process after the power is turned on to the machine tool 1 (S21:YES), then the peak angle φ determined in S16 is... j The initial peak angle φ1 is determined and stored in RAM 33 (S22). The process in S22 corresponds to process P7. The CPU 31 adds 1 to the value of variable j (S23) and terminates the tool change process.
[0074] If the CPU 31 determines that the value of variable j is 2 or greater and that the tool change process currently being executed is not the first process after the power is turned on to the machine tool 1 (S21: NO), it calculates the difference Δφ (S24). In the process of S24, the CPU 31 calculates the peak angle φ determined in S16 for the tool change process currently being executed. j , and the peak angle φ determined in S16 of the previous tool change process and stored in S17 j-1 Based on this, the difference Δφ is calculated using equation 3. The process in S24 corresponds to process P11. The CPU 31 determines that the difference Δφ calculated in S24 is the threshold Δφ. max The following is determined (S25). The process in S25 corresponds to process P12.
[0075] CPU31 determines that the difference Δφ is the threshold Δφ max If it is determined that the following is true (S25: YES), then it is determined that no abnormality occurred during the mounting operation, and the difference ρ is calculated (S26). The process in S26 corresponds to process P8. In S26, the CPU 31 calculates the peak angle φ determined in S16. j Based on the initial peak angle φ1 stored in S22, the difference ρ is calculated using equation 2. The CPU 31 associates the difference ρ calculated in S26 with the second tool acquired in S4 (see Figure 7) and stores it in the storage device 34 (S27). The processing in S27 corresponds to process P9.
[0076] The CPU 31 calculates the average of the difference ρ stored for each tool 3 in the S27 process (S28). Based on the average of the difference ρ calculated in the S28 process, the CPU 31 determines the expansion / contraction amount L of the ball screw 41. b The process in S29 identifies the variable j (S29). The process in S29 corresponds to process P10. The CPU 31 adds 1 to the value of variable j (S23) and terminates the tool change process.
[0077] CPU31 determines that the difference Δφ is the threshold Δφ max If it is determined to be greater than (S25: NO), the CPU 31 performs notification processing as an abnormality has occurred during the mounting operation (S30). In the process of S30, the CPU 31 displays on the display unit 38 that an abnormality has occurred during the mounting operation as part of the notification processing. The CPU 31 then terminates the tool change process.
[0078] <Operation and effects of this embodiment> As explained above, the temperature of the ball screw 41 changes due to external heating and heat dissipation. When a temperature change occurs, the ball screw 41 expands and contracts in the Z-axis direction. When the ball screw 41 expands and contracts, the position of the spindle 9 in the Z-axis direction calculated from the rotation angle θ no longer matches the actual position of the spindle 9 in the Z-axis direction. If machining of the workpiece is performed using the tool 3 in this state, there is a risk that the machining accuracy of the workpiece will decrease.
[0079] The CPU 31 of the numerical control device 30 acquires the disturbance force F and rotation angle θ of the Z-axis motor 51 during the tool mounting operation at a period of 0.5 ms (P1, S7). The disturbance force F is the torque T of the Z-axis motor 51. m It is included, and CPU31 is Torque T m The disturbance force F is obtained by acquiring the derivative value f of the disturbance force F, which fluctuates over time, and the rotation angle θ. The CPU 31 then calculates the peak angle φ from the rotation angle θ. j The CPU 31 determines the peak angle φ (P6, S16). j Based on the initial peak angle φ1 stored in RAM33, the difference ρ is calculated. The CPU31 stores the difference ρ for each tool 3 and calculates the expansion / contraction amount L of the ball screw 41 based on the average of the difference ρ. bIdentify (P10, S29).
[0080] Thus, the numerical control device 30 detects the disturbance force F (torque T) of the Z-axis motor 51. m The configuration for controlling the expansion / contraction amount L b This identifies the expansion / contraction amount L. b Without providing a separate sensor to identify the expansion / contraction amount L b The numerical control device 30 can identify the identified amount of expansion and contraction L. b By correcting the rotation angle θ based on this, the discrepancy between the position of the spindle 9 in the Z-axis direction calculated from the rotation angle θ and the actual position of the spindle 9 in the Z-axis direction can be suppressed.
[0081] CPU31 performs differential processing, taking the time derivative of the disturbance force F to calculate the feature variable, the derivative value f (P4, S12). Based on the derivative value f and the rotation angle θ, CPU31 calculates the peak angle φ. j Determine (P6, S16). At the peak angle φ, which is the rotation angle θ at the timing when the plate cam 47 separates from the cam follower 49, the variation of the derivative value f is the torque T m The change is more pronounced compared to the fluctuations of φ. Therefore, the numerical control device 30 controls the peak angle φ j It can determine this with high accuracy.
[0082] The CPU31 determines the rotation angle θ corresponding to the minimum derivative f among the derivative values f to be the peak angle φ. j This is determined (P6, S16). As a result, the numerical control device 30 can easily determine the peak angle φ from the variation of the derivative value f. j It is possible to determine this.
[0083] CPU31 is Torque T m And by obtaining the rotation angle θ, the torque T m The disturbance force F contained within is obtained. The CPU 31 performs differentiation, taking the time derivative of the disturbance force F to calculate the derivative value f. The CPU 31 then selects the rotation angle θ corresponding to the minimum derivative value f from the derivative values f, and sets the peak angle φ. j It is determined as follows: As shown in Equation 1, torque T mThis includes inertial forces in addition to disturbance forces F. The numerical control device 30 controls torque T m The disturbance force F contained within is obtained, and the peak angle φ is based on the derivative f obtained by differentiating the disturbance force F with respect to time. j This determines the torque T due to the acceleration and deceleration of the Z-axis motor 51. m Eliminate the effects of changes in the amount of expansion L b It can be identified with high accuracy.
[0084] The CPU 31 interpolates the acquired rotation angle θ and disturbance force F to generate an interpolated angle θ and an interpolated disturbance force F (P2, S10). The CPU 31 performs differentiation and calculates the derivative value f by differentiating the interpolated disturbance force F with respect to time (P4, S12). The CPU 31 determines the rotation angle θ corresponding to the minimum derivative value f among the derivative values f to be the peak angle φ. j It is determined as follows: Peak angle φ j The resolution depends on the acquisition period (0.5 ms) of the rotation angle θ and the disturbance force F. By interpolating the rotation angle θ and the disturbance force F, the peak angle φ determined in process P6 (processing in S16) can be obtained with respect to the rotation angle θ at the timing when the plate cam 47 actually separates from the cam follower 49, without shortening the acquisition period. j This allows for a more accurate approximation of the expansion / contraction amount L. Therefore, the numerical control device 30 can determine the expansion / contraction amount L. b Even when the difference is slight, the expansion / contraction amount L can be accurately measured. b It can be identified.
[0085] The CPU 31 determines the peak angle φ during the first mounting operation performed after the power of the machine tool 1 is turned on. j The initial peak angle φ1 is determined and stored in RAM33 (P7, S22). The CPU31 then determines the peak angle φ after the second power-on. j Based on the difference ρ and the initial peak angle φ1, the CPU 31 calculates the expansion / contraction amount L based on the difference ρ. b This identifies the amount L of expansion or contraction of the ball screw 41 from the state after power-on. b It can be identified.
[0086] The CPU31 determines the peak angle φ during the ongoing tool change process.j , and the peak angle φ determined in the previous tool change procedure j-1 Based on this, the difference Δφ is calculated. CPU31 calculates the difference Δφ when the threshold Δφ is Δφ max Determine whether the following applies (P12, S25): If an abnormality occurs during the mounting operation, for example, if chip jamming occurs between the spindle 9 and the tool 3 during the mounting operation, the peak angle φ determined in the previous tool change process is determined. j-1 The peak angle φ determined in this instance j The threshold Δφ max It becomes larger than that. Therefore, the numerical control device 30 can determine an abnormality in the mounting operation by performing process P12 (processing in S25).
[0087] The CPU 31 calculates the difference ρ and stores it in the memory device 34 (P9, S27). The CPU 31 calculates the average of the difference ρ stored in the memory device 34. Based on the calculated average, the CPU 31 determines the expansion / contraction amount L of the ball screw 41. b This identifies the peak angle φ due to variations in the mounting operation. j The error in determining the expansion / contraction amount L can be reduced. Therefore, the numerical control device 30 determines the specified expansion / contraction amount L b This reduces the error between the actual amount of expansion and contraction of the ball screw 41 and the calculated amount.
[0088] The CPU 31 associates the calculated difference ρ with the second tool and stores it in the memory device 34. The CPU 31 calculates the average of the stored difference ρ for each tool 3. Based on the calculated average, the CPU 31 calculates the expansion / contraction amount L. b This identifies the difference ρ. As a result, even if there is variation in the difference ρ for each tool 3, the numerical control device 30 determines the amount of expansion / contraction L based on the average of the difference ρ. b By identifying the variation in the difference ρ, the amount of expansion and contraction L can be determined. b The impact on specific accuracy can be suppressed. Therefore, the numerical control device 30 controls the expansion / contraction amount L. b It can be identified with high accuracy.
[0089] <Variation> The present invention can be modified in various ways from the above embodiments. The various modifications described below can be combined in any way as long as they do not create contradictions. For example, the numerical control device 30 is not limited to being installed on the machine tool 1, but may be installed separately from the machine tool 1. For example, the numerical control device 30 may be a device (PC, dedicated machine, etc.) connected to the machine tool 1. The tool changing device 20 is not limited to a turret type, but may be an arm type, for example.
[0090] The numerical control device 30 may acquire the disturbance force F of the motor during the detachment operation. Although not shown in the figures, the rotation angle θ changes in the positive direction during the detachment operation, so the derivative value f of the disturbance force F during the detachment operation has the opposite sign to the derivative value f during the mounting operation shown in Figure 5(B). The timing at which the derivative value f during the detachment operation is maximum is the timing at which the plate cam 47 contacts the cam follower 49. The CPU 31 of the numerical control device 30 sets the rotation angle θ corresponding to the derivative value f at which the derivative value f during the detachment operation is maximum to the peak angle φ j The CPU 31 determines the peak angle φ, similar to the mounting operation. j Based on the initial peak angle φ1 stored in RAM33, the difference ρ is calculated. The CPU31 calculates the expansion / contraction amount L of the ball screw 41 based on the average of the difference ρ. b The numerical control device 30 identifies the expansion / contraction amount L from the fluctuation of the disturbance force F during the detachment operation. b It can be identified.
[0091] The numerical control device 30 determines the expansion / contraction amount L from the fluctuation of the disturbance force F during the detachment operation. b If this is identified, the abnormality in the detachment operation may be determined by the difference Δφ. An abnormality in the detachment operation may be, for example, that the clamp axis 81 of the spindle 9 does not move normally in the Z-axis direction, and the gripping part 85 is unable to properly detach the tool 3 from the spindle 9. In this case, the peak angle φ determined in the previous tool change process may be used. j-1 The peak angle φ determined in this instance j This becomes excessively large. Therefore, the numerical control device 30 can determine an abnormality in the detachment operation based on the magnitude of the difference Δφ.
[0092] The numerical controller 30 may specify the expansion / contraction amount L based not on the disturbance force F but on the variation in the torque T whose acquisition is started in the process of S7 m . b The CPU 31 time-differentiates the torque T even when based on the variation in the torque T, in the same manner as when based on the variation in the disturbance force F m . m The CPU 31 determines, as the peak angle φ, the rotation angle θ corresponding to the differential value of the torque T that indicates the minimum among the differential values of the torque T m . m The CPU 31 specifies the expansion / contraction amount L of the ball screw 41 based on the determined peak angle φ and the difference ρ of the initial peak angle φ1 stored in the RAM 33 j . j In this way, the numerical controller 30 can specify the expansion / contraction amount L based on the variation in the torque T b . m b
[0093] The numerical controller 30 may specify the expansion / contraction amount L based on the position of the spindle 9 in the Z-axis direction calculated based on the rotation angle θ of the Z-axis motor 51 b . In this case, the CPU 31 specifies the expansion / contraction amount L using the position of the spindle 9 in the Z-axis direction corresponding to the minimum differential value f as the peak position b .
[0094] In the above embodiment, the numerical controller 30 may appropriately modify the acquisition method of the disturbance force F. For example, the numerical controller 30 may acquire the difference between the torque T and the inertia force as the disturbance force F instead of using Equation 1 m .
[0095] The numerical controller 30 does not need to perform interpolation of the rotation angle θ and the disturbance force F. In this case, the step P2 (the process of S10) may be omitted. The numerical controller 31 can simplify the specific step (process) of the expansion / contraction amount L b .
[0096] In the above embodiment, the numerical control device 30 interpolated the rotation angle θ and the disturbance force F by connecting multiple combinations of rotation angles θ and disturbance forces F with a straight line (linear approximation), but is not limited to this method. For example, the numerical control device 30 may interpolate the rotation angle θ and the disturbance force F by curve approximation using a spline. The numerical control device 30 may also interpolate the rotation angle θ and the disturbance force F based on an approximated straight line linearly approximated by the least squares method.
[0097] The numerical control device 30 determines the expansion / contraction amount L based on the initial peak angle φ1. b It is not necessary to specify it as such. In this case, the memory device 34 stores the reference peak angle in advance before the tool change process, and the numerical control device 30 determines the peak angle φ during the tool change process. j Based on the difference in the reference peak angle stored in the memory device 34, the amount of extension / contraction L of the ball screw 41 is determined. b Identify.
[0098] The numerical control device 30 determines the peak angle φ during the first tool change process after power-on. j It is not necessary to determine the initial peak angle φ1. The numerical control device 30 determines, for example, the peak angle φ determined in the first tool change process after the execution of the NC program for machining the workpiece. j The initial peak angle φ1 may be determined as such.
[0099] The numerical control device 30 does not need to determine any abnormalities in the mounting operation. In this case, steps P11 (processing in S24) and P12 (processing in S25) may be omitted. The numerical control device 30 determines the amount of expansion and contraction L b This allows for the simplification of specific steps (processes).
[0100] The numerical control device 30 may also determine an abnormality in the attachment operation based on the difference obtained by subtracting the difference ρ from the difference ρ at the j-th time. In this case as well, the numerical control device 30 can determine an abnormality in the attachment operation.
[0101] In the above embodiment, the numerical control device 30 determines the peak angle φ jThe difference ρ of the initial peak angle φ1 is calculated, and based on its average, the amount of expansion and contraction L of the ball screw 41 is determined. b While this has been identified, it is not limited to this. The numerical control device 30, for example, calculates the amount of change in the position of the main axis 9 from the difference ρ as the expansion / contraction amount L b It may also be specified as follows: The numerical control device 30 determines the amount of expansion and contraction L of the ball screw 41 based on the median of the difference ρ. b The numerical control device 30 may store in the storage device 34 the amount of change in the position of the main axis 9 calculated from the difference ρ, instead of the difference ρ. In this case, the average of the amount of change is used as the expansion / contraction amount L. b It may be specified as such.
[0102] When the numerical control device 30 stores the difference ρ in the memory device 34, it does not need to associate it with each tool 3.
[0103] The numerical control device 30 does not need to apply a low-pass filter to the interpolation angle θ and the interpolation disturbance force F. In this case, process P3 (processing in S11) may be omitted. The numerical control device 30 controls the expansion / contraction amount L. b This allows for the simplification of certain processes (processes). The numerical control device 30 may apply processing to the interpolation angle θ and the interpolation disturbance force F using a high-pass filter or a band-pass filter.
[0104] The numerical control device 30 uses disturbance forces F other than those generated during tool change of tool 3 to control the expansion and contraction amount L b The amount of expansion and contraction L is determined by the disturbance force F generated when the X-axis motor 53 is rotated to move the table 13 to the opposite side of the motor and presses against the end of the stroke. b You may specify it.
[0105] The configuration of the Z-axis movement mechanism 8 may be modified as appropriate. The Z-axis movement mechanism 8 may have a configuration in which the spindle 9 is moved by the rotation of a Z-axis motor 51 instead of a ball screw 41. The Z-axis movement mechanism 8 may have, for example, a sliding screw extending in the Z-axis direction, or a spline shaft with teeth formed in the Z-axis direction, instead of a ball screw 41. In this case, the sliding screw and spline shaft are examples of the "feed axis" of the present invention.
[0106] In the above embodiment, Torque T m The peak angle φ was determined using the derivative f of the disturbance force F contained in as a feature, but the feature used to determine the peak angle φ may be changed as appropriate. The numerical control device 30 does not differentiate the disturbance force F, for example, but instead uses the disturbance force F (torque T) which fluctuates with time. m The peak angle φ may be determined using the following as a feature. In this case, the numerical control device 30 may determine the peak angle φ as the rotation angle θ corresponding to the disturbance force F that represents either the maximum or minimum of the disturbance forces F.
[0107] The numerical control device 30 controls the torque T which fluctuates over time. m The peak angle φ may be determined using the torque T as a feature. In this case, the numerical control device 30 determines the torque T m Torque T, which indicates either the maximum or minimum value. m The rotation angle θ corresponding to this can be determined as the peak angle φ.
[0108] The numerical control device 30 detects the disturbance force F (torque T m The value obtained by squaring the disturbance force F (torque T m The second derivative of ) and the disturbance force F (torque T) within a given time. m The peak angle φ may be determined using the average value of ) as a feature.
[0109] The numerical control device 30 does not have to set the rotation angle θ corresponding to the minimum derivative value f as the peak angle φ during the mounting operation. The numerical control device 30 may set the rotation angle θ corresponding to the maximum derivative value f as the peak angle φ during the mounting operation. The numerical control device 30 does not have to set the rotation angle θ corresponding to the maximum derivative value f as the peak angle φ during the detachment operation. The numerical control device 30 may set the rotation angle θ corresponding to the minimum derivative value f as the peak angle φ during the detachment operation.
[0110] The numerical control device 30 does not have to determine the rotation angle θ corresponding to the differential value f that represents either the maximum or minimum of the differential values f as the peak angle φ. The numerical control device 30 may, for example, determine the rotation angle (θ - θ1) which is shifted by a predetermined angle θ1 from the rotation angle θ corresponding to the rotation angle f that represents the minimum differential value f as the peak angle φ. The numerical control device 30 may, for example, determine the rotation angle (βθ) obtained by multiplying the rotation angle θ corresponding to the rotation angle f that represents the minimum differential value f by a predetermined coefficient β as the peak angle φ.
[0111] <Other> In the above embodiment, the Z-axis direction is an example of the "predetermined direction" of the present invention. The ball screw 41 is an example of the "feed axis" of the present invention. The Z-axis motor 51 is an example of the "motor" of the present invention. Process P1 is an example of the "acquisition process" of the present invention. Process P4 is an example of the "differentiation process" and "interpolation differentiation process" of the present invention. Process P6 is an example of the "determination process" of the present invention. The initial peak angle φ1 is an example of the "reference specific angle" of the present invention. The difference ρ is an example of the "first difference" of the present invention. Process P10 is an example of the "specification process" of the present invention. The differential value f is an example of the "disturbance force differential value" of the present invention. Process P2 is an example of the "interpolation process" of the present invention. Process P7 is an example of the "reference determination process" of the present invention. Δφ is an example of the "second difference" of the present invention. Process P12 is an example of the "determination process" of the present invention. Process P9 is an example of the "storage process" of the present invention. The CPU 31 that executes the processing of S7 is an example of the "acquisition unit" of the present invention. The CPU 31 that executes the process in S12 is an example of the "differentiation unit" of the present invention. The CPU 31 that executes the process in S16 is an example of the "determination unit" of the present invention. The CPU 31 that executes the process in S29 is an example of the "specification unit" of the present invention. Peak angles φ, φ n , φ j This is an example of the "specific angle" of the present invention. The derivative value f is an example of the "feature quantity" of the present invention. [Explanation of Symbols]
[0112] 1 Machine tools 3 tools 9 Main axis 20 Tool changer 30 Numerical control device 31 CPU 41 Ball screw 51 Z-axis motor
Claims
1. A method for determining the amount of extension or retraction of the feed axis in a predetermined direction in a machine tool, comprising a spindle for mounting a tool, a feed axis extending in a predetermined direction, and a motor for rotating the feed axis around the axis extending in the predetermined direction, wherein the motor rotates the feed axis, thereby moving the spindle and mounting the tool to be gripped by a tool changer onto the spindle, An acquisition step of acquiring the torque of the motor and the rotation angle of the motor in a time series during at least one of the tool mounting operation or the tool detachment operation, A determination step in which a specific angle is determined from the rotation angle based on the characteristic quantities of the time-series data of the torque and the rotation angle obtained in the acquisition step, A determination step to determine the amount of extension or contraction of the feed axis based on the first difference between the specific angle determined by the determination step and a reference specific angle that serves as the basis for the specific angle, and A method for identification characterized by including
2. The aforementioned feature quantity is the derivative of the torque obtained by the acquisition process, with respect to time. The process further includes a differentiation step of calculating the differential value corresponding to the rotation angle from the torque obtained in the acquisition step, The determination step involves determining the specific angle based on the differential value calculated in the differentiation step and the rotation angle. The identification method according to claim 1, characterized by the above.
3. The determination step involves determining the rotation angle corresponding to the differential value that represents either the maximum or minimum of the differential values calculated in the differentiation step as the specific angle. The identification method according to claim 2, characterized by the above.
4. The acquisition step acquires the disturbance force acting on the motor as a reaction force to the motor's drive, which is included in the torque. The process further includes a differentiation step for calculating the differential value of the disturbance force obtained by the acquisition step, which is the time derivative of the disturbance force obtained by the acquisition step, The determination step involves determining the rotation angle corresponding to the maximum or minimum of the disturbance force derivative values calculated in the differentiation step as the specific angle. The identification method according to claim 1, characterized by the above.
5. The aforementioned differentiation process is, An interpolation step that generates an interpolated angle obtained by interpolating the rotation angle obtained by the acquisition step, and an interpolated torque corresponding to the interpolated angle and obtained by interpolating the torque obtained by the acquisition step, An interpolation differentiation step is performed to differentiate the interpolated torque interpolated by the interpolation step and calculate the interpolated derivative value of the interpolated torque corresponding to the interpolation angle. Includes, The determination step involves determining the interpolation angle corresponding to the interpolation derivative value that represents either the maximum or minimum of the interpolation derivative values calculated in the interpolation derivative step as the specific angle. The identification method according to claim 3, characterized by the above.
6. The process includes a reference determination step in which the specific angle determined in the first step is determined as the reference specific angle, The aforementioned identification step involves determining the amount of expansion or contraction based on the first difference between the specified angle determined in the determination step for the second time or later and the standard specified angle determined in the standard determination step. The identification method according to claim 1, characterized by the above.
7. A determination step to determine an abnormality in the attachment operation or the detachment operation based on a second difference between the specific angle determined n times (where n is an integer of two or more) by the determination step and the specific angle determined n-1 times by the determination step. The identification method according to claim 1, characterized by including the following.
8. The system includes a storage step for storing the first difference calculated based on the specific angle determined by the determination step, The aforementioned identification step involves determining the amount of expansion or contraction based on the average of the multiple first differences stored in the aforementioned storage step. The identification method according to claim 1, characterized by the above.
9. The memory step involves storing the first difference for each tool mounted on the spindle, The aforementioned identification step involves determining the amount of expansion or contraction based on the average of a plurality of first differences stored for each tool in the aforementioned storage step. The identification method according to claim 8, characterized by the above.
10. A numerical control device controls the operation of a machine tool, comprising a spindle for mounting a tool, a feed axis extending in a predetermined direction, and a motor that rotates the feed axis around the axis extending in the predetermined direction, wherein the motor rotates the feed axis to move the spindle and mount the tool that a tool changer grips onto the spindle, An acquisition unit that acquires the torque of the motor and the rotation angle of the motor in a time series during at least one of the tool mounting operation or the tool detachment operation, Based on the characteristic quantities of the time-series data of torque and rotation angle acquired by the acquisition unit, a determination unit determines a specific angle from the rotation angle, A determination unit determines the amount of extension or contraction of the feed shaft in the predetermined direction based on the first difference between the specific angle determined by the determination unit and a reference specific angle that serves as the basis for the specific angle. A numerical control device characterized by comprising the above.
Citation Information
Patent Citations
Feed unit
JP1983177253U
Thermal displacement compensation method and thermal displacement compensation device for machine tool
JP2012101330A
Workpiece machining method of machine tool
JP2019000945A
Numerical control device and mounting determination reference setting method
JP2019042847A
Numerical control device, control method, and storage medium
JP2021103395A
