JP2020204823A - Notch filter adjuster, and motor control unit comprising the same - Google Patents
Notch filter adjuster, and motor control unit comprising the same Download PDFInfo
- Publication number
- JP2020204823A JP2020204823A JP2019111097A JP2019111097A JP2020204823A JP 2020204823 A JP2020204823 A JP 2020204823A JP 2019111097 A JP2019111097 A JP 2019111097A JP 2019111097 A JP2019111097 A JP 2019111097A JP 2020204823 A JP2020204823 A JP 2020204823A
- Authority
- JP
- Japan
- Prior art keywords
- resonance
- frequency
- notch filter
- value
- vibration
- 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.)
- Granted
Links
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
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Feedback Control In General (AREA)
- Control Of Electric Motors In General (AREA)
Abstract
Description
本発明は、モータ制御におけるノッチフィルタを調整する技術に関する。 The present invention relates to a technique for adjusting a notch filter in motor control.
近年、ＦＡ分野ではモータ制御系の導入時間の短縮、およびモータ制御系の最適調整によるタクトタイム短縮による生産性の向上が望まれている。モータ制御系の調整要素の一つは機械系の共振を抑制する制御手段のパラメータであり、これを人の介在なく短時間かつ最適に自動調整する技術が上述のニーズに対する一つの解決策に成り得る。 In recent years, in the FA field, it has been desired to shorten the introduction time of the motor control system and improve the productivity by shortening the tact time by optimally adjusting the motor control system. One of the adjustment elements of the motor control system is the parameter of the control means that suppresses the resonance of the mechanical system, and the technology for optimally and automatically adjusting this in a short time without human intervention is one solution to the above-mentioned needs. obtain.
一般的に、機械系の共振特性が原因でフィードバック制御器(以降、ＦＢ制御器と略記する場合がある)のゲインをあげられない場合があり、これの回避の目的でＦＢ制御器後段にノッチフィルタを介在させ、共振特性を相殺することが行われる。但しノッチフィルタのフィルタパラメータは、共振特性に対して適切に設定される必要がある。 In general, it may not be possible to increase the gain of the feedback controller (hereinafter sometimes abbreviated as FB controller) due to the resonance characteristics of the mechanical system, and a notch in the rear stage of the FB controller is intended to avoid this. A filter is interposed to cancel the resonance characteristics. However, the filter parameters of the notch filter need to be set appropriately with respect to the resonance characteristics.
また機械系の共振特性は複数存在する場合があり、このうちＦＢ制御器のゲイン上昇を妨げるものの全てに対してノッチフィルタを適用させる必要がある。 In addition, there may be a plurality of mechanical resonance characteristics, and it is necessary to apply a notch filter to all of them that hinder the gain increase of the FB controller.
したがって上述の機械系の共振を抑制する制御手段の自動調整は、ＦＢ制御器後段に介在させるノッチフィルタの数と介在させた各ノッチフィルタのフィルタパラメータの最適化によって成される。 Therefore, the automatic adjustment of the control means for suppressing the resonance of the mechanical system described above is performed by optimizing the number of notch filters interposed in the subsequent stage of the FB controller and the filter parameters of each notch filter interposed.
このような自動調整を行う手段として、特許文献１、２が提案されている。
特許文献１では、２つの共振特性を抑制できるようにＦＢ制御器系内にノッチフィルタを直列に２段設けており、これをＦＢ制御系に並列に配置した適応ノッチフィルタを用いてリアルタイムに自動調整する方法が提案されている。なお、ＦＢ制御器系内に設けられたノッチフィルタを適応ノッチフィルタと区別する目的で以降、ＦＢ制御器系内に設けられたノッチフィルタを実ノッチフィルタと称する。
In
具体的には、エンコーダで観測したモータ回転数に対して設定バンド幅の異なる２つのバンドパスフィルタ（以降、ＢＰＦと略記する場合がある）を並列に適用し、各ＢＰＦの出力に対して各々適応ノッチフィルタを動作させることで、２つの共振特性に起因したモータ回転数の振動成分の周波数を同時に推定し、各実ノッチフィルタの中心周波数に適用することで短時間に自動調整を成す方法である。 Specifically, two bandpass filters (hereinafter, may be abbreviated as BPF) having different set bandwidths for the motor rotation speed observed by the encoder are applied in parallel, and each is applied to the output of each BPF. By operating the adaptive notch filter, the frequency of the vibration component of the motor rotation speed due to the two resonance characteristics is estimated at the same time, and by applying it to the center frequency of each real notch filter, automatic adjustment is achieved in a short time. is there.
また特許文献２では、共振抑制を目的にＦＢ制御器系内に設定されていた複数の実ノッチフィルタを、経年劣化で変化した共振特性に適合するよう、自動で実ノッチフィルタを再調整する方法が提案されている。
Further, in
具体的には、エンコーダで観測したモータ回転数に対して振動の周波数を推定する手段を設け、本手段で推定した振動の周波数が経年劣化で変化した共振特性に起因する振動の周波数と判断し、既に複数設定された実ノッチフィルタのなかから、推定した振動の周波数と各実ノッチフィルタのノッチ周波数とを比較し、修正すべき実ノッチフィルタを適切に見定めることで、経年劣化で変化した共振特性に起因した共振現象を自動で抑制する方法である。 Specifically, a means for estimating the vibration frequency with respect to the motor rotation speed observed by the encoder is provided, and the vibration frequency estimated by this means is determined to be the vibration frequency due to the resonance characteristic changed due to aged deterioration. , Resonance changed due to aging by comparing the estimated vibration frequency with the notch frequency of each real notch filter from among the multiple real notch filters already set and appropriately determining the real notch filter to be corrected. This is a method of automatically suppressing the resonance phenomenon caused by the characteristics.
特許文献１では、２つの共振特性に対して２つのＢＰＦのバンド幅は、各共振特性に起因した振動成分が各ＢＰＦを通過するように適切に設定されなければ意図した効果が期待できない。例えば２つの共振特性の共振周波数が近く２つのＢＰＦのうち１つのＢＰＦで２つの共振特性に起因した振動が抽出される場合は、一つの適応ノッチフィルタで２つの共振特性を推定することになり推定誤差が発生し意図した効果が期待できない。また、共振特性に対するＢＰＦのバンド幅の適切な設定が容易でないという課題があった。
In
更に、共振特性の数が３つ以上の場合はＢＰＦを共振特性の数に合わせて設ける必要があり、かつ各ＢＰＦのバンド幅の適切な設計が容易でない。また制御対象機械の共振特性の数を事前に把握しておく必要があり、この分調整に手間がかかるという課題があった。 Further, when the number of resonance characteristics is three or more, it is necessary to provide BPFs according to the number of resonance characteristics, and it is not easy to properly design the bandwidth of each BPF. In addition, it is necessary to know the number of resonance characteristics of the controlled machine in advance, and there is a problem that it takes time and effort to adjust this amount.
特許文献２でも同様に、制御対象機械の共振特性の数は事前に把握されている必要があり、また２つの共振特性が同時に経時劣化した場合に対応できないといった課題があった。
Similarly, in
更に実ノッチフィルタが介在した状態で共振特性が変化した場合、介在した実ノッチフィルタの影響を受けて必ずしもモータ回転数に重畳する振動の周波数は特性が変化した共振周波数に一致せず、またＦＢ制御器の設定ゲイン次第でもモータ回転数に重畳する振動の周波数は必ずしも特性が変化した共振周波数に一致せず、実ノッチフィルタの調整がうまくいかない場合があるといった課題があった。 Furthermore, when the resonance characteristics change with the actual notch filter intervening, the frequency of vibration superimposed on the motor rotation speed due to the influence of the intervening actual notch filter does not necessarily match the resonance frequency at which the characteristics have changed, and FB. There is a problem that the frequency of vibration superimposed on the motor rotation speed does not always match the resonance frequency whose characteristics have changed even depending on the set gain of the controller, and the adjustment of the actual notch filter may not be successful.
本発明の目的は、ＦＢ制御系内に設ける実ノッチフィルタの数、および実ノッチフィルタのノッチ周波数を、事前調査することなく、機械系の1つ以上の共振特性に起因して発生する制御系の応答の振動を高精度・リアルタイムに抑制することにある。 An object of the present invention is a control system generated due to one or more resonance characteristics of a mechanical system without prior investigation of the number of real notch filters provided in the FB control system and the notch frequency of the real notch filters. The purpose is to suppress the vibration of the response in real time with high accuracy.
本発明の好ましい一例は、制御対象の１つ以上の共振特性に起因して制御系の応答に重畳する振動成分を抽出する振動抽出部と、前記振動成分のうち、ある１つの振動成分の周波数を逐次に推定し、これを振動周波数推定値系列として出力する逐次周波数推定部と、前記振動周波数推定値系列に基づいて、前記制御系の応答に重畳する振動の発生原因となる共振特性の数を、共振数推定値系列として出力するとともに、前記共振数推定値系列の値に応じた個数の前記ノッチフィルタを前記制御系の制御器後段に直列に設置する共振数推定部とを有するノッチフィルタ調整装置である。 A preferred example of the present invention is a vibration extraction unit that extracts a vibration component superimposed on the response of the control system due to one or more resonance characteristics of the controlled object, and a frequency of one of the vibration components. Sequentially estimates and outputs this as a vibration frequency estimation value series, and the number of resonance characteristics that cause vibration to be superimposed on the response of the control system based on the vibration frequency estimation value series. Is output as a resonance number estimation value series, and a notch filter having a resonance number estimation unit for installing a number of the notch filters corresponding to the values of the resonance number estimation value series in series after the controller of the control system. It is an adjusting device.
本発明の好ましい他の例は、位置速度算出部で算出されたモータ速度、及び速度制御器の操作量を入力とし、電流制御器に出力するノッチフィルタ調整装置を備えるモータ制御装置であって、
前記ノッチフィルタ調整装置は、
制御対象の１つ以上の共振特性に起因して制御系の応答に重畳する振動成分を抽出する振動抽出部と、前記振動成分のうち、ある１つの振動成分の周波数を逐次に推定し、これを振動周波数推定値系列として出力する逐次周波数推定部と、前記振動周波数推定値系列に基づいて、前記制御系の応答に重畳する振動の発生原因となる共振特性の数を、共振数推定値系列として出力するとともに、前記共振数推定値系列の値に応じた個数の前記ノッチフィルタを前記制御系の制御器後段に直列に設置する共振数推定部とを有する、モータ制御装置である。
Another preferred example of the present invention is a motor control device including a notch filter adjusting device that receives the motor speed calculated by the position / speed calculation unit and the operation amount of the speed controller as inputs and outputs the output to the current controller.
The notch filter adjusting device is
A vibration extraction unit that extracts a vibration component that is superimposed on the response of the control system due to one or more resonance characteristics of the controlled object, and a vibration extraction unit that sequentially estimates the frequency of one of the vibration components, and this Based on the vibration frequency estimation value series and the sequential frequency estimation unit that outputs the vibration frequency estimation value series, the number of resonance characteristics that cause vibration superimposed on the response of the control system is calculated by the resonance number estimation value series. This is a motor control device having a resonance number estimation unit in which a number of the notch filters corresponding to the values of the resonance number estimation value series are installed in series after the controller of the control system.
本発明によれば、実ノッチフィルタの数、および実ノッチフィルタのノッチ周波数を、事前調査することなく、機械系の1つ以上の共振特性に起因して発生する制御系の応答の振動を高精度・リアルタイムに抑制できる。 According to the present invention, the number of real notch filters and the notch frequency of the real notch filters are not investigated in advance, and the vibration of the control system response caused by one or more resonance characteristics of the mechanical system is increased. It can be suppressed in real time with accuracy.
以下、実施例について図面を参照しながら説明する。なお各図において、共通な機能を有する構成要素には同一の番号を付与し、その説明を省略する。また、以降「フィードバック」は「ＦＢ」と、「ノッチフィルタ」を「ＮＦ」と、「ローパスフィルタ」を「ＬＰＦ」と、「ハイパスフィルタ」を「ＨＰＦ」と、「バンドパスフィルタ」を「ＢＰＦ」と略記する場合がある。 Hereinafter, examples will be described with reference to the drawings. In each figure, components having a common function are given the same number, and the description thereof will be omitted. After that, "feedback" is "FB", "notch filter" is "NF", "low pass filter" is "LPF", "high pass filter" is "HPF", and "band pass filter" is "BPF". May be abbreviated as.
図１は、実施例１の自動調整部２を、一般的なモータのＦＢ制御系に適用した際の構成を示した図である。自動調整部２を含まない一般的なモータのＦＢ制御系では、ＦＢ制御器１３の操作量がモータ１４に与えられ、モータ１４の出力ｙにより制御対象機械１５は制御される。
FIG. 1 is a diagram showing a configuration when the
出力ｙはモータ回転数[ｒｐｍ]であり、これをセンサ（例えばエンコーダ）を用いて計測し、回転数指令ｒとの偏差を加減算器１６で算出し、ＦＢ制御器１３は速度偏差としてこれを処理する。なおモータ１４の前段にはモータ１４を駆動するための装置（インバータ等）やモータ１４の電流を制御する制御器が設けられるが、図１ではこれらを略記している。
The output y is the motor rotation speed [rpm], which is measured using a sensor (for example, an encoder), the deviation from the rotation speed command r is calculated by the adder /
ＦＢ制御系において、制御対象機械１５の共振特性に起因した振動や発振を抑制する手段として一般にはノッチフィルタが用いられる。具体的には、共振特性の共振周波数に対して、ノッチフィルタのノッチ周波数を一致させるようにノッチフィルタをＦＢ制御器後段に設ければよい。これによりノッチフィルタの零点が共振特性の共振極を相殺し、ＦＢ制御器１３は共振特性の励起無く制御対象機械１５を制御可能となる（以降、共振抑制を目的にＦＢ制御ループ内に設けられるノッチフィルタを実ノッチフィルタと称する）。
In the FB control system, a notch filter is generally used as a means for suppressing vibration or oscillation caused by the resonance characteristic of the controlled
モータトルクからモータ回転数への伝達特性に現れる１つの共振特性と、これを１つの実ノッチフィルタで相殺する様子を、ボード線図で示したものが図１６である。共振特性のピークがノッチフィルタのノッチ（谷）で相殺されていることがわかる。 FIG. 16 is a Bode diagram showing one resonance characteristic appearing in the transmission characteristic from the motor torque to the motor rotation speed and how one real notch filter cancels the resonance characteristic. It can be seen that the peaks of the resonance characteristics are canceled by the notches (valleys) of the notch filter.
制御対象機械１５の共振特性は複数存在すると想定されるが、実ノッチフィルタはＦＢ制御系の所望の応答特性の実現に障害となる制御対象機械１５の共振特性の数だけ、ＦＢ制御器後段に設置できればよい。実ノッチフィルタを設けたことで、ＦＢ制御系における共振特性起因の安定余裕の減少を低減でき、ＦＢ制御ゲインを上昇でき、ＦＢ制御系の高応答化（所望の応答特性の実現）を図ることができる。
It is assumed that there are a plurality of resonance characteristics of the controlled
自動調整部２は必要に応じてＦＢ制御器の後段に実ノッチフィルタ１〜実ノッチフィルタｎを設けることで、ＦＢ制御系における制御対象機械１５の最大ｎ個の共振の影響を抑制する。自動調整部２は、実ノッチフィルタの必要個数と、各実ノッチフィルタのノッチ周波数をリアルタイムに高速に、自動で調整するノッチフィルタ調整装置の構成となっている。
The
自動調整部２は、逐次周波数推定部３、共振数推定部４、共振番号判断部５、振動抽出部６、振動検出部７、スイッチ８、切替スイッチ９、及びｎ個の実ノッチフィルタから構成される。なお自動調整部２はマイコン等のディジタル演算器で実行されることを前提とする。
The
振動抽出部６は、モータからの出力ｙを入力とし、ｙから振動成分を抽出し、振動成分ｙｄ（ｔ）を出力するものである。なおｙｄ（ｔ）はディジタル演算器の所定の演算周期Ｔｓにあわせてｙｄ（０）、ｙｄ（Ｔｓ）、ｙｄ（２Ｔｓ）、…のように出力されるものとする。
The
自動調整部２は、実ノッチフィルタに設定するノッチ周波数を共振周波数に一致させることを目的とするので、極力共振起因で発生する振動成分だけを出力ｙから抽出したい。その一例としてＨＰＦやＢＰＦの利用があげられる。出力ｙを検出するセンサの雑音除去という観点ではＬＰＦの利用が考えられ、制御応答である定常成分を出力ｙから除去し、振動成分のみ抽出するという観点ではＨＰＦの利用が考えられる。
Since the
両観点を充足するフィルタはＬＰＦ＋ＨＰＦ＝ＢＰＦである。これらフィルタは共振起因の振動として抽出したい周波数帯域に合わせて、遮断周波数を設計すればよい。例えば、自動調整部２による実ノッチフィルタの設定周波数レンジを１００[Ｈｚ]以上とする場合は、ＨＰＦの遮断周波数を１００[Ｈｚ]に設定する等である。
The filter that satisfies both viewpoints is LPF + HPF = BPF. For these filters, the cutoff frequency may be designed according to the frequency band to be extracted as vibration caused by resonance. For example, when the set frequency range of the actual notch filter by the
振動検出部７は、振動抽出部６の出力であるｙｄ（ｔ）を入力とし、ｙｄ（ｔ）から顕著な持続的振動の発生が確認できる場合、その発生持続時間帯に１、それ以外の時間帯は０とする振動検出フラグ信号を出力する役割を担う。
The
自動調整部２の初期状態は実ノッチフィルタがＦＢ制御器後段に１つも設けられていない状態であり、初期状態において振動検出部７が振動を未検出の状態では、実ノッチフィルタはＦＢ制御器の後段に１つも設けられない状態となるようにスイッチ１７を制御する信号を、振動検出部７がスイッチ１７に出力する。１つ以上の実ノッチフィルタがＦＢ制御器後段に設けられる状況では、振動検出部７は実ノッチフィルタが有効に機能するようにスイッチ１７を切り替える。なおスイッチ１７の切替えは共振数推定部４が担ってもよい。
The initial state of the
スイッチ８は、振動検出部７の出力である振動検出フラグ信号と、ｙｄ（ｔ）とを入力とし、振動検出フラグ信号が１のときはｙｄ（ｔ）を出力し、振動検出フラグ信号が０のときは０を出力するよう動作する。
The
逐次周波数推定部３は、スイッチ８の出力を入力とし、振動周波数推定値系列ａ（ｋ）[Ｈｚ]を出力する。
The sequential
逐次周波数推定部３はスイッチ８の出力が非ゼロの時のみ、ｙｄ（ｔ）の振動の周波数をリアルタイム（周期Ｔｓ）に推定し、推定完了時にａ（ｋ）、ｋ＝０、１、…を出力する。すなわち振動周波数推定値系列ａ（ｋ）は、所定演算周期Ｔｓ毎に出力される（更新される）のではなく、周波数推定が完了した場合のみ出力される（更新される）点に注意する。
The sequential
逐次周波数推定部３は、振動検出部７で顕著な持続的振動が発生していると判断された場合にのみｙｄ（ｔ）の振動の周波数を推定し、またｙｄ（ｔ）の振動の周波数は振動抽出部６で共振起因の振動として抽出したい周波数帯域に制限されているため、振動周波数推定値系列ａ（ｋ）[Ｈｚ]は、ｙｄ（ｔ）が非持続的な振動波形であったり、振動として顕著でない場合の振動の推定値ではない点に注意する。
The sequential
すなわち振動抽出部６及び振動検出部７は、例えばインパクト外乱によるＦＢ制御系の応答の、非持続的振動等を逐次周波数推定部３での推定対象にしないように、推定する振動に制約を与える役割を担っている。
That is, the
上記の振動抽出部６及び振動検出部７によるｙｄ（ｔ）への制約から、ｙｄ（ｔ）は、複数存在すると想定される制御対象機械１５の共振特性のうち、ＦＢ制御系において所望の応答特性を得るのに障害となる共振特性の数分の振動成分が重畳した振動である。
Due to the restrictions on yd (t) by the
仮にｙｄ（ｔ）はｎ種の振動成分の重畳により構成されているとした場合、逐次周波数推定部３は、ｎ種の振動成分のうち、１つの振動成分ｊに着目し、振動成分ｊの周波数を推定しａ（ｋ）として出力する。
Assuming that yd (t) is composed of superimposition of n types of vibration components, the sequential
ｊの選択方針のひとつは、ｎ種の振動成分のうち、最も振幅（パワー）が大きい振動とする、である。以降、本実施例では、逐次周波数推定部３はｙｄ（ｔ）のｎ種の振動成分のうち、最も振幅（パワー）が大きい振動の周波数を推定し、ａ（ｋ）として出力するものとする。
One of the selection policies of j is that the vibration has the largest amplitude (power) among the n types of vibration components. Hereinafter, in this embodiment, the sequential
共振数推定部４は振動周波数推定値系列ａ（ｋ）を基に、複数存在すると想定される制御対象機械１５の共振特性のうち、ＦＢ制御系において所望の応答特性を得るのに障害となる共振特性の数を推定し、共振数推定値系列Ｎ（ｋ）を出力し、Ｎ（ｋ）の値に応じた個数の実ノッチフィルタ１〜ｎをＦＢ制御系の後段に設定する役割を担う。
Based on the vibration frequency estimation value series a (k), the resonance
共振番号判断部５は、振動周波数推定値系列ａ（ｋ）と共振数推定値系列Ｎ（ｋ）を入力とし、ａ（ｋ）を設定すべき実ノッチフィルタの番号を出力する。
The resonance
切替スイッチ９は、共振番号判断部５から得た実ノッチフィルタの番号に合わせて、ａ（ｋ）を設定すべき実ノッチフィルタに設定できるようにスイッチングを行う。これにより切替スイッチ９で選択された実ノッチフィルタのノッチ周波数はａ（ｋ）に更新される。
The
上記の共振数推定部４、共振番号判断部５及び切替スイッチ９の処理は、振動周波数推定値系列ａ（ｋ）が更新される毎に反復的に実施される。前述のように振動周波数推定値系列ａ（ｋ）が更新される場合は、共振起因の顕著な持続的振動が発生していると期待されるときに限られる。そのため、実ノッチフィルタがＦＢ制御系内に１つも介在せず共振起因の顕著な持続的振動が発生している場合や、ノッチ周波数にａ（ｋ）を有する（ｋ回目の更新が行われた際の）実ノッチフィルタが共振特性を相殺しきれていない場合は、振動周波数推定値系列ａ（ｋ）は反復的に更新が継続される。そして、逐次にａ（ｋ）が実ノッチフィルタに設定される。すなわちこのような反復処理は、実ノッチフィルタが共振特性を十分に相殺するまで継続されることとなる。
The processing of the resonance
このような反復処理の処理フロー２０を図２に示す。
The
振動検出部７は、持続的振動の発生が確認される持続時間帯を示す振動検出フラグを算出し、振動検出フラグが１である場合のみ逐次周波数推定部３がｙｄ（ｔ）の周波数の推定を行う。
The
逐次周波数推定部３が振動周波数推定値系列ａ（ｋ）の推定を完了できていない場合は、引き続きｙｄ（ｔ）の周波数の推定を継続する。
If the sequential
逐次周波数推定部３が振動周波数推定値系列ａ（ｋ）の推定を完了したと判断する場合は、振動周波数推定値系列ａ（ｋ）を共振数推定部４、共振番号判断部５、および切替スイッチ９を介して実ノッチフィルタに適用し、振動検出部７は実ノッチフィルタ適用後に持続的振動の発生が確認される持続時間帯を示す振動検出フラグを算出する。
When it is determined that the sequential
振動検出フラグが１で無い場合には、本処理は終了する。 If the vibration detection flag is not 1, this process ends.
このような反復処理の必要性について、一共振時の収束平面を示す概念図である図３を用いて説明する。ＦＢ制御系において、共振特性起因で発生する応答の振動成分ｙｄ（ｔ）の周波数ωｖは、共振特性の共振周波数ωｍに必ずしも一致しない。特にＦＢ制御ゲインを高く設定した場合や共振周波数が高い場合や、ＦＢ制御ループ内に介在する遅れ時間が長い場合は両者の乖離ωｍ−ωｖはより顕著なものとなりやすい。 The necessity of such iterative processing will be described with reference to FIG. 3, which is a conceptual diagram showing a convergence plane at the time of one resonance. In the FB control system, the frequency ωv of the vibration component yd (t) of the response generated due to the resonance characteristic does not always match the resonance frequency ωm of the resonance characteristic. In particular, when the FB control gain is set high, the resonance frequency is high, or when the delay time intervening in the FB control loop is long, the dissociation ωm-ωv between the two tends to be more remarkable.
したがって、逐次周波数推定部３はｙｄ（ｔ）の周波数を正確に推定しａ（ｋ）（＝ωｖ）を出力し、ωｖがノッチ周波数（図１５のｆ２）として実ノッチフィルタに適用されたとしても、必ずしもａ（ｋ）（＝ωｖ）を伴った実ノッチフィルタが共振特性を相殺できるとは限らない。
Therefore, assuming that the sequential
更に、ωｍ≠ａ（ｋ）（＝ωｖ）なる実ノッチフィルタがＦＢ制御系内に設定された際に観測される、共振特性起因で発生する応答の振動成分ｙｄ（ｔ）の周波数はωｖのままとは限らない。仮にωｖ１に変化した状況で逐次周波数推定部３が実行された場合、逐次周波数推定部３はωｖ１の推定値としてａ（ｋ）を得るが、これがωｍ≠ａ（ｋ）（＝ωｖ１）の場合も想定される。
Further, the frequency of the vibration component yd (t) of the response generated due to the resonance characteristic observed when the real notch filter of ωm ≠ a (k) (= ωv) is set in the FB control system is ωv. It is not always the same. If the sequential
すなわち、得られたａ（ｋ）（＝ωｖ１）を実ノッチフィルタに設定した場合、やはり共振特性を相殺できるとは限らない。したがって少なからず処理フロー２０に示すような反復処理を行う動機が生じる。反復処理により実ノッチフィルタが共振特性を相殺可能となるためには、反復処理を行うことでａ（ｋ）がωｍに収束し、ａ（ｋ）＝ωｍとなることが保証されなければならない。
That is, when the obtained a (k) (= ωv1) is set in the actual notch filter, it is not always possible to cancel the resonance characteristics. Therefore, there is a motivation to perform the iterative processing as shown in the
今、１つの共振特性を１つの実ノッチフィルタ（図１５）で相殺する場合（図１６）を考える。共振特性の伝達特性ＲＡＲ（ｓ）、ノッチフィルタの伝達特性Ｎｃｈ（ｓ）は以下で表現される。 Now, consider a case (FIG. 16) in which one resonance characteristic is canceled by one real notch filter (FIG. 15). The transmission characteristic RAR (s) of the resonance characteristic and the transmission characteristic Nch (s) of the notch filter are expressed as follows.
但し、ωａ、ωｍ、ζａ、ζｍは各々反共振周波数［ｒａｄ／ｓ］、共振周波数［ｒａｄ／ｓ］、反共振減衰係数、共振減衰係数である。またωｎ、Ｄ、Ｗは各々、ノッチ周波数［ｒａｄ／ｓ］、ノッチ深さ、ノッチ幅である。 However, ωa, ωm, ζa, and ζm are antiresonance frequency [rad / s], resonance frequency [rad / s], antiresonance attenuation coefficient, and resonance attenuation coefficient, respectively. Further, ωn, D, and W are notch frequency [rad / s], notch depth, and notch width, respectively.
逐次周波数推定部３は振動成分ｙｄ（ｔ）の周波数ωｖを正確に推定でき、ａ（ｋ）＝ωｖであるとする。処理フロー２０の反復処理で、ａ（ｋ）が共振周波数ωｍに収束できることはすなわち、式（３）および式（４）が成立すること、望ましくはｄ（ｋ）が式（５）のような性質を有する収束点列となっていることである。
It is assumed that the sequential
今、ａ（ｋ）（＝ωｖ）を伴う実ノッチフィルタがＦＢ制御器後段に１つ設定された際の振動成分ｙｄ（ｔ）の周波数をωｖａと記述する。このとき式（５）を満たすには、ａ（ｋ）とωｖａの関係は例えば図３のＣＰ１〜ＣＰ３のようであればよい。 Now, the frequency of the vibration component yd (t) when one real notch filter with a (k) (= ωv) is set in the subsequent stage of the FB controller is described as ωva. At this time, in order to satisfy the equation (5), the relationship between a (k) and ωva may be, for example, CP1 to CP3 in FIG.
すなわち、ａ（ｋ）に対するωｖａの関係が交点座標（ωｖａ、ａ（ｋ））＝（ωｍ、ωｍ）を通過し、かつ斜線部分に立ち入らない平面（以降、これを収束平面と称する）になることである。ＣＰ１〜ＣＰ３のいずれの収束平面でも反復処理によりいずれはωｍ＝ωｖａ＝ａ（ｋ）となる。 That is, the relationship of ωva with respect to a (k) becomes a plane that passes through the intersection coordinates (ωva, a (k)) = (ωm, ωm) and does not enter the shaded portion (hereinafter, this is referred to as a convergence plane). That is. In any of the convergence planes of CP1 to CP3, ωm = ωva = a (k) is eventually obtained by iterative processing.
収束平面がフラットな程少ない反復回数でωｍに収束できる。ＣＰ４のような収束平面の場合は、反復処理により必ずしもωｍに収束できる保証はないが、平面の形状やａ（ｋ）の初期値次第では収束できる場合もある。 The flatter the convergence plane, the smaller the number of iterations required to converge to ωm. In the case of a convergent plane such as CP4, there is no guarantee that it can converge to ωm by iterative processing, but it may be possible to converge depending on the shape of the plane and the initial value of a (k).
収束平面は、ＦＢ制御器のゲイン、ＦＢ制御ループ内の遅れ、共振周波数、共振減衰係数、ノッチ幅、ノッチ深さによって変化する複雑な関数であり、反復処理によるａ（ｋ）の収束性の解析的な保証は困難である。したがって反復処理による収束性の解析的なアプローチは概略的な現象把握をするに留め、収束平面が式（４）〜（５）を充足するか否かの確認は数値的アプローチの支援を得るとする。 The convergence plane is a complex function that changes with the gain of the FB controller, the delay in the FB control loop, the resonance frequency, the resonance attenuation coefficient, the notch width, and the notch depth, and the convergence of a (k) by iterative processing. Analytical guarantees are difficult. Therefore, the analytical approach of convergence by iterative processing is limited to grasping the general phenomenon, and the confirmation of whether the convergence plane satisfies equations (4) to (5) is supported by the numerical approach. To do.
以下のようにＩ、Ｅ、Ｅｔを定義する。 I, E, and Et are defined as follows.
式（６）において、Ｉ、Ｅは各々共振特性をノッチフィルタで相殺する際の理想応答項及び相殺誤差項である。Ｉの定義からＥの分母は共振極を有する共振特性で、分子は実ノッチフィルタの零点を有する実ノッチフィルタ分子となるため、Ｅ＝１のとき、実ノッチフィルタの零点が共振極を完全に相殺したことになる。 In the formula (6), I and E are an ideal response term and an offset error term when the resonance characteristics are canceled by the notch filter, respectively. From the definition of I, the denominator of E is a resonance characteristic having a resonance pole, and the molecule is a real notch filter molecule having a zero point of the real notch filter. Therefore, when E = 1, the zero point of the real notch filter completely eliminates the resonance pole. It will be offset.
他方Ｉは共振極を含まないが、ノッチ周波数ωｎを含むため、ノッチ周波数の変化（調整）で特性が変化する点に注意する。相殺誤差項Ｅの見通しを良くするために式（８）の相殺残差項Ｅｔを定義する。 On the other hand, I does not include the resonance electrode, but contains the notch frequency ωn, so it should be noted that the characteristics change with the change (adjustment) of the notch frequency. In order to improve the visibility of the offset error term E, the offset residual term Et of the equation (8) is defined.
もし、Ｅｔ＝０であれば式（６）から、理想応答項Ｉのみとなり、共振特性を完全に相殺できたことになる。なおノッチ深さＤ＝１とすると式（２）はＮｃｈ（ｓ）＝１となるので、Ｄ＝１とする場合は式（６）〜（８）は実ノッチフィルタを含まない表現になる。したがって反復処理を行う前の、実ノッチフィルタをＦＢ制御器後段に設ける前もＤ＝１とすることで式（６）〜（８）で統一的に解析できる。 If Et = 0, from the equation (6), only the ideal response term I is obtained, and the resonance characteristics can be completely offset. When the notch depth D = 1, the equation (2) has Nch (s) = 1, so when D = 1, the equations (6) to (8) do not include the actual notch filter. Therefore, the equations (6) to (8) can be unified by setting D = 1 even before the actual notch filter is provided in the subsequent stage of the FB controller before the iterative processing is performed.
Ｅｔ＝０を達成するには、式（８）から以下であればよい。 In order to achieve Et = 0, the following may be used from the equation (8).
Ｅｔの定義から、仮にＤＷ＝ζｍであった場合、｜ωｎ−ωｍ｜が単調に減少すれば、Ｅｔも単調にＥｔ→０が達成されることがわかる。 From the definition of Et, it can be seen that if DW = ζ m, if | ωn−ωm | decreases monotonically, Et → 0 is monotonically achieved as well.
今、Ｚ（ｓ）をＦＢ制御ループ内の、Ｎｃｈ（ｓ）とＲＡＲ（ｓ）以外の要素、すなわちＦＢ制御器の伝達関数ＦＢ（ｓ）と、制御対象機械のイナーシャ特性Ｊ（ｓ）と、ＦＢ制御ループ内に介在する遅れ特性Ｄ（ｓ）の積として以下で与えられるとする。 Now, Z (s) is the element other than Nch (s) and RAR (s) in the FB control loop, that is, the transfer function FB (s) of the FB controller and the inertia characteristic J (s) of the controlled machine. , Is given below as the product of the delay characteristics D (s) intervening in the FB control loop.
このときＦＢ制御系の閉ループ伝達特性（図１７におけるｒ→ｙの伝達特性）は以下と書ける。 At this time, the closed loop transmission characteristic of the FB control system (transmission characteristic of r → y in FIG. 17) can be written as follows.
Ｅｔ＝０であればｙ１は立ち消えＦＢ制御系の応答は理想応答ｙ０（＝Ｚ（ｓ）Ｉ（ωｎ）／（１＋Ｚ（ｓ）Ｉ（ωｎ）））のみとなることがわかる。注目すべきは式（１１）の第２項である。Ｅｔの分母ＤＥ（ｓ）は共振極を有する共振特性である。したがって、式（１１）の第２項はＥｔを積の形で含むので、式（１１）の第２項は共振極を有する。そうであるならば、ｙ１は共振周波数ωｍの振動成分を含むはずである。 It can be seen that if Et = 0, y1 disappears and the response of the FB control system is only the ideal response y0 (= Z (s) I (ωn) / (1 + Z (s) I (ωn))). Of note is the second term of equation (11). The denominator DE (s) of Et is a resonance characteristic having a resonance pole. Therefore, since the second term of the equation (11) includes Et in the form of a product, the second term of the equation (11) has a resonant pole. If so, y1 should contain a vibration component with a resonant frequency of ωm.
しかしながら前述のようにｙ＝ｙ０＋ｙ１から共振起因の振動成分のみ抽出したｙｄ（ｔ）の振動の周波数は共振周波数ωｍに必ずしも一致しない。このことは式（１１）の第２項を以下のように解析することで把握される。 However, as described above, the frequency of the vibration of yd (t) obtained by extracting only the vibration component caused by the resonance from y = y0 + y1 does not always match the resonance frequency ωm. This can be grasped by analyzing the second term of the equation (11) as follows.
式（１２）において、Ｅｔの分母ＤＥ（ｓ）は分子ＮＣ（ｓ）のＤＥ（ｓ）で相殺され、ｙ１は共振周波数ωｍでは振動せず、ｙ１はＤＣ（ｓ）の根（極）のうち共振起因の根（極）の周波数で振動することを意味している。これがｙｄ（ｔ）の周波数が共振周波数に一致しない理由である。 In equation (12), the denominator DE (s) of Et is offset by the DE (s) of the numerator NC (s), y1 does not oscillate at the resonance frequency ωm, and y1 is the root (pole) of DC (s). It means that it vibrates at the frequency of the root (pole) caused by resonance. This is the reason why the frequency of yd (t) does not match the resonance frequency.
続いてｙｄ（ｔ）の周波数が共振周波数に近い理由を説明する。
ｙ０は閉ループ系における理想応答である。しかしながら式（１１）ようにｙ０の伝達特性の分母は、ｙ１も共通に分母に有するＤＣ（ｓ）であり、すなわちｙ１もＤＣ（ｓ）の根（極）のうち共振起因の根（極）の周波数で振動する成分を含むことを意味し、一見理想応答と見なせないように思われる。
Next, the reason why the frequency of yd (t) is close to the resonance frequency will be described.
y0 is the ideal response in a closed loop system. However, as shown in equation (11), the denominator of the transmission characteristic of y0 is DC (s) which also has y1 in the denominator, that is, y1 is also the root (pole) caused by resonance among the roots (poles) of DC (s). It means that it contains a component that oscillates at the frequency of, and it seems that it cannot be regarded as an ideal response at first glance.
しかしながら、ｙ０がｙ１と異なるのは、ｙ０の伝達特性分子には共振特性ＤＥ（ｓ）が存在することである。すなわちＤＣ（ｓ）の根（極）のうち共振起因の根（極）は共振特性ＤＥ（ｓ）で概略相殺され、ｙ０には影響が殆ど生じない、と説明できる。これはｙｄ（ｔ）の振動の周波数（ＤＣ（ｓ）の根（極）のうち共振起因の根（極）の周波数）は共振周波数（ＤＥ（ｓ）の共振極）に近いことを意味している。 However, y0 is different from y1 in that the transfer characteristic molecule of y0 has a resonance characteristic DE (s). That is, it can be explained that among the roots (poles) of DC (s), the roots (poles) caused by resonance are roughly offset by the resonance characteristic DE (s), and y0 is hardly affected. This means that the vibration frequency of yd (t) (the frequency of the root (pole) caused by resonance among the roots (poles) of DC (s)) is close to the resonance frequency (resonant pole of DE (s)). ing.
このことはＤ＝１（ノッチフィルタが存在しない場合）にも共通にいえることで、すなわち程度の差はあれど、ノッチフィルタを介在させない場合のｙｄ（ｔ）の周波数は共振周波数に近いことを意味する。 This also applies to D = 1 (when there is no notch filter), that is, the frequency of yd (t) when the notch filter is not interposed is close to the resonance frequency, although the degree is different. means.
またＥｔが０に漸近するとき、 ｙ０は共振起因の振動が概略含まれず理想化する。また『ＤＣ（ｓ）の根(極)のうち共振起因の根(極)は共振特性ＤＥ（ｓ）の共振極に概略一致する』ため、 ｙ１の伝達特性においてＥｔ分母の共振特性ＤＥ（ｓ）を相殺していたＮＣ（ｓ）に含まれるＤＥ（ｓ）が概略ＤＣ（ｓ）で相殺されてしまい、この結果共振特性ＤＥ（ｓ）がｙ１の伝達特性に残される。 Further, when Et approaches 0, y0 is idealized because the vibration caused by resonance is not roughly included. Further, since "the root (pole) caused by resonance among the roots (poles) of DC (s) roughly matches the resonance pole of the resonance characteristic DE (s)", the resonance characteristic DE (s) of the Et denominator in the transmission characteristic of y1 The DE (s) contained in the NC (s) that offsets) is approximately canceled by the DC (s), and as a result, the resonance characteristic DE (s) is left in the transmission characteristic of y1.
このことはＥｔが０に漸近・一致すると、ｙ０は共振起因の振動を含まず、ｙ１は共振周波数で振動することを意味する。すなわちＦＢ制御系の応答に重畳する共振起因の振動の周波数は共振周波数ωｍとなる。 This means that when Et approaches and coincides with 0, y0 does not include vibration caused by resonance, and y1 vibrates at the resonance frequency. That is, the frequency of the vibration caused by the resonance superimposed on the response of the FB control system is the resonance frequency ωm.
したがってＥｔ＝０であれば収束平面の交点座標は（ωｍ、ωｍ）となる。なおＥｔ＝０の場合、式（１１）からｙ１＝０で、すなわちＦＢ制御系の応答はｙ＝ｙ０である。したがって収束平面の交点座標（ωｍ、ωｍ）近傍でのＦＢ制御系の応答ｙの共振起因の振動の振幅は微小であるといえる。 Therefore, if Et = 0, the coordinates of the intersection of the convergence planes are (ωm, ωm). When Et = 0, y1 = 0 from the equation (11), that is, the response of the FB control system is y = y0. Therefore, it can be said that the amplitude of the vibration caused by the resonance of the response y of the FB control system in the vicinity of the intersection coordinates (ωm, ωm) of the convergence plane is minute.
式（１１）および式（１２）から、Ｅｔを０に漸近・一致させることで、共振起因の振動の周波数は共振周波数に一致し、振幅が微小化する。すなわち共振起因の振動を除去できることが把握され、前述の反復処理でそれが実現できる。換言すればノッチ幅Ｗとノッチ深さＤを共振減衰特性ζｍに対して適切に設定し、ノッチ周波数ωｎを共振周波数ωｍに漸近させれば実現できることが把握できた。また収束平面の交点座標が（ωｍ、ωｍ）となることも把握できた。 From the equations (11) and (12), by asymptotically matching Et to 0, the frequency of the vibration caused by the resonance matches the resonance frequency, and the amplitude becomes small. That is, it is understood that the vibration caused by the resonance can be removed, and this can be realized by the above-mentioned iterative processing. In other words, it was found that this can be achieved by appropriately setting the notch width W and the notch depth D with respect to the resonance attenuation characteristic ζ m and making the notch frequency ωn asymptotic to the resonance frequency ωm. It was also found that the coordinates of the intersection of the convergence planes are (ωm, ωm).
しかしながら収束平面が図３のように構成されることが厳密に示されたわけではなく、すなわち反復処理の収束性が厳密に示されたわけではない。 However, it is not strictly shown that the convergence plane is constructed as shown in FIG. 3, that is, the convergence of the iterative processing is not strictly shown.
このために一共振時の収束平面を数値的に描かせたのが図４である。図４は共振周波数が１８９４[Ｈｚ]の場合である。なおＦＢ制御ゲインや遅れの設定は、実ノッチフィルタ無しではＦＢ制御系が発振する設定とし、実ノッチフィルタのノッチ幅Ｗ、ノッチ深さＤは、ノッチ周波数が共振周波数に一致している場合に、ＦＢ制御系が安定化し発振しなくなるような値としている。 For this reason, FIG. 4 shows the convergence plane at the time of one resonance numerically drawn. FIG. 4 shows a case where the resonance frequency is 1894 [Hz]. The FB control gain and delay are set so that the FB control system oscillates without the actual notch filter, and the notch width W and notch depth D of the actual notch filter are when the notch frequency matches the resonance frequency. , The value is set so that the FB control system stabilizes and does not oscillate.
図４からこの数値例では、収束平面は図３の斜線部分に立ち入らず、交点座標（ωｍ、ωｍ）を通過する、反復処理でノッチ周波数を共振周波数に一致させることが可能な状態にあることがわかる。なお例えば、ノッチ幅が極端に狭い場合等は収束平面が図３の斜線部分に立ち入る場合がある。 In this numerical example from FIG. 4, the convergence plane does not enter the shaded portion of FIG. 3, passes through the intersection coordinates (ωm, ωm), and is in a state where the notch frequency can be matched with the resonance frequency by iterative processing. I understand. For example, when the notch width is extremely narrow, the convergence plane may enter the shaded portion in FIG.
したがって実ノッチフィルタの幅や深さが適切でない場合は、反復処理を行っても必ずしもノッチ周波数を共振周波数に一致させることが可能とはいえないが、実ノッチフィルタの設定値が適切である等の条件が整っていれば、多くの場合において、反復処理でノッチ周波数を共振周波数に一致させることが可能なことは数値的アプローチにより確認できる。 Therefore, if the width and depth of the actual notch filter are not appropriate, it is not always possible to match the notch frequency with the resonance frequency even if iterative processing is performed, but the set value of the actual notch filter is appropriate, etc. In many cases, it can be confirmed by a numerical approach that the notch frequency can be matched with the resonance frequency by iterative processing if the above conditions are met.
図４の数値例では、実ノッチフィルタが約９００〜２０００［Ｈｚ］に介在するとき、ＦＢ制御系は安定化される。これは共振起因でＦＢ制御系が発振している場合、共振周波数より低めに実ノッチフィルタを設定することで、実ノッチフィルタのノッチ周波数以上の周波数帯域での位相進み特性が、ＦＢ制御系の共振周波数周辺での安定余裕を回復させるため、共振周波数≧ノッチ周波数としたほうがＦＢ制御系の安定化に寄与しやすいことによる。 In the numerical example of FIG. 4, the FB control system is stabilized when the actual notch filter is interposed at about 900 to 2000 [Hz]. This is because when the FB control system is oscillating due to resonance, by setting the actual notch filter lower than the resonance frequency, the phase lead characteristics in the frequency band above the notch frequency of the actual notch filter can be improved by the FB control system. This is because it is easier to contribute to the stabilization of the FB control system if the resonance frequency ≥ the notch frequency in order to recover the stability margin around the resonance frequency.
このことは、反復処理の過程でａ（ｋ）≠共振周波数であっても、共振周波数≧ａ（ｋ）であれば共振抑制の効果が期待できることを意味し、ａ（ｋ）＝共振周波数でなくても概略的な共振抑制効果が得られることを示している。 This means that even if a (k) ≠ resonance frequency in the process of iterative processing, the effect of suppressing resonance can be expected if the resonance frequency ≥ a (k), and a (k) = resonance frequency. It is shown that a general resonance suppression effect can be obtained without it.
ここまでで、共振特性が１つで、実ノッチフィルタ１つでそれを相殺する場合について述べたが、共振特性がｎ個で、実ノッチフィルタｎ個でそれらを相殺する場合についても上述の式（６）〜（１２）の解析的アプローチ、及び数値的アプローチを用いて説明可能である。 Up to this point, the case where one resonance characteristic is used and one real notch filter cancels it has been described. However, the above equation also applies to the case where n resonance characteristics and n real notch filters cancel them. It can be explained by using the analytical approach and the numerical approach of (6) to (12).
説明の簡単化のためにｎ＝２の場合について説明する。共振特性の伝達特性ＲＡＲ（ｓ）、ノッチフィルタの伝達特性Ｎｃｈ（ｓ）は以下で表現される。 For the sake of simplification of the explanation, the case of n = 2 will be described. The transmission characteristic RAR (s) of the resonance characteristic and the transmission characteristic Nch (s) of the notch filter are expressed as follows.
ｎ＝１の場合と同様に以下を定義する。 The following is defined as in the case of n = 1.
但し、Ｉ１、Ｅｔ１、Ｉ２、Ｅｔ２は各々第１共振の理想応答項、相殺残差項、第２共振の理想応答項および相殺残差項である。なお Ｄｐ（ｐ＝１、２）＝１とすることで実ノッチフィルタＮｃｈｐ（ｓ、ωｍｐ）（ｐ＝１、２）が介在しない状況も表現できる。 However, I1, Et1, I2, and Et2 are the ideal response term and the canceling residual term of the first resonance, the ideal response term of the second resonance, and the canceling residual term, respectively. By setting Dp (p = 1, 2) = 1, it is possible to express a situation in which the actual notch filter Nchp (s, ωmp) (p = 1, 2) does not intervene.
式（１６）〜（２１）から次式が得られ、Ｎｃｈ１（ｓ、ωｎ１）・ＲＡＲ１（ｓ、ωｍ１）の相殺誤差、Ｎｃｈ２（ｓ、ωｎ２・ＲＡＲ２（ｓ、ωｎｍ２）の相殺誤差、およびそれら相殺誤差の相互影響を明示的に表現できる。 The following equations are obtained from the equations (16) to (21), and the offset error of Nch1 (s, ωn1) and RAR1 (s, ωm1), the offset error of Nch2 (s, ωn2 and RAR2 (s, ωnm2), and them. The mutual effect of the offset error can be explicitly expressed.
Ｅｔ１＝Ｅｔ２＝０を達成するには、式（１８）および（２１）から以下であればよい。 In order to achieve Et1 = Et2 = 0, the following may be obtained from equations (18) and (21).
Ｅｔｐ（ｐ＝１、２）の定義から、仮にＤｐＷｐ＝ζｍｐであった場合、｜ωｎｐ−ωｍｐ｜が単調に減少すれば、Ｅｔｐも単調にＥｔｐ→０が達成されることがわかる。 From the definition of Etp (p = 1, 2), if DpWp = ζmp, it can be seen that if | ωnp-ωmp | decreases monotonically, Etp also monotonically achieves Etp → 0.
今、Ｚ（ｓ）をＦＢ制御ループ内の、Ｎｃｈ１（ｓ）、ＲＡＲ１（ｓ）、Ｎｃｈ２（ｓ）、ＲＡＲ２（ｓ）以外の要素として式（１０）で与えられるとする。 Now, it is assumed that Z (s) is given by the equation (10) as an element other than Nch1 (s), RAR1 (s), Nch2 (s), and RAR2 (s) in the FB control loop.
このときＦＢ制御系の閉ループ伝達特性（図１８におけるｒ→ｙの伝達特性）は以下と書ける。 At this time, the closed loop transmission characteristic of the FB control system (transmission characteristic of r → y in FIG. 18) can be written as follows.
ＦＢ制御系の応答に重畳する共振起因の振動２種の周波数が共振周波数ωｍ１及びωｍ２に一致しないのは、２共振の場合においてもｙ１、ｙ２、ｙ１２が式（１１）と同形で与えられたことから、前述のｎ＝１の場合と同じ理由による。 Resonance-induced vibrations superimposed on the response of the FB control system The two frequencies do not match the resonance frequencies ωm1 and ωm2, because y1, y2, and y12 are given in the same form as equation (11) even in the case of two resonances. Therefore, the reason is the same as in the case of n = 1 described above.
また収束平面を描かせた場合、交点座標（ｗｍ１、ｗｍ１）および交点座標（ｗｍ２、ｗｍ２）を必ず通過することも、前述のｎ＝１の場合と同じ理由による。 Further, when the convergence plane is drawn, it always passes through the intersection coordinates (wm1, wm1) and the intersection coordinates (wm2, wm2) for the same reason as in the case of n = 1 described above.
以下では便利のために、Ｎｃｈ１（ｓ）・ＲＡＲ１（ｓ）およびＮｃｈ２（ｓ）・ＲＡＲ２（ｓ）に対して任意の一方をｘ、もう一方をｙとしてＮｃｈｘ（ｓ）・ＲＡＲｘ（ｓ）および Ｎｃｈｙ（ｓ）・ＲＡＲｙ（ｓ）のように表記する。 In the following, for convenience, Nchx (s), RARx (s) and Nchx (s), RARx (s) and Nchx (s), RARx (s) and Nchx (s), RARx (s) and Notated as Nchy (s) / RARY (s).
図１に示す構成で反復処理を実施した際、以下の条件を充足できれば反復処理により２つ共振特性の抑制を達成できる。 When the iterative process is performed with the configuration shown in FIG. 1, if the following conditions are satisfied, the suppression of the two resonance characteristics can be achieved by the iterative process.
Ｃ１：反復の各回において、実ノッチフィルタＮｃｈｘは逐次周波数推定部３が推定した振動を発生させた共振特性ＲＡＲｘを、より相殺できる方向に更新・設定されること
Ｃ２：反復の各回において、逐次周波数推定部３が推定した振動を発生させた共振特性ＲＡＲｘの、もう一方の共振特性ＲＡＲｙに対して設定済の実ノッチフィルタＮｃｈｙの共振抑制効果を減少・無効化しないこと
条件Ｃ２に関して、一方の実ノッチフィルタＮｃｈｘを更新した場合、他方の共振特性ＲＡＲｙと実ノッチフィルタＮｃｈｙの物理特性自体は変化しないので、開ループでみれば他方側ＲＡＲｙ・Ｎｃｈｙの共振抑制・相殺効果が減少することはない。
C1: At each iteration, the actual notch filter Nchx updates and sets the resonance characteristic RARx that generated the vibration estimated by the sequential
しかしながら閉ループで見た場合は一方の実ノッチフィルタの更新で他方側にも何かしらの影響が及ぶので、必ずしも条件Ｃ２が成立する保証はない。 However, when viewed in a closed loop, updating one of the actual notch filters has some effect on the other side, so there is no guarantee that condition C2 will be satisfied.
しかしながら式（２５）によれば、一方の実ノッチフィルタＮｃｈｘを更新し共振相殺・抑制効果を高める(即ちＥｔｘを０に近づける)と、相互影響項であるＥｔｘｙも０に近づき、ｙ０〜ｙ１２の全ての分母に共通に含まれる相殺残差部分（１＋Ｅｔｘ＋Ｅｔｙ＋Ｅｔｘｙ）の影響が減少するため、ｙ０は理想応答に近づき、ｙｘ、ｙｘｙにおいても相殺誤差の影響が減少することがわかる。したがって一方の実ノッチフィルタＮｃｈｘのＣ１を充足する更新で、もう一方ｙの共振相殺・抑制効果が著しく減少するわけではない。 However, according to the equation (25), when one of the real notch filters Nchx is updated to enhance the resonance canceling / suppressing effect (that is, Etx is brought closer to 0), the mutual influence term Etxy also approaches 0, and y0 to y12. Since the influence of the canceling residual portion (1 + Etx + Ety + Etxy) commonly included in all denominators is reduced, it can be seen that y0 approaches the ideal response and the influence of the canceling error is also reduced in yx and yxy. Therefore, the update that satisfies C1 of one real notch filter Nchx does not significantly reduce the resonance canceling / suppressing effect of the other y.
特に一方の実ノッチフィルタＮｃｈｘのＣ１を充足する更新でＥｔｘ≒０になった場合は、ｙｘ、ｙｘｙが概略０になるので、もう一方の実ノッチフィルタＮｃｈｙのその後の更新でｘ側の共振相殺・抑制効果が低下することはない。 In particular, when Etx≈0 is obtained by updating to satisfy C1 of one real notch filter Nchx, yx and yxy become approximately 0, so that the resonance of the x side is canceled by the subsequent update of the other real notch filter Nchy. -The inhibitory effect does not decrease.
このことはＥｔｘおよびＥｔｙが０に近い程、条件Ｃ２を満たし収束に有利な状況になることを意味する。またＥｔｘもしくはＥｔｙが０に近い程、１共振（ｎ＝１）の場合に漸近し、反復処理において条件Ｃ１が充足される。 This means that the closer Etx and Ety are to 0, the more the condition C2 is satisfied and the situation becomes more advantageous for convergence. Further, the closer Etx or Ety is to 0, the closer to the case of 1 resonance (n = 1), and the condition C1 is satisfied in the iterative processing.
ｎ＝２以上の収束性の厳密な証明は難しいので、収束平面の解析には数値的アプローチの支援を得るとする。 Since it is difficult to prove the convergence of n = 2 or more exactly, it is assumed that the numerical approach is supported for the analysis of the convergence plane.
共振周波数１８９４．７［Ｈｚ］のＲＡＲ１、および共振周波数３１３２．０［Ｈｚ］のＲＡＲ２に対して図１に示すようなＦＢ制御系を構成し、２つの実ノッチフィルタＮｃｈ１およびＮｃｈ２をノッチ周波数１１００［Ｈｚ］から３９００［Ｈｚ］までスライドさせた際の収束平面を描かせる。 An FB control system as shown in FIG. 1 is configured for RAR1 having a resonance frequency of 1894.7 [Hz] and RAR2 having a resonance frequency of 3132.0 [Hz], and two real notch filters Nch1 and Nch2 are provided with notch frequencies 1100. Draw a convergence plane when sliding from [Hz] to 3900 [Hz].
但し実ノッチフィルタが２つであるため定義域が２次元となり、収束平面は３次元平面となる。また共振特性が２種となったので、各共振特性に対して各々収束平面が存在する。３次元平面における評価を容易にするために、一方の実ノッチフィルタＮｃｈｙを固定させた状態でもう一方の実ノッチフィルタＮｃｈｘをスライドさせて２次元の収束平面を描かせ、Ｎｃｈｙを各所に固定させた場合の収束平面を重ね合わせてプロットすることで評価する。 However, since there are two actual notch filters, the domain is two-dimensional and the convergence plane is a three-dimensional plane. Moreover, since there are two types of resonance characteristics, there is a convergence plane for each resonance characteristic. In order to facilitate evaluation in a three-dimensional plane, one real notch filter Nchy is fixed and the other real notch filter Nchx is slid to draw a two-dimensional convergence plane, and Nchy is fixed in various places. Evaluate by superimposing and plotting the convergence planes of the above cases.
なお固定したＮｃｈｙが存在しない（すなわちＮｃｈｙ＝１）の場合も合わせて評価する。図５はこのような方法で第１共振１８９４．７［Ｈｚ］の収束平面をプロットしたものであり、図６は第２共振３１３２．０［Ｈｚ］の収束平面をプロットしたものである。 The case where the fixed Nchy does not exist (that is, Nchy = 1) is also evaluated. FIG. 5 is a plot of the convergence plane of the first resonance 1894.7 [Hz] by such a method, and FIG. 6 is a plot of the convergence plane of the second resonance 3132.0 [Hz].
図５及び図６から、固定側ノッチフィルタＮｃｈｙがいずれの周波数に介在する場合も、もしくは介在しない場合でも、第１共振および第２共振において収束平面は式（３）〜（５）を満たすことが確認される。したがって反復処理で２共振を抑制できる。 From FIGS. 5 and 6, the convergence plane satisfies equations (3) to (5) in the first resonance and the second resonance regardless of which frequency the fixed-side notch filter Nchy intervenes or does not intervene. Is confirmed. Therefore, two resonances can be suppressed by iterative processing.
固定側ノッチフィルタＮｃｈｙが第ｘ共振付近に位置する場合（例えば第２共振に固定側ノッチフィルタＮｃｈｙが介在した場合）は、収束平面はフラット化する傾向となる。 When the fixed-side notch filter Nchy is located near the x-resonance (for example, when the fixed-side notch filter Nchy intervenes in the second resonance), the convergence plane tends to be flattened.
これは共振特性ｘがノッチフィルタＮｃｈｙでより相殺された場合は、もう一方のノッチフィルタＮｃｈｘの介在周波数がいかなるものであっても相殺能力が高い状態を維持することを示し、すなわち２共振であっても、他方の共振特性がノッチフィルタでより相殺され、更には完全相殺された場合には、共振抑制問題は１共振の場合に移行できることを意味する。このことは式（２５）の解釈と矛盾しない。 This indicates that when the resonance characteristic x is more offset by the notch filter Nchy, the state of high canceling ability is maintained regardless of the intervening frequency of the other notch filter Nchx, that is, two resonances. However, if the other resonance characteristic is more offset by the notch filter and further offset completely, it means that the resonance suppression problem can be shifted to the case of one resonance. This is consistent with the interpretation of equation (25).
ｎ＝１の場合と同様に、実ノッチフィルタの幅や深さが適切でない場合は、反復処理を行っても必ずしもノッチ周波数を共振周波数に一致させることが可能とはいえないが、実ノッチフィルタの設定値が適切である等の条件が整っていれば、多くの場合において、収束平面が式（３）〜（５）を充足することを数値的アプローチにより確認できる。 As in the case of n = 1, if the width and depth of the actual notch filter are not appropriate, it is not always possible to match the notch frequency with the resonance frequency even by performing iterative processing, but the actual notch filter In many cases, it can be confirmed by a numerical approach that the convergence plane satisfies the equations (3) to (5) if the conditions such as the appropriate setting value of are satisfied.
したがって２共振の場合でも、反復処理により２つの共振を抑制できる。
ここまでの説明では、逐次周波数推定部３が出力する系列ａ（ｋ）は振動ｙｄ（ｔ）の（振幅（パワー）が最大の振動成分の）周波数を正確に推定できることを前提とした。
Therefore, even in the case of two resonances, the two resonances can be suppressed by the iterative process.
In the description so far, it is assumed that the series a (k) output by the sequential
これを実現するための逐次周波数推定部３を図７に示す。逐次周波数推定部３は、逐次周波数推定器７１、収束判定器７２、及びＡＮＤ処理７３から構成される。
逐次周波数推定器７１は振動ｙｄ（ｔ）の時刻ｔ時点での振動ｙｄ（ｔ）の周波数の推定値を逐次周波数推定値系列ａ（ｔ）として出力する。
FIG. 7 shows a sequential
The
収束判定器７２はａ（ｔ）を入力とし、逐次周波数推定値系列ａ（ｔ）が一定値に収束したと判断したタイミングｋ（ｋ＝０、１、２、・・・）で収束判定パルスＰｌｓ（ｋ）ｋ（ｋ＝０、１、２、・・・）を出力する。
The
ＡＮＤ処理７３はａ（ｔ）とＰｌｓ（ｋ）を入力とし、Ｐｌｓ（ｋ）に基づき逐次周波数推定部３の出力である推定値系列ａ（ｋ）（ｋ＝０、１、２、・・・）を出力とする。
逐次周波数推定器７１は例えば、適応ノッチフィルタ、適応ラインエンハンサや非線形推定器（正弦波フィッティング）等のリアルタイムに周波数が推定可能な逐次推定器である。逐次周波数推定器７１に簡素な構成の離散ＩＩＲ（Ｌａｔｔｉｃｅ）型の適応ノッチフィルタ（１段）を採用した場合の処理のブロック構成を図８に示す。そして逐次周波数推定器７１の適応アルゴリズムを以下に示す。
The AND process 73 takes a (t) and Pls (k) as inputs, and based on Pls (k), the estimated value series a (k) (k = 0, 1, 2, ..., Which is the output of the sequential
The
＜離散ＩＩＲノッチフィルタ８１＞ <Discrete IIR notch filter 81>
＜適応調整器８２＞ <Adaptive regulator 82>
＜単位変換器８３＞ <Unit converter 83>
なお、ｘ、ｅ、及びａＬは各々内部状態量、推定誤差、及びノッチ周波数を意味する変数である。またμ、λ、ｒＬ、及びσx2は各々更新ステップ調整係数、忘却係数、ノッチ幅係数、及びｘの分散でありいずれも正の値である。また単位変換器８３はａＬ（ｔ）の単位を［Ｈｚ］に変換しａ（ｔ）として出力する処理である。 Note that x, e, and aL are variables that mean the internal state quantity, the estimation error, and the notch frequency, respectively. Further, μ, λ, rL, and σx2 are the variances of the update step adjustment coefficient, the forgetting coefficient, the notch width coefficient, and x, respectively, and are all positive values. Further, the unit converter 83 is a process of converting the unit of aL (t) into [Hz] and outputting it as a (t).
式（２６）〜（３０）による振動ｙｄ（ｔ）の逐次周波数推定値系列ａ（ｔ）は、もしｙｄ（ｔ）が複数の周波数成分が重畳した振動波形であった場合は、複数の振動成分のうち振幅（パワー）が最大かつ持続的な振動成分に対する周波数を優先的に推定する傾向にある（なお各振動成分の振幅(パワー)比が１に近い場合は、初期値ａ（０）に依存してａ（０）に近い周波数を有する振動成分を推定しやすい傾向となる）。 The sequential frequency estimation value series a (t) of the vibration yd (t) according to the equations (26) to (30) has a plurality of vibrations if the yd (t) is a vibration waveform in which a plurality of frequency components are superimposed. There is a tendency to preferentially estimate the frequency for the vibration component with the largest amplitude (power) among the components (note that when the amplitude (power) ratio of each vibration component is close to 1, the initial value a (0). It tends to be easy to estimate the vibration component having a frequency close to a (0) depending on the above).
このことはａ（ｔ）がａ（ｋ）として実ノッチフィルタに適用され共振が抑制されるとする場合、逐次周波数推定器７１に上記適応ノッチフィルタを採用するとき、最も振幅（パワー）の大きい共振が優先的に抑制される傾向となることを意味する。
This means that when a (t) is applied to the actual notch filter as a (k) and resonance is suppressed, the amplitude (power) is the largest when the adaptive notch filter is adopted for the
収束判定器７２は様々な実現方法が考えられるが、簡素な構成の一例を以下に示す。
Various implementation methods can be considered for the
＜収束判定器７２＞
差分過程を次式で定義する。
<
The difference process is defined by the following equation.
収束判定器の出力Ｐｌｓ（ｋ）は以下で算出する。
ｉ) 差分過程ε（ｔ）が指定時間Ｔｅ以内に差分閾値Ｔεを一度も超過しない、かつ 指定時間Ｔｅ内のａ（ｔ）の最初の値と最後の値の差(傾き)の絶対値が傾き閾値Ｔεｄ以内であるとき、収束したと判断し、そのタイミングをｋ、収束判定パルスＰｌｓ（ｋ）を１に設定。
ｉi)差分過程ε（ｔ）が指定時間Ｔｅ以内に差分閾値Ｔεを一度でも超過する、もしくは収束判定パルス発生後、指定時間Ｔｅｄを経過するまでは収束判定パルスは０。
The output Pls (k) of the convergence test is calculated as follows.
i) The difference process ε (t) never exceeds the difference threshold Tε within the specified time Te, and the absolute value of the difference (slope) between the first and last values of a (t) within the specified time Te is When it is within the inclination threshold value Tεd, it is determined that the convergence is performed, the timing is set to k, and the convergence test pulse Pls (k) is set to 1.
ii) The convergence test pulse is 0 until the difference process ε (t) exceeds the difference threshold value Tε even once within the specified time Te, or after the specified time Ted elapses after the convergence test pulse is generated.
簡素な傾き演算方法、及び傾き閾値を設けたことで、常にａ（ｔ）が微小に増加し続ける場合、もしくは微小に減少し続ける場合を収束判定しないようにしている。 By providing a simple slope calculation method and a slope threshold value, convergence test is not performed when a (t) always continues to increase slightly or continues to decrease minutely.
これにより、ａ（ｋ）は適応アルゴリズムの収束完了時の信頼できる推定値となり、振動ｙｄ（ｔ）の周波数の正確な推定値であることが期待できる。 As a result, a (k) becomes a reliable estimate when the convergence of the adaptive algorithm is completed, and it can be expected that it is an accurate estimate of the frequency of the vibration yd (t).
このようなａ（ｋ）が得られることで、前述の反復処理に基づく複数の共振特性の共振周波数の推定が可能になる。 By obtaining such a (k), it becomes possible to estimate the resonance frequencies of a plurality of resonance characteristics based on the above-mentioned iterative processing.
このようなａ（ｋ）を前提に共振特性の数が最大２（ｎ＝１、２）の場合の共振数推定部４の動作を図９に示す。共振数推定部４はａ（ｋ）に基づき、ａ（ｋ）から共振数を逐次に推定し共振数推定値系列Ｎ（ｋ）を出力する。
FIG. 9 shows the operation of the resonance
図９では、ｎ＝１（第１共振がＦ１［Ｈｚ］）の場合に、図４に示すような収束平面を形成する場合に、反復処理を行った際のａ（ｋ）を実線、ｎ＝２（第１共振がＦ１［Ｈｚ］、第２共振がＦ２［Ｈｚ］）の場合に、図５及び図６のような収束平面を形成する場合に、反復処理を行った際のａ（ｋ）を破線で示している。 In FIG. 9, when n = 1 (the first resonance is F1 [Hz]), when the convergence plane as shown in FIG. 4 is formed, a (k) when the iterative processing is performed is a solid line, n. When = 2 (the first resonance is F1 [Hz] and the second resonance is F2 [Hz]) and the convergence plane as shown in FIGS. 5 and 6 is formed, a (a (a) when the iterative process is performed. k) is shown by a broken line.
但し、ｎ＝２の場合、ここでは実ノッチフィルタ１は第１共振を抑制するためのものとし、実ノッチフィルタ２は第２共振を抑制するためのものとし、ａ（ｋ）はどちらの共振特性の周波数推定値かを正確に把握でき、適切な実ノッチフィルタに適用できるものと仮定する。
However, when n = 2, here, the
ｎ＝１の場合、初期ｋ＝０での推定値ａ（０）は第１共振を対象とした推定値であるが、ＦＢ制御によりＦ１≠ａ（０）であり、１回の反復処理を行ったａ（１）は図４の収束平面によれば｜Ｆ１−ａ（０）｜＞｜Ｆ１−ａ（１）｜が期待できる。図４によれば、｜Ｆ１−ａ（ｋ）｜→Ｆ１＝ａ（ｋ）（ｋ→∞）となるはずであり、式（５）を充足する場合は必ず｜ａ（ｋ−１）−ａ（ｋ−２）｜＞｜ａ（ｋ）−ａ（ｋ−１）｜である。 When n = 1, the estimated value a (0) at the initial k = 0 is an estimated value for the first resonance, but F1 ≠ a (0) due to FB control, and one iteration process is performed. According to the convergence plane of FIG. 4, the performed a (1) can be expected to be | F1-a (0) |> | F1-a (1) |. According to FIG. 4, | F1-a (k) | → F1 = a (k) (k → ∞), and when equation (5) is satisfied, | a (k-1) − a (k-2) |> | a (k) -a (k-1) |.
他方、ｎ＝２の場合、仮に図９のようにｋ＝０、１で第１共振Ｆ１を抑制したとしある程度の抑制効果が発揮されたとき、第１共振より第２共振の振動（パワー）が顕著になり、ｋ＝２では第２共振を対象にしたａ（ｋ）が得られることが想定される。 On the other hand, in the case of n = 2, if the first resonance F1 is suppressed at k = 0 and 1 as shown in FIG. 9, and a certain degree of suppression effect is exhibited, the vibration (power) of the second resonance rather than the first resonance is exhibited. Is remarkable, and it is assumed that a (k) targeting the second resonance can be obtained when k = 2.
この場合、｜Ｆ１−ａ（０）｜＞｜Ｆ１−ａ（１）｜ではなく、｜Ｆ１−ａ（０）｜＜｜Ｆ１−ａ（１）｜、｜ａ（ｋ−１）−ａ（ｋ−２）｜＞｜ａ（ｋ）−ａ（ｋ−１）｜ではなく、｜ａ（ｋ−１）−ａ（ｋ−２）｜＜｜ａ（ｋ）−ａ（ｋ−１）｜となる傾向にある。 In this case, instead of | F1-a (0) |> | F1-a (1) |, | F1-a (0) | << | F1-a (1) |, | a (k-1) -a (K-2) |> | a (k) -a (k-1) |, not | a (k-1) -a (k-2) | << a (k) -a (k-1) | ) |.
したがってｎ＝１、ｎ＝２の場合のａ（ｋ）の挙動に注目すると、以下の簡素なアルゴリズムで共振数を推定可能といえる。すなわち、逐次周波数推定部３から得たａ（ｋ）の今回値と前回値の差の絶対値が所定の閾値を超過した場合に共振数は２、それ以外は１と推定すればよい。
Therefore, paying attention to the behavior of a (k) when n = 1 and n = 2, it can be said that the number of resonances can be estimated by the following simple algorithm. That is, the resonance number may be estimated to be 2 when the absolute value of the difference between the current value and the previous value of a (k) obtained from the sequential
＜共振数推定部４（最大２共振（ｎ＝１、２）の場合）＞ <Resonance number estimation unit 4 (in the case of maximum 2 resonances (n = 1, 2))>
但し、Ｔｒ、Ｎ（ｋ）は各々共振数閾値［Ｈｚ］及び共振数推定値系列である。また逐次周波数推定部３はｋ≧０で動作し、振動検出部７が振動を未検出の、自動調整部２が初期状態の場合では、ｋ＝−１とし共振数はＮ（−１）＝０、すなわち実ノッチフィルタは制御器後段に１つも設けられない状態となることに注意する。
However, Tr and N (k) are resonance number threshold values [Hz] and resonance number estimation value series, respectively. Further, when the sequential
またＮ（ｋ）が２となった時に、前述の仮定である、
『実ノッチフィルタ１は第１共振を抑制するためのものとし、実ノッチフィルタ２は第２共振を抑制するためのものとし、ａ（ｋ）はどちらの共振特性の周波数推定値かを正確に把握でき、適切な実ノッチフィルタに適用できる』、を成立させる、ａ（ｋ）を適用する実ノッチフィルタの選択手段である共振番号判断部５は下記の簡素なアルゴリズムで実現可能である。
Further, when N (k) becomes 2, the above assumption is made.
"The
＜共振番号判断部５（最大２共振（ｎ＝１、２）の場合）＞
ａ（ｋ）を適用する実ノッチフィルタの番号は以下のＬｎ（ｋ）で決定する。
<Resonance number determination unit 5 (in the case of maximum 2 resonances (n = 1, 2))>
The number of the actual notch filter to which a (k) is applied is determined by the following Ln (k).
但し、ａｎ１、ａｎ２は各々ｋ時点での実ノッチフィルタ１のノッチ周波数［Ｈｚ］、及びｋ時点での実ノッチフィルタ２のノッチ周波数［Ｈｚ］のノッチフィルタである。
However, an1 and an2 are notch filters having a notch frequency [Hz] of the
ここまでで、共振数が最大２（ｎ＝１、２）の場合の共振数推定部４及び共振番号判断部５について説明したが、共振数が３つ以上の場合も共振数推定部４を拡張し、図１０に示す共振数推定部１１１とすることで可能である。共振数推定部１１１のアルゴリズムを以下に示す。
Up to this point, the resonance
図１０は、図１と同様な一般的なモータのＦＢ制御系に適用した実施例１の変形例を示した図である。図１と同じ構成部分については、説明を省略する。 FIG. 10 is a diagram showing a modified example of the first embodiment applied to the FB control system of a general motor similar to that of FIG. The same components as in FIG. 1 will not be described.
＜共振数推定部１１１（ｎ共振対応の場合）＞
Ｎ（０）＝１、ｒＮ（０）＝１
Ｆｏｒ ｋ＝１〜
ＩＦ ｜ａ（ｋ）−ａ（ｋ−１）｜＜Ｔｒ
Ｎ（ｋ）＝Ｎ（ｋ−１）
ｒＮ（ｋ）＝ｒＮ（ｋ−１）
ＥＬＳＥ ％共振数閾値を超過する場合
Ｒｎｇ（ｒＮ（ｋ−１））＝［Ｗｍｉｎ(ｒＮ（ｋ−１)、Ｗｍａｘ（ｒＮ（ｋ−１））
ＩＦ ａ（ｋ）がＲｎｇ（１）〜Ｒｎｇ（Ｎ（ｋ−１））のうち、
いずれかのＲｎｇ（ｊ）に含まれる場合
ｒＮ（ｋ）＝ ｊ
Ｎ（ｋ）＝Ｎ（ｋ−１）
ＥＬＳＥ
Ｎ（ｋ）＝Ｎ（ｋ−１）＋１
ｒＮ（ｋ）＝Ｎ（ｋ）
ＥＮＤ
ＥＮＤ
ＥＮＤ
<Resonance number estimation unit 111 (when n-resonance is supported)>
N (0) = 1, rN (0) = 1
Fork = 1 ~
IF | a (k) -a (k-1) | <Tr
N (k) = N (k-1)
rN (k) = rN (k-1)
When the ELSE% resonance number threshold is exceeded Rng (rN (k-1)) = [Wmin (rN (k-1), Wmax (rN (k-1)))
IF a (k) is Rng (1) to Rng (N (k-1)).
When it is contained in any Rng (j)
rN (k) = j
N (k) = N (k-1)
ELSE
N (k) = N (k-1) + 1
rN (k) = N (k)
END
END
END
但し、Ｒｎｇ（ｉ）は、ｉ番目の共振周波数幅であり、所定の周波数幅［Ｗｍｉｎ（ｉ）、Ｗｍａｘ（ｉ））(すなわちＷｍｉｎ（ｉ）≦Ｒｎｇ（ｉ）＜Ｗｍａｘ（ｉ）)を持つものである。一例として、ａ（ｋ−１）が与えられたときに、Ｒｎｇ（ｉ）は、Ｔｒ＞２×ＷｒＮなるＷｒＮを用いて、Ｒｎｇ（ｉ）＝［ａ（ｋ−１）−ＷｒＮ、ａ（ｋ−１）＋ＷｒＮ）として与える。 However, Rng (i) is the i-th resonance frequency width, and a predetermined frequency width [Wmin (i), Wmax (i)) (that is, Wmin (i) ≤ Rng (i) <Wmax (i)). It has. As an example, when a (k-1) is given, Rng (i) uses WrN such that Tr> 2 × WrN, and Rng (i) = [a (k-1) -WrN, a ( It is given as k-1) + WrN).
ｒＮ（ｋ）は、共振周波数幅番号であり各Ｒｎｇに割り付け、Ｒｎｇを識別するための番号である。共振数推定部１１１は、Ｎ（ｋ）を共振数推定値系列として出力し、共振周波数幅番号ｒＮ（ｋ）を、ａ（ｋ）を適用する実ノッチフィルタの番号Ｌｎ（ｋ）として出力するものとする。
rN (k) is a resonance frequency width number, which is a number assigned to each Rng to identify the Rng. The resonance
上記アルゴリズムは、ａ（ｋ）が共振数閾値Ｔｒを超過した場合に、ａ（ｋ−１）に共振周波数幅及び共振周波数幅番号を割り付け、ａ（ｋ）が既に共振周波数幅番号が割り付けられた共振周波数幅Ｒｎｇのいずれにも属さないときのみ、共振数を＋１増加させるアルゴリズムである。共振数推定部１１１の挙動を図１１に示す。
In the above algorithm, when a (k) exceeds the resonance number threshold Tr, the resonance frequency width and the resonance frequency width number are assigned to a (k-1), and the resonance frequency width number is already assigned to a (k). It is an algorithm that increases the number of resonances by +1 only when it does not belong to any of the resonance frequency widths Rng. The behavior of the resonance
図１１の事例は、第１〜第４共振が存在し、共振数は４つとし、各共振周波数が５５０、１０００、２０００、４０００［Ｈｚ］とした際の結果である。共振数閾値を超過するたびに共振周波数幅Ｒｎｇがａ（ｋ−１）に割り付けられ、ａ（ｋ）が既存の共振周波数幅Ｒｎｇのいずれにも属さない場合のみ、共振数が＋１増加され、最終的に共振数推定値Ｎ（ｋ）は真値４となることが把握できる。
The example of FIG. 11 is a result when the first to fourth resonances exist, the number of resonances is four, and the respective resonance frequencies are 550, 1000, 2000, 4000 [Hz]. Each time the resonance number threshold is exceeded, the resonance frequency width Rng is assigned to a (k-1), and the resonance number is increased by +1 only when a (k) does not belong to any of the existing resonance frequency widths Rng. Finally, it can be understood that the estimated resonance number N (k) becomes the
上記アルゴリズムは、共振数推定部４と共振番号判断部５を纏めて一般化したものである。換言すれば、共振数推定部４と共振番号判断部５は上記アルゴリズムを共振数が最大２である場合に特化させ、処理を簡素化したものである。
The above algorithm is a generalization of the resonance
ここで、共振数推定部４の動作について、説明する。
制御対象の１つ以上の共振特性に起因してＦＢ制御系の応答に振動が重畳する場合に、共振数推定部４は、共振数推定値の初期値を１に設定し、更に共振周波数幅番号の初期値を１に設定する（ステップ１）。
Here, the operation of the resonance
When vibration is superimposed on the response of the FB control system due to one or more resonance characteristics of the controlled object, the resonance
逐次周波数推定部３から得た振動周波数推定値系列の今回値と前回値の差の絶対値が所定の閾値（共振数閾値）を超えた場合に、前回値に対して共振周波数幅番号に紐付いた共振周波数幅を割り当てる（ステップ２）。
When the absolute value of the difference between the current value and the previous value of the vibration frequency estimation value series obtained from the sequential
共振周波数幅は前回値を中心値とし中心値に対して正の所定の値を加算した値を上限とし中心値に対して正の所定の値を減算した値を下限とする周波数領域であるとする（ステップ３）。 The resonance frequency width is a frequency domain in which the previous value is the center value, the upper limit is the value obtained by adding a positive predetermined value to the center value, and the lower limit is the value obtained by subtracting the positive predetermined value from the center value. (Step 3).
今回値が既に設けられた１つ以上の共振周波数幅のどれか１つに入る場合には共振数推定値は変化させず、かつ共振周波数幅番号を今回値が含まれる共振周波数幅に紐付けられた共振周波数幅番号へと更新する（ステップ４）。 If the value this time falls within any one of one or more resonance frequency widths already provided, the estimated resonance number is not changed, and the resonance frequency width number is linked to the resonance frequency width including the current value. It is updated to the obtained resonance frequency width number (step 4).
今回値が既に設けられた１つ以上の共振周波数幅に入らない場合、もしくは共振周波数幅が１つ以上設けられていない場合は、共振数推定値を１増加させ、更に共振周波数幅番号を１増加させた共振数推定値に設定する（ステップ５）。 If the value does not fall within one or more resonance frequency widths already provided, or if one or more resonance frequency widths are not provided, the resonance number estimation value is increased by 1, and the resonance frequency width number is further increased by 1. It is set to the increased resonance number estimate (step 5).
逐次周波数推定部３から得た振動周波数推定値系列の今回値と前回値の差の絶対値が所定の閾値（共振数閾値）を超えない場合は共振数推定値を変化させず、また前記共振周波数幅番号を変化させない（ステップ６）。
If the absolute value of the difference between the current value and the previous value of the vibration frequency estimation value series obtained from the sequential
前記ステップ２から前記ステップ６を今回値が得られる毎に逐次に繰り返すことで共振数を推定し、共振数推定値系列として出力する。
The resonance number is estimated by sequentially repeating the
共振周波数幅番号は、制御器の後段に１つ以上設けられるノッチフィルタを適用する番号とし、逐次推定の結果の今回値を、共振周波数幅番号のノッチフィルタに適用する。 The resonance frequency width number is a number to which one or more notch filters provided in the subsequent stage of the controller are applied, and the current value of the result of sequential estimation is applied to the notch filter of the resonance frequency width number.
図１に示す自動調整部２を実行した際の、共振抑制の状況を図１２に示す。なお、共振数は２とし、第１共振周波数１０００［Ｈｚ］、第２共振周波数２０００［Ｈｚ］とし、振動ｙｄ（ｔ）は図１２のように同時間帯に第１共振及び第２共振に起因した振動２種（ｙｄ１（ｔ）およびｙｄ２（ｔ））が重畳した振動が観測された場合の共振抑制の状況である。
FIG. 12 shows the state of resonance suppression when the
振動ｙｄ（ｔ）に対する逐次周波数推定部３の周波数の推定値は、常に（振幅（パワー）最大の成分を優先的に)１つのみしか得られないが、共振数推定部４と共振番号判断部５を伴うことで、２共振が持続的に発生している状況であれば、短時間に、リアルタイムに２共振を精度よく抑制可能なことがわかる。
Only one frequency estimation value of the sequential
もちろん、２共振が非同時に発生する場合でも、各共振が顕著に持続的に発生した場合でも、短時間に、リアルタイムに各共振を抑制可能である。また振動抽出部６、振動検出部７で抑制すべき振動（共振特性）を選別した後に逐次周波数推定器７１で振動ｙｄ（ｔ）の周波数を推定し、かつ収束判定器７２で振動ｙｄ（ｔ）の周波数の推定値としての信頼度を高めたａ（ｋ）が得られる構成としており、高精度・高信頼な共振抑制が可能である。
Of course, even when two resonances occur non-simultaneously or when each resonance occurs remarkably continuously, each resonance can be suppressed in real time in a short time. Further, after the
本実施例によれば、機械系の1つ以上の共振特性を抑制する目的でＦＢ制御系内に設ける実ノッチフィルタの数、及び実ノッチフィルタのノッチ周波数を、事前調査の必要なしに、且つ２つ以上の共振特性が同時に発生した場合であっても、高精度・リアルタイムに自動で推定・調整し、機械系の1つ以上の共振特性をリアルタイムに抑制することが可能なノッチフィルタ調整装置、およびそれを備えたモータ制御装置を提供することが可能である。 According to this embodiment, the number of real notch filters provided in the FB control system for the purpose of suppressing one or more resonance characteristics of the mechanical system and the notch frequency of the real notch filters can be determined without the need for prior investigation. A notch filter adjustment device that can automatically estimate and adjust with high accuracy and in real time even when two or more resonance characteristics occur at the same time, and suppress one or more resonance characteristics of the mechanical system in real time. , And a motor control device including the same.
なお本実施例では、自動調整部２はモータ回転数ｙを入力としたが、振動成分の抽出のしやすさの観点から、自動調整部２の入力を、図1の加減算器１６の出力であるモータ回転数偏差としてもよい。また同観点からＦＢ制御器１３の出力を用いてもよい。
In this embodiment, the motor rotation speed y is input to the
またａ（ｋ）による実ノッチフィルタのノッチ周波数の更新に合わせて、ノッチ幅Ｗ、ノッチ深さＤを更新してもよい。 Further, the notch width W and the notch depth D may be updated in accordance with the update of the notch frequency of the actual notch filter by a (k).
共振特性をよりロバストに抑制するという観点からはノッチ幅Ｗは広めに、ノッチ深さは深めに設定する方がよい。しかしａ（ｋ）が低い周波数の場合、ノッチ幅を広く設定する、もしくはノッチ深さを深く設定すると、ノッチフィルタの特性上、ノッチ周波数より低域でＦＢ制御系の位相遅れが増加する傾向となり、ＦＢ制御系の安定余裕を減少させ、場合よってはＦＢ制御系が発振する恐れがある。そのため、ａ（ｋ）に合わせてノッチ幅Ｗ、ノッチ深さＤを設定する方が望ましい。したがって例えばノッチ幅Ｗ、ノッチ深さＤは、ノッチ幅Ｗ（ａ（ｋ））、ノッチ深さＤ（ａ（ｋ））のようにａ（ｋ）の関数、もしくはＭＡＰとして適切な値を割り振るようにしてもよい。 From the viewpoint of suppressing the resonance characteristics more robustly, it is better to set the notch width W to be wide and the notch depth to be deep. However, when a (k) is a low frequency, if the notch width is set wide or the notch depth is set deep, the phase delay of the FB control system tends to increase in the range lower than the notch frequency due to the characteristics of the notch filter. , The stability margin of the FB control system is reduced, and in some cases, the FB control system may oscillate. Therefore, it is desirable to set the notch width W and the notch depth D according to a (k). Therefore, for example, the notch width W and the notch depth D are assigned appropriate values as a function of a (k) such as the notch width W (a (k)) and the notch depth D (a (k)) or as a MAP. You may do so.
またノッチ幅Ｗ、ノッチ深さＤはａ（ｋ）と振動ｙｄ（ｔ）の振幅を観測して調整する仕組みを設けてもよい。例えばａ（ｋ）は持続的な変化がないが、振動ｙｄ（ｔ）の振幅が大きいままである場合は、ノッチ幅Ｗを広げる、もしくはノッチ深さＤを深める、等の調整である。 Further, the notch width W and the notch depth D may be adjusted by observing the amplitudes of a (k) and vibration yd (t). For example, when a (k) does not have a continuous change but the amplitude of the vibration yd (t) remains large, the notch width W is widened or the notch depth D is deepened.
また、共振数閾値Ｔｒはａ（ｋ）に合わせて変化するものとしてもよい。すなわちＴｒ（ａ（ｋ））である。自動調整したい機械系を想定して適切な関数、ＭＡＰとすればよい。 Further, the resonance number threshold Tr may be changed according to a (k). That is, Tr (a (k)). Assuming a mechanical system to be automatically adjusted, an appropriate function or MAP may be used.
また、共振周波数幅Ｒｎｇはａ（ｋ−１）に合わせて変化するものとしてもよい。すなわちＲｎｇ（ａ（ｋ−１））である。自動調整したい機械系を想定して適切な関数、ＭＡＰとすればよい。 Further, the resonance frequency width Rng may be changed according to a (k-1). That is, Rng (a (k-1)). Assuming a mechanical system to be automatically adjusted, an appropriate function or MAP may be used.
また、共振数推定部１１１は、推定する共振数に上限を設けてもよい。また、抑制したい共振周波数の範囲に制約を設けてもよい。例えばＡｍｉｎ［Ｈｚ］〜Ａｍａｘ［Ｈｚ］を抑制したい範囲とした場合、ａ（ｔ）に基づいて収束判定を行う収束判定器７２に、収束判定パルスを出力する条件として、「Ａｍｉｎ≦ａ（ｔ）≦Ａｍａｘであること」を追加すればよい。
Further, the resonance
また振動抽出部６で抽出する周波数帯域をＡｍｉｎ［Ｈｚ］〜Ａｍａｘ［Ｈｚ］に絞ってもよい。
Further, the frequency band extracted by the
また自動調整部２は、ＦＢ制御器１３のＦＢゲインに基づいて動作のＯＮ／ＯＦＦや共振数閾値等の自動調整部２のパラメータが調整されるものとしてもよい。機械系の複数の共振特性のうち、ＦＢ制御系が考慮・抑制すべき共振特性の数はＦＢゲインに依存するためである。
Further, the
また同様の理由から、自動調整部２は、共振数推定値や振動抑制の状況に合わせてＦＢ制御器１３のＦＢゲインを調整する仕組みを設けてもよい。
Further, for the same reason, the
また、実ノッチフィルタは式（２）、（１４）、（１５）で与えられる形式のものでなくてもよい。式（２）、（１４）、（１５）は連続系であり実装時は離散化する必要があるが、これらを一般的なｚ変換各種（ＺＯＨ、Ｔｕｓｔｉｎ変換、整合ｚ変換）で離散化したフィルタは、離散ＩＩＲノッチフィルタ８１の式（２６）、（２７）と同じ構造になるとは限らない。したがって、例えば離散ＩＩＲノッチフィルタ８１をそのまま実ノッチフィルタとして採用してもよい。 Further, the actual notch filter does not have to be of the type given by the equations (2), (14) and (15). Equations (2), (14), and (15) are continuous systems and need to be discretized at the time of mounting, but these are discretized by various general z-transforms (ZOH, Tustin transform, matched z-transform). The filter does not always have the same structure as the equations (26) and (27) of the discrete IIR notch filter 81. Therefore, for example, the discrete IIR notch filter 81 may be adopted as it is as the actual notch filter.
また、自動調整部２は別途実ノッチフィルタをリセットする仕組みを設けてもよい。例えば抑制する共振特性の数がｎ＝２で、実ノッチフィルタの利用可能上限数が２である場合、共振数推定部４と共振番号判断部５においては、何らかの誤差要因で１つの実ノッチフィルタＮｃｈｘが第１共振及び第２共振のいずれからも極端に離れた不正な周波数に設定された場合には、第１共振と第２共振を他方の実ノッチフィルタＮｃｈｙのみで抑制しなければならない状況が発生しうる。このような場合を検出し、固定化された実ノッチフィルタＮｃｈｘを開放・リセットする仕組みを設けることは自動調整部２のロバスト化に有効である。
Further, the
実施例２は、実施例１をモータ制御装置に適用した例であり、図１３示すＡＣサーボモータのカスケードＦＢ制御系における速度制御系へ適用した実施例である。 The second embodiment is an example in which the first embodiment is applied to the motor control device, and is an example in which the AC servomotor shown in FIG. 13 is applied to the speed control system in the cascade FB control system.
図１に示した自動調整部２を、図１３に適用した実施例２を示すのが図１４である。自動調整部１４０１はエンコーダ１３９の出力から位置・速度算出部１３１１で算出されたモータ速度（モータ回転数）を入力として取り扱う。
FIG. 14 shows Example 2 in which the
モータの電気回路部分を電流制御器１３３が制御し、この制御周期が速度制御器１３２より速い前提においては速度制御系において、電流制御系は近似的に１（速度制御器の操作量がモータの機械部分（ロータ）に直達される）にみなされる。したがって自動調整部１４０１の出力を入力する速度制御器１３２の制御対象は、モータの機械部分（ロータ）とモータロータに結合された機械１３１３であり、これが図１におけるＦＢ制御器の制御対象に相当する。
Assuming that the electric circuit part of the motor is controlled by the
機械１３１３の慣性数は１とし、機械１３１３とモータロータが弾性結合されているとみなされる場合は、制御対象は機械１３１３とモータロータがバネ・ダンパで結合された２慣性系とみなすことができ、制御対象は１組の共振・反共振特性を含む周波数特性を有するものとなる。
When the number of inertia of the
また、機械１３１３の慣性数が２で各慣性はバネ・ダンパで結合され、その一方がモータロータに対して弾性結合されているとみなされる場合は制御対象は各慣性がバネ・ダンパで結合された３慣性系とみなすことができ、２組の共振・反共振特性を含む周波数特性を有するものとなる。
Further, when the number of inertias of the
実施例１で示したように、自動調整部２は共振数を事前調査の必要なく、２共振、もしくはそれ以上であっても、自動で共振を抑制可能である。したがって、本実施例においても自動調整部２は共振数を事前調査の必要なく、速度制御器１３２の後段に適切なノッチ周波数を内包する実ノッチフィルタを適切な数だけ自動で設定・調整することが可能である。
As shown in the first embodiment, the
したがって、本実施例によれば、図１３に示すＡＣサーボモータのカスケードＦＢ制御系における速度制御系に対しても、自動調整部２を適用し、速度制御系内に設ける実ノッチフィルタの数、及び実ノッチフィルタのノッチ周波数を、事前調査の必要なしに、且つ２つ以上の共振特性が同時に発生した場合であっても、高精度・リアルタイムに自動で推定・調整し、機械系の1つ以上の共振特性をリアルタイムに抑制することが可能である。またそのような自動調整部２を備えたＡＣサーボモータのカスケードＦＢ制御系を備えたモータ制御装置を提供することが可能である。
Therefore, according to this embodiment, the
２…自動調整部、３…逐次周波数推定部、４…共振数推定部、５…共振番号判断部、６…振動抽出部、７…振動検出部、８…スイッチ、９…切替スイッチ、１０〜１２…実ノッチフィルタ１〜ｎ、１３…ＦＢ制御器、１４…モータ、１５…制御対象機械
2 ... Automatic adjustment unit, 3 ... Sequential frequency estimation unit, 4 ... Resonance number estimation unit, 5 ... Resonance number determination unit, 6 ... Vibration extraction unit, 7 ... Vibration detection unit, 8 ... Switch, 9 ... Changeover switch, 10 ... 12 ...
Claims (12)
前記振動成分のうち、ある１つの前記振動成分の周波数を逐次に推定し、これを振動周波数推定値系列として出力する逐次周波数推定部と、
前記振動周波数推定値系列に基づいて、
前記制御系の応答に重畳する振動の発生原因となる共振特性の数を、
共振数推定値系列として出力するとともに、
前記共振数推定値系列の値に応じた個数のノッチフィルタを前記制御系の制御器後段に直列に設置する共振数推定部とを有することを特徴とするノッチフィルタ調整装置。 A vibration extractor that extracts one or more vibration components that are superimposed on the response of the control system due to one or more resonance characteristics of the controlled object.
A sequential frequency estimation unit that sequentially estimates the frequency of one of the vibration components and outputs this as a vibration frequency estimation value series.
Based on the vibration frequency estimation value series
The number of resonance characteristics that cause vibrations superimposed on the response of the control system is determined.
While outputting as a resonance number estimation value series,
A notch filter adjusting device comprising a resonance number estimation unit in which a number of notch filters corresponding to the values of the resonance number estimation value series are installed in series after the controller of the control system.
前記逐次周波数推定部は、１つ以上の前記振動成分のうち
振幅が最も大きい前記振動成分の周波数を推定し、逐次周波数推定値系列として出力する逐次周波数推定器と、
前記逐次周波数推定値系列が一定値に収束したか否かを、前記逐次周波数推定値系列に基づいて判断する収束判定器とを有し、
前記収束判定器は収束したと判断した毎に、その時刻の前記逐次周波数推定値系列の値を推定値系列として出力し、
前記推定値系列を、前記逐次周波数推定部の出力としての前記振動周波数推定値系列とすることを特徴とするノッチフィルタ調整装置。 In the notch filter adjusting device according to claim 1,
The sequential frequency estimator includes a sequential frequency estimator that estimates the frequency of the vibration component having the largest amplitude among one or more of the vibration components and outputs the frequency as a sequential frequency estimation value series.
It has a convergence tester that determines whether or not the sequential frequency estimation value series has converged to a constant value based on the sequential frequency estimation value series.
Each time the convergence tester determines that the convergence has occurred, the value of the sequential frequency estimation value series at that time is output as an estimation value series.
A notch filter adjusting device, characterized in that the estimated value series is the vibration frequency estimated value series as an output of the sequential frequency estimation unit.
前記共振数推定部の推定した前記共振数推定値系列の現時刻の共振数と前記逐次周波数推定部が推定した前記振動周波数推定値系列の現時刻の周波数とから、前記制御器後段に設けられた1つ以上の実ノッチフィルタに対して
前記振動周波数推定値系列の前記現時刻の周波数に対応した実ノッチフィルタを選択する共振番号判断部を有することを特徴とするノッチフィルタ調整装置。 In the notch filter adjusting device according to claim 1,
It is provided in the latter stage of the controller from the resonance number at the current time of the resonance number estimation value series estimated by the resonance number estimation unit and the current time frequency of the vibration frequency estimation value series estimated by the sequential frequency estimation unit. A notch filter adjusting device comprising a resonance number determining unit that selects a real notch filter corresponding to the frequency of the current time in the vibration frequency estimation value series for one or more real notch filters.
前記共振数推定部は、
前記逐次周波数推定部から得た前記振動周波数推定値系列の今回値と前回値の差の絶対値が、共振数閾値を超えた場合は、前記共振特性の数は２つと推定し、
前記共振数閾値を超過しない場合は、前記共振特性の数は１つと推定し、
前記推定した前記共振特性の数を前記共振数推定値系列として出力することを特徴とするノッチフィルタ調整装置。 In the notch filter adjusting device according to claim 1,
The resonance number estimation unit is
When the absolute value of the difference between the current value and the previous value of the vibration frequency estimation value series obtained from the sequential frequency estimation unit exceeds the resonance number threshold value, the number of the resonance characteristics is estimated to be two.
If the resonance number threshold is not exceeded, the number of resonance characteristics is estimated to be one.
A notch filter adjusting device, characterized in that the estimated number of resonance characteristics is output as the resonance number estimation value series.
前記共振数推定部は、
共振数推定値の初期値を１に設定し、更に共振周波数幅番号の初期値を１に設定し、
処理Ａとして、
前記逐次周波数推定部から得た前記振動周波数推定値系列の今回値と前回値
の差の絶対値が共振数閾値を超えた場合に、
前記前回値に対して前記共振周波数幅番号に対応した共振周波数幅を割り当
て、前記共振周波数幅は前記前回値を中心値とし前記中心値に対して正の
所定の値を加算した値を上限とし、
前記中心値に対して正の所定の値を減算した値を下限とする周波数領域で
あるとし、前記今回値が既に設けられた１つ以上の前記共振周波数幅の
どれか１つに入る場合は前記共振数推定値は変化させず、
かつ前記共振周波数幅番号を前記今回値が含まれる前記共振周波数幅に
紐付けられた前記共振周波数幅番号へと更新し、
前記今回値が既に設けられた１つ以上の前記共振周波数幅に入らない場合、
もしくは前記共振周波数幅が１つ以上設けられていない場合は、
前記共振数推定値を１増加させ、更に前記共振周波数幅番号を
前記１増加させた前記共振数推定値に設定し、
処理Ｂとして、
前記逐次周波数推定部から得た前記振動周波数推定値系列の前記今回値と
前記前回値の差の絶対値が前記共振数閾値を超えない場合は、前記共振数
推定値を変化させず、また前記共振周波数幅番号を変化させず、
前記振動周波数推定値系列の前記今回値が得られる毎に逐次に前記処理Ａおよび前記処理Ｂを繰り返すことで共振数を推定し、前記共振数推定値系列として出力することを特徴とするノッチフィルタ調整装置。 In the notch filter adjusting device according to claim 1,
The resonance number estimation unit is
Set the initial value of the resonance number estimation value to 1, and further set the initial value of the resonance frequency width number to 1.
As process A
When the absolute value of the difference between the current value and the previous value of the vibration frequency estimation value series obtained from the sequential frequency estimation unit exceeds the resonance number threshold value.
The resonance frequency width corresponding to the resonance frequency width number is assigned to the previous value, and the resonance frequency width is obtained by adding a positive predetermined value to the center value with the previous value as the center value. As an upper limit
When the frequency domain is defined as the lower limit of the value obtained by subtracting a predetermined positive value from the center value, and the value this time falls within any one of one or more of the resonance frequency widths already provided. The estimated resonance number is not changed.
Then, the resonance frequency width number is updated to the resonance frequency width number associated with the resonance frequency width including the current value.
If the current value does not fall within one or more of the resonant frequency widths already provided
Alternatively, if one or more of the resonance frequency widths are not provided,
The resonance number estimated value is increased by 1, and the resonance frequency width number is set to the resonance number estimated value obtained by increasing the resonance frequency width number by 1.
As process B
When the absolute value of the difference between the current value and the previous value of the vibration frequency estimation value series obtained from the sequential frequency estimation unit does not exceed the resonance number threshold, the resonance number estimation value is not changed and the resonance number estimation value is not changed. Without changing the resonance frequency width number
A notch filter characterized in that the resonance number is estimated by sequentially repeating the processing A and the processing B each time the current value of the vibration frequency estimation value series is obtained, and the resonance number is output as the resonance number estimation value series. Adjustment device.
前記制御系の制御器後段に１つ以上設けられる前記ノッチフィルタは１から昇順に正の番号が割り振られ、
前記共振周波数幅番号は、
前記逐次周波数推定部が推定した前記振動周波数推定値系列の前記今回値を、
前記制御系の制御器後段に１つ以上設けられる前記ノッチフィルタに適用する番号とし、
前記振動周波数推定値系列の前記今回値は前記共振周波数幅番号の前記ノッチフィルタに適用されることを特徴とするノッチフィルタ調整装置。 In the notch filter adjusting device according to claim 5,
One or more notch filters provided after the controller of the control system are assigned positive numbers in ascending order from 1.
The resonance frequency width number is
The present value of the vibration frequency estimation value series estimated by the sequential frequency estimation unit is
A number applied to the notch filter provided at one or more after the controller of the control system.
A notch filter adjusting device, wherein the current value of the vibration frequency estimation value series is applied to the notch filter having the resonance frequency width number.
前記ノッチフィルタ調整装置が初期状態にあり、
前記ノッチフィルタ調整装置が動作開始から振動検出部が一度も振動発生有りと判断していない場合は前記制御系の制御器後段に前記ノッチフィルタを設けないことを特徴とするノッチフィルタ調整装置。 In the notch filter adjusting device according to claim 1,
The notch filter adjusting device is in the initial state,
A notch filter adjusting device, characterized in that the notch filter is not provided in the subsequent stage of the controller of the control system when the vibration detecting unit has never determined that vibration is generated from the start of operation of the notch filter adjusting device.
フィードバック制御器の後段に配置されるとともに、
出力側には、電動機と制御対象とが配置されることを特徴とするノッチフィルタ調整装置。 The notch filter adjusting device according to claim 1 is
It is placed after the feedback controller and
A notch filter adjusting device characterized in that an electric motor and a control target are arranged on the output side.
前記振動周波数推定値系列に基づいて、前記制御系の応答に重畳する振動の発生原因となる共振特性の数を、共振数推定値系列として出力するとともに、
前記共振数推定値系列の値に応じた個数のノッチフィルタを前記制御系の制御器後段に直列に設置することを特徴とするノッチフィルタ調整方法。 One or more vibration components superimposed on the response of the control system due to one or more resonance characteristics of the controlled object are extracted, and the frequency of one of the vibration components is sequentially estimated. This is used as the vibration frequency estimation value series.
Based on the vibration frequency estimation value series, the number of resonance characteristics that cause vibration superimposed on the response of the control system is output as a resonance number estimation value series, and is also output.
A notch filter adjusting method, characterized in that a number of notch filters corresponding to the values of the resonance number estimation value series are installed in series after the controller of the control system.
前記ノッチフィルタ調整方法が初期状態にあり、
前記ノッチフィルタ調整方法が処理開始から一度も共振起因の振動の発生を検出しない場合は前記制御系の制御器後段に前記ノッチフィルタを設けないことを特徴とするノッチフィルタ調整方法。 In the notch filter adjusting method according to claim 10,
The notch filter adjustment method is in the initial state,
A notch filter adjusting method, characterized in that the notch filter is not provided in the subsequent stage of the controller of the control system when the notch filter adjusting method does not detect the occurrence of vibration due to resonance even once from the start of processing.
Priority Applications (5)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2019111097A JP7178327B2 (en) | 2019-06-14 | 2019-06-14 | NOTCH FILTER ADJUSTMENT DEVICE AND MOTOR CONTROL DEVICE INCLUDING THE SAME |
| PCT/JP2019/051443 WO2020250469A1 (en) | 2019-06-14 | 2019-12-27 | Motor control device, notch filter adjustment device, and notch filter adjustment method |
| DE112019006707.9T DE112019006707T5 (en) | 2019-06-14 | 2019-12-27 | ENGINE CONTROL DEVICE, NOTCH FILTER ADJUSTMENT AND NOTCH FILTER ADJUSTMENT PROCEDURE |
| CN201980093852.0A CN113557479B (en) | 2019-06-14 | 2019-12-27 | Motor control device, notch filter adjustment device, and notch filter adjustment method |
| TW109115020A TWI735223B (en) | 2019-06-14 | 2020-05-06 | Motor control device, notch filter adjustment device, and notch filter adjustment method |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2019111097A JP7178327B2 (en) | 2019-06-14 | 2019-06-14 | NOTCH FILTER ADJUSTMENT DEVICE AND MOTOR CONTROL DEVICE INCLUDING THE SAME |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2020204823A true JP2020204823A (en) | 2020-12-24 |
| JP7178327B2 JP7178327B2 (en) | 2022-11-25 |
Family
ID=73781721
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2019111097A Active JP7178327B2 (en) | 2019-06-14 | 2019-06-14 | NOTCH FILTER ADJUSTMENT DEVICE AND MOTOR CONTROL DEVICE INCLUDING THE SAME |
Country Status (5)
| Country | Link |
|---|---|
| JP (1) | JP7178327B2 (en) |
| CN (1) | CN113557479B (en) |
| DE (1) | DE112019006707T5 (en) |
| TW (1) | TWI735223B (en) |
| WO (1) | WO2020250469A1 (en) |
Families Citing this family (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP7390267B2 (en) * | 2020-09-07 | 2023-12-01 | 株式会社日立産機システム | motor control device |
| TWI762221B (en) * | 2021-02-26 | 2022-04-21 | 中國鋼鐵股份有限公司 | Detection method for rotation speed |
| KR20230154976A (en) * | 2021-04-21 | 2023-11-09 | 미쓰비시덴키 가부시키가이샤 | Motor control device, motor control system and motor control method |
| CN113775323A (en) * | 2021-10-21 | 2021-12-10 | 中国石油大学(华东) | Self-adaptive pulsating hydraulic fracturing technology based on frequency spectrum resonance |
Citations (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2005245051A (en) * | 2004-02-24 | 2005-09-08 | Matsushita Electric Ind Co Ltd | Control parameter calculation method of motor control device and motor control device |
| JP2006288124A (en) * | 2005-04-01 | 2006-10-19 | Mitsubishi Electric Corp | Motor controller |
| JP2009296746A (en) * | 2008-06-04 | 2009-12-17 | Panasonic Corp | Motor control apparatus |
| JP2013089089A (en) * | 2011-10-19 | 2013-05-13 | Sumitomo Heavy Ind Ltd | Resonance suppression device and resonance suppression method |
| JP2020017071A (en) * | 2018-07-25 | 2020-01-30 | 株式会社日立産機システム | Automatic adjusting method for feedback control system, and feedback control device |
Family Cites Families (8)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| WO2006006552A1 (en) * | 2004-07-13 | 2006-01-19 | Kabushiki Kaisha Yaskawa Denki | Motor controller |
| JP4340299B2 (en) * | 2007-03-08 | 2009-10-07 | 株式会社日立産機システム | Motor control device and motor control system |
| JP2008312339A (en) * | 2007-06-14 | 2008-12-25 | Panasonic Corp | Controller for motors |
| JP2012108610A (en) * | 2010-11-15 | 2012-06-07 | Sumitomo Heavy Ind Ltd | Resonance suppression device and resonance suppression method |
| WO2012086550A1 (en) * | 2010-12-20 | 2012-06-28 | 三菱電機株式会社 | Motor control device |
| CN105007059B (en) * | 2015-07-24 | 2017-09-19 | 太原理工大学 | The current control notch filter that a kind of electromechanical coupled vibration suppresses |
| KR102165991B1 (en) * | 2016-05-31 | 2020-10-15 | 미쓰비시덴키 가부시키가이샤 | Motor control unit |
| EP3522366A4 (en) * | 2016-09-29 | 2019-08-07 | Panasonic Intellectual Property Management Co., Ltd. | Motor control device and motor control method |
-
2019
- 2019-06-14 JP JP2019111097A patent/JP7178327B2/en active Active
- 2019-12-27 WO PCT/JP2019/051443 patent/WO2020250469A1/en active Application Filing
- 2019-12-27 CN CN201980093852.0A patent/CN113557479B/en active Active
- 2019-12-27 DE DE112019006707.9T patent/DE112019006707T5/en active Granted
-
2020
- 2020-05-06 TW TW109115020A patent/TWI735223B/en active
Patent Citations (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2005245051A (en) * | 2004-02-24 | 2005-09-08 | Matsushita Electric Ind Co Ltd | Control parameter calculation method of motor control device and motor control device |
| JP2006288124A (en) * | 2005-04-01 | 2006-10-19 | Mitsubishi Electric Corp | Motor controller |
| JP2009296746A (en) * | 2008-06-04 | 2009-12-17 | Panasonic Corp | Motor control apparatus |
| JP2013089089A (en) * | 2011-10-19 | 2013-05-13 | Sumitomo Heavy Ind Ltd | Resonance suppression device and resonance suppression method |
| JP2020017071A (en) * | 2018-07-25 | 2020-01-30 | 株式会社日立産機システム | Automatic adjusting method for feedback control system, and feedback control device |
Also Published As
| Publication number | Publication date |
|---|---|
| TW202046625A (en) | 2020-12-16 |
| CN113557479A (en) | 2021-10-26 |
| TWI735223B (en) | 2021-08-01 |
| JP7178327B2 (en) | 2022-11-25 |
| CN113557479B (en) | 2024-02-02 |
| DE112019006707T5 (en) | 2021-10-28 |
| WO2020250469A1 (en) | 2020-12-17 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| WO2020250469A1 (en) | Motor control device, notch filter adjustment device, and notch filter adjustment method | |
| JP6044647B2 (en) | Dynamometer control device and inertia moment estimation method using the same | |
| US7843159B2 (en) | Motor controller | |
| US9423782B2 (en) | Motor drive device | |
| JP5757842B2 (en) | Resonance suppression device and resonance suppression method | |
| JP5980890B2 (en) | Servo controller with automatic filter adjustment function using experimental mode analysis | |
| JP6073454B2 (en) | Active vibration noise control device | |
| JP5591345B2 (en) | Electric motor control device | |
| CN109863692B (en) | Motor control device and motor control method | |
| JP2004007955A (en) | Position controller of motor | |
| US11777427B2 (en) | Motor control device and automatic adjustment method for same | |
| JP2009048462A (en) | Mechanical resonance frequency compensation apparatus | |
| JP2005223960A (en) | Controller of motor | |
| JP6827565B2 (en) | Electric motor control device | |
| JP7390267B2 (en) | motor control device | |
| WO2021157178A1 (en) | Motor control device | |
| JP2003227854A (en) | Frequency estimation device and frequency estimation method | |
| JP2023015828A (en) | Motor control device and motor control method | |
| JP2004023970A (en) | Variable speed gear |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20211216 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20220628 |
|
| A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20220824 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20220906 |
|
| A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20221025 |
|
| TRDD | Decision of grant or rejection written | ||
| A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20221108 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20221114 |
|
| R150 | Certificate of patent or registration of utility model |
Ref document number: 7178327 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |