Motor control device and industrial machine for suppressing vibration

Abstract

A motor control device includes an acceleration detecting section configured to detect an acceleration of a control object, and an acceleration control section configured to control an acceleration of a motor driving the control object based on the detected acceleration, in which the acceleration control section includes a vibration component extraction filter configured to extract a vibration component generated between the motor and the control object, and the vibration component extraction filter changes a filter characteristic frequency according to at least one of a position and a mass of the control object.

Claims

1. A motor control device comprising: an acceleration detecting section configured to detect an acceleration of a control object driven along a shaft that is supported on at least one end of the shaft by a supporting element; and an acceleration control section configured to control an acceleration of a motor driving the control object along the shaft based on the detected acceleration; wherein the acceleration control section includes a vibration component extraction filter configured to extract a vibration component generated between the motor and the control object on the basis of the detected acceleration, and the vibration component extraction filter computes and changes a filter characteristic frequency according to a plate spring vibration characteristic of the shaft computed based on an elasticity of the shaft and a position of the control object relative to the supporting element, and a mass of the control object.

2. The motor control device of claim 1, wherein the position of the control object is a position of the control object the shaft driven by the motor or a position of the control object on another shaft driven by a motor different from the motor.

3. The motor control device of claim 1, wherein a weight of the control object is input by an operator in advance, or is estimated based on a relationship between a torque and an acceleration of the control object or the motor.

4. The motor control device of claim 1, wherein the filter characteristic frequency is changed based on at least one of a torsional vibration characteristic and a plate spring vibration characteristic.

5. The motor control device of claim 4, wherein the torsional vibration characteristic is represented by the following equation
ω.sub.1=√{square root over (k.sub.1/J.sub.L)} based on a spring constant k.sub.1 that changes according to the position of the control object, an inertia J.sub.L of the control object, and an angular frequency ω.sub.1 of the control object.

6. The motor control device of claim 4, wherein the plate spring vibration characteristic is represented by the following equation
ω.sub.2=√{square root over (k.sub.2/M)} based on a spring constant k.sub.2 that changes according to the position of the control object, a mass M of the control object, and an angular frequency ω.sub.2 of the control object.

7. The motor control device of claim 1, wherein the vibration component extraction filter is at least one of a low-pass filter and a band-pass filter, and the filter characteristic frequency is a cut-off frequency in the low-pass filter, or a center frequency or an upper cut-off frequency and a lower cut-off frequency in the band-pass filter.

8. The motor control device of claim 1, wherein the vibration component extraction filter is a filter provided downstream from the acceleration detecting section.

9. The motor control device of claim 1, wherein the acceleration control section further includes an acceleration controller configured to control an acceleration of the motor, and the vibration component extraction filter is a filter provided upstream or downstream from the acceleration controller.

10. An industrial machine comprising: a motor; a shaft driven by the motor; a control object movable by the shaft; an acceleration detecting section configured to detect an acceleration of the control object driven along the shaft that is supported on at least one end of the shaft by a supporting element; and an acceleration control section configured to control an acceleration of the motor driving the control object along the shaft based on the detected acceleration; wherein the acceleration control section includes a vibration component extraction filter configured to extract a vibration component generated between the motor and the control object on the basis of the detected acceleration, and the vibration component extraction filter computes and changes a filter characteristic frequency according to a plate spring vibration characteristic of the shaft computed based on an elasticity of the shaft and a position of the control object relative to the supporting element, and a mass of the control object.

11. An industrial machine comprising: a motor; a shaft driven by the motor; another shaft driven by a motor different from the motor; a control object movable by at least one of the shaft and the other shaft; an acceleration detecting section configured to detect an acceleration of the control object driven along the at least one of the shaft and the other shaft that is supported on at least one end of the at least one of the shaft and the other shaft by a supporting element; and an acceleration control section configured to control an acceleration of at least one of the motors driving the control object along the at least one of the shaft and the other shaft based on the detected acceleration; wherein the acceleration control section includes a vibration component extraction filter configured to extract a vibration component generated between at least one of the motors and the control object on the basis of the detected acceleration, and the vibration component extraction filter computes and changes a filter characteristic frequency according to a plate spring vibration characteristic of the at least one of the shaft and the other shaft computed based on an elasticity of the at least one of the shaft and the other shaft and a position of the control object relative to the supporting element, and a mass of the control object.

Description

BRIEF DESCRIPTION OF THE DRAWINGS

(1) FIG. 1 is a configuration diagram of a motor control device according to one embodiment.

(2) FIG. 2 is a configuration diagram of a motor control device according to another embodiment.

(3) FIG. 3A is an explanatory diagram illustrating a torsional vibration characteristic of a ball screw.

(4) FIG. 3B is an explanatory diagram illustrating a torsional vibration characteristic of a ball screw.

(5) FIG. 4 is an explanatory diagram illustrating a plate spring vibration characteristic of a ball screw.

(6) FIG. 5 is a configuration diagram of an industrial machine with its own shaft driven by a motor.

(7) FIG. 6 is a configuration diagram of an industrial machine with also another shaft driven by a motor different from the above-described motor.

DETAILED DESCRIPTION

(8) Embodiments of the present disclosure will be described in detail below with reference to the accompanying drawings. In each drawing, the same or similar components are denoted by the same or similar reference numerals. Additionally, the embodiments described below are not intended to limit the technical scope of the invention or the meaning of terms set forth in the claims.

(9) FIG. 1 illustrates a configuration of a motor control device 1 according to the present embodiment. The motor control device 1 includes a position command section 10 that generates a position command for the control object 3, a position detecting section 13 that detects a position of a motor 2, and a servo control section 12 that controls the motor 2 based on the generated position command and the detected position of the motor. A control object 3 includes, for example, a table, a main spindle head, a conveyor or the like of an industrial machine such as a machine tool and a transport machine. The position detecting section 13 includes a rotational displacement sensor directly attached to the motor such as an encoder, a resolver, and a Hall sensor. The servo control section 12 performs a feedback control of at least one of a position, a speed, and a torque of the motor 2.

(10) The motor control device 1 according to the present example further includes an acceleration detecting section 14 that detects an acceleration of the control object 3, and an acceleration control section 11 that controls acceleration of the motor 2 based on the detected acceleration. The acceleration detecting section 14 includes an acceleration sensor of, for example, a piezoelectric type, a piezoresistance type, or a capacitance type, and is attached to an industrial machine. The acceleration control section 11 includes a differentiator 20, a vibration component extraction filter 21a, a subtractor 22, an acceleration controller 23, and an adder 24. The acceleration control section 11 may include a processor such as a central processing unit (CPU) and a field-programmable gate array (FPGA).

(11) The differentiator 20 differentiates twice the position command generated by the position command section 10 to generate an acceleration command. However, the differentiator 20 may generate an acceleration command by differentiating once the speed command generated by the servo control section 12. The vibration component extraction filter 21a is an acceleration feedback filter provided downstream from the acceleration detecting section 14, and extracts an acceleration including a vibration component from the acceleration detected by the acceleration detecting section 14. The subtractor 22 subtracts the acceleration including the vibration component extracted by the vibration component extraction filter 21a from the acceleration command generated by the differentiator 20 to generate an acceleration deviation. The acceleration controller 23 performs at least one of a proportional control (P), an integral control (I) and a differential control (D) based on the acceleration deviation to generate a correction torque. However, instead of the correction torque, the acceleration controller 23 may generate a correction position, a correction speed or the like to output them to the servo control section 12. The adder 24 adds the correction torque and the torque command generated by the servo control section 12 to output the result to the motor 2. However, the adder 24 may add the correction position and the position command, or may add the correction speed and the speed command. As described above, the motor control device 1 performs a motor control in which a vibration of the control object 3 is suppressed.

(12) FIG. 2 illustrates a configuration of a motor control device 1 according to another embodiment. A vibration component extraction filter 21b of the present example is an acceleration deviation filter provided upstream from the acceleration controller 23, and differs from the vibration component extraction filter 21a described above in that the acceleration deviation including the vibration component is extracted. However, the vibration component extraction filter 21b may be a correction torque filter provided downstream from the acceleration controller 23, and in this case, extracts a correction torque including a vibration component. As a result, the motor control device 1 performs motor control in which vibration of the control object 3 is suppressed.

(13) Either of the vibration component extraction filters 21a and 21b described above preferably includes at least one of filters that pass a specific frequency component, such as a low-pass filter and a band-pass filter. When each of the vibration component extraction filters 21a and 21b includes a plurality of filters, these filters may be arranged in series or in parallel. Further, the filter characteristic frequency ω.sub.0 of each of the vibration component extraction filters 21a and 21b is changed according to the vibration frequencies ω.sub.1 and ω.sub.2 of the control object 3, as described later. The filter characteristic frequency ω.sub.0 is, for example, a cut-off frequency in a low-pass filter, or a center frequency or an upper cut-off frequency and a lower cut-off frequency in a band-pass filter. The band-pass filter may pass a specific frequency band using a half-width.

(14) In general, an industrial machine transmits power to the control object 3 via a power transmission element such as a shaft, a gear, a belt, a chain, a cam, a link, or the like. Accordingly, the vibration frequency of the control object 3 can be represented by the torsional vibration characteristic, the plate spring vibration characteristic, of the power transmission element, and combinations thereof, or the like.

(15) As an example of the torsional vibration characteristic, the torsional vibration characteristic of a ball screw 31 will be described with reference to FIGS. 3A and 3B. In this example, it is assumed that the control object 3 as a table moves on the ball screw 31, the ball screw 31 is supported by the support element 32 in a cantilever manner, and the ball screw 31 generates a torsional vibration V.sub.1. When the ball screw 31 has a length L, a diameter d, and a transverse elastic modulus G, and its mass can be ignored, the spring constant k.sub.1 of the ball screw 31 is represented by the equation below:

(16) $\begin{array}{cc}{k}_1=\frac{\pi d^{4}G}{32L}& \mathrm{Equation}1\end{array}$

(17) As can be seen from this equation, the spring constant k.sub.1 changes depending on the length L, of the ball screw, equivalent to the position of the control object 3. As the position L of the control object 3 changes as illustrated in FIG. 3B and the spring constant k.sub.1 changes, the angular frequency ω.sub.1 (i.e., the vibration frequency) of the control object 3 also changes as in the following equation. In the following equation, J.sub.L is an inertia of the control object 3.
ω.sub.1=√{square root over (k.sub.1/J.sub.L)}  Equation 2

(18) According to this equation, it is also understood that the angular frequency ω.sub.1 of the control object 3 changes according to the inertia J.sub.L equivalent to a mass M of the control object 3. When the control object 3 has the mass M and is driven by the ball screw 31 with the pitch p [m], the inertia J.sub.L of the control object 3 can be converted into the mass M of the control object 3 by the following equation.

(19) $\begin{array}{cc}{J}_L={\left(\frac{p}{2\pi }\right)}^2\times M& \mathrm{Equation}3\end{array}$

(20) Further, as an example of the plate spring vibration characteristic, the plate spring vibration characteristic of the ball screw 31 will be described with reference to FIG. 4. In this example, it is assumed that the control object 3 is at the tip of the ball screw 31, the ball screw 31 is supported by the support element 32 in a cantilever manner, and the ball screw 31 generates a plate spring vibration V.sub.2. When the ball screw 31 has a length L, a diameter d, and a Young's modulus E, and its mass can be ignored, a spring constant k.sub.2 of the ball screw 31 is represented by the equation below:

(21) $\begin{array}{cc}{k}_2=\frac{d^{4}E}{4L^3}& \mathrm{Equation}4\end{array}$

(22) As can be seen from this equation, the spring constant k.sub.2 changes depending on the length L, of the ball screw 31, equivalent to the position of the control object 3. As the position L of the control object 3 changes and the spring constant k.sub.2 changes, the angular frequency ω.sub.2 (i.e., the vibration frequency) of the control object 3 also changes as in the following equation. In the following equation, M is the mass of the control object 3.
ω.sub.2=√{square root over (k.sub.2/M)}  Equation 5

(23) According to this equation, it is also understood that the angular frequency ω.sub.2 of the control object 3 changes according to the mass M of the control object 3. According to the above, the filter characteristic frequency ω.sub.0 of each of the vibration component extraction filters 21a and 21b is preferably changed based on a physical change of the control object 3 (i.e., a change in at least one of the position L and the mass M of the control object 3).

(24) Referring again to FIG. 1 and FIG. 2, with respect to the position L of the control object 3, the position of the motor 2 detected by the position detecting section 13 may be input to each of the vibration component extraction filters 21a and 21b as indicated by a dashed arrow, or the position command generated by the position command section 10 may be input to each of the vibration component extraction filters 21a and 21b. On the other hand, the mass M of the control object 3 may be input in advance to the motor control device 1 by an operator, or may be estimated from the relationship between a torque and an acceleration of the control object 3 or the motor 2 by operating (e.g., vibrating) the motor 2 minutely.

(25) FIG. 5 illustrates an industrial machine 30 provided with its own shaft 31 driven by the motor 2. The industrial machine 30 includes the motor 2, the own shaft 31 driven by the motor 2, the control object 3 movable by the own shaft 31, and the motor control device 1 that controls the motor 2. The motor 2 is, for example, a servo motor, the own shaft 31 is, for example, an X-axis ball screw that defines the X-axis direction, and the control object 3 is, for example, a table. The own shaft 31 is supported by the support element 32 in a cantilever manner, but may be supported by both ends.

(26) The motor control device 1 includes the vibration component extraction filter 21a or 21b illustrated in FIG. 1 or FIG. 2. The own shaft 31 generates the torsional vibration V.sub.1, and the torsional vibration characteristic changes according to a position Lx of the control object 3 in the X-axis direction. Therefore, each of the vibration component extraction filters 21a and 21b obtains the angular frequency ω.sub.1 of the torsional vibration V.sub.1 from the equation 2 based on the position Lx of the control object 3 on the own shaft 31, and changes the filter characteristic frequency ω.sub.0 based on the obtained angular frequency ω.sub.1. Then, each of the vibration component extraction filters 21a and 21b extracts the acceleration F (a) including the torsional vibration component based on the changed filter characteristic frequency ω.sub.0.

(27) FIG. 6 illustrates an industrial machine 30 also provided with another shaft 33 driven by a motor 4 different from the motor 2. The industrial machine 30 includes the motor 2, the own shaft 31, the other shaft 33, the control object 3 movable by at least one of the own shaft 31 and the other shaft 33, and the motor control device 1 that controls the motor 2 and the motor 4. The own shaft 31 is, for example, a Y-axis ball screw that defines the Y-axis direction, the other shaft 33 is, for example, a Z-axis ball screw that defines the Z-axis direction, and the control object 3 is, for example, a main spindle head. The own shaft 31 is supported in a cantilever manner by the support element 32, but may be supported by both ends, and the other shaft 33 is supported in a cantilever manner.

(28) The motor control device 1 includes the vibration component extraction filter 21a or 21b illustrated in FIG. 1 or FIG. 2. It is preferable that each of the vibration component extraction filters 21a and 21b of the present example includes at least two filters (hereinafter referred to as “torsional vibration characteristic filter” and “plate spring vibration characteristic filter”) in which a low-pass filter, a band-pass filter, or the like are arranged in parallel, and an adder that adds acceleration including vibration components extracted by the two filters. The own shaft 31 generates a torsional vibration V.sub.1, and the torsional vibration characteristic changes according to a position Ly of the control object 3 in the Y-axis direction. The other shaft 33 generates a plate spring vibration V.sub.2, and the plate spring vibration characteristic changes according to a position Lz of the control object 3 in the Z-axis direction. The torsional vibration characteristic filter obtains the angular frequency ω.sub.1 of the torsional vibration V.sub.1 from the equation 2 according to the position Ly of the control object 3 on the own shaft 31, and changes the filter characteristic frequency ω.sub.0 based on the obtained angular frequency co. Then, the torsional vibration characteristic filter extracts the acceleration F.sub.1 (a) including the torsional vibration component based on the changed filter characteristic frequency ω.sub.0.

(29) Further, the plate spring vibration characteristic filter obtains the angular frequency ω.sub.2 of the plate spring vibration V.sub.2 from equation 5 according to the position Lz of the control object 3 on the other shaft 33, and changes the filter characteristic frequency ω.sub.0 based on the obtained angular frequency ω.sub.2. Then, the plate spring vibration characteristic filter extracts the acceleration F.sub.2 (a) including the plate spring vibration component based on the changed filter characteristic frequency ω.sub.0. The adder adds the acceleration F.sub.1 (a) including the torsional vibration component and the acceleration F.sub.2 (a) including the plate spring vibration component. Thus, each of the vibration component extraction filters 21a and 21b extracts the acceleration F (a) including the torsional vibration component and the plate spring vibration component.

(30) According to the above-described embodiment, each of the vibration component extraction filters 21a and 21b is changed in accordance with the physical change of the control object 3 (i.e., change in the position and the mass of the control object), so that the vibration suppression function can be adapted to a change in the vibration characteristic more quickly and more accurately.

(31) Further, the program executed by the above-described processor may be provided by being recorded on a non-transitory recording medium readable by a computer, such as a CD-ROM.

(32) Although various embodiments have been described herein, it should be recognized that the present invention is not limited to the above-described embodiments and various changes can be made within the scope described in the following claims.