JPWO2005064781A1 - モータの制御装置 - Google Patents
モータの制御装置 Download PDFInfo
- Publication number
- JPWO2005064781A1 JPWO2005064781A1 JP2005507030A JP2005507030A JPWO2005064781A1 JP WO2005064781 A1 JPWO2005064781 A1 JP WO2005064781A1 JP 2005507030 A JP2005507030 A JP 2005507030A JP 2005507030 A JP2005507030 A JP 2005507030A JP WO2005064781 A1 JPWO2005064781 A1 JP WO2005064781A1
- Authority
- JP
- Japan
- Prior art keywords
- frequency
- gain
- speed
- filter
- motor
- 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
- 230000003111 delayed effect Effects 0.000 claims abstract description 22
- 238000001514 detection method Methods 0.000 claims description 12
- 238000004364 calculation method Methods 0.000 claims description 4
- 238000010586 diagram Methods 0.000 description 17
- 238000000034 method Methods 0.000 description 9
- 230000000694 effects Effects 0.000 description 8
- 230000007423 decrease Effects 0.000 description 2
- 230000001771 impaired effect Effects 0.000 description 1
- 230000010354 integration Effects 0.000 description 1
- 238000013178 mathematical model Methods 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 238000005070 sampling Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B11/00—Automatic controllers
- G05B11/01—Automatic controllers electric
- G05B11/06—Automatic controllers electric in which the output signal represents a continuous function of the deviation from the desired value, i.e. continuous controllers
-
- 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
- G05B11/42—Automatic controllers electric with provision for obtaining particular characteristics, e.g. proportional, integral, differential for obtaining a characteristic which is both proportional and time-dependent, e.g. P.I., P.I.D.
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P29/00—Arrangements for regulating or controlling electric motors, appropriate for both AC and DC motors
- H02P29/10—Arrangements for regulating or controlling electric motors, appropriate for both AC and DC motors for preventing overspeed or under speed
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P6/00—Arrangements for controlling synchronous motors or other dynamo-electric motors using electronic commutation dependent on the rotor position; Electronic commutators therefor
- H02P6/14—Electronic commutators
- H02P6/16—Circuit arrangements for detecting position
- H02P6/18—Circuit arrangements for detecting position without separate position detecting elements
- H02P6/181—Circuit arrangements for detecting position without separate position detecting elements using different methods depending on the speed
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P6/00—Arrangements for controlling synchronous motors or other dynamo-electric motors using electronic commutation dependent on the rotor position; Electronic commutators therefor
- H02P6/34—Modelling or simulation for control purposes
Abstract
速度指令信号とモータ１の検出速度の差信号に基いてモータ１の速度を速度指令信号に追従させるためのモータ１の駆動指令信号を出力する速度制御手段７と、速度制御ループに速度制御手段７と直列に挿入されると共に、高周波数領域と、低周波数領域と、高周波数領域と低周波数領域との間にある中間周波数領域とから成り、高周波数領域のゲインＫＨよりも低周波数領域のゲインＫＬが大きいと共に、中間周波数領域の位相が遅れる位相遅れ特性を有するフィルタ１３とを備え、速度制御手段７は、入力に比例ゲインＫＰを乗じて出力する比例制御部９を有しており、フィルタ１３は、機械系の共振周波数と反共振周波数との間で、位相が遅れるように設定されたものである。
Description
図６は従来から一般に用いられているモータの速度制御装置の構成を概念的に示したものである。図中、１はモータ、２はモータによって駆動される負荷、３はモータ１と負荷２を接続する軸である。負荷２はモータ１で駆動される機械の可動部分をひとつの慣性負荷としてモデル化したものであり、軸３はモータ１が発生するトルクを機械に伝達する機構をモデル化したものである。４はモータ１に取り付けられ、モータ１の位置を検出するエンコーダ、５はエンコーダ４で検出されたモータ位置を微分することでモータ速度を計算する速度検出手段である。６は比較器であり、図示しない上位コントローラから与えられる速度指令信号と速度検出手段５の出力であるモータ速度とを比較し、両者の差である速度誤差を出力する。７は速度制御手段であり、比較器６の出力である速度誤差を入力してモータの駆動指令である電流指令を出力する。８は電流制御手段であり、速度制御手段７の出力である電流指令に基づいてモータ電流を制御することによりモータにトルクを発生させ、モータを回転させる。
速度制御手段７は比例制御器９、積分制御器１０、および、加算器１１から構成される。比例制御器９は入力した速度誤差に比例ゲインＫＰを乗じて出力し、積分制御器１０は速度誤差の積分値に積分ゲインＫＩを乗じて出力する。加算器１１は比例制御器９の出力と積分制御器１０の出力を加算して、電流指令として出力する。また、１５は機械系であり、モータ１と負荷２および軸３から構成される。
従来の速度制御系は上記のように構成され、速度指令信号とモータ速度の差である速度誤差が小さくなるようにモータ１を加速あるいは減速するトルクを発生させ、これにより、モータ速度が上位コントローラから与えられる速度指令信号に追従するようにモータ１と負荷２が回転する。機械系に外乱トルクが作用した場合には、この外乱トルクによってモータ速度が変動するが、この速度変動はエンコーダ４と速度検出手段５で検出され、速度制御手段７にフィードバックされて速度変動を修正するような電流指令が生成される。このように、外乱トルクが作用した場合でも速度制御ループによって速度変動が抑制され、速度指令信号に追従するようにモータが制御される。
図７は従来の速度制御装置を用いて速度制御系を構成した場合の速度開ループ周波数特性を示したものである。速度開ループ周波数特性とは、速度制御手段７の入力から速度検出手段５で検出されるモータ速度までの周波数特性であり、図７上図はゲイン特性、下図は位相特性を示す。図の破線はモータ１と負荷２を接続する軸３の剛性が高い場合、すなわち、機械剛性が高い場合の周波数特性を示す。また、実線は軸３の剛性が低いために機械剛性が低く、機械共振を持つ場合の周波数特性を示している。
機械剛性が高い（軸３の剛性が高い）場合のゲイン特性は図７上図に破線で示すように、全周波数にわたって右下がりとなる。位相特性は図７下図に破線で示すように、高周波数では電流制御手段８や制御装置のサンプル周期に起因する位相遅れのために位相遅れが大きくなり、低周波数でも速度制御手段７で積分制御器１０を用いているために位相遅れが大きくなる。
一方、機械剛性が低い（軸３の剛性が低い）場合、機械系は機械共振を持つようになり、そのゲイン特性は図７上図に実線で示すように共振と呼ばれるピークと反共振と呼ばれる谷の部分を持つようになる。共振と反共振の間でゲインが左下がりとなるため、低周波数でのゲインは軸３の剛性が高い場合（破線）に比べて小さくなる。モータ１の慣性モーメントと負荷２の慣性モーメントの和である機械系全体の慣性モーメントＪがモータの慣性モーメントＪＭに比べて大きくなるほど、共振と反共振の距離が離れ、反共振の周波数が低くなるため、低周波数のゲインはより小さくなる。
高精度の速度制御を実現するには、速度誤差の要因のひとつである外乱トルクの影響を抑制して、外乱トルクが作用したときの速度変動を小さくしなければならない。一般に、外乱トルクは低周波数の信号成分を持つので、外乱トルクによる速度変動を小さくするには、低周波数でのゲインを大きくする必要がある。ところが、剛性が低い機械では上記のように低周波数でのゲインが小さくなるため、外乱トルクによる速度変動が大きくなり、高精度の制御が困難であった。
図６に示した従来の速度制御装置で低周波数でのゲインを大きくするには、速度制御手段７の比例ゲインＫＰや積分ゲインＫＩを大きくする必要がある。しかし、これには限界があり、結果的に高精度の制御ができなかった。その理由を以下に説明する。図７において、低剛性の場合のゲイン特性（実線）が反共振周波数より低い周波数でゲイン０ｄｂの線と交差する周波数を第一の交差周波数ωＣ１、共振周波数より高い周波数でゲイン０ｄｂの線と交差する周波数を第二の交差周波数ωＣ２とする。制御系が振動を起こしたり発振したりせずに安定に動作するには、第一の交差周波数ωＣ１や第二の交差周波数ωＣ２において速度開ループ周波数特性の位相遅れが小さいことが必要となる。ところが、比例ゲインＫＰを大きくすると、第二の交差周波数ωＣ２が高周波側に移動するため、第二の交差周波数ωＣ２における位相遅れが大きくなり、制御系が振動的になったり、発振したりするようになってしまう。また、積分ゲインＫＩを大きくすると、積分制御器１０による低周波数での位相遅れが大きくなるため、第一の交差周波数ωＣ１での位相遅れが大きくなり、やはり制御系が振動的になったり、発振したりするようになってしまう。このように、従来の速度制御装置では、比例ゲインＫＰや積分ゲインＫＩをある程度以上には大きくすることができないため、低周波数のゲインを大きくすることが出来ず、結果として高精度の制御が困難となっていたのである。
機械共振を持つ機械系を対象としたサーボ制御技術が日本国特開２０００−３２２１０５号公報に開示されている。この技術を用いた速度制御装置の構成を図８に示す。図６と同一部分には同一の符号を付してある。図８において、１２は速度制御ループに直列に挿入されたフィルタであり、機械系の反共振・共振特性の逆の特性あるいは近似する特性を持つ。このフィルタ１２は式（１）に示されるような特性を示すように調整される。
ここで、ω１、ω２、ζ１、ζ２は各々パラメータであり、ω１は反共振周波数に近い値とし、ω２は共振周波数に近い値とする。また、ζ１、ζ２は反共振、共振のピークに応じて小さめに設定する。この技術によれば、機械系の共振ピークのゲインをフィルタ１２によって抑えることができるので、従来よりもゲインを上げられるようになり、高精度の制御が実現できるというものである。
しかしながら、この技術が主に対象としているのは図７に示す共振ピークよりももっと高い周波数にある不安定な共振ピークを抑えることであり、図７のような安定な共振ピークに対してこの技術を適用すると不都合が生じる。以下、この不都合を説明する。
図７の実線に示す周波数特性を持つ機械系にこの技術を適用した場合のフィルタ１２の周波数特性を図９に示す。フィルタ１２は上記のように機械系の反共振・共振特性と逆の特性を持つように調整されるので、そのゲイン特性は機械系の反共振でピークを持ち、機械系の共振で谷を持つ特性となる。このようなフィルタを用いて制御されている機械系に外乱トルクが作用した場合を考える。共振周波数は機械系が振動しやすい周波数であり、外乱トルクが作用すると機械系が共振周波数で振動することがある。この振動は速度検出手段５で検出され、速度制御手段７にフィードバックされ、速度制御手段７はこの振動を止めるための電流指令を生成して出力する。この電流指令には当然ながら共振周波数の信号成分が含まれている。ところが、図９に示すようにフィルタ１２のゲインは共振周波数で小さくなっているので、フィルタ１２を通ることにより電流指令から共振周波数の信号成分が除去されてしまう。つまり、フィルタ１２により、振動を止めるための信号成分が電流指令から除去されてしまうのである。このため、機械系が共振周波数で振動しても、速度制御系はこの振動を止めることができないと言う不都合が生じるのである。
上記のように、低剛性で、かつ、機械系の慣性モーメントＪがモータの慣性モーメントＪＭに比べて大きい機械系を制御する場合、従来一般に用いられていた速度制御装置では低周波数でのゲインを大きくすることが困難で、外乱トルクによる速度変動が大きくなるため高精度の制御が困難であると言う問題があった。
また、特開２０００−３２２１０５号公報に開示されている技術は、低周波数でのゲインを大きくすることは出来るが機械振動を止めることが出来なくなるため、低い周波数で機械共振を持つ機械系に適用できなかった。
速度制御手段７は比例制御器９、積分制御器１０、および、加算器１１から構成される。比例制御器９は入力した速度誤差に比例ゲインＫＰを乗じて出力し、積分制御器１０は速度誤差の積分値に積分ゲインＫＩを乗じて出力する。加算器１１は比例制御器９の出力と積分制御器１０の出力を加算して、電流指令として出力する。また、１５は機械系であり、モータ１と負荷２および軸３から構成される。
従来の速度制御系は上記のように構成され、速度指令信号とモータ速度の差である速度誤差が小さくなるようにモータ１を加速あるいは減速するトルクを発生させ、これにより、モータ速度が上位コントローラから与えられる速度指令信号に追従するようにモータ１と負荷２が回転する。機械系に外乱トルクが作用した場合には、この外乱トルクによってモータ速度が変動するが、この速度変動はエンコーダ４と速度検出手段５で検出され、速度制御手段７にフィードバックされて速度変動を修正するような電流指令が生成される。このように、外乱トルクが作用した場合でも速度制御ループによって速度変動が抑制され、速度指令信号に追従するようにモータが制御される。
図７は従来の速度制御装置を用いて速度制御系を構成した場合の速度開ループ周波数特性を示したものである。速度開ループ周波数特性とは、速度制御手段７の入力から速度検出手段５で検出されるモータ速度までの周波数特性であり、図７上図はゲイン特性、下図は位相特性を示す。図の破線はモータ１と負荷２を接続する軸３の剛性が高い場合、すなわち、機械剛性が高い場合の周波数特性を示す。また、実線は軸３の剛性が低いために機械剛性が低く、機械共振を持つ場合の周波数特性を示している。
機械剛性が高い（軸３の剛性が高い）場合のゲイン特性は図７上図に破線で示すように、全周波数にわたって右下がりとなる。位相特性は図７下図に破線で示すように、高周波数では電流制御手段８や制御装置のサンプル周期に起因する位相遅れのために位相遅れが大きくなり、低周波数でも速度制御手段７で積分制御器１０を用いているために位相遅れが大きくなる。
一方、機械剛性が低い（軸３の剛性が低い）場合、機械系は機械共振を持つようになり、そのゲイン特性は図７上図に実線で示すように共振と呼ばれるピークと反共振と呼ばれる谷の部分を持つようになる。共振と反共振の間でゲインが左下がりとなるため、低周波数でのゲインは軸３の剛性が高い場合（破線）に比べて小さくなる。モータ１の慣性モーメントと負荷２の慣性モーメントの和である機械系全体の慣性モーメントＪがモータの慣性モーメントＪＭに比べて大きくなるほど、共振と反共振の距離が離れ、反共振の周波数が低くなるため、低周波数のゲインはより小さくなる。
高精度の速度制御を実現するには、速度誤差の要因のひとつである外乱トルクの影響を抑制して、外乱トルクが作用したときの速度変動を小さくしなければならない。一般に、外乱トルクは低周波数の信号成分を持つので、外乱トルクによる速度変動を小さくするには、低周波数でのゲインを大きくする必要がある。ところが、剛性が低い機械では上記のように低周波数でのゲインが小さくなるため、外乱トルクによる速度変動が大きくなり、高精度の制御が困難であった。
図６に示した従来の速度制御装置で低周波数でのゲインを大きくするには、速度制御手段７の比例ゲインＫＰや積分ゲインＫＩを大きくする必要がある。しかし、これには限界があり、結果的に高精度の制御ができなかった。その理由を以下に説明する。図７において、低剛性の場合のゲイン特性（実線）が反共振周波数より低い周波数でゲイン０ｄｂの線と交差する周波数を第一の交差周波数ωＣ１、共振周波数より高い周波数でゲイン０ｄｂの線と交差する周波数を第二の交差周波数ωＣ２とする。制御系が振動を起こしたり発振したりせずに安定に動作するには、第一の交差周波数ωＣ１や第二の交差周波数ωＣ２において速度開ループ周波数特性の位相遅れが小さいことが必要となる。ところが、比例ゲインＫＰを大きくすると、第二の交差周波数ωＣ２が高周波側に移動するため、第二の交差周波数ωＣ２における位相遅れが大きくなり、制御系が振動的になったり、発振したりするようになってしまう。また、積分ゲインＫＩを大きくすると、積分制御器１０による低周波数での位相遅れが大きくなるため、第一の交差周波数ωＣ１での位相遅れが大きくなり、やはり制御系が振動的になったり、発振したりするようになってしまう。このように、従来の速度制御装置では、比例ゲインＫＰや積分ゲインＫＩをある程度以上には大きくすることができないため、低周波数のゲインを大きくすることが出来ず、結果として高精度の制御が困難となっていたのである。
機械共振を持つ機械系を対象としたサーボ制御技術が日本国特開２０００−３２２１０５号公報に開示されている。この技術を用いた速度制御装置の構成を図８に示す。図６と同一部分には同一の符号を付してある。図８において、１２は速度制御ループに直列に挿入されたフィルタであり、機械系の反共振・共振特性の逆の特性あるいは近似する特性を持つ。このフィルタ１２は式（１）に示されるような特性を示すように調整される。
しかしながら、この技術が主に対象としているのは図７に示す共振ピークよりももっと高い周波数にある不安定な共振ピークを抑えることであり、図７のような安定な共振ピークに対してこの技術を適用すると不都合が生じる。以下、この不都合を説明する。
図７の実線に示す周波数特性を持つ機械系にこの技術を適用した場合のフィルタ１２の周波数特性を図９に示す。フィルタ１２は上記のように機械系の反共振・共振特性と逆の特性を持つように調整されるので、そのゲイン特性は機械系の反共振でピークを持ち、機械系の共振で谷を持つ特性となる。このようなフィルタを用いて制御されている機械系に外乱トルクが作用した場合を考える。共振周波数は機械系が振動しやすい周波数であり、外乱トルクが作用すると機械系が共振周波数で振動することがある。この振動は速度検出手段５で検出され、速度制御手段７にフィードバックされ、速度制御手段７はこの振動を止めるための電流指令を生成して出力する。この電流指令には当然ながら共振周波数の信号成分が含まれている。ところが、図９に示すようにフィルタ１２のゲインは共振周波数で小さくなっているので、フィルタ１２を通ることにより電流指令から共振周波数の信号成分が除去されてしまう。つまり、フィルタ１２により、振動を止めるための信号成分が電流指令から除去されてしまうのである。このため、機械系が共振周波数で振動しても、速度制御系はこの振動を止めることができないと言う不都合が生じるのである。
上記のように、低剛性で、かつ、機械系の慣性モーメントＪがモータの慣性モーメントＪＭに比べて大きい機械系を制御する場合、従来一般に用いられていた速度制御装置では低周波数でのゲインを大きくすることが困難で、外乱トルクによる速度変動が大きくなるため高精度の制御が困難であると言う問題があった。
また、特開２０００−３２２１０５号公報に開示されている技術は、低周波数でのゲインを大きくすることは出来るが機械振動を止めることが出来なくなるため、低い周波数で機械共振を持つ機械系に適用できなかった。
本発明は、上記課題を解決するためになされたもので、共振周波数と反共振周波数とを有する機械系を有する機械負荷に結合されたモータを、安定かつ高精度に制御するモータの制御装置を提供することを目的とするものである。
第１の発明に係るモータの制御装置は、共振周波数と反共振周波数とを有する機械系を有する機械負荷に結合されたモータを、速度指令信号に基いて駆動すると共に、前記モータの検出速度を速度制御ループに有するモータの制御装置において、前記速度指令信号と前記モータの検出速度の差信号に基いて前記モータの速度を前記速度指令信号に追従させるための前記モータの駆動指令信号を出力する速度制御手段と、前記速度制御ループに前記速度制御手段と直列に挿入されると共に、高周波数領域と、低周波数領域と、高周波数領域と低周波数領域との間にある中間周波数領域とから成り、前記高周波数領域のゲインＫＨよりも低周波数領域のゲインＫＬが大きいと共に、前記中間周波数領域の位相が遅れる位相遅れ特性を有するフィルタとを備え、前記速度制御手段は、入力に比例ゲインＫＰを乗じて出力する比例制御部、または、入力に比例ゲインＫＰを乗じた値と入力の積分値に積分ゲインＫＩを乗じた値を加算して出力する積分制御部を有しており、前記フィルタは、前記共振周波数と前記反共振周波数との間で、位相が遅れるように設定されたことを特徴とするものである。
第２の発明に係るモータの制御装置は、共振周波数と反共振周波数とを有する機械系を有する機械負荷に結合されたモータを、速度指令信号に基いて駆動すると共に、前記モータの検出速度を速度制御ループに有するモータの制御装置において、前記速度指令信号と前記モータの検出速度の差信号に基いて前記モータの速度を前記速度指令信号に追従させるための前記モータの駆動指令信号を出力する速度制御手段と、前記速度制御ループに前記速度制御手段と直列に挿入されると共に、高周波数領域と、低周波数領域と、高周波数領域と低周波数領域との間にある中間周波数領域とから成り、前記高周波数領域のゲインＫＨよりも低周波数領域のゲインＫＬが大きいと共に、前記中間周波数領域の位相が遅れる位相遅れ特性を有するフィルタとを備え、前記速度制御手段は、入力に比例ゲインＫＰを乗じて出力する比例制御部、または、入力に比例ゲインＫＰを乗じた値と入力の積分値に積分ゲインＫＩを乗じた値を加算して出力する積分制御部を有しており、前記フィルタは、前記比例ゲインＫＰと前記ゲインＫＬとの積を前記機械系の慣性モーメントＪで除した値である第一の交差周波数ωＣ１と前記比例ゲインＫＰと前記ゲインＫＨとの積を前記モータの慣性モーメントＪＭで除した値である第二の交差周波数ωＣ２との間で、位相が遅れるように設定された、ことを特徴とするものである。
第３の発明に係るモータの制御装置は、共振周波数と反共振周波数とを有する機械系を有する機械負荷に結合されたモータを速度指令信号に基いて駆動すると共に、前記モータの検出速度を速度制御ループに有するモータの制御装置において、前記速度指令信号と前記モータの検出速度の差信号に基いて前記モータの速度を前記速度指令信号に追従させるための前記モータの駆動指令信号を出力する速度制御手段と、前記速度制御ループに前記速度制御手段と直列に挿入すると共に、第一のフィルタ周波数ωＦ１より低い周波数領域でほぼ一定のゲインＫＬとなり、第二のフィルタ周波数ωＦ２より高い周波数領域で前記ゲインＫＬよりも小さいほぼ一定のゲインＫＨを有し、前記第一のフィルタ周波数ωＦ１と前記第二のフィルタ周波数ωＦ２との間で位相が遅れる位相遅れ特性を有するフィルタとを備え、前記速度制御手段は入力に比例ゲインＫＰを乗じて出力する比例制御演算、または、入力に比例ゲインＫＰを乗じた値と入力の積分値に積分ゲインＫＩを乗じた値を加算して出力する比例積分制御演算を有しており、前記フィルタは、前記比例ゲインＫＰと前記ゲインＫＬとの積を前記機械系の慣性モーメントＪで除した値である交差周波数ωＣ１と前記第一のフィルタ周波数ωＦ１との比が概ね一定となるように設定する、ことを特徴とするものである。
第４の発明に係るモータの制御装置は、モータに結合された機械負荷からなる共振周波数と反共振周波数とを有する機械系を、速度指令信号に基づいて前記モータの検出速度を速度制御ループにより駆動制御するモータの制御装置において、前記速度制御ループに速度制御手段と直列に挿入するとともに、第一のフィルタ周波数ωＦ１より低い周波数領域ではほぼ一定のゲインＫＬとなり、第二のフィルタ周波数ωＦ２より高い周波数領域では前記ゲインＫＬより小さいほぼ一定のゲインＫＨとなり、前記低い周波数領域と前記高い周波数領域との間の中間周波数領域で、位相遅れ特性を有するフィルタと、前記フィルタの特性と前記速度制御手段のパラメータを設定するパラメータ設定手段とを備え、前記速度制御手段は、入力に比例ゲインＫＰを乗じた値と入力の積分値に積分ゲインＫＩを乗じた値を加算して出力する積分制御部を有しており、前記フィルタは、前記比例ゲインＫＰと前記ゲインＫＬとの積を前記機械系の慣性モーメントＪで除した値である交差周波数ωＣ１と前記第一のフィルタ周波数ωＦ１との比が概ね一定となるようにすると共に、前記積分ゲインＫＩを前記比例ゲインＫＰで除した値である零点周波数ωＰＩと前記交差周波数ωＣ１との比が概ね一定とする、ことを特徴とするものである。
第５の発明に係るモータの制御装置は、フィルタと速度制御手段のパラメータを設定するパラメータ設定手段を備えており、パラメータ設定手段は、機械系の慣性モーメントＪをモータの慣性モーメントＪＭで除した値である慣性比が大きくなれば、第一のフィルタ周波数ωＦ１に対する第二のフィルタ周波数ωＦ２の比が大きくなるように設定する、ことを特徴とするものである。
第６の発明に係るモータの制御装置は、フィルタと速度制御手段のパラメータを設定するパラメータ設定手段を備えており、パラメータ設定手段はゲインＫＬとゲインＫＨの比であるゲイン比、または、第二のフィルタ周波数ωＦ２と第一のフィルタ周波数ωＦ１の比である周波数比を入力し、ゲイン比、または、周波数比に基づいてフィルタの特性を設定する、ことを特徴とするものである。
第７の発明に係るモータの制御装置は、共振周波数と反共振周波数とを有する機械系を有する機械負荷に結合されたモータを、速度指令信号に基いて駆動すると共に、前記モータの検出速度を速度制御ループに有するモータの制御装置において、前記速度指令信号と前記モータの検出速度の差信号に基いて前記モータの速度を前記速度指令信号に追従させるための前記モータの駆動指令信号を出力する速度制御手段と、前記速度制御ループに前記速度制御手段と直列に挿入されると共に、高周波数領域と、低周波数領域と、高周波数領域と低周波数領域との間にある中間周波数領域とから成り、前記高周波数領域のゲインＫＨよりも低周波数領域のゲインＫＬが大きいと共に、前記中間周波数領域の位相が遅れる位相遅れ特性を有するフィルタと、前記機械系の周波数特性を取得する周波数特性取得手段と、前記フィルタの特性を設定するパラメータ設定手段とを備え、前記パラメータ設定手段は、前記周波数特性取得手段で取得した前記機械系の周波数特性に基づいて機械系の反共振周波数と共振周波数の間で前記フィルタの位相が遅れるように設定する、ことを特徴とするものである。
以上のように、第１の発明によれば、フィルタは、機械系の共振周波数と反共振周波数との間で、位相が遅れるように設定したので、制御系の安定性を保ちながら低周波数でのゲインを大きくすることができる。これによって外乱トルクによる速度変動が小さくなり、高精度の制御が実現できるという効果がある。
第２の発明によれば、比例ゲインＫＰとゲインＫＬとの積を機械系の慣性モーメントＪで除した値である第一の交差周波数ωＣ１と比例ゲインＫＰと前記ゲインＫＨとの積を前記モータの慣性モーメントＪＭで除した値である第二の交差周波数ωＣ２との間で、位相が遅れるように設定した。これにより第一の交差周波数ωＣ１及び第二の交差周波数ωＣ２での位相遅れの増加分が小さくなるので、制御系の安定性を保ちながら低周波数でのゲインを大きくすることができる。これによって外乱トルクによる速度変動が小さくなり、高精度の制御が実現できるという効果がある。
第３の発明によれば、フィルタは、比例ゲインＫＰとゲインＫＬとの積を機械系の慣性モーメントＪで除した値である交差周波数ωＣ１と第一のフィルタ周波数ωＦ１との比が概ね一定となるように設定したので、第一の交差周波数ωＣ１での位相遅れの増加分も小さくなり、安定性を損ねることがなくなり、制御系が振動的になったり、発振したりすることがないという効果がある。
第４の発明によれば、フィルタは、比例ゲインＫＰとゲインＫＬとの積を機械系の慣性モーメントＪで除した値である交差周波数ωＣ１と第一のフィルタ周波数ωＦ１との比が概ね一定となるようにすると共に、積分ゲインＫＩを比例ゲインＫＰで除した値である零点周波数ωＰＩと交差周波数ωＣ１との比を概ね一定としたので、第一の交差周波数ωＣ１における位相遅れが大きくなり過ぎず、制御系の安定性を確保することができるという効果がある。
第５の発明によれば、パラメータ設定手段は、機械系の慣性モーメントＪをモータの慣性モーメントＪＭで除した値である慣性比が大きくなれば、第一のフィルタ周波数ωＦ１に対する第二のフィルタ周波数ωＦ２の比が大きくなるように設定したので、第二の交差周波数ωＣ２での位相遅れの増加分も小さくなり、安定性を損ねることがなくなり、制御系が振動的になったり、発振したりすることがないという効果がある。
第６の発明によれば、パラメータ設定手段はゲインＫＬとゲインＫＨの比であるゲイン比、または、第二のフィルタ周波数ωＦ２と第一のフィルタ周波数ωＦ１の比である周波数比を入力し、ゲイン比、または、周波数比に基づいてフィルタの特性を設定したので、機械系が複数の機械共振を持つ場合でも、第一の交差周波数ωＣ１及び第二の交差周波数ωＣ２における位相遅れが大きくなり過ぎることはなく、安定性を保ちながら低周波数のゲインを増大させることができるという効果がある。
第７の発明によれば、パラメータ設定手段は、周波数特性取得手段で取得した機械系の周波数特性に基づいて機械系の反共振周波数と共振周波数の間でフィルタの位相が遅れるように設定したので、フィルタの位相遅れが機械系の位相進みによってキャンセルされる。このため、第一の交差周波数ωＣ１、および、第二の交差周波数ωＣ２での位相遅れが大きくなることがなく、フィルタを挿入しても安定性を損なうことがなくなるという効果がある。
第１の発明に係るモータの制御装置は、共振周波数と反共振周波数とを有する機械系を有する機械負荷に結合されたモータを、速度指令信号に基いて駆動すると共に、前記モータの検出速度を速度制御ループに有するモータの制御装置において、前記速度指令信号と前記モータの検出速度の差信号に基いて前記モータの速度を前記速度指令信号に追従させるための前記モータの駆動指令信号を出力する速度制御手段と、前記速度制御ループに前記速度制御手段と直列に挿入されると共に、高周波数領域と、低周波数領域と、高周波数領域と低周波数領域との間にある中間周波数領域とから成り、前記高周波数領域のゲインＫＨよりも低周波数領域のゲインＫＬが大きいと共に、前記中間周波数領域の位相が遅れる位相遅れ特性を有するフィルタとを備え、前記速度制御手段は、入力に比例ゲインＫＰを乗じて出力する比例制御部、または、入力に比例ゲインＫＰを乗じた値と入力の積分値に積分ゲインＫＩを乗じた値を加算して出力する積分制御部を有しており、前記フィルタは、前記共振周波数と前記反共振周波数との間で、位相が遅れるように設定されたことを特徴とするものである。
第２の発明に係るモータの制御装置は、共振周波数と反共振周波数とを有する機械系を有する機械負荷に結合されたモータを、速度指令信号に基いて駆動すると共に、前記モータの検出速度を速度制御ループに有するモータの制御装置において、前記速度指令信号と前記モータの検出速度の差信号に基いて前記モータの速度を前記速度指令信号に追従させるための前記モータの駆動指令信号を出力する速度制御手段と、前記速度制御ループに前記速度制御手段と直列に挿入されると共に、高周波数領域と、低周波数領域と、高周波数領域と低周波数領域との間にある中間周波数領域とから成り、前記高周波数領域のゲインＫＨよりも低周波数領域のゲインＫＬが大きいと共に、前記中間周波数領域の位相が遅れる位相遅れ特性を有するフィルタとを備え、前記速度制御手段は、入力に比例ゲインＫＰを乗じて出力する比例制御部、または、入力に比例ゲインＫＰを乗じた値と入力の積分値に積分ゲインＫＩを乗じた値を加算して出力する積分制御部を有しており、前記フィルタは、前記比例ゲインＫＰと前記ゲインＫＬとの積を前記機械系の慣性モーメントＪで除した値である第一の交差周波数ωＣ１と前記比例ゲインＫＰと前記ゲインＫＨとの積を前記モータの慣性モーメントＪＭで除した値である第二の交差周波数ωＣ２との間で、位相が遅れるように設定された、ことを特徴とするものである。
第３の発明に係るモータの制御装置は、共振周波数と反共振周波数とを有する機械系を有する機械負荷に結合されたモータを速度指令信号に基いて駆動すると共に、前記モータの検出速度を速度制御ループに有するモータの制御装置において、前記速度指令信号と前記モータの検出速度の差信号に基いて前記モータの速度を前記速度指令信号に追従させるための前記モータの駆動指令信号を出力する速度制御手段と、前記速度制御ループに前記速度制御手段と直列に挿入すると共に、第一のフィルタ周波数ωＦ１より低い周波数領域でほぼ一定のゲインＫＬとなり、第二のフィルタ周波数ωＦ２より高い周波数領域で前記ゲインＫＬよりも小さいほぼ一定のゲインＫＨを有し、前記第一のフィルタ周波数ωＦ１と前記第二のフィルタ周波数ωＦ２との間で位相が遅れる位相遅れ特性を有するフィルタとを備え、前記速度制御手段は入力に比例ゲインＫＰを乗じて出力する比例制御演算、または、入力に比例ゲインＫＰを乗じた値と入力の積分値に積分ゲインＫＩを乗じた値を加算して出力する比例積分制御演算を有しており、前記フィルタは、前記比例ゲインＫＰと前記ゲインＫＬとの積を前記機械系の慣性モーメントＪで除した値である交差周波数ωＣ１と前記第一のフィルタ周波数ωＦ１との比が概ね一定となるように設定する、ことを特徴とするものである。
第４の発明に係るモータの制御装置は、モータに結合された機械負荷からなる共振周波数と反共振周波数とを有する機械系を、速度指令信号に基づいて前記モータの検出速度を速度制御ループにより駆動制御するモータの制御装置において、前記速度制御ループに速度制御手段と直列に挿入するとともに、第一のフィルタ周波数ωＦ１より低い周波数領域ではほぼ一定のゲインＫＬとなり、第二のフィルタ周波数ωＦ２より高い周波数領域では前記ゲインＫＬより小さいほぼ一定のゲインＫＨとなり、前記低い周波数領域と前記高い周波数領域との間の中間周波数領域で、位相遅れ特性を有するフィルタと、前記フィルタの特性と前記速度制御手段のパラメータを設定するパラメータ設定手段とを備え、前記速度制御手段は、入力に比例ゲインＫＰを乗じた値と入力の積分値に積分ゲインＫＩを乗じた値を加算して出力する積分制御部を有しており、前記フィルタは、前記比例ゲインＫＰと前記ゲインＫＬとの積を前記機械系の慣性モーメントＪで除した値である交差周波数ωＣ１と前記第一のフィルタ周波数ωＦ１との比が概ね一定となるようにすると共に、前記積分ゲインＫＩを前記比例ゲインＫＰで除した値である零点周波数ωＰＩと前記交差周波数ωＣ１との比が概ね一定とする、ことを特徴とするものである。
第５の発明に係るモータの制御装置は、フィルタと速度制御手段のパラメータを設定するパラメータ設定手段を備えており、パラメータ設定手段は、機械系の慣性モーメントＪをモータの慣性モーメントＪＭで除した値である慣性比が大きくなれば、第一のフィルタ周波数ωＦ１に対する第二のフィルタ周波数ωＦ２の比が大きくなるように設定する、ことを特徴とするものである。
第６の発明に係るモータの制御装置は、フィルタと速度制御手段のパラメータを設定するパラメータ設定手段を備えており、パラメータ設定手段はゲインＫＬとゲインＫＨの比であるゲイン比、または、第二のフィルタ周波数ωＦ２と第一のフィルタ周波数ωＦ１の比である周波数比を入力し、ゲイン比、または、周波数比に基づいてフィルタの特性を設定する、ことを特徴とするものである。
第７の発明に係るモータの制御装置は、共振周波数と反共振周波数とを有する機械系を有する機械負荷に結合されたモータを、速度指令信号に基いて駆動すると共に、前記モータの検出速度を速度制御ループに有するモータの制御装置において、前記速度指令信号と前記モータの検出速度の差信号に基いて前記モータの速度を前記速度指令信号に追従させるための前記モータの駆動指令信号を出力する速度制御手段と、前記速度制御ループに前記速度制御手段と直列に挿入されると共に、高周波数領域と、低周波数領域と、高周波数領域と低周波数領域との間にある中間周波数領域とから成り、前記高周波数領域のゲインＫＨよりも低周波数領域のゲインＫＬが大きいと共に、前記中間周波数領域の位相が遅れる位相遅れ特性を有するフィルタと、前記機械系の周波数特性を取得する周波数特性取得手段と、前記フィルタの特性を設定するパラメータ設定手段とを備え、前記パラメータ設定手段は、前記周波数特性取得手段で取得した前記機械系の周波数特性に基づいて機械系の反共振周波数と共振周波数の間で前記フィルタの位相が遅れるように設定する、ことを特徴とするものである。
以上のように、第１の発明によれば、フィルタは、機械系の共振周波数と反共振周波数との間で、位相が遅れるように設定したので、制御系の安定性を保ちながら低周波数でのゲインを大きくすることができる。これによって外乱トルクによる速度変動が小さくなり、高精度の制御が実現できるという効果がある。
第２の発明によれば、比例ゲインＫＰとゲインＫＬとの積を機械系の慣性モーメントＪで除した値である第一の交差周波数ωＣ１と比例ゲインＫＰと前記ゲインＫＨとの積を前記モータの慣性モーメントＪＭで除した値である第二の交差周波数ωＣ２との間で、位相が遅れるように設定した。これにより第一の交差周波数ωＣ１及び第二の交差周波数ωＣ２での位相遅れの増加分が小さくなるので、制御系の安定性を保ちながら低周波数でのゲインを大きくすることができる。これによって外乱トルクによる速度変動が小さくなり、高精度の制御が実現できるという効果がある。
第３の発明によれば、フィルタは、比例ゲインＫＰとゲインＫＬとの積を機械系の慣性モーメントＪで除した値である交差周波数ωＣ１と第一のフィルタ周波数ωＦ１との比が概ね一定となるように設定したので、第一の交差周波数ωＣ１での位相遅れの増加分も小さくなり、安定性を損ねることがなくなり、制御系が振動的になったり、発振したりすることがないという効果がある。
第４の発明によれば、フィルタは、比例ゲインＫＰとゲインＫＬとの積を機械系の慣性モーメントＪで除した値である交差周波数ωＣ１と第一のフィルタ周波数ωＦ１との比が概ね一定となるようにすると共に、積分ゲインＫＩを比例ゲインＫＰで除した値である零点周波数ωＰＩと交差周波数ωＣ１との比を概ね一定としたので、第一の交差周波数ωＣ１における位相遅れが大きくなり過ぎず、制御系の安定性を確保することができるという効果がある。
第５の発明によれば、パラメータ設定手段は、機械系の慣性モーメントＪをモータの慣性モーメントＪＭで除した値である慣性比が大きくなれば、第一のフィルタ周波数ωＦ１に対する第二のフィルタ周波数ωＦ２の比が大きくなるように設定したので、第二の交差周波数ωＣ２での位相遅れの増加分も小さくなり、安定性を損ねることがなくなり、制御系が振動的になったり、発振したりすることがないという効果がある。
第６の発明によれば、パラメータ設定手段はゲインＫＬとゲインＫＨの比であるゲイン比、または、第二のフィルタ周波数ωＦ２と第一のフィルタ周波数ωＦ１の比である周波数比を入力し、ゲイン比、または、周波数比に基づいてフィルタの特性を設定したので、機械系が複数の機械共振を持つ場合でも、第一の交差周波数ωＣ１及び第二の交差周波数ωＣ２における位相遅れが大きくなり過ぎることはなく、安定性を保ちながら低周波数のゲインを増大させることができるという効果がある。
第７の発明によれば、パラメータ設定手段は、周波数特性取得手段で取得した機械系の周波数特性に基づいて機械系の反共振周波数と共振周波数の間でフィルタの位相が遅れるように設定したので、フィルタの位相遅れが機械系の位相進みによってキャンセルされる。このため、第一の交差周波数ωＣ１、および、第二の交差周波数ωＣ２での位相遅れが大きくなることがなく、フィルタを挿入しても安定性を損なうことがなくなるという効果がある。
図１は、本発明の一実施例である制御装置の構成示すブロック図である。
図２は、本発明の一実施例である位相遅れフィルタの周波数特性を示す図である。
図３は、一実施例による速度開ループ周波数特性を示す図である。
図４は、本発明の他の実施例による制御装置の構成示すブロック図である。
図５は、本発明の他の実施例による制御装置の構成示すブロック図である。
図６は、従来の速度制御装置の構成を示すブロック図である。
図７は、従来の速度制御装置を適用した場合の速度開ループ周波数特性を示す図である。
図８は、機械共振を持つ機械系を対象とした従来の速度制御装置の構成を示すブロック図である。
図９は、従来技術で用いられるフィルタの周波数特性を示す図である。
図２は、本発明の一実施例である位相遅れフィルタの周波数特性を示す図である。
図３は、一実施例による速度開ループ周波数特性を示す図である。
図４は、本発明の他の実施例による制御装置の構成示すブロック図である。
図５は、本発明の他の実施例による制御装置の構成示すブロック図である。
図６は、従来の速度制御装置の構成を示すブロック図である。
図７は、従来の速度制御装置を適用した場合の速度開ループ周波数特性を示す図である。
図８は、機械共振を持つ機械系を対象とした従来の速度制御装置の構成を示すブロック図である。
図９は、従来技術で用いられるフィルタの周波数特性を示す図である。
本発明の一実施例を図１に示す制御装置の構成ブロック図によって説明する。図１中、図６と同一又は相当部分には同一の符号を付し、適宜説明を省略する。図１において、１はモータ、２はモータによって駆動される負荷、３はモータ１と負荷２を接続する軸である。負荷２はモータ１で駆動される機械の可動部分をひとつの慣性負荷としてモデル化したものであり、軸３はモータ１が発生するトルクを機械に伝達する機構をモデル化したものである。４はモータ１に取り付けられ、モータ１の位置を検出する位置検出手段としてのエンコーダ、５はエンコーダ４で検出されたモータ位置を微分することでモータ１の速度を計算する速度検出手段である。６は比較器であり、図示しない上位コントローラから与えられる速度指令信号と速度検出手段５の出力であるモータ１の検出速度（検出速度信号）とを比較し、両者の差である速度誤差（速度偏差信号）を出力する。７は速度制御手段であり、比較器６の出力である速度誤差を入力してモータ１の駆動指令信号である電流指令を出力する。８は電流制御手段であり、速度制御手段７の出力である電流指令に基づいてモータ電流を制御することによりモータ１にトルクを発生させ、モータを回転させる。
速度制御手段７は比例制御器９、積分制御器１０、および、加算器１１から構成される。比例制御器９は入力した速度誤差に比例ゲインＫＰを乗じて出力し、積分制御器１０は速度誤差の積分値に積分ゲインＫＩを乗じて出力する。加算器１１は比例制御器９の出力と積分制御器１０の出力を加算して、電流指令として出力する。また、１５は共振周波数と反共振周波数とを有する機械系で、モータ１と負荷２および軸３から構成される。１３は、速度ループに速度制御手段７と直列に挿入されると共に、速度制御手段７の出力を入力とし、フィルタ演算を行って電流指令を出力する位相遅れフィルタ、１４は位相遅れフィルタの特性と速度制御手段のパラメータである積分ゲインＫＩを設定するパラメータ設定手段である。
ここで、速度ループとは、速度制御手段７、位相遅れフィルタ１３、電流制御手段８、モータ１、エンコーダ４、速度検出５にて形成されるループをいう。
位相遅れフィルタ１３は図２に示すような位相遅れ特性を持つフィルタである。すなわち、第一のフィルタ周波数ωＦ１以下（低周波領域）、の周波数でほぼ一定のゲインＫＬを持ち、第二のフィルタ周波数ωＦ２以上（高周波領域）ではゲインＫＬより小さいほぼ一定のゲインＫＨをもち、第一のフィルタ周波数ωＦ１と第二のフィルタ周波数ωＦ２の間でゲインが連続的に変化する。図２では、ＫＨ＝１＝０ｄｂとしている。また、位相特性は、第一のフィルタ周波数ωＦ１と第二のフィルタ周波数ωＦ２の間で位相が遅れ、第一のフィルタ周波数ωＦ１以下の周波数と第二のフィルタ周波数ωＦ２以上の周波数では位相遅れがほぼ零もしくは小さい値となる。このような周波数特性を持つフィルタは、たとえば、式（２）のような伝達関数Ｇｆ（ｓ）を持つフィルタで実現できる。
ここに、ω１＝ωＦ１、 ω２＝ωＦ２
ただし、ω１＜ω２である。
位相遅れフィルタ１３の特性を決める第一のフィルタ周波数ωＦ１と第二のフィルタ周波数ωＦ２はパラメータ設定手段１４で以下のように設定される。まず、第一の交差周波数ωＣ１と第二の交差周波数ωＣ２を以下の式で計算できる。
ここに、ＫＰ：速度制御手段７の比例ゲイン
ＫＬ：位相遅れフィルタ１３の低周波数でのゲイン
ＫＨ：位相遅れフィルタ１３の高周波数でのゲイン
Ｊ：機械系１５の慣性モーメント
ＪＭ：モータ１の慣性モーメント
式（３）と式（４）は次のようにして導出できる。反共振周波数以下の低周波数では、機械系１５の伝達関数を１／Ｊｓで近似することができる。また、低周波数での位相遅れフィルタ１３のゲインはＫＬとなるので、速度制御手段７の比例ゲインがＫＰであることを考慮すると、低周波数での速度開ループ伝達関数は近似的にＫＰ・ＫＬ／Ｊｓとなる。ただし、速度制御手段７の積分ゲインＫＩは小さいとしての影響を無視している。この伝達関数のゲインが０ｄｂとなる周波数はＫＰ・ＫＬ／Ｊであり、これが第一の交差周波数ωＣ１となるから式（３）が得られる。
同様に、共振周波数以上の高周波数では機械系１５の伝達関数を１／ＪＭｓで近似することができ、高周波数での位相遅れフィルタ１３のゲインはＫＨとなるので、高周波数での速度開ループ伝達関数は近似的にＫＰ・ＫＨ／ＪＭｓとなる。
この伝達関数のゲインが０ｄｂとなる周波数はＫＰ・ＫＨ／ＪＭとなり、これが第二の交差周波数ωＣ２となるから式（４）が得られる。パラメータ設定手段１４では、式（３）および式（４）で与えられる第一の交差周波数ωＣ１と第二の交差周波数ωＣ２との間で位相遅れフィルタ１３の位相が遅れるように第一のフィルタ周波数ωＦ１と第二のフィルタ周波数ωＦ２とを設定する。
図３はこのような位相遅れフィルタ１３を速度ループに挿入した場合としない場合の速度開ループ周波数特性を比較したものである。図３において、実線は位相遅れフィルタ１３を速度ループに挿入した場合、破線は挿入しない場合の周波数特性である。位相遅れフィルタ１３は低周波数でゲインを大きくする特性を持っているので、位相遅れフィルタ１３を速度ループに挿入することにより、低周波数でのゲインが大きくなっていることがわかる。上記のように、低周波数でのゲインを大きくすると外乱トルクによる速度変動が小さくなるので、位相遅れフィルタ１３を挿入することで精度のよい制御が実現できることになる。
また、制御系が安定に動作するには、上記のように第一の交差周波数ωＣ１と第二の交差周波数ωＣ２での位相遅れが小さいことが必要である。位相遅れフィルタ１３は上記のように、第一の交差周波数ωＣ１と第二の交差周波数ωＣ２で位相遅れが小さくなるように第一のフィルタ周波数ωＦ１と第二のフィルタ周波数ωＦ２を設定しているので、第一の交差周波数ωＣ１と第二の交差周波数ωＣ２での位相遅れの増加分が小さく、制御系の安定性を損なうことがない。すなわち、パラメータ設定手段１４で位相遅れフィルタ１３の第一のフィルタ周波数ωＦ１と第二のフィルタ周波数ωＦ２を上記のように設定すれば、制御系の安定性を損なうことなく、低周波数でのゲインを大きくすることができ、高精度の制御を実現することが可能となる。
なお、図３の第一の交差周波数ωＣ１と第二の交差周波数ωＣ２の正確な値は速度開ループ周波数特性を実際に計測しないと決められないが、近似的には上記式（３）および式（４）で計算することができる。
次にパラメータ設定手段１４の具体的な処理内容について説明する。まず、第一のフィルタ周波数ωＦ１と第一の交差周波数ωＣ１の比が概ね一定となるように、第一のフィルタ周波数ωＦ１を設定する。たとえば、第一のフィルタ周波数ωＦ１は第一の交差周波数ωＣ１の１〜２倍程度に設定する。図２に示したように、第一のフィルタ周波数ωＦ１以下の周波数では位相遅れフィルタ１３の位相遅れが小さくなっているので、このように設定すれば第一の交差周波数ωＣ１での位相遅れの増加分も小さくなり、安定性を損ねることがなくなり、制御系が振動的になったり、発振したりすることがない。
次に、機械系１５の慣性モーメントＪをモータ１の慣性モーメントＪＭで除した値である慣性比が大きくなれば、第一のフィルタ周波数ωＦ１に対する第二のフィルタ周波数ωＦ２の比が大きくなるように第二のフィルタ周波数ωＦ２を設定する。たとえば、第二のフィルタ周波数ωＦ２を慣性比の平方根と第一のフィルタ周波数ωＦ１の積に設定する。または、第二のフィルタ周波数ωＦ２を第二の交差周波数ωＣ２の１／２〜１倍程度に設定してもよい。このように設定すれば、第二のフィルタ周波数ωＦ２は第二の交差周波数ωＣ２と同程度かそれよりも小さい値となる。図２に示したように、第二のフィルタ周波数ωＦ２以上の周波数では位相遅れフィルタ１３の位相遅れが小さくなっているので、このように設定すれば第二の交差周波数ωＣ２での位相遅れの増加分も小さくなり、安定性を損ねることがなくなり、制御系が振動的になったり、発振したりすることがない。
さらに、パラメータ設定手段１４は、速度制御手段７における積分ゲインＫＩを比例ゲインＫＰで除した値である零点周波数ωＰＩと第一の交差周波数ωＣ１との比が概ね一定となるように積分ゲインＫＩを設定する。たとえば、零点周波数ωＰＩが第一の交差周波数ωＣ１の１／２になるようにするには、ＫＩ＝ＫＰ・ωＣ１／２とすればよい。積分制御器１０に起因する第一の交差周波数ωＣ１における位相遅れの大きさは概ね零点周波数ωＰＩと第一の交差周波数ωＣ１の比で決まるので、零点周波数ωＰＩと第一の交差周波数ωＣ１の比を適切に設定しておけば第一の交差周波数ωＣ１における位相遅れが大きくなり過ぎず、制御系の安定性を確保することができる。つまり、零点周波数ωＰＩと第一の交差周波数ωＣ１の比が適切な値になるように積分ゲインＫＩを設定すれば、制御系の安定性が確保された範囲内で積分ゲインＫＩを大きくでき、低周波数の外乱に対する抑制効果を増大できる。
速度制御手段７は比例制御器９、積分制御器１０、および、加算器１１から構成される。比例制御器９は入力した速度誤差に比例ゲインＫＰを乗じて出力し、積分制御器１０は速度誤差の積分値に積分ゲインＫＩを乗じて出力する。加算器１１は比例制御器９の出力と積分制御器１０の出力を加算して、電流指令として出力する。また、１５は共振周波数と反共振周波数とを有する機械系で、モータ１と負荷２および軸３から構成される。１３は、速度ループに速度制御手段７と直列に挿入されると共に、速度制御手段７の出力を入力とし、フィルタ演算を行って電流指令を出力する位相遅れフィルタ、１４は位相遅れフィルタの特性と速度制御手段のパラメータである積分ゲインＫＩを設定するパラメータ設定手段である。
ここで、速度ループとは、速度制御手段７、位相遅れフィルタ１３、電流制御手段８、モータ１、エンコーダ４、速度検出５にて形成されるループをいう。
位相遅れフィルタ１３は図２に示すような位相遅れ特性を持つフィルタである。すなわち、第一のフィルタ周波数ωＦ１以下（低周波領域）、の周波数でほぼ一定のゲインＫＬを持ち、第二のフィルタ周波数ωＦ２以上（高周波領域）ではゲインＫＬより小さいほぼ一定のゲインＫＨをもち、第一のフィルタ周波数ωＦ１と第二のフィルタ周波数ωＦ２の間でゲインが連続的に変化する。図２では、ＫＨ＝１＝０ｄｂとしている。また、位相特性は、第一のフィルタ周波数ωＦ１と第二のフィルタ周波数ωＦ２の間で位相が遅れ、第一のフィルタ周波数ωＦ１以下の周波数と第二のフィルタ周波数ωＦ２以上の周波数では位相遅れがほぼ零もしくは小さい値となる。このような周波数特性を持つフィルタは、たとえば、式（２）のような伝達関数Ｇｆ（ｓ）を持つフィルタで実現できる。
ただし、ω１＜ω２である。
位相遅れフィルタ１３の特性を決める第一のフィルタ周波数ωＦ１と第二のフィルタ周波数ωＦ２はパラメータ設定手段１４で以下のように設定される。まず、第一の交差周波数ωＣ１と第二の交差周波数ωＣ２を以下の式で計算できる。
ＫＬ：位相遅れフィルタ１３の低周波数でのゲイン
ＫＨ：位相遅れフィルタ１３の高周波数でのゲイン
Ｊ：機械系１５の慣性モーメント
ＪＭ：モータ１の慣性モーメント
式（３）と式（４）は次のようにして導出できる。反共振周波数以下の低周波数では、機械系１５の伝達関数を１／Ｊｓで近似することができる。また、低周波数での位相遅れフィルタ１３のゲインはＫＬとなるので、速度制御手段７の比例ゲインがＫＰであることを考慮すると、低周波数での速度開ループ伝達関数は近似的にＫＰ・ＫＬ／Ｊｓとなる。ただし、速度制御手段７の積分ゲインＫＩは小さいとしての影響を無視している。この伝達関数のゲインが０ｄｂとなる周波数はＫＰ・ＫＬ／Ｊであり、これが第一の交差周波数ωＣ１となるから式（３）が得られる。
同様に、共振周波数以上の高周波数では機械系１５の伝達関数を１／ＪＭｓで近似することができ、高周波数での位相遅れフィルタ１３のゲインはＫＨとなるので、高周波数での速度開ループ伝達関数は近似的にＫＰ・ＫＨ／ＪＭｓとなる。
この伝達関数のゲインが０ｄｂとなる周波数はＫＰ・ＫＨ／ＪＭとなり、これが第二の交差周波数ωＣ２となるから式（４）が得られる。パラメータ設定手段１４では、式（３）および式（４）で与えられる第一の交差周波数ωＣ１と第二の交差周波数ωＣ２との間で位相遅れフィルタ１３の位相が遅れるように第一のフィルタ周波数ωＦ１と第二のフィルタ周波数ωＦ２とを設定する。
図３はこのような位相遅れフィルタ１３を速度ループに挿入した場合としない場合の速度開ループ周波数特性を比較したものである。図３において、実線は位相遅れフィルタ１３を速度ループに挿入した場合、破線は挿入しない場合の周波数特性である。位相遅れフィルタ１３は低周波数でゲインを大きくする特性を持っているので、位相遅れフィルタ１３を速度ループに挿入することにより、低周波数でのゲインが大きくなっていることがわかる。上記のように、低周波数でのゲインを大きくすると外乱トルクによる速度変動が小さくなるので、位相遅れフィルタ１３を挿入することで精度のよい制御が実現できることになる。
また、制御系が安定に動作するには、上記のように第一の交差周波数ωＣ１と第二の交差周波数ωＣ２での位相遅れが小さいことが必要である。位相遅れフィルタ１３は上記のように、第一の交差周波数ωＣ１と第二の交差周波数ωＣ２で位相遅れが小さくなるように第一のフィルタ周波数ωＦ１と第二のフィルタ周波数ωＦ２を設定しているので、第一の交差周波数ωＣ１と第二の交差周波数ωＣ２での位相遅れの増加分が小さく、制御系の安定性を損なうことがない。すなわち、パラメータ設定手段１４で位相遅れフィルタ１３の第一のフィルタ周波数ωＦ１と第二のフィルタ周波数ωＦ２を上記のように設定すれば、制御系の安定性を損なうことなく、低周波数でのゲインを大きくすることができ、高精度の制御を実現することが可能となる。
なお、図３の第一の交差周波数ωＣ１と第二の交差周波数ωＣ２の正確な値は速度開ループ周波数特性を実際に計測しないと決められないが、近似的には上記式（３）および式（４）で計算することができる。
次にパラメータ設定手段１４の具体的な処理内容について説明する。まず、第一のフィルタ周波数ωＦ１と第一の交差周波数ωＣ１の比が概ね一定となるように、第一のフィルタ周波数ωＦ１を設定する。たとえば、第一のフィルタ周波数ωＦ１は第一の交差周波数ωＣ１の１〜２倍程度に設定する。図２に示したように、第一のフィルタ周波数ωＦ１以下の周波数では位相遅れフィルタ１３の位相遅れが小さくなっているので、このように設定すれば第一の交差周波数ωＣ１での位相遅れの増加分も小さくなり、安定性を損ねることがなくなり、制御系が振動的になったり、発振したりすることがない。
次に、機械系１５の慣性モーメントＪをモータ１の慣性モーメントＪＭで除した値である慣性比が大きくなれば、第一のフィルタ周波数ωＦ１に対する第二のフィルタ周波数ωＦ２の比が大きくなるように第二のフィルタ周波数ωＦ２を設定する。たとえば、第二のフィルタ周波数ωＦ２を慣性比の平方根と第一のフィルタ周波数ωＦ１の積に設定する。または、第二のフィルタ周波数ωＦ２を第二の交差周波数ωＣ２の１／２〜１倍程度に設定してもよい。このように設定すれば、第二のフィルタ周波数ωＦ２は第二の交差周波数ωＣ２と同程度かそれよりも小さい値となる。図２に示したように、第二のフィルタ周波数ωＦ２以上の周波数では位相遅れフィルタ１３の位相遅れが小さくなっているので、このように設定すれば第二の交差周波数ωＣ２での位相遅れの増加分も小さくなり、安定性を損ねることがなくなり、制御系が振動的になったり、発振したりすることがない。
さらに、パラメータ設定手段１４は、速度制御手段７における積分ゲインＫＩを比例ゲインＫＰで除した値である零点周波数ωＰＩと第一の交差周波数ωＣ１との比が概ね一定となるように積分ゲインＫＩを設定する。たとえば、零点周波数ωＰＩが第一の交差周波数ωＣ１の１／２になるようにするには、ＫＩ＝ＫＰ・ωＣ１／２とすればよい。積分制御器１０に起因する第一の交差周波数ωＣ１における位相遅れの大きさは概ね零点周波数ωＰＩと第一の交差周波数ωＣ１の比で決まるので、零点周波数ωＰＩと第一の交差周波数ωＣ１の比を適切に設定しておけば第一の交差周波数ωＣ１における位相遅れが大きくなり過ぎず、制御系の安定性を確保することができる。つまり、零点周波数ωＰＩと第一の交差周波数ωＣ１の比が適切な値になるように積分ゲインＫＩを設定すれば、制御系の安定性が確保された範囲内で積分ゲインＫＩを大きくでき、低周波数の外乱に対する抑制効果を増大できる。
図４は本発明の他の実施例である制御装置の構成をブロック図で示したものである。図１と同一部分には同一の符号を付して適宜説明を省略する。図４において、１６は位相遅れフィルタの特性と速度制御手段のパラメータである積分ゲインＫＩを設定するパラメータ設定手段であり、図１のパラメータ設定手段とほぼ同様の作用をするが、外部からひとつの調整パラメータαを入力するようになっている。
この調整パラメータαは、位相遅れフィルタ１３の高周波数でのゲインＫＨに対する低周波数でのゲインＫＬの比を指定する。パラメータ設定手段１６では、調整パラメータαを用いてＫＬ＝α・ＫＨとし、上式（３）によって第一の交差周波数ωＣ１を計算する。さらに、上記のように、第一の交差周波数ωＣ１と第一のフィルタ周波数ωＦ１の比が概ね一定になるように第一のフィルタ周波数ωＦ１を決める。第二のフィルタ周波数ωＦ２はＫＬ＝α・ＫＨとなるように設定される。
調整パラメータαの与え方は、まず、α＝１とする。そして、機械系を作動させてその応答特性を見ながらαを徐々に大きくして行く。望ましい応答が得られるか、または、機械振動が出始めたら調整パラメータαを大きくするのをやめ、望ましい応答が得られた場合はαをその値で固定し、振動が出はじめた場合はαを少し小さくして固定する。このような手順で調整パラメータαを与えることにより、制御系の安定性を保ちながら低周波数でのゲインを大きくすることができ、外乱に対する抑制効果を増大させることができる。その理由を以下に説明する。
まず、調整パラメータαを大きくすると、ＫＬ＝α・ＫＨによって位相遅れフィルタの低周波数でのゲインＫＬが大きくなるので、低周波数の外乱に対する抑制効果を増大できる。また、このとき、第一の交差周波数ωＣ１と第一のフィルタ周波数ωＦ１の比が概ね一定になるようにしているので、上記のように第一の交差周波数ωＣ１における位相遅れが大きくなり過ぎることはなく、安定性を保ちながら低周波数のゲインを増大させることができる。
また、第二のフィルタ周波数ωＦ２は位相遅れフィルタ１３の低周波数でのゲインＫＬと高周波数でのゲインＫＨの関係がＫＬ＝α・ＫＨとなるように設定される。図２のフィルタ特性を見るとわかるが、高周波数でのゲインＫＨに対する低周波数でのゲインＫＬの比であるαを大きくするには、第一のフィルタ周波数ωＦ１に対する第二のフィルタ周波数ωＦ２の比も大きくする必要がある。αを大きくすると、ＫＬ＝α・ＫＨによりＫＬが大きくなり、これに伴って式（３）により第一の交差周波数ωＣ１が大きくなり、さらに第一の交差周波数ωＣ１と第一のフィルタ周波数ωＦ１の比が概ね一定になるようにしているから第一のフィルタ周波数ωＦ１も大きくなり、したがって、第二のフィルタ周波数ωＦ２も大きくなる。第一のフィルタ周波数ωＦ１と第二のフィルタ周波数ωＦ２が大きくなると、位相遅れフィルタ１３の位相が遅れる周波数範囲が高周波側に移動するため、第二の交差周波数ωＣ２における位相遅れが大きくなる。
このように、調整パラメータαを１から徐々に大きくしていくと、それに応じて第二の交差周波数ωＣ２におけ位相遅れが少しずつ大きくなって行くことになる。しかし、第二の交差周波数ωＣ２におけ位相遅れが大きくなり過ぎると機械系に振動が出始めるので、機械系の応答を見ているとそれを知ることができる。
したがって、機械系の振動が出始めるよりも少し小さい値にαを設定すると、第二の交差周波数ωＣ２においても位相遅れが大きくなり過ぎることがなくなる。このようにして、第一の交差周波数ωＣ１と第二の交差周波数ωＣ２の両方における位相遅れが大きくならないように位相遅れフィルタ１３の特性を設定することができ、制御系の安定性を保つことができる。
図１に示した実施の形態１の速度制御装置におけるパラメータ設定手段１４は、機械系が一組の共振・反共振を持つ場合には有効に作用する。しかし、機械によってはより高い周波数にも別の共振・反共振特性を持つ場合があり、このような機械では第二の交差周波数ωＣ２を計算で正確に求めることが困難となる。このような場合は、第二のフィルタ周波数ωＦ２を計算で自動的に設定するよりは、調整パラメータαを用いて機械の応答をみながら設定した方が結果的に良好な特性が得られる。
なお、上記では、調整パラメータαは、位相遅れフィルタ１３の低周波でのゲインＫＬと高周波でのゲインＫＨの比であるゲイン比を指定するようにしたが、第二のフィルタ周波数ωＦ２と第一のフィルタ周波数ωＦ１の比である周波数比を指定するようにしてもよい。ゲイン比と周波数比の関係は位相遅れフィルタ１３の伝達関数により決まっているから、ゲイン比を指定しても周波数比を指定しても同じ効果が得られる。
この調整パラメータαは、位相遅れフィルタ１３の高周波数でのゲインＫＨに対する低周波数でのゲインＫＬの比を指定する。パラメータ設定手段１６では、調整パラメータαを用いてＫＬ＝α・ＫＨとし、上式（３）によって第一の交差周波数ωＣ１を計算する。さらに、上記のように、第一の交差周波数ωＣ１と第一のフィルタ周波数ωＦ１の比が概ね一定になるように第一のフィルタ周波数ωＦ１を決める。第二のフィルタ周波数ωＦ２はＫＬ＝α・ＫＨとなるように設定される。
調整パラメータαの与え方は、まず、α＝１とする。そして、機械系を作動させてその応答特性を見ながらαを徐々に大きくして行く。望ましい応答が得られるか、または、機械振動が出始めたら調整パラメータαを大きくするのをやめ、望ましい応答が得られた場合はαをその値で固定し、振動が出はじめた場合はαを少し小さくして固定する。このような手順で調整パラメータαを与えることにより、制御系の安定性を保ちながら低周波数でのゲインを大きくすることができ、外乱に対する抑制効果を増大させることができる。その理由を以下に説明する。
まず、調整パラメータαを大きくすると、ＫＬ＝α・ＫＨによって位相遅れフィルタの低周波数でのゲインＫＬが大きくなるので、低周波数の外乱に対する抑制効果を増大できる。また、このとき、第一の交差周波数ωＣ１と第一のフィルタ周波数ωＦ１の比が概ね一定になるようにしているので、上記のように第一の交差周波数ωＣ１における位相遅れが大きくなり過ぎることはなく、安定性を保ちながら低周波数のゲインを増大させることができる。
また、第二のフィルタ周波数ωＦ２は位相遅れフィルタ１３の低周波数でのゲインＫＬと高周波数でのゲインＫＨの関係がＫＬ＝α・ＫＨとなるように設定される。図２のフィルタ特性を見るとわかるが、高周波数でのゲインＫＨに対する低周波数でのゲインＫＬの比であるαを大きくするには、第一のフィルタ周波数ωＦ１に対する第二のフィルタ周波数ωＦ２の比も大きくする必要がある。αを大きくすると、ＫＬ＝α・ＫＨによりＫＬが大きくなり、これに伴って式（３）により第一の交差周波数ωＣ１が大きくなり、さらに第一の交差周波数ωＣ１と第一のフィルタ周波数ωＦ１の比が概ね一定になるようにしているから第一のフィルタ周波数ωＦ１も大きくなり、したがって、第二のフィルタ周波数ωＦ２も大きくなる。第一のフィルタ周波数ωＦ１と第二のフィルタ周波数ωＦ２が大きくなると、位相遅れフィルタ１３の位相が遅れる周波数範囲が高周波側に移動するため、第二の交差周波数ωＣ２における位相遅れが大きくなる。
このように、調整パラメータαを１から徐々に大きくしていくと、それに応じて第二の交差周波数ωＣ２におけ位相遅れが少しずつ大きくなって行くことになる。しかし、第二の交差周波数ωＣ２におけ位相遅れが大きくなり過ぎると機械系に振動が出始めるので、機械系の応答を見ているとそれを知ることができる。
したがって、機械系の振動が出始めるよりも少し小さい値にαを設定すると、第二の交差周波数ωＣ２においても位相遅れが大きくなり過ぎることがなくなる。このようにして、第一の交差周波数ωＣ１と第二の交差周波数ωＣ２の両方における位相遅れが大きくならないように位相遅れフィルタ１３の特性を設定することができ、制御系の安定性を保つことができる。
図１に示した実施の形態１の速度制御装置におけるパラメータ設定手段１４は、機械系が一組の共振・反共振を持つ場合には有効に作用する。しかし、機械によってはより高い周波数にも別の共振・反共振特性を持つ場合があり、このような機械では第二の交差周波数ωＣ２を計算で正確に求めることが困難となる。このような場合は、第二のフィルタ周波数ωＦ２を計算で自動的に設定するよりは、調整パラメータαを用いて機械の応答をみながら設定した方が結果的に良好な特性が得られる。
なお、上記では、調整パラメータαは、位相遅れフィルタ１３の低周波でのゲインＫＬと高周波でのゲインＫＨの比であるゲイン比を指定するようにしたが、第二のフィルタ周波数ωＦ２と第一のフィルタ周波数ωＦ１の比である周波数比を指定するようにしてもよい。ゲイン比と周波数比の関係は位相遅れフィルタ１３の伝達関数により決まっているから、ゲイン比を指定しても周波数比を指定しても同じ効果が得られる。
図５は本発明の他の実施例である制御装置の構成をブロック図で示したものである。図１と同一部分には同一の符号を付してある。図５において、１７は機械系の周波数特性を取得する周波数特性取得手段、１８は位相遅れフィルタの特性を設定するパラメータ設定手段であり、周波数特性取得手段１７で取得した機械系の周波数特性に基づいて位相遅れフィルタの特性を設定する。
周波数特性取得手段１７では機械系の周波数特性を取得するが、その方法はいくつか知られている。専用の計測器を用いて計測することも出来るし、モータをランダムなトルクで駆動して、そのときの速度応答を周波数解析して求めることもできる。また、機械の剛性や質量、慣性モーメントなどがわかっている場合はこれらを用いて数式モデルを作り、計算で求めることもできる。その結果、たとえば、図７に実線で示したような周波数特性が得られる。パラメータ設定手段１８では、このようにして取得した機械系の周波数特性に基づいて、機械系の反共振周波数と共振周波数の間で位相遅れフィルタ１３の位相が遅れるように位相遅れフィルタ１３の特性を設定する。このためには、位相遅れフィルタの第一のフィルタ周波数ωＦ１を反共振周波数の付近に設定し、第二のフィルタ周波数ωＦ２を共振周波数付近に設定する。
機械共振を持つ機械系の周波数特性は、図７の実線に示したように、反共振周波数と共振周波数の間で位相が進む特性を持っている。したがって、上記のように反共振周波数と共振周波数の間で位相遅れフィルタ１３の位相が遅れるように設定すれば、位相遅れフィルタの位相遅れが機械系の位相進みによってキャンセルされる。このため、第一の交差周波数ωＣ１、および、第二の交差周波数ωＣ２での位相遅れが大きくなることがなく、位相遅れフィルタ１３を挿入しても安定性を損なうことがなくなる。
周波数特性取得手段１７では機械系の周波数特性を取得するが、その方法はいくつか知られている。専用の計測器を用いて計測することも出来るし、モータをランダムなトルクで駆動して、そのときの速度応答を周波数解析して求めることもできる。また、機械の剛性や質量、慣性モーメントなどがわかっている場合はこれらを用いて数式モデルを作り、計算で求めることもできる。その結果、たとえば、図７に実線で示したような周波数特性が得られる。パラメータ設定手段１８では、このようにして取得した機械系の周波数特性に基づいて、機械系の反共振周波数と共振周波数の間で位相遅れフィルタ１３の位相が遅れるように位相遅れフィルタ１３の特性を設定する。このためには、位相遅れフィルタの第一のフィルタ周波数ωＦ１を反共振周波数の付近に設定し、第二のフィルタ周波数ωＦ２を共振周波数付近に設定する。
機械共振を持つ機械系の周波数特性は、図７の実線に示したように、反共振周波数と共振周波数の間で位相が進む特性を持っている。したがって、上記のように反共振周波数と共振周波数の間で位相遅れフィルタ１３の位相が遅れるように設定すれば、位相遅れフィルタの位相遅れが機械系の位相進みによってキャンセルされる。このため、第一の交差周波数ωＣ１、および、第二の交差周波数ωＣ２での位相遅れが大きくなることがなく、位相遅れフィルタ１３を挿入しても安定性を損なうことがなくなる。
上記のようにモータで駆動する機械系の慣性モーメントがモータ自身の慣性モーメントに比して大きい制御システムに適する。
Claims (7)
- 共振周波数と反共振周波数とを有する機械系を有する機械負荷に結合されたモータを、速度指令信号に基いて駆動すると共に、前記モータの検出速度を速度制御ループに有するモータの制御装置において、
前記速度指令信号と前記モータの検出速度の差信号に基いて前記モータの速度を前記速度指令信号に追従させるための前記モータの駆動指令信号を出力する速度制御手段と、
前記速度制御ループに前記速度制御手段と直列に挿入されると共に、高周波数領域と、低周波数領域と、高周波数領域と低周波数領域との間にある中間周波数領域とから成り、前記高周波数領域のゲインＫＨよりも低周波数領域のゲインＫＬが大きいと共に、前記中間周波数領域の位相が遅れる位相遅れ特性を有するフィルタとを備え、
前記速度制御手段は、入力に比例ゲインＫＰを乗じて出力する比例制御部、または、入力に比例ゲインＫＰを乗じた値と入力の積分値に積分ゲインＫＩを乗じた値を加算して出力する積分制御部を有しており、
前記フィルタは、前記共振周波数と前記反共振周波数との間で、位相が遅れるように設定された、
ことを特徴とするモータの制御装置。 - 共振周波数と反共振周波数とを有する機械系を有する機械負荷に結合されたモータを、速度指令信号に基いて駆動すると共に、前記モータの検出速度を速度制御ループに有するモータの制御装置において、
前記速度指令信号と前記モータの検出速度の差信号に基いて前記モータの速度を前記速度指令信号に追従させるための前記モータの駆動指令信号を出力する速度制御手段と、
前記速度制御ループに前記速度制御手段と直列に挿入されると共に、高周波数領域と、低周波数領域と、高周波数領域と低周波数領域との間にある中間周波数領域とから成り、前記高周波数領域のゲインＫＨよりも低周波数領域のゲインＫＬが大きいと共に、前記中間周波数領域の位相が遅れる位相遅れ特性を有するフィルタとを備え、
前記速度制御手段は、入力に比例ゲインＫＰを乗じて出力する比例制御部、または、入力に比例ゲインＫＰを乗じた値と入力の積分値に積分ゲインＫＩを乗じた値を加算して出力する積分制御部を有しており、
前記フィルタは、前記比例ゲインＫＰと前記ゲインＫＬとの積を前記機械系の慣性モーメントＪで除した値である第一の交差周波数ωＣ１と前記比例ゲインＫＰと前記ゲインＫＨとの積を前記モータの慣性モーメントＪＭで除した値である第二の交差周波数ωＣ２との間で、位相が遅れるように設定された、
ことを特徴とするモータの制御装置。 - 共振周波数と反共振周波数とを有する機械系を有する機械負荷に結合されたモータを速度指令信号に基いて駆動すると共に、前記モータの検出速度を速度制御ループに有するモータの制御装置において、
前記速度指令信号と前記モータの検出速度の差信号に基いて前記モータの速度を前記速度指令信号に追従させるための前記モータの駆動指令信号を出力する速度制御手段と、
前記速度制御ループに前記速度制御手段と直列に挿入すると共に、第一のフィルタ周波数ωＦ１より低い周波数領域でほぼ一定のゲインＫＬとなり、第二のフィルタ周波数ωＦ２より高い周波数領域で前記ゲインＫＬよりも小さいほぼ一定のゲインＫＨを有し、前記第一のフィルタ周波数ωＦ１と前記第二のフィルタ周波数ωＦ２との間で位相が遅れる位相遅れ特性を有するフィルタとを備え、
前記速度制御手段は入力に比例ゲインＫＰを乗じて出力する比例制御演算、または、入力に比例ゲインＫＰを乗じた値と入力の積分値に積分ゲインＫＩを乗じた値を加算して出力する比例積分制御演算を有しており、
前記フィルタは、前記比例ゲインＫＰと前記ゲインＫＬとの積を前記機械系の慣性モーメントＪで除した値である交差周波数ωＣ１と前記第一のフィルタ周波数ωＦ１との比が概ね一定となるように設定する、
ことを特徴とするモータの制御装置。 - モータに結合された機械負荷からなる共振周波数と反共振周波数とを有する機械系を、速度指令信号に基づいて前記モータの検出速度を速度制御ループにより駆動制御するモータの制御装置において、
前記速度制御ループに速度制御手段と直列に挿入するとともに、第一のフィルタ周波数ωＦ１より低い周波数領域ではほぼ一定のゲインＫＬとなり、第二のフィルタ周波数ωＦ２より高い周波数領域では前記ゲインＫＬより小さいほぼ一定のゲインＫＨとなり、前記低い周波数領域と前記高い周波数領域との間の中間周波数領域で、位相遅れ特性を有するフィルタと、
前記フィルタの特性と前記速度制御手段のパラメータを設定するパラメータ設定手段とを備え、
前記速度制御手段は、入力に比例ゲインＫＰを乗じた値と入力の積分値に積分ゲインＫＩを乗じた値を加算して出力する積分制御部を有しており、
前記フィルタは、前記比例ゲインＫＰと前記ゲインＫＬとの積を前記機械系の慣性モーメントＪで除した値である交差周波数ωＣ１と前記第一のフィルタ周波数ωＦ１との比が概ね一定となるようにすると共に、
前記積分ゲインＫＩを前記比例ゲインＫＰで除した値である零点周波数ωＰＩと前記交差周波数ωＣ１との比が概ね一定とする、
することを特徴とするモータの制御装置。 - 前記フィルタと前記速度制御手段のパラメータを設定するパラメータ設定手段を備え、
前記パラメータ設定手段は、前記機械系の慣性モーメントＪを前記モータの慣性モーメントＪＶで除した値である慣性比が大きくなれば、前記第一のフィルタ周波数ωＦ１に対する前記第二のフィルタ周波数ωＦ２の比が大きくなるように設定する、
ことを特徴とする請求の範囲３または４に記載のモータの制御装置。 - 前記フィルタと前記速度制御手段のパラメータを設定するパラメータ設定手段を備え、
前記パラメータ設定手段は前記ゲインＫＬと前記ゲインＫＨの比であるゲイン比、または、前記第二のフィルタ周波数ωＦ２と前記第一のフィルタ周波数ωＦ１の比である周波数比を入力し、前記ゲイン比、または、前記周波数比に基づいて前記フィルタの特性を設定する、
ことを特徴とする請求の範囲３または４に記載のモータの制御装置。 - 共振周波数と反共振周波数とを有する機械系を有する機械負荷に結合されたモータを、速度指令信号に基いて駆動すると共に、前記モータの検出速度を速度制御ループに有するモータの制御装置において、
前記速度指令信号と前記モータの検出速度の差信号に基いて前記モータの速度を前記速度指令信号に追従させるための前記モータの駆動指令信号を出力する速度制御手段と、
前記速度制御ループに前記速度制御手段と直列に挿入されると共に、高周波数領域と、低周波数領域と、高周波数領域と低周波数領域との間にある中間周波数領域とから成り、前記高周波数領域のゲインＫＨよりも低周波数領域のゲインＫＬが大きいと共に、前記中間周波数領域の位相が遅れる位相遅れ特性を有するフィルタと、
前記機械系の周波数特性を取得する周波数特性取得手段と、
前記フィルタの特性を設定するパラメータ設定手段とを備え、
前記パラメータ設定手段は、前記周波数特性取得手段で取得した前記機械系の周波数特性に基づいて機械系の反共振周波数と共振周波数の間で前記フィルタの位相が遅れるように設定する、
ことを特徴とするモータの制御装置。
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| PCT/JP2003/016760 WO2005064781A1 (ja) | 2003-12-25 | 2003-12-25 | モータの制御装置 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JPWO2005064781A1 true JPWO2005064781A1 (ja) | 2007-07-26 |
| JP4367411B2 JP4367411B2 (ja) | 2009-11-18 |
Family
ID=34717664
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2005507030A Expired - Lifetime JP4367411B2 (ja) | 2003-12-25 | 2003-12-25 | モータの制御装置 |
Country Status (6)
| Country | Link |
|---|---|
| US (1) | US7183738B2 (ja) |
| JP (1) | JP4367411B2 (ja) |
| CN (1) | CN100388614C (ja) |
| DE (1) | DE10394087T5 (ja) |
| TW (1) | TWI234341B (ja) |
| WO (1) | WO2005064781A1 (ja) |
Families Citing this family (12)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| ATE415643T1 (de) * | 2004-01-23 | 2008-12-15 | Gsi Group Corp | System und verfahren zum optimieren der zeichenmarkierungsleistung |
| EP1616774A3 (en) * | 2004-07-15 | 2007-08-08 | NSK Ltd., | Electric power steering apparatus |
| EP2019978B1 (en) * | 2006-05-19 | 2011-12-21 | Siemens Industry, Inc. | Automating tuning of a closed loop controller |
| DE112011103674B9 (de) | 2010-11-05 | 2016-11-17 | Mitsubishi Electric Corporation | Motorregelvorrichtung |
| US9231500B2 (en) * | 2013-01-30 | 2016-01-05 | Nidec Motor Corporation | Sensorless motor braking system |
| JP6177705B2 (ja) * | 2014-02-21 | 2017-08-09 | 三菱重工業株式会社 | 機械装置の制御装置及び摩擦補償用のゲイン決定方法 |
| WO2016056305A1 (ja) * | 2014-10-09 | 2016-04-14 | 三菱電機株式会社 | 制御装置及び制御方法 |
| JP6846213B2 (ja) * | 2017-01-20 | 2021-03-24 | 山洋電気株式会社 | モータ制御装置 |
| JP6717872B2 (ja) * | 2018-03-27 | 2020-07-08 | ファナック株式会社 | モータ制御装置 |
| TWI747126B (zh) * | 2020-01-03 | 2021-11-21 | 國立勤益科技大學 | 電動滑板之管理系統 |
| WO2023195293A1 (ja) * | 2022-04-07 | 2023-10-12 | パナソニックＩｐマネジメント株式会社 | モータ駆動装置のサーボ調整方法、プログラム及びモータ駆動装置のサーボ調整装置 |
| DE102023004076A1 (de) | 2023-10-11 | 2023-12-14 | Mercedes-Benz Group AG | Verfahren zur Geräuschunterdrückung von Motorgeräuschen eines zumindest teilweise elektrisch betriebenen Fahrzeugs |
Family Cites Families (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| DE69131208T2 (de) * | 1990-02-14 | 1999-09-02 | Nikon Corp | Antriebsvorrichtung für einen Ultraschallwellenmotor |
| JP2000322105A (ja) * | 1999-05-07 | 2000-11-24 | Toshiba Mach Co Ltd | サーボ制御装置およびサーボ制御装置の安定化調整方法 |
| JP2001333588A (ja) * | 2000-05-23 | 2001-11-30 | Matsushita Electric Ind Co Ltd | 回転制御装置 |
| JP3856215B2 (ja) * | 2002-03-19 | 2006-12-13 | 株式会社安川電機 | 速度制御装置 |
| US6936990B2 (en) * | 2002-03-29 | 2005-08-30 | Matsushita Electric Industrial Co., Ltd. | Method for controlling electric motor and apparatus for controlling the same |
| US6844693B2 (en) * | 2002-03-29 | 2005-01-18 | Matsushita Electric Industrial Co., Ltd. | Position control apparatus for motor |
-
2003
- 2003-12-25 JP JP2005507030A patent/JP4367411B2/ja not_active Expired - Lifetime
- 2003-12-25 CN CNB2003801005708A patent/CN100388614C/zh not_active Expired - Lifetime
- 2003-12-25 DE DE10394087T patent/DE10394087T5/de not_active Withdrawn
- 2003-12-25 WO PCT/JP2003/016760 patent/WO2005064781A1/ja active Application Filing
- 2003-12-25 US US10/511,908 patent/US7183738B2/en not_active Expired - Lifetime
-
2004
- 2004-01-29 TW TW093101939A patent/TWI234341B/zh not_active IP Right Cessation
Also Published As
| Publication number | Publication date |
|---|---|
| DE10394087T5 (de) | 2005-12-22 |
| US20050200327A1 (en) | 2005-09-15 |
| CN100388614C (zh) | 2008-05-14 |
| TWI234341B (en) | 2005-06-11 |
| TW200522500A (en) | 2005-07-01 |
| JP4367411B2 (ja) | 2009-11-18 |
| CN1692548A (zh) | 2005-11-02 |
| US7183738B2 (en) | 2007-02-27 |
| WO2005064781A1 (ja) | 2005-07-14 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP3899526B2 (ja) | 位置制御装置 | |
| JP4367411B2 (ja) | モータの制御装置 | |
| JP4837558B2 (ja) | モータ制御装置 | |
| JP2010148178A (ja) | イナーシャ推定を行う制御装置及び制御システム | |
| WO2004049550A1 (ja) | モータの速度制御装置 | |
| JP5127767B2 (ja) | 駆動制御装置 | |
| US6803735B2 (en) | Speed-based open-loop start-up method for brushless DC motor | |
| JP3526022B2 (ja) | サーボ制御系の発振臨界検出方法 | |
| JP6161854B1 (ja) | モータ制御システム | |
| JP5316424B2 (ja) | モータ制御装置 | |
| WO2015079499A1 (ja) | 機械装置の設計改善作業を支援する方法及び装置 | |
| JP2890529B2 (ja) | セルフチューニング方法 | |
| KR100676835B1 (ko) | 모터의 제어장치 | |
| JPH11313495A (ja) | 電動機サーボ系の制御装置 | |
| JPH0670567A (ja) | 電動機の制御ゲイン自動設定方法及びバックラッシュ検出方法 | |
| JP2004086702A (ja) | 振動抑制フィルタの自動設定方法 | |
| JP6395927B2 (ja) | 位置決め制御装置 | |
| JP2009081923A (ja) | モータ制御システムとそのパラメータ調整方法 | |
| WO2021181787A1 (ja) | 制御装置 | |
| JP4784826B2 (ja) | システム同定装置およびそれを備えたモータ制御装置 | |
| WO2023171122A1 (ja) | モータ制御装置、およびその自動調整方法 | |
| JP2018040757A (ja) | モータ速度検出方法及びモータ速度制御方法 | |
| JP2002078369A (ja) | サーボモータ制御装置の調整方法およびその装置 | |
| JP4390049B2 (ja) | サーボ制御装置およびその限界ゲイン抽出方法 | |
| JP2000347743A (ja) | 位置制御装置 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20090507 |
|
| A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20090703 |
|
| 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: 20090804 |
|
| A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20090817 |
|
| R151 | Written notification of patent or utility model registration |
Ref document number: 4367411 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R151 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120904 Year of fee payment: 3 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130904 Year of fee payment: 4 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| EXPY | Cancellation because of completion of term |