The present invention relates to a speed control apparatus of a motor capable of properly setting a notch frequency of a notch filter.
A speed control apparatus of a motor rotates a motor and a load at a commanded speed given from a host controller by generating torque for accelerating or decelerating a speed of the motor according to a speed error.
Generally, as a value of a speed gain Kv multiplied by a speed error resulting in a difference between a speed command signal and a speed detection signal of a motor by speed control unit is set large, a speed of the motor is corrected at large acceleration with respect to the speed error, so that the speed error decreases in a short time and speed control with high accuracy can be performed.
However, when rigidity of a motor shaft for transmitting torque generated from the motor to a load is low, the value of the speed gain Kv cannot be increased and control accuracy becomes worse. That is, when the rigidity of the shaft is low, the shaft acts as a spring, so that mechanical vibration tends to occur. As a result of this, when the speed gain Kv is set large, the mechanical vibration increases with time and a control system may oscillate.
As unit for solving such a problem, a speed control apparatus of a motor in which a notch filter is inserted into a speed loop of the motor is disclosed in a publication of JP-A-60-39397.
According to the publication, a filter for eliminating only a particular frequency component from an input signal and producing an output is inserted into the speed loop and a frequency component of mechanical resonance is eliminated and thereby oscillation of a control system can be suppressed.
According to such a speed control apparatus of the motor, while suppressing the oscillation of the control system, a speed gain Kv can be set large and as a result, control with high accuracy can be achieved.
However, the motor speed control apparatus as described above is constructed so that resonance of a mechanical system does not occur by setting the notch filter so as to match a notch frequency with a known mechanical system resonance frequency. Then, in order to see the mechanical system resonance frequency, there are a method by calculation and a method by measurement, but there were problems that complicated calculation or a dedicated measuring device is required, respectively.
Thus, as a simple and easy method for matching the notch frequency with the mechanical system resonance frequency, an adaptive notch filter is proposed. The adaptive notch filter is described in, for example, “Analysis of State Characteristics of Adaptive IIR Digital Notch Filter” (Paper Journal of Institute of Electronics, Information and Communication Engineers, Vol. J81-A, No. 9). A block diagram of a speed control apparatus of a motor using an adaptive notch filter is shown in
Incidentally, an adaptive notch filter 20 includes the notch filter adaptive part 16 and the notch filter 14.
Contents of processing of the notch filter adaptive part 16 are described in the paper journal and basically, a notch frequency is adjusted so that an output of a ripple of the notch filter 14 decreases. When a control system becomes an oscillation state and the motor 4 and the load 2 vibrate at a resonance frequency, the vibration is detected by the encoder 6 and is inputted to the notch filter 14 through the speed detection part 8, the comparator 10 and the speed control part 12. When the notch frequency does not match with the resonance frequency of the control system, the notch filter 14 cannot suppress oscillation, so that mechanical resonance increases with time. As a result of that, a signal component of the resonance frequency is largely included in input of the notch filter 14 and becomes predominant. In the notch filter adaptive part 16, the signal component of the resonance frequency is largely included in the source current command signal Ia resulting in input of the notch filter 14, so that elimination of the frequency component leads to a decrease in output. As a result, the notch filter adaptive part 16 acts so as to approximate the notch frequency to the resonance frequency and finally, the notch frequency substantially matches with the resonance frequency.
The fact that oscillation of the control system is suppressed by the adaptive notch filter 20 will be described by simulation shown in
An open loop gain characteristic of a speed control system at the time when a notch filter is not inserted is shown in
Therefore, in an initial state, a notch frequency is set to 3000 Hz and using 3000 Hz as an initial value, the notch filter adaptive part 16 adjusts the notch frequency. Control is started from the time 0 and first, a resonance frequency does not match with a notch frequency, so that a control system becomes an oscillation state and a motor speed (speed detection signal) vibrates and the amplitude increases with time. In
However, in the case of well observing
As described above, in the case that adjustment of the notch frequency functions effectively, a signal component of the resonance frequency must continue to be inputted to the notch filter 14. However, when oscillation of the control system converges, vibration of the motor 4 also stops and the signal component of the resonance frequency is not included in a speed detection signal from the speed detection part 8. As a result of this, the signal component of the resonance frequency is not included in a source current command signal Ia resulting in input of the notch filter 14 and adjustment of the notch frequency by the notch filter adaptive part 16, that is, an adaptive operation does not proceed further. Finally, a notch frequency of 1770 Hz is obtained and a gain characteristic of the notch filter 14 at 1770 Hz is shown in
As shown in
The invention is implemented to solve the problem, and an object of the invention is to provide a speed control apparatus of a motor capable of accurately adjusting a notch frequency in a notch filter.
A speed control apparatus of a motor according to the invention is characterized by including a motor for driving a load, current command generation unit which generates a source current command signal capable of having a frequency component based on a difference between a speed command signal of the motor and a speed detection signal in which a speed of the motor is detected, notch filter unit which can break a notch frequency resulting in a predetermined frequency selected among continuous frequency band widths and also generates a compensating current command signal in which the notch frequency is eliminated from the source current command signal inputted, notch filter adjustment unit which selects the notch frequency so that the compensating current command signal in which a sustained vibration frequency component of the source current command signal is eliminated is generated from the notch filter unit, subtraction unit which generates an elimination portion current command signal resulting in a difference between the source current command signal and the compensating current command signal, addition unit which adds the compensating current command signal and the elimination portion current command signal and generating a current command signal passed through the motor, and current limit unit which limits a maximum value of the current command signal.
According to such a speed control apparatus of the motor, subtraction unit generates an elimination portion current command signal resulting in a difference between a source current command signal and a compensating current command signal, and addition unit adds the compensating current command signal and the elimination portion current command signal and generates a current command signal, and current limit unit limits a maximum value of the current command signal.
Therefore, the elimination portion current command signal is generated (produced) based on the source current command signal and the current command signal is produced by the elimination portion current command signal and the compensating current command signal, so that even if the compensating current command signal does not vibrate, the current command signal vibrates and a speed detection signal of the motor also vibrates and thereby the source current command signal also vibrates. Thus, vibration of the current command signal can be sustained, so that there is an effect of facilitating selection (adjustment) of a notch frequency of notch filter unit.
A speed control apparatus of a motor according to another invention is characterized by including limiter unit which inputs the elimination portion current command signal and generating a limit current signal while limiting a maximum value of the elimination portion current command signal instead of the current limit unit.
According to such a speed control apparatus of the motor, limiter unit can limit vibration of the elimination portion current command signal within a desired predetermined value, so that there is an effect capable of adjusting a notch frequency of a notch filter while suppressing vibration of the motor.
Notch filter adjustment unit in a speed control apparatus of a motor according to another invention is characterized by automatically adjusting the notch frequency so as to match with a sustained vibration frequency component of the source current command signal.
According to such a speed control apparatus of the motor, there is an effect capable of easily adjusting a notch frequency of a notch filter.
A speed control apparatus of a motor according to another invention is characterized by including oscillation decision unit which decides whether or not the compensating current command signal has oscillated and also generating a decision signal, and switch unit which turns on and off the limit current signal based on the decision signal and inputting the limit current signal to the addition unit.
According to such a speed control apparatus of the motor, oscillation decision unit decides that adjustment to a notch frequency is completed by a stop of oscillation and the limit current signal is turned off, so that there is an effect that the compensating current command signal results in a current command signal and vibration of the current command signal is not sustained.
a) to 2(d) are time charts by simulation of the speed control apparatus of the motor shown in
a) to 3(b) are time charts by simulation of the speed control apparatus of the motor shown in
a) to 4(c) are gain diagram of a speed control system in the case of adjusting a notch frequency of the speed control apparatus of the motor shown in
a) to 8(e) are time charts by simulation of each part in the speed control apparatus of the motor shown in
a) to 9(e) are time charts by simulation describing action of a limiter shown in
a) to 10(c) are gain diagrams of a speed control system in the case of adjusting a notch frequency of the speed control apparatus shown in
A speed control apparatus of a motor according to one embodiment of the invention will be described by
In
A sustained vibration maintenance part includes a subtracter 103 acting as subtraction unit which subtracts the compensating current command signal Ic from the source current command signal Ia and outputting an elimination portion current command signal Ir, a limiter 105 acting as limiter unit which inputs the elimination portion current command signal Ir and outputs a limit current command signal IL suppressed to a predetermined value or less, a vibration detection part 120 acting as oscillation decision unit in which it is decided whether or not the compensating current command signal Ic has vibrated (oscillated) and when it is decided that it has vibrated, an on signal is generated and when it is decided that it has not vibrated, an off signal is generated, an on-off part 107 acting as switch unit which switches on (closes) by the on signal of the vibration detection part 120 and switches off (opens) by the off signal, and an adder 109 acting as addition unit which adds the compensating current command signal Ic and the limit current command signal IL.
Here, the predetermined value of the limiter 105 is preferably a value in which a speed control system of the motor 4 maintains sustained vibration based on the elimination portion current command signal Ir and is the smallest possible value. This is because it is constructed so as not to cause excessive vibration to the motor 4 etc. while adjusting the notch frequency fn of the notch filter 14 by the sustained vibration. For example, the value is set to about several percent of rated current of the motor 4.
The vibration detection part 120, which decides whether or not the compensating current command signal Ic has vibrated, includes a rectification circuit 122 for rectifying the compensating current command signal Ic, a smoothing circuit 124 for smoothing an input signal after rectification by the rectification circuit 122, and a comparator 126 in which a smoothing value from the smoothing circuit 124 is compared with a reference value set by a reference value setting device 128 and thereby when the smoothing value is larger than the reference value, it is decided that the compensating current command signal Ic has vibrated and an on signal is generated and when smoothing value is smaller than the reference value, it is decided that the compensating current command signal Ic has not vibrated and an off signal is generated. Incidentally, both of the on signal and the off signal are called a switch signal.
Action of the speed control apparatus 101 constructed as described above will be described by
The speed control part 12 generates a source current command signal Ia and inputs the source current command signal Ia to the notch filter 14 and the notch filter adaptive part 16, and a compensating current command signal Ic is inputted from the notch filter 14 to the notch filter adaptive part 16. The notch filter adaptive part 16 generates a compensating current command signal Ic in which a notch frequency fn is automatically selected (adjusted) from continuous frequency band widths in the notch filter 14 so as to decrease a sustained vibration component of the compensating current command signal Ic.
The subtracter 103 obtains an elimination portion current command signal Ir resulting in a difference between the source current command signal Ia and the compensating current command signal Ic, and the elimination portion current command signal Ir is inputted to the limiter 105, and the limiter 105 outputs a limit current command signal IL.
The vibration detection part 120 decides whether or not the compensating current command signal Ic has oscillated (vibrated) as described above (step S101), and when it has vibrated, an on signal is generated and the on-off part 107 is turned on (step S103), and the adder 109 inputs a current command signal in which the limit current command signal IL and the compensating current command signal Ic are added to the current control part 18. The current control part 18 gives a torque command signal to the motor 4 and drives the motor 4 along with the load 2.
Next, the vibration detection part 120 decides whether or not the compensating current command signal Ic has vibrated (step S105), and when the vibration converges, it waits until predetermined time has elapsed (step S107), and an off signal is generated and the on-off part 107 is turned off (step S109). As a result of this, addition of the limit current command signal IL to the adder 109 is stopped and only the compensating current command signal Ic is inputted from the adder 109 to the current control part 18 as a current command signal and the motor 4 is driven.
That is, in the speed control apparatus 101 according to the present embodiment, the elimination portion current command Ir is changed to the limit current command IL through the limiter 105 and is added to the compensating current command signal Ic and a current command signal is obtained and thereby vibration is sustained. Therefore, even when the compensating current command signal Ic is not vibratory, the source current command signal Ia based on a difference between the speed command signal and the speed detection signal also vibrates. Since the source current command signal Ia vibrates, room to adjust the notch frequency fn of the notch filter 14 arises, so that adjustment accuracy of the notch frequency fn can be improved.
Next, action of the speed control apparatus 101 of the motor will be described on the basis of a simulation result shown in
When control of the speed control apparatus 101 is started from the time 0, a control system starts to oscillate. With this, the notch filter adaptive part 16 adjusts a notch frequency fn of the notch filter 14 (
When the vibration detection part 120 detects vibration at the time (0.02 second), the on-off part 107 is turned on (
According to the present embodiment, the elimination portion current command signal Ir passes through the limiter 105 and the limit current command signal IL is added to the compensating current command signal Ic and thereby the current command signal can be made to sustain vibration at a constant level. While the vibration is sustained, a vibration component of a resonance frequency continues to be inputted to the notch filter 14 as shown in
Further, action of the limiter 105 of the speed control apparatus 101 will be described in detail by
Since the output (
Also, amplitude of output of the limiter 105 is limited by a limit value, so that amplitude of vibration of the motor 4 does not increase excessively and is suppressed at a constant level. When the limit value is set to a small value, the amplitude of vibration of the motor 4 also decreases and application of an excessive load to the motor 4 or a machine is eliminated.
The final notch frequency fn is 1500 Hz as shown in
Here, it has been constructed so as to turn off the on-off part 107 after a lapse of predetermined time since vibration of the compensating current command signal Ic converged, but similar effect can also be obtained in the case of being constructed so as to turn off the on-off part 107 at the completion of adjusting the notch frequency fn. For that purpose, it could be constructed so that a change in the notch frequency fn adjusted by the notch filter adaptive part 16 is monitored and when the notch frequency fn does not change for predetermined time, it is considered that adjustment to the notch frequency fn is completed and the on-off part 107 is turned off.
Incidentally, in the speed control apparatus of the present embodiment, the limiter 105 has been provided, but the limiter 105 is not necessarily provided as long as there is a function of limiting a current command in the current control part 18 etc.
As described above, a speed control apparatus of a motor according to the invention is suitable to adjust a notch filter.
Filing Document | Filing Date | Country | Kind | 371c Date |
---|---|---|---|---|
PCT/JP02/12282 | 11/26/2002 | WO | 00 | 10/12/2004 |
Publishing Document | Publishing Date | Country | Kind |
---|---|---|---|
WO2004/049550 | 6/10/2004 | WO | A |
Number | Name | Date | Kind |
---|---|---|---|
5304905 | Iwasaki | Apr 1994 | A |
5404418 | Nagano | Apr 1995 | A |
5541488 | Bansal et al. | Jul 1996 | A |
5903129 | Okuno et al. | May 1999 | A |
6219196 | Semba et al. | Apr 2001 | B1 |
6274994 | Tsutsui | Aug 2001 | B1 |
6703809 | Royak et al. | Mar 2004 | B1 |
6844697 | Masaki et al. | Jan 2005 | B1 |
Number | Date | Country |
---|---|---|
60-039397 | Mar 1985 | JP |
6-78575 | Mar 1994 | JP |
11-18465 | Jan 1999 | JP |
11-96704 | Apr 1999 | JP |
11-123000 | Apr 1999 | JP |
2001-251880 | Sep 2001 | JP |
WO 0070739 | Nov 2000 | WO |
Number | Date | Country | |
---|---|---|---|
20050238335 A1 | Oct 2005 | US |