EP4212968A1 - Motor control device - Google Patents
Motor control device Download PDFInfo
- Publication number
- EP4212968A1 EP4212968A1 EP21863954.0A EP21863954A EP4212968A1 EP 4212968 A1 EP4212968 A1 EP 4212968A1 EP 21863954 A EP21863954 A EP 21863954A EP 4212968 A1 EP4212968 A1 EP 4212968A1
- Authority
- EP
- European Patent Office
- Prior art keywords
- vibration
- frequency
- unit
- vibrations
- motor control
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
- 230000001629 suppression Effects 0.000 claims abstract description 78
- 230000004044 response Effects 0.000 claims abstract description 30
- 238000000034 method Methods 0.000 claims abstract description 27
- 230000008569 process Effects 0.000 claims abstract description 16
- 238000000605 extraction Methods 0.000 claims abstract description 15
- 239000000284 extract Substances 0.000 claims abstract description 5
- 230000003044 adaptive effect Effects 0.000 claims description 30
- 238000001514 detection method Methods 0.000 claims description 8
- 238000004148 unit process Methods 0.000 claims 1
- 238000004364 calculation method Methods 0.000 description 12
- 238000013016 damping Methods 0.000 description 6
- 238000010586 diagram Methods 0.000 description 5
- 238000004904 shortening Methods 0.000 description 5
- 230000008859 change Effects 0.000 description 3
- 230000000694 effects Effects 0.000 description 2
- 230000008901 benefit Effects 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 238000007689 inspection Methods 0.000 description 1
- 238000011835 investigation Methods 0.000 description 1
- 230000007246 mechanism Effects 0.000 description 1
- 230000009467 reduction Effects 0.000 description 1
- 239000004065 semiconductor Substances 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B11/00—Automatic controllers
- G05B11/01—Automatic controllers electric
- G05B11/36—Automatic controllers electric with provision for obtaining particular characteristics, e.g. proportional, integral, differential
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B19/00—Programme-control systems
- G05B19/02—Programme-control systems electric
- G05B19/18—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form
- G05B19/404—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form characterised by control arrangements for compensation, e.g. for backlash, overshoot, tool offset, tool wear, temperature, machine construction errors, load, inertia
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/41—Servomotor, servo controller till figures
- G05B2219/41128—Compensate vibration beam, gantry, feedback of speed of non driven end
Definitions
- the present invention relates to a motor control technique.
- the vibration suppression control is one of adjustment elements of the motor control system, and a technique of optimally and automatically adjusting the vibration suppression control in a short time without intervention of human contributes to shortening tact time and improving productivity.
- Means for performing an automatic adjustment of vibration suppression control has been proposed in Patent Document 1.
- Patent Document 1 discloses a technique of automatically adjusting vibration suppression control when a plurality of vibrations caused by mechanical resonance are observed from a response of a motor and vibration occurs at a machine end in a motor control system.
- the motor control system includes an estimation signal calculation unit that extracts a single vibration from the plurality of superimposed vibrations observed from the response of the motor; a resonance characteristic estimation calculation unit that identifies vibration characteristics (frequency and the like) based on the extracted single vibration; a feedforward control unit that suppresses vibration of the machine end occurring due to a plurality of the mechanical resonances; and a vibration suppression control setting unit that adjusts the feedforward control unit that is a vibration suppression control unit, based on the identified vibration characteristics.
- An automatic adjustment of vibration suppression control is performed by causing the estimation signal calculation unit to extract a single vibration in a predetermined order from a plurality of vibrations that have occurred and been observed when a machine is driven in a predetermined drive pattern, by causing the resonance characteristic estimation calculation unit to identify vibration characteristics of the extracted single vibration, and by causing the vibration suppression control setting unit to adjust the feedforward control unit based on the vibration characteristics identified by the vibration suppression control setting unit, and to iteratively execute adjustment in a predetermined drive pattern until identification is completed for all individuals of the plurality of vibrations.
- Patent Document 1 WO 2012/056868 A
- Patent Document 1 until the plurality of vibrations are excited in a predetermined drive pattern, and identification is completed for all vibration characteristics of the plurality of vibrations, the vibration suppression control setting unit needs to iteratively adjust the feedforward control unit that is a vibration suppression control unit, in the predetermined drive pattern, so that the adjustment takes time, which is a problem.
- An object of the present invention is to provide a motor control device that adjusts a vibration suppression control unit in a short time and in real time to suppress vibration of a machine end when vibration caused by mechanical resonance is observed from a response of a motor and vibration occurs at the machine end.
- a motor control device includes: a vibration extraction filter that extracts a plurality of vibrations that are superimposed in a response of a motor control system due to a plurality of mechanical resonances, from a rotation speed response or a rotation position response of a motor; a sequential frequency estimation unit that sequentially estimates a frequency of each of the plurality of vibrations obtained from the vibration extraction filter, one by one, and that outputs a frequency estimation result as estimated frequency value series; a vibration suppression control unit that processes a command to be input to the motor control system, so as to suppress vibration occurring at an end portion of a machine attached to the motor; and a vibration suppression control designing unit that adjusts the vibration suppression control unit based on the estimated frequency value series.
- the vibration suppression control unit it is possible to automatically suppress vibration of the machine end by adjusting the vibration suppression control unit in a short time and in real time.
- Fig. 1 is a diagram showing a configuration when an automatic adjustment unit 2 of the first embodiment is applied to a general motor FB control system having a semi-closed configuration.
- a general motor FB control system that does not include the automatic adjustment unit 2
- an operation amount of a FB controller 13 is provided to a motor 14, and a control target machine 15 is controlled such that a deviation between a command r(t) and an output y(t) of the motor 14 is zero.
- the output y(t) is a motor rotation position
- the motor rotation position is measured using a sensor (for example, encoder)
- a deviation between the motor rotation position and the rotation position command r(t) is calculated by an adder-subtractor 16
- the FB controller 13 processes the deviation as a positional deviation.
- a device that drives the motor 14 inverter or the like
- a controller that controls a speed or a current of the motor 14 is provided in a preceding stage of the motor 14, and these components are not shown in Fig. 1 .
- an end portion of the machine (hereinafter, referred to as a machine end) may vibrate at a low frequency of several Hz to 100 HZ due to a resonance and anti-resonance characteristic of the machine, and it may take time to perform positioning.
- a vibration suppression control unit 5 is used for the purpose of suppressing vibration of the machine end and of shortening the positioning time.
- the vibration suppression control unit 5 processes the rotation position command r(t) to be input to the motor control system, so as to suppress vibration of the machine end attached to the motor.
- the vibration suppression control unit 5 is a notch filter (hereinafter, referred to as an actual notch filter), and a frequency characteristic of the actual notch filter is shown in Fig. 2 .
- an actual notch filter By causing a notch frequency of the actual notch filter to coincide with a frequency of vibration of the machine end, a frequency component that excites vibration of the machine end can be removed from the rotation position command r(t), and the vibration suppression control unit 5 can generate a rotation position command rs(t) that does not excite vibration of the machine end, by processing the rotation position command r(t).
- a plurality of vibrations having different frequencies may be superimposed in a response of the machine end due to a plurality of resonance and anti-resonance characteristics of the machine.
- each vibration generally has a different vibration amplitude or damping time due to each resonance and anti-resonance characteristic.
- vibration of the machine end can be suppressed by applying an actual notch filter to each vibration.
- the actual notch filters are provided in multiple stages, a delay of the rotation position command r(t) increases, which may consequently not lead to shortening of the positioning time.
- the vibration suppression control unit 5 may adopt other vibration suppression control means based on a control target model, instead of the actual notch filter. Incidentally, even when the other vibration suppression control means is adopted, it is necessary to know at least the frequency of vibration of the machine end.
- the automatic adjustment unit 2 automatically adjusts the vibration suppression control unit 5 without prior information about the control target machine 15, and includes a sequential frequency estimation unit 3, a vibration suppression control designing unit 4, the vibration suppression control unit 5, and a vibration extraction filter 6.
- the automatic adjustment unit 2 is intended to suppress vibration of a low frequency of several Hz to 100 Hz at the machine end, and does not suppress vibration of a frequency of 100 [Hz] or more at the machine end.
- the vibration extraction filter 6 extracts a plurality of vibrations that are superimposed in a response of the motor control system due to a plurality of mechanical resonances, from a rotation speed response or a rotation position response of the motor.
- the vibration extraction filter 6 plays a role of removing a normal response component of the rotation position response y(t), and of extracting and outputting only a vibration component related to vibration of the machine end, as yd(t).
- the vibration extraction filter 6 is a bandpass filter that passes signals only in a predetermined frequency band of fL to fH.
- the vibration extraction filter 6 may be a combination of a high-pass filter and a low-pass filter.
- the vibration extraction filter 6 is designed to have a sufficiently wide frequency band of fL to fH, so as to be able to extract the plurality of vibrations. As a result, the plurality of vibrations are observed as yd(t).
- the sequential frequency estimation unit 3 sequentially estimates a frequency of each of the plurality of vibrations yd(t) obtained from the vibration extraction filter 6, one by one, and outputs a frequency estimation result as estimated frequency value series f(k) that are one-dimensional point sequence data.
- yd(t) is observed as two types of vibrations being superimposed, the vibrations being formed of vibration yd1(t) having a frequency of f1, a maximum vibration amplitude value of M1, and a vibration continuation time of T1 and vibration yd2(t) having a frequency of f2, a maximum vibration amplitude value of M2, and a vibration continuation time of T2 (here, f1 ⁇ f2 ⁇ 100 [Hz]).
- the sequential frequency estimation unit 3 includes a notch filter 31 as a vibration removal unit that removes only a predetermined frequency component; an adaptive notch filter 34 as an adaptive estimation unit that sequentially estimates frequencies of the vibrations from a vibration waveform and that sequentially outputs estimation values as frequency estimation value signals; a vibration detection unit 32; and a convergence determination unit 33 that determines whether or not the frequency estimation value signals have converged and that outputs frequency estimation values of the frequency estimation value signals when it is determined that the frequency estimation value signals have converged, as the estimated frequency value series.
- the notch filter 31 has the frequency characteristic shown in Fig. 2 , and a notch frequency Nf [Hz] of the notch filter 31 changes a frequency component to be removed based on the estimated frequency value series f(k) [Hz] output by the convergence determination unit 33.
- the notch filter 31 removes only a frequency component of the notch frequency Nf [Hz] from the plurality of vibrations yd(t), and outputs a signal obtained by removing the frequency component of the notch frequency Nf from the plurality of vibrations yd(t), as residual vibration yr(t).
- the notch frequency Nf [Hz] of the notch filter 31 is set to a value that is sufficiently larger than 100 [Hz] as an upper limit of a band of vibration suppression of the machine end which the vibration suppression control unit is responsible for, and accordingly, both vibrations of the frequencies f1 and f2 are output as the residual vibrations yr(t) without being removed by the notch filter 31.
- the notch frequency Nf [Hz] is set to a value sufficiently larger than 100 [Hz], and returns to the initial state.
- the vibration detection unit 32 determines that vibration is detected, when vibration continues with a predetermined amplitude or more for a predetermined time or more is observed in the residual vibration yr(t), and otherwise, determines that no vibration is detected.
- the adaptive notch filter 34 and the convergence determination unit 33 operate only when the vibration detection unit 32 has determined that vibration is detected.
- the adaptive notch filter 34 sequentially estimates frequencies of main vibration of the residual vibration yr(t).
- the adaptive notch filter 34 having a notch filter and an adaptive algorithm uses the following (Equation 1) and (Equation 2) that are good in calculation cost.
- Adaptive algorithm [Equation 2] a t + 1 a t ⁇ ⁇ a t ⁇ L e t ⁇ sgn x t ⁇ 1
- a(t) is a notch frequency (here, the unit is not [Hz])
- rL is a notch width
- ⁇ is an update gain for adjusting an update amount
- L(Y) indicates a limiter process for Y
- sgn indicates a sign function
- x(t) indicates a notch filter state
- e(t) indicates a notch filter output.
- the adaptive notch filter 34 includes a notch filter expressed by (Equation 1), and the adaptive algorithm of (Equation 2) adaptively adjusts a notch frequency a(t) of the notch filter of (Equation 1).
- the adaptive algorithm of (Equation 2) iteratively operates such that the notch filter of (Equation 1) removes main vibration of the residual vibration yr(t) that is an input, and a(t) when the main vibration of the residual vibration yr(t) has been completely removed by the notch filter of (Equation 1) is a frequency of the main vibration.
- the adaptive notch filter 34 is sequential frequency estimation means for the residual vibration yr(t), and a(t) is a frequency estimation value signal for the residual vibration yr(t).
- a(t) has a nonlinear characteristic with respect to frequency [Hz], and shows strong nonlinearity particularly when a(t) is in a low range of 100 [Hz] or less.
- the lower range the frequency is in the smaller an absolute value of a change amount of a(t) per absolute value of a unit frequency change amount [Hz] tends to become. Therefore, if the update gain ⁇ is constant when the low range is estimated, the update gain is too large, the adaptive algorithm of (Equation 2) vibrates and does not reach convergence, which is a problem.
- the update gain is ⁇ (a(t)) and is changed according to the frequency estimation value signal.
- a1 is a design frequency and ⁇ a is a basic update gain.
- Equation 3 may be implemented to hold data of ⁇ and a(t) in a tabular form such as a map for the reduction of calculation cost.
- ⁇ (a(t)) may be another function having an effect similar to that of (Equation 3).
- the notch filter of (Equation 1) can be regarded as having completely removed the main vibration of the residual vibration yr(t), and it can be determined that the frequency of the main vibration of the residual vibration yr(t) has been completely estimated.
- Means for determining whether or not the frequency estimation value signal a(t) has converged is the convergence determination unit 33.
- the convergence determination unit 33 receives the frequency estimation value signal a(t) to determine whether or not a(t) has converged.
- the frequency estimation value signal a(t) has a nonlinear characteristic with respect to frequency [Hz]
- the convergence determination unit 33 includes conversion means for converting a(t) into units of frequency [Hz], and accordingly, a(t) is converted into f(t) [Hz]. Therefore, the convergence determination unit 33 determines whether or not a(t) has converged, based on f(t) [Hz].
- Fig. 4 shows a mode of the calculation of the estimated frequency value series f(k) in the sequential frequency estimation unit 3.
- the sequential frequency estimation unit 3 of the present embodiment is characterized in being able to preferentially and alternately estimate frequencies of main vibration at high speed even when one or more damping vibrations are superimposed and observed as yd(t).
- the vibration system is a two-vibration system at 0 to T1, but is a onevibration system at T1 to T2, and the order of the vibration system changes at the unknown damping (continuation) times T1 and T2, which is a time deformation identification problem.
- the sequential frequency estimation unit 3 has an advantage of being able to appropriately estimate frequencies of vibrations at high speed even when the damping (continuation) time and the number of superimposed vibrations are unknown.
- the vibration suppression control designing unit 4 adjusts the vibration suppression control unit 5 based on the estimated frequency value series.
- the vibration suppression control designing unit 4 performs unsupervised clustering.
- a distance between centers of gravity of the clusters is a predetermined value or less, the clusters are merged together.
- Fig. 5 shows the process of the vibration suppression control designing unit 4 for the f(k) shown in Fig. 4 .
- a cluster 1 is formed of f(1), f(2), and f(5)
- a cluster 2 is formed of f(3) and f(4), and since the number of the clusters is 2, the number N of superimpositions of vibrations is 2, and a frequency of each vibration is each of average values (f (1) + f(2) + f(5))/3 and (f(3) + f(4))/2 of the clusters.
- the vibration suppression control designing unit 4 adopts the following algorithm when the number N of superpositions of vibrations is 1 to 2, in addition to adopting the unsupervised clustering described above.
- the following algorithm is characterized in having good processing cost compared to the k-means method.
- S1 An average value Ma of point cloud data is calculated, and two clusters C1 and C2 are generated depending on the magnitude of Ma.
- the predetermined adjustment time of the automatic adjustment unit 2 may be only the time it takes to perform one operation of the control target machine 15.
- the time required for a plurality of operations of the control target machine 15 may be set as the predetermined adjustment time of the automatic adjustment unit 2.
- the vibration suppression control setting unit causes the feedforward control unit that is a vibration suppression control unit to iteratively adjust a plurality of resonance characteristics.
- the vibration suppression control unit 5 in the initial state where the adjustment of the vibration suppression control unit is started, the vibration suppression control unit 5 does not process command to be input to the motor control system, and after the vibration suppression control designing unit 4 has completed the adjustment of the vibration suppression control unit 5 based on the estimated frequency value series, the vibration suppression control unit 5 starts processing of the command to be input to the motor control system.
- the automatic adjustment unit 2 has the motor rotation position y(t) as an input, but from the viewpoint of the ease of extracting a vibration component, a motor rotation position deviation, an output of the FB controller 13, a motor rotation speed deviation, an output of a speed FB controller, a motor rotation speed response, or the like may be used as an input to the automatic adjustment unit 2.
- a width of the actual notch filter may be variable based on the magnitude of a variance of clusters generated by the vibration suppression control designing unit 4. The reason is that when the variance of the clusters is large, expecting the accuracy of frequency estimation values is considered to be difficult, so that it may be effective to set the width of the actual notch filter to a large value to remove a wide range of frequency components.
- a plurality of stages of the notch filters 31 may be configured to be arranged in series, and the estimated frequency value series f(k) may be appropriately applied to each notch frequency. Accordingly, even when the superposition of a large number of vibrations is observed from yd(t), the accuracy of estimation of frequencies cannot be expected. However, in this case, attention is paid to the point that a process of managing which notch filter f(k) is applied is separately required.
- the automatic adjustment unit 2 may have a function of adjusting a gain of the FB controller 13. The reason is that when the vibration suppression control unit 5 is adjusted by the automatic adjustment unit 2 and the adjustment is effective, vibration of the machine end is suppressed, and even in the case of a higher FB control gain, the machine end can be controlled and positioned without occurrence of vibration.
- the motor control device including the automatic adjustment unit 2, the adder-subtractor 16, and the FB controller 13 in Fig. 1 includes a central processing unit (CPU) that is not shown.
- the CPU reads out a program and executes the program, so that the automatic adjustment unit 2, the adder-subtractor 16, and the FB controller 13 including processing units of the vibration extraction filter 6, the sequential frequency estimation unit 3, the vibration suppression control designing unit 4, and the vibration suppression control unit 5 execute processes of the processing units.
- All or some of the processing units can be configured as hardware such as an application specific integrated circuit (ASIC) or a field programmable gate array (FPGA).
- ASIC application specific integrated circuit
- FPGA field programmable gate array
- the vibration suppression control unit in the motor FB control system having a semi-closed configuration, when vibration occurs at the machine end, it is not necessary to identify particularly the number of the mechanical resonances in advance, and it is possible to suppress vibration of the machine end by adjusting the vibration suppression control unit in a short time and in real time.
- a second embodiment is an example in which the first embodiment is applied to a motor control device. Description of the same items as in the first embodiment will not be repeated.
- the second embodiment is an embodiment in which the automatic adjustment unit 2 shown in Fig. 1 is applied to a semi-closed position FB control system of an AC servomotor, as an automatic adjuster 622.
- a system in which the automatic adjuster 622 is not included in Fig. 6 is a generally known semi-closed position FB control system.
- the semi-closed position FB control system of the AC servomotor includes an adder-subtractor 612; an adder-subtractor 614; a position controller 61; a speed controller 62; a current controller 63; a first coordinate converter 64 that converts coordinates from a d-q coordinate system to a 3-phase coordinate system; a second coordinate converter 610 that converts coordinates from the 3-phase coordinate system to the d-q coordinate system; a PWM output unit 65 to which a 3-phase voltage command is input and which outputs a PWM pulse; an inverter (power converter) 66 including a switching element; a current detector 68; a position and speed calculation unit 611; the automatic adjuster 622; and encoder 69 that measures the number of rotations of a motor; a motor 67; and a machine 613 to be driven by the motor.
- a motor rotation position or a motor rotation speed 616 calculated by the position and speed calculation unit 611 that calculates rotation position and speed of the motor from an output of the encoder 69 is input to the automatic adjuster 622.
- the vibration suppression control unit 5 of the automatic adjuster 622 processes a rotation position command 615 so as not to excite vibration of an end portion of the machine 613 (machine end), and outputs a processed rotation position command 617, and the automatic adjuster 622 plays a role of automatically adjusting the vibration suppression control unit 5 as appropriate based on the motor rotation position 616.
- the processed rotation position command 617 output from the automatic adjuster 622, and the motor rotation position 616 from the position and speed calculation unit 611 are input to the adder-subtractor 614, and a difference between the processed rotation position command 617 and the motor rotation position 616 is input to the position controller 61 as a position command.
- the position controller 61 outputs a speed command 618, and the adder-subtractor 612 does not output a difference between the speed command 618 and a motor rotation speed 619 to the speed controller 62.
- the position controller 61 uses the processed rotation position command 617 as a command, and executes position FB control on a speed and current control system of a minor loop system and an integral element as control targets.
- a control target machine can be regarded as being a two-inertia system in which the machine 613 and the rotor of the motor are coupled to each other by a spring and a damper, and the control target machine has a frequency characteristic including one set of resonance and anti-resonance characteristics.
- a control target machine can be regarded as being a threeinertia system, and has a frequency characteristic including two sets of resonance and anti-resonance characteristics.
- An example of such a system is a case where a servomotor mechanism having two inertias in which inertia bodies move is installed on a frame having low rigidity, or the like.
- the automatic adjuster 622 does not require in-advance investigation on the resonance and anti-resonance characteristic of the machine, and can suppress vibration of the machine end by automatically adjusting the vibration suppression control unit 5 in a short time and in real time as appropriate, even when the machine end vibrates and a plurality of vibrations are observed as being superimposed in a response of the motor control system. Therefore, even in the present embodiment, similarly to the first embodiment, the automatic adjuster 622 can suppress vibration of the machine end by automatically adjusting the vibration suppression control unit 5 in a short time and in real time as appropriate.
- the automatic adjuster 622 is provided, it is not necessary to identify particularly the number of the mechanical resonances in advance. Further, according to the present embodiment, it is possible to suppress vibration of the machine ends by automatically adjusting the vibration suppression control unit 5 in a short time and in real time as appropriate.
- the automatic adjuster 622 can also be applied to a semi-closed speed FB control system of the AC servomotor.
- the position controller 61 of Fig. 6 is removed. The reason is that even in the speed FB control system, vibrations caused by resonance and anti-resonance characteristics of one or more control target machines can be observed from a speed response 716 and vibration of machine ends can occur.
- the vibration suppression control unit 5 of the automatic adjuster 622 processes a speed command 715 so as not to excite vibration of the end portion of the machine 613 (machine end), and outputs a processed speed command 717.
- the adder-subtractor 612 outputs a difference between the processed speed command 717 and the motor rotation speed 716 from the position and speed calculation unit 611, to the speed controller 62.
- the automatic adjuster 622 can also automatically adjust the vibration suppression control unit 5 as shown in the first embodiment, using the speed response 716. Accordingly, even in the semi-closed speed FB control system of the AC servomotor shown in Fig. 7 , since the automatic adjuster 622 is provided, it is not necessary to identify particularly the number of the mechanical resonances in advance.
- the vibration suppression control unit in the semi-closed position FB control system of the AC servomotor or in the semi-closed speed FB control system of the AC servomotor, when vibration occurs at the machine end, it is not necessary to identify particularly the number of the mechanical resonances in advance, and it is possible to suppress vibration of the machine end by adjusting the vibration suppression control unit in a short time and in real time.
- the present invention can be applied to, for example, a semiconductor inspection device, a main motor control device for an electric vehicle, an electric power steering, and the like, in addition to the motor control device.
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Human Computer Interaction (AREA)
- Manufacturing & Machinery (AREA)
- Control Of Electric Motors In General (AREA)
- Feedback Control In General (AREA)
Abstract
Description
- The present invention relates to a motor control technique.
- In recent years, in the FA field, it is desirable that productivity is improved by optimally adjusting a motor control system and by shortening tact time. In a motor control system having a semi-closed configuration intended to control a control target machine, when rigidity of the machine attached to a motor is low, generally, an end portion of the machine (hereinafter, referred to as a machine end) vibrates at a low frequency of several Hz to 100 Hz due to a resonance and anti-resonance characteristic of the machine, and it takes time to perform positioning, and tact time cannot be shortened, which is a problem. In such a case, generally, vibration suppression control is used.
- The vibration suppression control is one of adjustment elements of the motor control system, and a technique of optimally and automatically adjusting the vibration suppression control in a short time without intervention of human contributes to shortening tact time and improving productivity. Means for performing an automatic adjustment of vibration suppression control has been proposed in
Patent Document 1. -
Patent Document 1 discloses a technique of automatically adjusting vibration suppression control when a plurality of vibrations caused by mechanical resonance are observed from a response of a motor and vibration occurs at a machine end in a motor control system. - Specifically, the motor control system includes an estimation signal calculation unit that extracts a single vibration from the plurality of superimposed vibrations observed from the response of the motor; a resonance characteristic estimation calculation unit that identifies vibration characteristics (frequency and the like) based on the extracted single vibration; a feedforward control unit that suppresses vibration of the machine end occurring due to a plurality of the mechanical resonances; and a vibration suppression control setting unit that adjusts the feedforward control unit that is a vibration suppression control unit, based on the identified vibration characteristics. An automatic adjustment of vibration suppression control is performed by causing the estimation signal calculation unit to extract a single vibration in a predetermined order from a plurality of vibrations that have occurred and been observed when a machine is driven in a predetermined drive pattern, by causing the resonance characteristic estimation calculation unit to identify vibration characteristics of the extracted single vibration, and by causing the vibration suppression control setting unit to adjust the feedforward control unit based on the vibration characteristics identified by the vibration suppression control setting unit, and to iteratively execute adjustment in a predetermined drive pattern until identification is completed for all individuals of the plurality of vibrations.
- Patent Document 1:
WO 2012/056868 A - In
Patent Document 1, until the plurality of vibrations are excited in a predetermined drive pattern, and identification is completed for all vibration characteristics of the plurality of vibrations, the vibration suppression control setting unit needs to iteratively adjust the feedforward control unit that is a vibration suppression control unit, in the predetermined drive pattern, so that the adjustment takes time, which is a problem. - An object of the present invention is to provide a motor control device that adjusts a vibration suppression control unit in a short time and in real time to suppress vibration of a machine end when vibration caused by mechanical resonance is observed from a response of a motor and vibration occurs at the machine end.
- As a preferred example of the present invention, a motor control device includes: a vibration extraction filter that extracts a plurality of vibrations that are superimposed in a response of a motor control system due to a plurality of mechanical resonances, from a rotation speed response or a rotation position response of a motor; a sequential frequency estimation unit that sequentially estimates a frequency of each of the plurality of vibrations obtained from the vibration extraction filter, one by one, and that outputs a frequency estimation result as estimated frequency value series; a vibration suppression control unit that processes a command to be input to the motor control system, so as to suppress vibration occurring at an end portion of a machine attached to the motor; and a vibration suppression control designing unit that adjusts the vibration suppression control unit based on the estimated frequency value series.
- According to the present invention, it is possible to automatically suppress vibration of the machine end by adjusting the vibration suppression control unit in a short time and in real time.
-
-
Fig. 1 is a diagram showing a first embodiment applied to a motor FB control system. -
Fig. 2 is a graph showing a frequency characteristic of a notch filter. -
Fig. 3 is a diagram showing a sequential frequency estimation unit. -
Fig. 4 is a graph showing the calculation of estimated frequency value series in the sequential frequency estimation unit. -
Fig. 5 is a graph showing a process of a vibration suppression control designing unit. -
Fig. 6 is a diagram showing the application of the first embodiment to a motor position FB control system. -
Fig. 7 is a diagram showing the application of the first embodiment to a motor speed FB control system. - Hereinafter, an embodiment will be described with reference to the drawings. Incidentally, in the drawings, components having a common function are denoted by the same reference sign, and a description thereof will not be repeated. In addition, hereinafter, ."feedback", "notch filter", "low-pass filter", "high-pass filter", and "bandpass filter" may be abbreviated as "FB", "NF", "LPF", "HPF", and "BPF", respectively.
-
Fig. 1 is a diagram showing a configuration when anautomatic adjustment unit 2 of the first embodiment is applied to a general motor FB control system having a semi-closed configuration. In a general motor FB control system that does not include theautomatic adjustment unit 2, an operation amount of aFB controller 13 is provided to amotor 14, and acontrol target machine 15 is controlled such that a deviation between a command r(t) and an output y(t) of themotor 14 is zero. - Specifically, the output y(t) is a motor rotation position, the motor rotation position is measured using a sensor (for example, encoder), a deviation between the motor rotation position and the rotation position command r(t) is calculated by an adder-
subtractor 16, and theFB controller 13 processes the deviation as a positional deviation. Incidentally, a device that drives the motor 14 (inverter or the like) or a controller that controls a speed or a current of themotor 14 is provided in a preceding stage of themotor 14, and these components are not shown inFig. 1 . - In the FB control system of
Fig. 1 , when rigidity of the machine attached to a rotating shaft of the motor is low, generally, an end portion of the machine (hereinafter, referred to as a machine end) may vibrate at a low frequency of several Hz to 100 HZ due to a resonance and anti-resonance characteristic of the machine, and it may take time to perform positioning. - In such a case, a vibration
suppression control unit 5 is used for the purpose of suppressing vibration of the machine end and of shortening the positioning time. The vibrationsuppression control unit 5 processes the rotation position command r(t) to be input to the motor control system, so as to suppress vibration of the machine end attached to the motor. - In the present embodiment, the vibration
suppression control unit 5 is a notch filter (hereinafter, referred to as an actual notch filter), and a frequency characteristic of the actual notch filter is shown inFig. 2 . By causing a notch frequency of the actual notch filter to coincide with a frequency of vibration of the machine end, a frequency component that excites vibration of the machine end can be removed from the rotation position command r(t), and the vibrationsuppression control unit 5 can generate a rotation position command rs(t) that does not excite vibration of the machine end, by processing the rotation position command r(t). - A plurality of vibrations having different frequencies may be superimposed in a response of the machine end due to a plurality of resonance and anti-resonance characteristics of the machine. Incidentally, each vibration generally has a different vibration amplitude or damping time due to each resonance and anti-resonance characteristic.
- When a plurality of vibrations are superimposed in a response of the machine end, vibration of the machine end can be suppressed by applying an actual notch filter to each vibration. When N vibrations having frequencies f1 to fN are superimposed at the machine end, N stages of actual notch filters of a notch frequency fk(k = 1 ... N) may be applied in series. However, when the actual notch filters are provided in multiple stages, a delay of the rotation position command r(t) increases, which may consequently not lead to shortening of the positioning time.
- In this case, for the purpose of shortening the positioning time, the vibration
suppression control unit 5 may adopt other vibration suppression control means based on a control target model, instead of the actual notch filter. Incidentally, even when the other vibration suppression control means is adopted, it is necessary to know at least the frequency of vibration of the machine end. - The
automatic adjustment unit 2 automatically adjusts the vibrationsuppression control unit 5 without prior information about thecontrol target machine 15, and includes a sequentialfrequency estimation unit 3, a vibration suppressioncontrol designing unit 4, the vibrationsuppression control unit 5, and avibration extraction filter 6. - Incidentally, in the present embodiment, the
automatic adjustment unit 2 is intended to suppress vibration of a low frequency of several Hz to 100 Hz at the machine end, and does not suppress vibration of a frequency of 100 [Hz] or more at the machine end. - The
vibration extraction filter 6 extracts a plurality of vibrations that are superimposed in a response of the motor control system due to a plurality of mechanical resonances, from a rotation speed response or a rotation position response of the motor. InFig. 1 , thevibration extraction filter 6 plays a role of removing a normal response component of the rotation position response y(t), and of extracting and outputting only a vibration component related to vibration of the machine end, as yd(t). - In the present embodiment, the
vibration extraction filter 6 is a bandpass filter that passes signals only in a predetermined frequency band of fL to fH. Incidentally, thevibration extraction filter 6 may be a combination of a high-pass filter and a low-pass filter. - When a plurality of vibrations are superimposed in a response of the machine end, a plurality of vibrations are also superimposed in the rotation position response y(t). The
vibration extraction filter 6 is designed to have a sufficiently wide frequency band of fL to fH, so as to be able to extract the plurality of vibrations. As a result, the plurality of vibrations are observed as yd(t). - The sequential
frequency estimation unit 3 sequentially estimates a frequency of each of the plurality of vibrations yd(t) obtained from thevibration extraction filter 6, one by one, and outputs a frequency estimation result as estimated frequency value series f(k) that are one-dimensional point sequence data. - In the present embodiment, for simplicity of description, yd(t) is observed as two types of vibrations being superimposed, the vibrations being formed of vibration yd1(t) having a frequency of f1, a maximum vibration amplitude value of M1, and a vibration continuation time of T1 and vibration yd2(t) having a frequency of f2, a maximum vibration amplitude value of M2, and a vibration continuation time of T2 (here, f1 < f2 ≤ 100 [Hz]).
- As shown in
Fig. 3 , the sequentialfrequency estimation unit 3 includes anotch filter 31 as a vibration removal unit that removes only a predetermined frequency component; anadaptive notch filter 34 as an adaptive estimation unit that sequentially estimates frequencies of the vibrations from a vibration waveform and that sequentially outputs estimation values as frequency estimation value signals; avibration detection unit 32; and aconvergence determination unit 33 that determines whether or not the frequency estimation value signals have converged and that outputs frequency estimation values of the frequency estimation value signals when it is determined that the frequency estimation value signals have converged, as the estimated frequency value series. - The
notch filter 31 has the frequency characteristic shown inFig. 2 , and a notch frequency Nf [Hz] of thenotch filter 31 changes a frequency component to be removed based on the estimated frequency value series f(k) [Hz] output by theconvergence determination unit 33. - The
notch filter 31 removes only a frequency component of the notch frequency Nf [Hz] from the plurality of vibrations yd(t), and outputs a signal obtained by removing the frequency component of the notch frequency Nf from the plurality of vibrations yd(t), as residual vibration yr(t). - In an initial state of the start of adjustment by the
automatic adjustment unit 2, the notch frequency Nf [Hz] of thenotch filter 31 is set to a value that is sufficiently larger than 100 [Hz] as an upper limit of a band of vibration suppression of the machine end which the vibration suppression control unit is responsible for, and accordingly, both vibrations of the frequencies f1 and f2 are output as the residual vibrations yr(t) without being removed by thenotch filter 31. - After the start of adjustment by the
automatic adjustment unit 2, the notch frequency Nf [Hz] of thenotch filter 31 is updated as Nf = f(k) each time that k of the estimated frequency value series f(k) (k = 1 ...) output by theconvergence determination unit 33 is updated. After the completion of adjustment by theautomatic adjustment unit 2, the notch frequency Nf [Hz] is set to a value sufficiently larger than 100 [Hz], and returns to the initial state. - The
vibration detection unit 32 determines that vibration is detected, when vibration continues with a predetermined amplitude or more for a predetermined time or more is observed in the residual vibration yr(t), and otherwise, determines that no vibration is detected. - The
adaptive notch filter 34 and theconvergence determination unit 33 operate only when thevibration detection unit 32 has determined that vibration is detected. - If one of two types of vibrations of yd(t) has an amplitude of 0 (for example, M2 = 0) and the notch frequency Nf [Hz] of the
notch filter 31 is f1, ideally, no vibration is observed from the residual vibration yr(t), and thevibration detection unit 32 determines that no vibration is detected. In this case, operations of theadaptive notch filter 34 and theconvergence determination unit 33 are not started. - The
adaptive notch filter 34 sequentially estimates frequencies of main vibration of the residual vibration yr(t). Theadaptive notch filter 34 having a notch filter and an adaptive algorithm uses the following (Equation 1) and (Equation 2) that are good in calculation cost.
□ Notch filter
[Equation 1]
□ Adaptive algorithm
[Equation 2] - Here, a(t) is a notch frequency (here, the unit is not [Hz]), rL is a notch width, µ is an update gain for adjusting an update amount, L(Y) indicates a limiter process for Y, sgn indicates a sign function, x(t) indicates a notch filter state, and e(t) indicates a notch filter output.
- The
adaptive notch filter 34 includes a notch filter expressed by (Equation 1), and the adaptive algorithm of (Equation 2) adaptively adjusts a notch frequency a(t) of the notch filter of (Equation 1). - Specifically, the adaptive algorithm of (Equation 2) iteratively operates such that the notch filter of (Equation 1) removes main vibration of the residual vibration yr(t) that is an input, and a(t) when the main vibration of the residual vibration yr(t) has been completely removed by the notch filter of (Equation 1) is a frequency of the main vibration.
- Therefore, it can be said that the
adaptive notch filter 34 is sequential frequency estimation means for the residual vibration yr(t), and a(t) is a frequency estimation value signal for the residual vibration yr(t). - Incidentally, a(t) has a nonlinear characteristic with respect to frequency [Hz], and shows strong nonlinearity particularly when a(t) is in a low range of 100 [Hz] or less. Specifically, the lower range the frequency is in, the smaller an absolute value of a change amount of a(t) per absolute value of a unit frequency change amount [Hz] tends to become. Therefore, if the update gain µ is constant when the low range is estimated, the update gain is too large, the adaptive algorithm of (Equation 2) vibrates and does not reach convergence, which is a problem.
-
- Here, a1 is a design frequency and µa is a basic update gain.
- When µa is an appropriate update gain at the design frequency a1, according to µ(a(t)) of (Equation 3), the update gain at the frequency a(t) < a1 is regarded as having the same magnitude as µa. Accordingly, it is possible to solve the problem that the adaptive algorithm of (Equation 2) vibrates and does not reach convergence at the frequency a(t) < a1.
- Incidentally, (Equation 3) may be implemented to hold data of µ and a(t) in a tabular form such as a map for the reduction of calculation cost. In addition, µ(a(t)) may be another function having an effect similar to that of (Equation 3).
- When a(t) of the
adaptive notch filter 34 converges, the notch filter of (Equation 1) can be regarded as having completely removed the main vibration of the residual vibration yr(t), and it can be determined that the frequency of the main vibration of the residual vibration yr(t) has been completely estimated. - Means for determining whether or not the frequency estimation value signal a(t) has converged is the
convergence determination unit 33. Theconvergence determination unit 33 receives the frequency estimation value signal a(t) to determine whether or not a(t) has converged. However, as described above, since the frequency estimation value signal a(t) has a nonlinear characteristic with respect to frequency [Hz], it is not easy to determine whether or not the convergence has occurred, based on a(t). - The
convergence determination unit 33 includes conversion means for converting a(t) into units of frequency [Hz], and accordingly, a(t) is converted into f(t) [Hz]. Therefore, theconvergence determination unit 33 determines whether or not a(t) has converged, based on f(t) [Hz]. - Specifically, when a change width of f(t) within a predetermined time is a predetermined value [Hz] or less, it is determined that a(t) has converged, f(t) at this time is set to a k-th (k = 1 ...) value and is held as f(k), and the convergence determination is continued sequentially. k is counted up each time it is determined that a(t) has converged, and the value is held as f(k), and as a result, the
convergence determination unit 33 outputs f(k) (k = 1 ... ) as estimated frequency value series. - The sequential
frequency estimation unit 3 is executed for a predetermined time from the start to the completion of adjustment by theautomatic adjustment unit 2, and the estimated frequency value series f(k) (k = 1 ...) for the predetermined time can be obtained from the sequentialfrequency estimation unit 3. -
Fig. 4 shows a mode of the calculation of the estimated frequency value series f(k) in the sequentialfrequency estimation unit 3. InFig. 4 , when the frequencies of the vibrations yd1(t) and yd2(t) are f1 = 10 and f2 = 20, respectively, and the sequentialfrequency estimation unit 3 operates during an adjustment time of theautomatic adjustment unit 2 for the vibration yd(t) in which both vibrations are superimposed, f(t) is shown by a dashed line, and the estimated frequency value series f(k) for which convergence determination is performed for f(t) is shown by a solid line. - In addition, in
Fig. 4 , each of yd1r(t) and yd2r(t) is shown in yr(t) = ydlr(t) + yd2r(t), which is an output of thenotch filter 31. - The frequency f1 of the vibration yd1(t) that a main vibration component of the vibration yd(t) at the convergence determination k = 1 and 2 is estimated by the
adaptive notch filter 34, and f(1) and f(2) are applied to thenotch filter 31. For this reason, at k = 1 and 2, the amplitude of ydlr(t) becomes small, and the main vibration component of the vibration yd(t) is yd2(t). - Accordingly, the frequency f2 of yd2(t) at k = 3 and 4 is estimated by the
adaptive notch filter 34, f(3) and f(4) are applied to thenotch filter 31, and the main vibration component of the vibration yd(t) is yd1(t). - The
adaptive notch filter 34 estimates a frequency of yd1(t) to obtain f(5), but k = more than 5, the vibration yd(t) is damped and no vibration occurs, so that thevibration detection unit 32 determines that no vibration is detected, and stops the operations of theadaptive notch filter 34 and theconvergence determination unit 33. - As described above, the sequential
frequency estimation unit 3 of the present embodiment is characterized in being able to preferentially and alternately estimate frequencies of main vibration at high speed even when one or more damping vibrations are superimposed and observed as yd(t). - When the vibration amplitude, the frequency, the damping (continuation) time, and the number of superimposed vibrations are unknown, it is not possible to always accurately estimate a frequency of each vibration using, for example, general identification means such as a sequential least square identification method. The reason is that, for example, in the case of yd(t) in which two types of the vibrations yd1 and yd2 are superimposed and of a damping time of T1 < T2, the vibration system is a two-vibration system at 0 to T1, but is a onevibration system at T1 to T2, and the order of the vibration system changes at the unknown damping (continuation) times T1 and T2, which is a time deformation identification problem.
- On the other hand, the sequential
frequency estimation unit 3 has an advantage of being able to appropriately estimate frequencies of vibrations at high speed even when the damping (continuation) time and the number of superimposed vibrations are unknown. - The vibration suppression
control designing unit 4 adjusts the vibrationsuppression control unit 5 based on the estimated frequency value series. In the present embodiment, the vibration suppressioncontrol designing unit 4 performs unsupervised clustering. - Specifically, the estimated frequency value series f(k) (k = 1 ...) obtained for a predetermined adjustment time of the
automatic adjustment unit 2 are regarded as point cloud data, unsupervised clustering such as a k-means method is executed on the estimated frequency value series f(k), the number of clusters obtained accordingly is set as the number N of superimposed vibrations, and an average value of each cluster is set as an estimation value fk (k = 1 ... N) of the frequency of each vibration. Incidentally, when a distance between centers of gravity of the clusters is a predetermined value or less, the clusters are merged together. - The vibration suppression
control designing unit 4 sends an output F such as the number N of superimposed vibrations and the estimation value fk (k = 1 ... N) of the frequency of each vibration to the vibrationsuppression control unit 5, and the vibrationsuppression control unit 5 provides N stages of actual notch filters having the notch frequency fk in series, so that the process of theautomatic adjustment unit 2 is completed. -
Fig. 5 shows the process of the vibration suppressioncontrol designing unit 4 for the f(k) shown inFig. 4 . Acluster 1 is formed of f(1), f(2), and f(5), and acluster 2 is formed of f(3) and f(4), and since the number of the clusters is 2, the number N of superimpositions of vibrations is 2, and a frequency of each vibration is each of average values (f (1) + f(2) + f(5))/3 and (f(3) + f(4))/2 of the clusters. - Incidentally, since the
notch filter 31 is disabled and the superimposition of vibrations is remarkable at f(1) immediately after the start of automatic adjustment, f(t) tends to have a low accuracy as a frequency estimation value. For this reason, a process of thinning out a first half of the estimated frequency value series f(k) (k = 1 ...) before clustering may be added. - It is considered that the vibration suppression
control designing unit 4 adopts the following algorithm when the number N of superpositions of vibrations is 1 to 2, in addition to adopting the unsupervised clustering described above. The following algorithm is characterized in having good processing cost compared to the k-means method. - S1: An average value Ma of point cloud data is calculated, and two clusters C1 and C2 are generated depending on the magnitude of Ma.
- S2: An average value Mc1 of C1 and an average value Mc2 of C2 are calculated, and Te = |Mc1 - Mc2| is calculated.
- S3: when Te is a predetermined value or more, the number N of superimposed vibrations = 2, and frequency estimation values of the vibrations are f1 = Mc1 and f2 = Mc2. When Te is less than the predetermined value, the number N of superimposed vibrations = 1, and a frequency estimation value of the vibration is f1 = Ma.
- If vibration is observed in yd(t) in one operation of the
control target machine 15, and the estimated frequency value series f(k) are obtained, the predetermined adjustment time of theautomatic adjustment unit 2 may be only the time it takes to perform one operation of thecontrol target machine 15. - In addition, when a large number of the estimated frequency value series f(k) (k = 1 ...) want to be acquired and the accuracy of estimation of frequencies of vibrations wants to be increased, the time required for a plurality of operations of the
control target machine 15 may be set as the predetermined adjustment time of theautomatic adjustment unit 2. - According to the present embodiment, when vibrations caused by resonance and anti-resonance characteristics of one or more control target machines are observed from a response of the motor control system, and vibration occurs at machine ends, it is not necessary to identify particularly the number of the mechanical resonances in advance.
- In
Patent Document 1, the vibration suppression control setting unit causes the feedforward control unit that is a vibration suppression control unit to iteratively adjust a plurality of resonance characteristics. According to the present embodiment, in the initial state where the adjustment of the vibration suppression control unit is started, the vibrationsuppression control unit 5 does not process command to be input to the motor control system, and after the vibration suppressioncontrol designing unit 4 has completed the adjustment of the vibrationsuppression control unit 5 based on the estimated frequency value series, the vibrationsuppression control unit 5 starts processing of the command to be input to the motor control system. In the present embodiment, it is possible to provide an automatic adjustment method for motor control in which vibration of the machine end can be suppressed by adjusting the vibrationsuppression control unit 5 in a short time and in real time, and a motor control device with theautomatic adjustment unit 2. - Incidentally, in the present embodiment, the
automatic adjustment unit 2 has the motor rotation position y(t) as an input, but from the viewpoint of the ease of extracting a vibration component, a motor rotation position deviation, an output of theFB controller 13, a motor rotation speed deviation, an output of a speed FB controller, a motor rotation speed response, or the like may be used as an input to theautomatic adjustment unit 2. - In addition, a width of the actual notch filter may be variable based on the magnitude of a variance of clusters generated by the vibration suppression
control designing unit 4. The reason is that when the variance of the clusters is large, expecting the accuracy of frequency estimation values is considered to be difficult, so that it may be effective to set the width of the actual notch filter to a large value to remove a wide range of frequency components. - In addition, a plurality of stages of the notch filters 31 may be configured to be arranged in series, and the estimated frequency value series f(k) may be appropriately applied to each notch frequency. Accordingly, even when the superposition of a large number of vibrations is observed from yd(t), the accuracy of estimation of frequencies cannot be expected. However, in this case, attention is paid to the point that a process of managing which notch filter f(k) is applied is separately required.
- In addition, the
automatic adjustment unit 2 may have a function of adjusting a gain of theFB controller 13. The reason is that when the vibrationsuppression control unit 5 is adjusted by theautomatic adjustment unit 2 and the adjustment is effective, vibration of the machine end is suppressed, and even in the case of a higher FB control gain, the machine end can be controlled and positioned without occurrence of vibration. - The motor control device including the
automatic adjustment unit 2, the adder-subtractor 16, and theFB controller 13 inFig. 1 includes a central processing unit (CPU) that is not shown. The CPU reads out a program and executes the program, so that theautomatic adjustment unit 2, the adder-subtractor 16, and theFB controller 13 including processing units of thevibration extraction filter 6, the sequentialfrequency estimation unit 3, the vibration suppressioncontrol designing unit 4, and the vibrationsuppression control unit 5 execute processes of the processing units. All or some of the processing units can be configured as hardware such as an application specific integrated circuit (ASIC) or a field programmable gate array (FPGA). - According to the present embodiment, in the motor FB control system having a semi-closed configuration, when vibration occurs at the machine end, it is not necessary to identify particularly the number of the mechanical resonances in advance, and it is possible to suppress vibration of the machine end by adjusting the vibration suppression control unit in a short time and in real time.
- A second embodiment is an example in which the first embodiment is applied to a motor control device. Description of the same items as in the first embodiment will not be repeated. As shown in
Fig. 6 , the second embodiment is an embodiment in which theautomatic adjustment unit 2 shown inFig. 1 is applied to a semi-closed position FB control system of an AC servomotor, as anautomatic adjuster 622. A system in which theautomatic adjuster 622 is not included inFig. 6 is a generally known semi-closed position FB control system. - As shown in
Fig. 6 , the semi-closed position FB control system of the AC servomotor includes an adder-subtractor 612; an adder-subtractor 614; aposition controller 61; aspeed controller 62; acurrent controller 63; a first coordinateconverter 64 that converts coordinates from a d-q coordinate system to a 3-phase coordinate system; a second coordinateconverter 610 that converts coordinates from the 3-phase coordinate system to the d-q coordinate system; aPWM output unit 65 to which a 3-phase voltage command is input and which outputs a PWM pulse; an inverter (power converter) 66 including a switching element; acurrent detector 68; a position andspeed calculation unit 611; theautomatic adjuster 622; andencoder 69 that measures the number of rotations of a motor; amotor 67; and amachine 613 to be driven by the motor. - A motor rotation position or a
motor rotation speed 616 calculated by the position andspeed calculation unit 611 that calculates rotation position and speed of the motor from an output of theencoder 69 is input to theautomatic adjuster 622. - The vibration
suppression control unit 5 of theautomatic adjuster 622 processes arotation position command 615 so as not to excite vibration of an end portion of the machine 613 (machine end), and outputs a processedrotation position command 617, and theautomatic adjuster 622 plays a role of automatically adjusting the vibrationsuppression control unit 5 as appropriate based on themotor rotation position 616. - The processed
rotation position command 617 output from theautomatic adjuster 622, and themotor rotation position 616 from the position andspeed calculation unit 611 are input to the adder-subtractor 614, and a difference between the processedrotation position command 617 and themotor rotation position 616 is input to theposition controller 61 as a position command. - The
position controller 61 outputs aspeed command 618, and the adder-subtractor 612 does not output a difference between thespeed command 618 and amotor rotation speed 619 to thespeed controller 62. - The
position controller 61 uses the processedrotation position command 617 as a command, and executes position FB control on a speed and current control system of a minor loop system and an integral element as control targets. - When the number of inertias of the
machine 613 is 1, and themachine 613 and a rotor of the motor are regarded as being elastically coupled to each other, a control target machine can be regarded as being a two-inertia system in which themachine 613 and the rotor of the motor are coupled to each other by a spring and a damper, and the control target machine has a frequency characteristic including one set of resonance and anti-resonance characteristics. - In addition, when the number of inertias of the
machine 613 is 2, and when it is regarded that both are elastically coupled to each other and one is elastically coupled to the rotor of the motor, or when each of two inertias of themachine 613 is regarded as being elastically coupled to the rotor of the motor, a control target machine can be regarded as being a threeinertia system, and has a frequency characteristic including two sets of resonance and anti-resonance characteristics. An example of such a system is a case where a servomotor mechanism having two inertias in which inertia bodies move is installed on a frame having low rigidity, or the like. - As shown in the first embodiment, the
automatic adjuster 622 does not require in-advance investigation on the resonance and anti-resonance characteristic of the machine, and can suppress vibration of the machine end by automatically adjusting the vibrationsuppression control unit 5 in a short time and in real time as appropriate, even when the machine end vibrates and a plurality of vibrations are observed as being superimposed in a response of the motor control system. Therefore, even in the present embodiment, similarly to the first embodiment, theautomatic adjuster 622 can suppress vibration of the machine end by automatically adjusting the vibrationsuppression control unit 5 in a short time and in real time as appropriate. - According to the present embodiment, in the semi-closed position FB control system of the AC servomotor shown in
Fig. 6 , even when vibrations caused by resonance and anti-resonance characteristics of one or more control target machines are observed from a response of the motor control system, and vibration occurs at machine ends, since theautomatic adjuster 622 is provided, it is not necessary to identify particularly the number of the mechanical resonances in advance. Further, according to the present embodiment, it is possible to suppress vibration of the machine ends by automatically adjusting the vibrationsuppression control unit 5 in a short time and in real time as appropriate. - Incidentally, as shown in
Fig. 7 , theautomatic adjuster 622 can also be applied to a semi-closed speed FB control system of the AC servomotor. InFig. 7 , theposition controller 61 ofFig. 6 is removed. The reason is that even in the speed FB control system, vibrations caused by resonance and anti-resonance characteristics of one or more control target machines can be observed from aspeed response 716 and vibration of machine ends can occur. - In
Fig. 7 , the vibrationsuppression control unit 5 of theautomatic adjuster 622 processes aspeed command 715 so as not to excite vibration of the end portion of the machine 613 (machine end), and outputs a processedspeed command 717. The adder-subtractor 612 outputs a difference between the processedspeed command 717 and themotor rotation speed 716 from the position andspeed calculation unit 611, to thespeed controller 62. - The
automatic adjuster 622 can also automatically adjust the vibrationsuppression control unit 5 as shown in the first embodiment, using thespeed response 716. Accordingly, even in the semi-closed speed FB control system of the AC servomotor shown inFig. 7 , since theautomatic adjuster 622 is provided, it is not necessary to identify particularly the number of the mechanical resonances in advance. - Further, even in the semi-closed speed FB control system of the AC servomotor of
Fig. 7 , it is possible to suppress vibration of the machine end by automatically adjusting the vibrationsuppression control unit 5 in a short time and in real time as appropriate. - According to the present embodiment, in the semi-closed position FB control system of the AC servomotor or in the semi-closed speed FB control system of the AC servomotor, when vibration occurs at the machine end, it is not necessary to identify particularly the number of the mechanical resonances in advance, and it is possible to suppress vibration of the machine end by adjusting the vibration suppression control unit in a short time and in real time.
- Incidentally, in the embodiments, the present invention can be applied to, for example, a semiconductor inspection device, a main motor control device for an electric vehicle, an electric power steering, and the like, in addition to the motor control device.
-
- 2
- Automatic adjustment unit
- 3
- Sequential frequency estimation unit
- 4
- Vibration suppression control designing unit
- 5
- Vibration suppression control unit
- 6
- Vibration extraction filter
- 13
- FB controller
- 14
- Motor
- 15
- Control target machine
- 31
- Notch filter
- 32
- Vibration detection unit
- 33
- Convergence determination unit
- 34
- Adaptive notch filter
Claims (11)
- A motor control device comprising:a vibration extraction filter that extracts a plurality of vibrations that are superimposed in a response of a motor control system due to a plurality of mechanical resonances, from a rotation speed response or a rotation position response of a motor;a sequential frequency estimation unit that sequentially estimates a frequency of each of the plurality of vibrations obtained from the vibration extraction filter, one by one, and that outputs a frequency estimation result as estimated frequency value series;a vibration suppression control unit that processes a command to be input to the motor control system, so as to suppress vibration occurring at an end portion of a machine attached to the motor; anda vibration suppression control designing unit that adjusts the vibration suppression control unit based on the estimated frequency value series.
- The motor control device according to claim 1,wherein the sequential frequency estimation unit includes a vibration removal unit that removes only a predetermined frequency component, an adaptive estimation unit that sequentially estimates frequencies of the vibrations from a vibration waveform, a convergence determination unit, and a vibration detection unit,the vibration removal unit processes the plurality of vibrations, and outputs a signal obtained by removing the predetermined frequency component from the plurality of vibrations, as a residual vibration signal,the adaptive estimation unit sequentially estimates frequencies of one main vibration of the residual vibration signal, and sequentially outputs frequency estimation values as frequency estimation value signals,the convergence determination unit determines whether or not the frequency estimation value signals have converged, and outputs frequency estimation values of the frequency estimation value signals when it is determined that the frequency estimation value signals have converged, as the estimated frequency value series,the vibration removal unit changes the predetermined frequency component to be removed, based on the estimated frequency value series, andthe vibration detection unit determines whether or not the vibration continuously occurs in the residual vibration signal, and causes the adaptive estimation unit and the convergence determination unit to operate when an occurrence of vibration is detected.
- The motor control device according to claim 1,
wherein the vibration suppression control designing unit handles a predetermined time portion of the estimated frequency value series as point cloud data, divides the point cloud data into a plurality of clusters using unsupervised clustering, sets the number of the divided clusters as the number of superimposed vibrations of the plurality of vibrations, estimates a frequency of each vibration of the plurality of vibrations from point cloud data belonging to each cluster, to set the frequency as a vibration frequency estimation value, and adjusts the vibration suppression control unit based on the number of superimposed vibrations and on the vibration frequency estimation value. - The motor control device according to claim 2,wherein the vibration removal unit is a notch filter,the adaptive estimation unit is an adaptive notch filter,the convergence determination unit sequentially receives the frequencies of one main vibration of the plurality of vibrations to be sequentially estimated by the adaptive notch filter, as the frequency estimation value signals, and outputs the estimated frequency value series, andthe notch filter changes a notch frequency of the notch filter based on the output estimated frequency value series.
- The motor control device according to claim 4,
wherein in an initial state where the adjustment of the vibration suppression control unit is started, the notch frequency of the notch filter is set to be equal to or more than an upper limit of a vibration suppression band of the end portion of the machine which the vibration suppression control unit is responsible for. - The motor control device according to claim 1,wherein in an initial state where the adjustment of the vibration suppression control unit is started, the vibration suppression control unit does not process the command to be input to the motor control system, andafter the vibration suppression control designing unit has completed the adjustment of the vibration suppression control unit based on the estimated frequency value series, the vibration suppression control unit starts processing the command to be input to the motor control system.
- The motor control device according to claim 3,wherein the point cloud data is divided into two clusters based on an average value of the point cloud data, and an average value of each cluster is calculated,when an absolute value of a difference between the calculated average values is a predetermined value or more, the number of superimposed vibrations is set to 2, and otherwise, is set to 1, andwhen the number of superimposed vibrations is 2, the average value of each cluster is set as the vibration frequency estimation value, and when the number of superimposed vibrations is 1, the average value of the point cloud data is set as the vibration frequency estimation value.
- The motor control device according to claim 4,
wherein when the adaptive notch filter sequentially estimates the frequencies, the adaptive notch filter causes an update gain in a sequential update of the frequency to be variable, based on a current frequency estimation value. - An automatic adjustment method for motor control, the method comprising:extracting a plurality of vibrations that are superimposed in a response of a motor control system due to a plurality of mechanical resonances, from a rotation speed response or a rotation position response of a motor;sequentially estimating a frequency of each of the plurality of extracted vibrations one by one, and outputting a frequency estimation result as estimated frequency value series; andprocessing a command to be input to the motor control system, so as to suppress vibration occurring at an end portion of a machine attached to the motor, by performing an adjustment based on the estimated frequency value series.
- The automatic adjustment method for motor control according to claim 9,wherein in an initial state, the command to be input to the motor control system is not processed, andafter the adjustment of the command based on the estimated frequency value series is completed, processing of the command to be input to the motor control system is started.
- The automatic adjustment method for motor control according to claim 9,
wherein the sequential one-by-one estimation of the frequency of each of the plurality of vibrations is executed by a combination of a notch filter, an adaptive notch filter, and a determination on convergence of the adaptive notch filter.
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2020149999A JP7390267B2 (en) | 2020-09-07 | 2020-09-07 | motor control device |
PCT/JP2021/025870 WO2022049896A1 (en) | 2020-09-07 | 2021-07-08 | Motor control device |
Publications (1)
Publication Number | Publication Date |
---|---|
EP4212968A1 true EP4212968A1 (en) | 2023-07-19 |
Family
ID=80491112
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
EP21863954.0A Pending EP4212968A1 (en) | 2020-09-07 | 2021-07-08 | Motor control device |
Country Status (5)
Country | Link |
---|---|
EP (1) | EP4212968A1 (en) |
JP (1) | JP7390267B2 (en) |
CN (1) | CN116194849A (en) |
TW (1) | TWI793692B (en) |
WO (1) | WO2022049896A1 (en) |
Family Cites Families (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP4329438B2 (en) * | 2003-07-17 | 2009-09-09 | 三菱電機株式会社 | Electric motor control device |
JP2009048462A (en) * | 2007-08-21 | 2009-03-05 | Mitsuba Corp | Mechanical resonance frequency compensation apparatus |
KR101402486B1 (en) | 2010-10-27 | 2014-06-03 | 미쓰비시덴키 가부시키가이샤 | Electric motor control device |
JP6041762B2 (en) * | 2013-07-09 | 2016-12-14 | 山洋電気株式会社 | Motor control device |
JP7346014B2 (en) * | 2018-07-25 | 2023-09-19 | 株式会社日立産機システム | Automatic adjustment method of feedback control system and feedback control device |
JP7178327B2 (en) | 2019-06-14 | 2022-11-25 | 株式会社日立産機システム | NOTCH FILTER ADJUSTMENT DEVICE AND MOTOR CONTROL DEVICE INCLUDING THE SAME |
-
2020
- 2020-09-07 JP JP2020149999A patent/JP7390267B2/en active Active
-
2021
- 2021-07-08 EP EP21863954.0A patent/EP4212968A1/en active Pending
- 2021-07-08 WO PCT/JP2021/025870 patent/WO2022049896A1/en unknown
- 2021-07-08 CN CN202180060997.8A patent/CN116194849A/en active Pending
- 2021-08-02 TW TW110128348A patent/TWI793692B/en active
Also Published As
Publication number | Publication date |
---|---|
TW202211613A (en) | 2022-03-16 |
JP2022044396A (en) | 2022-03-17 |
JP7390267B2 (en) | 2023-12-01 |
CN116194849A (en) | 2023-05-30 |
TWI793692B (en) | 2023-02-21 |
WO2022049896A1 (en) | 2022-03-10 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP4565034B2 (en) | Control device and control system for inertia estimation | |
US9124212B2 (en) | Load characteristic estimating apparatus for driving machine | |
US10041858B2 (en) | Dynamometer control device and method for estimating moment of inertia using same | |
US9525378B2 (en) | Motor control device | |
US8872462B2 (en) | Motor control device | |
EP4212968A1 (en) | Motor control device | |
EP3331153A1 (en) | Method of and system for controlling a permanent magnet motor | |
JP2013126342A (en) | Control device of motor | |
JP2008199759A (en) | Machine-model estimating device, and machine-model estimating method | |
JP4329438B2 (en) | Electric motor control device | |
JP4285057B2 (en) | Servo control device | |
US11569709B2 (en) | Motor drive device and servo adjustment method | |
JP5516682B2 (en) | Vibration control device for feedback control system and motor control device provided with vibration detection device | |
EP4102716A1 (en) | Motor control device | |
WO2023171122A1 (en) | Motor control device, and automatic adjustment method for same | |
KR102276198B1 (en) | Method and apparatus for controlling persistent oscillation of servo systems | |
WO2022138797A1 (en) | Vibration information calculating device, vibration information calculating method, and program | |
JP4567308B2 (en) | Collision detection method and collision detection apparatus | |
WO2023276198A1 (en) | Motor control device | |
JP4692266B2 (en) | Vibration suppression method | |
Aldag et al. | Automatic Notch Filter Width Tuning for Resonance Peaks in Gearless Servo Drives | |
CN118435518A (en) | Motor control device and automatic adjusting method thereof | |
JP2007147523A (en) | Motor controller and abnormality diagnostic method therefor | |
CN111404445A (en) | Servo amplifier and servo system | |
JP2023029255A (en) | Stiffness adjustment method of servo system, stiffness adjustment device of servo system, and servo system |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
STAA | Information on the status of an ep patent application or granted ep patent |
Free format text: STATUS: THE INTERNATIONAL PUBLICATION HAS BEEN MADE |
|
PUAI | Public reference made under article 153(3) epc to a published international application that has entered the european phase |
Free format text: ORIGINAL CODE: 0009012 |
|
STAA | Information on the status of an ep patent application or granted ep patent |
Free format text: STATUS: REQUEST FOR EXAMINATION WAS MADE |
|
17P | Request for examination filed |
Effective date: 20230317 |
|
AK | Designated contracting states |
Kind code of ref document: A1 Designated state(s): AL AT BE BG CH CY CZ DE DK EE ES FI FR GB GR HR HU IE IS IT LI LT LU LV MC MK MT NL NO PL PT RO RS SE SI SK SM TR |
|
RIN1 | Information on inventor provided before grant (corrected) |
Inventor name: TOBARI, KAZUAKI Inventor name: YANADA, TETSUO Inventor name: KONDO, TERUTOMO Inventor name: UEI, YUSUKE Inventor name: TAKANO, YUURI Inventor name: MATSUBARA, MITSURU |
|
RIN1 | Information on inventor provided before grant (corrected) |
Inventor name: TOBARI, KAZUAKI Inventor name: YANADA, TETSUO Inventor name: KONDO, TERUTOMO Inventor name: UEI, YUSUKE Inventor name: TAKANO, YUURI Inventor name: MATSUBARA, MITSURU |
|
DAV | Request for validation of the european patent (deleted) | ||
DAX | Request for extension of the european patent (deleted) |