JP4228389B2 - 位置決め制御装置 - Google Patents
位置決め制御装置 Download PDFInfo
- Publication number
- JP4228389B2 JP4228389B2 JP2003187631A JP2003187631A JP4228389B2 JP 4228389 B2 JP4228389 B2 JP 4228389B2 JP 2003187631 A JP2003187631 A JP 2003187631A JP 2003187631 A JP2003187631 A JP 2003187631A JP 4228389 B2 JP4228389 B2 JP 4228389B2
- Authority
- JP
- Japan
- Prior art keywords
- position command
- prefilter
- filter
- vector
- time constant
- 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.)
- Expired - Fee Related
Links
Images
Landscapes
- Feedback Control In General (AREA)
- Control Of Position Or Direction (AREA)
Description
【０００１】
【発明の属する技術分野】
本発明は、位置指令部とフィードバック制御系との間にプレフィルタを備え、負荷先端の振動を抑制する位置決め制御装置に関する。
【０００２】
【従来の技術】
図１０は柔軟アームを有する産業用機械の位置決め制御系を示す一般的なブロック図で、モータ５と、負荷テープル８と、負荷先端１０と、負荷テープルと負荷先端を連結する柔軟アーム９と、モータと負荷テープルを連結するトルク伝達機構７とを備えている。制御系は、位置指令発生部１で生成した元位置指令Ｘｒをプレフィルタ２に通し、フィードバック制御系の位置指令Ｘｒｆを生成し、モータに連結したエンコーダー６のモータ位置信号Ｘｍをフィードバックし、フィードバック制御系の位置指令Ｘｒｆおよびモータ位置信号Ｘｍをフィードバック制御部に入力し、フィードバック制御部の出力をサーボドライバに入力しモータを駆動する。
一般の機械ではモータ５と負荷テープル８を連結するトルク伝達機構７の剛性は高く、フィードバック制御部３のゲインを高くとれ、負荷テープルの位置またはモータ位置信号Ｘｍをほぼ位置指令Ｘｒｆに追従させることができる。しかし、負荷テープル８と負荷先端１０を連結する柔軟アーム９の剛性が低い場合は、負荷テープル８は目標位置に到達しても、負荷先端１０は低周波数で振動し続けると言う問題があった。（図４、図７）このために、例えば、非特許文献１の例では、このような振動を抑制するためにプレフィルタ２を式（１）のように構成し、負荷機械の振動モードの極でゲインが０となるように係数Ａ１、Ａ２、Ａ３および時定数Ｔ２、Ｔ３を定め、位置決め完了後の負荷先端の残留振動を抑えていた。（図５）
Ｆ（ｓ）＝Ａ１＋Ａ２ｅｘｐ（−ｓＴ２）＋Ａ３ｅｘｐ（−ｓＴ３）・・（１）
【０００３】
【非特許文献１】
山浦：「制振シーク制御」計測自動制御学会、計測と制御、２００２・６、ｐ．４２１−４２７
【０００４】
【発明が解決しようとする課題】
しかしながら、非特許文献１の従来例の構成では、一つの振動モードでゲインが０となるようにプレフィルタを構成するので、負荷先端の質量が大きく変動するような場合は、負荷機械の固有振動周波数も大きく変動し、負荷先端の残留振動を抑えることができないという問題があった（図８）。
本発明は上記課題を解決するためになされたものであり、負荷機械の固有振動周波数が大きく変動しても負荷先端の残留振動を十分に抑制し、高速・高精度位置決めを実現することを目的とする。
【０００５】
【課題を解決するための手段】
上記問題を解決するため、本発明は次のように構成したものである。
請求項１に記載の発明は、位置指令を出力する位置指令部と、モータの位置を制御するフィードバック制御系と、前記位置指令部と前記フィードバック制御系との間にプレフィルタと、を備える位置決め制御装置において、前記プレフィルタが、前記位置指令を入力し、係数ベクトルおよび時定数ベクトルに基づいて、新たな位置指令を出力するフィルタであって、前記位置指令と前記新たな位置指令との定常偏差が０となる条件および負荷機械の複数の振動モードの極でゲインが０となる条件を満足するように、前記係数ベクトルおよび前記時定数ベクトルを定めたフィルタであるものである。
請求項２に記載の発明は、請求項１記載の発明における前記プレフィルタが、前記係数ベクトルおよび前記時定数ベクトルの次数ｍを、前記振動モードの数ｎより１大きい自然数以上とし、前記係数ベクトルおよび前記時定数ベクトルを定めたフィルタであるものである。
請求項３に記載の発明は、請求項１記載の発明における前記プレフィルタが、前記係数ベクトルおよび前記時定数ベクトルの次数ｍを、前記振動モードの数ｎの２倍より１大きい自然数以上とし、前記係数ベクトルおよび前記時定数ベクトルを定めたフィルタであるものである。
請求項４に記載の発明は、請求項１記載の発明における前記プレフィルタが、連続型あるいは離散型であるものである。
【００１０】
【発明の実施の形態】
以下、本発明の実施の形態について図に基づいて説明する。
図１は本発明の第１の実施例を示す制御装置のブロック図である。
図において、１１は連続型プレフィルタであり、１３はフィードバック制御系の位置指令Ｘｒｆからモータ位置Ｘｍまでの伝達関数、１４はモータ位置Ｘｍから負荷先端位置Ｘｈまでの伝達関数である。ここで、連続型プレフィルタ１１は式（２）で表される。
【００１１】
【数５】
【００１２】
ただし、ｍは３以上の自然数である。また、［Ａ１、Ａ２、・・・、Ａｍ］および［Ｔ１、Ｔ２、・・・、Ｔｍ］はそれぞれ後述するように無定常偏差条件およびロバストな振動抑制条件により定める係数ベクトルおよび時定数ベクトルである。
まず、無定常偏差条件を与える。
良く知られているように、フィードバック制御部が積分要素を含んでいれば、フィードバック系の位置指令Ｘｒｆとモータ位置Ｘｍの定常偏差は必ず０となる。ここで、問題とするのは連続型プレフィルタ１１の入力である元の位置指令Ｘｒとプレフィルタ通過後のフィードバック系の位置指令Ｘｒｆとの定常偏差が０となることである。
位置指令部１が生成した元の位置指令Ｘｒを式（３）で表す。
【００１３】
【数６】
【００１４】
ただし、Ｘｅは目標送り距離、ｔｅは指令時間である。
式（２）より、Ｘｒが連続型プレフィルタ１１を通過した後のフィードバック系の位置指令Ｘｒｆは式（４）となる。
【００１５】
【数７】
【００１６】
式（４）において、Ｔｄ＝ｍａｘ｛Ｔ１、Ｔ２、・・・、Ｔｍ｝とすると、［１，ｍ］に含まれるすべての整数ｉに対して、式（５）となるので、式（６）が成り立つ。
Ｘｒ（ｔ−Ｔｉ）＝Ｘｅ、（ｔ＞ｔｅ＋Ｔｄ） ・・・（５）
【００１７】
【数８】
【００１８】
式（６）から、明らかにｔ＞ｔｅ＋Ｔｄ時Ｘｒｆ（ｔ）＝Ｘｅ（無定常偏差条件）を満たすための必要十分条件は式（７）が成り立つことである。
【００１９】
【数９】
【００２０】
次に、ロバストな振動抑制条件を与える。
図２より、負荷機械の振動モードの極は式（８）となる。
ｓ１、ｓ２＝−ζ０ω０±ｊω０√（１−ζ０2） ・・・（８）
負荷機械の振動を抑制するため、連続型プレフィルタ１１は振動モードの極でゲインが０となる必要がある。ずなわち、振動抑制条件を式（９）のように与える。
【００２１】
【数１０】
【００２２】
式（９）を整理すると、振動抑制条件は式（１０）、式（１１）となる。
【００２３】
【数１１】
【００２４】
【数１２】
【００２５】
ただし、Ｋ＝ｅｘｐ（ζ０ω０）、ωｄ＝ω０√（１−ζ０2）である。
負荷先端の質量が変動し、負荷機械の固有振動モードが変化する場合、その変化範囲を包括するよう式（１２）から適当なｎ個の固有振動モードを選び、ζ０＝ζｋおよびω０＝ωｋを式（１０）および式（１１）に代入すると、ロバストな振動抑制条件は式（１３）、式（１４）のように与えられる。
ｓｋ１、ｓｋ２＝−ζｋωｋ±ｊωｋ√（１−ζｋ2） ・・・（１２）
（ｋ＝１、・・・、ｎ）
【００２６】
【数１３】
【００２７】
【数１４】
【００２８】
ただしＫｋ＝ｅｘｐ（ζｋωｋ）、ωｄｋ＝ωｋ√（１−ζｋ2）、ｋ＝１、・・・、ｎである。
最後に、係数ベクトル［Ａ１、Ａ２、・・・、Ａｍ］および時定数ベクトル［Ｔ１、Ｔ２、・・・、Ｔｍ］を定める。
プレフィルタ１１の係数ベクトルと時定数ベクトルを定める際に、無定常偏差条件の式（７）とロバストな振動抑制条件の式（１３）および式（１４）、全部で（２ｎ＋１）個方程式を同時に満たすようにしなければならない。
ｍが（ｎ＋１）以上であれば、（ｎ＋１）個の係数と（ｎ＋１）個の時定数は合わせて（２ｎ＋２）個以上の未定係数があるため、式（７）と式（１３）と式（１４）の連立方程式を解くと、前記未定係数を定めることができる。ところが、式（１３）と式（１４）は時定数ベクトルの非線形方程式であるため、前記連立方程式を解くことは大変困難である。そこで、ｍを（２ｎ＋１）以上に設定し、予め時定数ベクトル［Ｔ１、Ｔ２、・・・、Ｔｍ］を適当な値を与えておけば、式（７）と式（１３）と式（１４）は係数ベクトル［Ａ１、Ａ２、・・・、Ａｍ］の線形連立方程式となるので、係数ベクトル［Ａ１、Ａ２、・・・、Ａｍ］は簡単に求められる。
上記手段により、負荷機械の固有振動周波数が大きく変動しても負荷先端の残留振動を十分に抑制し、高速・高精度位置決めを実現できるようにした。
【００２９】
図２は本発明の第２の実施例を示すブロック図である。第２の実施例が第１の実施例と異なることは、図２の離散型プレフィルタ１２は図１の連続型プレフィルタ１１を離散化したものである。すなわち、式（２）におけるすべてのｉに対して、ｎｉを（Ｔｉ／Ｔ）の最も近い整数とし、遅れ要素ｅ―ｓＴｉをｚ−ｎｉに変換し、構成したものである。ただし、ｚはｚ変換演算子、Ｔはサンプル周期である。
以上のように離散化を行うと、プレフィルタの特性が少し変わるので、第１の実施の形態で定めた係数ベクトル［Ａ１、Ａ２、・・・、Ａｍ］をそのまま用いると、式（７）の無定常偏差条件および式（１３）と式（１４）のロバストな振動抑制条件が満たされない可能性がある。一般に、振動抑制条件は少し外れても、近似的に満足されれば十分に振動抑制されるが、無定常偏差条件は僅かに外れても、定常偏差が残ることになり、位置誤差が生じ精度が悪くなる。これは許されることではない。
以下、無定常偏差条件が常に満たされることを証明する。
まず、位置指令部１が生成した元の位置指令Ｘｒの離散形式を式（１５）で表すものとする。
【００３０】
【数１５】
【００３１】
ただし、Ｘｅが目標送り距離、ｎｅが指令のサンプル周期数である。
一方、Ｘｒが離散化プレフィルタ１２を通過した後のフィードバック系の位置指令Ｘｒｆは式（１６）になる。
【００３２】
【数１６】
【００３３】
式（１６）において、ｎｄ＝ｍａｘ｛ｎ１、ｎ２、・・・、ｎｍ｝とすると、式（１５）より、［１，ｍ］に含まれるすべての整数ｉに対して、式（１７）が成り立つ。
Ｘｒ（ｋ−ｎｉ）＝Ｘｅ （ｋ＞ｎｅ＋ｎｄ） ・・・（１７）
また、式（７）および式（１６）より、式（１８）が成立する。
【００３４】
【数１７】
【００３５】
式（１８）はフィードバック系の位置指令Ｘｒｆとモータ位置Ｘｍとの定常偏差がないことを意味する。
【００３６】
次に、本発明の効果を数字例を用いて説明する。
固有振動周波数が６Ｈｚ〜１６Ｈｚ変動し、減衰係数が０．０１６である負荷機械に対して、ｎ＝２，ζ１＝ζ２＝０．０１６，ω１＝２π×７，ω２＝２π×１４とし、ｍ＝５、Ｔ1＝０、Ｔ2=０．０６４３，Ｔ3=０．１０７３，Ｔ4=０．０５３５，Ｔ5=０．０７１５として式（７）、式（１３）および式（１４）に代入すると、以下の連立線形方程式が得られる。
Ａ１＋Ａ２＋Ａ３＋Ａ４＋Ａ５＝１
Ａ１−０．９９６７Ａ２＋０．００５１Ａ３−０．７３３３Ａ４−１．０５４２Ａ５＝０
０．３２５６Ａ２−１．０８２３Ａ３＋０．７３７９Ａ４−０．００３３Ａ５＝０
Ａ１＋０．８８７４Ａ２−１．１７１４Ａ３−０．００６８Ａ４＋１．１１１２Ａ５＝０
−０．６４９Ａ２−０．０１１Ａ３−１．０８２１Ａ４−０．００７Ａ５＝０
・・・（１９）
式（１９）の連立方程式を解くと、Ａ１＝０．３２５１、Ａ２＝−１．５４０３、Ａ３＝０．１６６８、Ａ４＝０．９２９３、Ａ５＝１．１１９１となる。ここで、ディジタ制御を行うため、連続型プレフィルタをサンプル周期Ｔ＝０．０００２５ｓで離散化する。ｎｉ＝Ｒｏｕｎｄ｛Ｔｉ／Ｔ｝（ｉ＝１、２、・・・、５）より、ｎ１＝０、ｎ２＝２５７、ｎ３＝４２９、ｎ４＝２１４、ｎ５＝２８６となる。よって、離散型プレフィルタ１２は式（２０）になる。
【００３７】
【数１８】
【００３８】
以上求めた離散型プレフィルタおよび従来技術のプレフィルタのボード線図を図３に示す。図３から、本発明の離散型プレフィルタのゲインは７Ｈｚの周辺で従来技術より減衰が少ないが、６Ｈｚ〜１６Ｈｚの広い範囲内で１０ｄＢ以上の減衰を保つことが分かる。また、負荷機械の固有振動周波数が７．５Ｈｚの場合は、プレフィルタを用いない場合と、従来技術のプレフィルタを用いた場合と、本発明の離散型プレフィルタを用いた場合とのシミュレーション結果をそれぞれ図４、図５および図６に示す。また、負荷機械の固有振動周波数が１５Ｈｚの場合は、プレフィルタを用いない場合と、従来技術のプレフィルタを用いた場合と、本発明の離散型プレフィルタを用いた場合とのシミュレーション結果をそれぞれ図７、図８および図９に示す。従来技術のプレフィルタを用いた場合は、７．５Ｈｚの振動を抑制できたが（図５）、１５Ｈｚの振動を抑制できなかった（図８）。一方、本発明の離散型プレフィルタを用いた場合は、７．５Ｈｚの振動および１５Ｈｚの振動を同時に抑制でき、しかも指令時間が短かった（図６、図９）。
【００３９】
【発明の効果】
以上述べたように本発明の実施例によれば、本制御装置は、複数の振動モードの極でゲインが０となるようにプレフィルタを構成し、指令発生部が生成した元の位置指令をプレフィルタに通させて得た信号をフィードバック制御系の位置指令とすることにより、負荷機械の固有振動周波数が広い範囲内で変動しても、負荷先端の残留振動を抑制し、高速・高精度位置決めができる。
【図面の簡単な説明】
【図１】本発明の第１の実施形態の制御装置を示すブロック図
【図２】本発明の第２の実施形態の制御装置を示すブロック図
【図３】本発明の離散型プレフィルタと従来技術のプレフィルタとのボード線図
【図４】負荷機械の固有振動数が７．５Ｈｚでありプレフィルタがない場合のシミュレーション結果
【図５】負荷機械の固有振動数が７．５Ｈｚであり従来技術のプレフィルタを用いた場合のシミュレーション結果
【図６】負荷機械の固有振動数が７．５Ｈｚであり本発明の離散型プレフィルタを用いた場合のシミュレーション結果
【図７】負荷機械の固有振動数が１５Ｈｚでありプレフィルタがない場合のシミュレーション結果
【図８】負荷機械の固有振動数が１５Ｈｚであり従来技術のプレフィルタを用いた場合のシミュレーション結果
【図９】負荷機械の固有振動数が１５Ｈｚであり本発明の離散型プレフィルタを用いた場合のシミュレーション結果
【図１０】柔軟アームを有する機械の位置決め制御系の構成図
【符号の説明】
１ 位置指令発生部
２ プレフィルタ
３ フィードバック制御部
４ サーボドライバ
５ モータ
６ エンコーダー
７ トルク伝達機構
８ 負荷テーブル
９ 柔軟アーム
１０ 負荷先端
１１ 連続型プレフィルタ
１２ 離散型プレフィルタ
１３ フィードバック制御系の位置指令からモータ位置までの伝達関数
１４ モータ位置から負荷先端位置までの伝達関数
Ｘｒ 元位置指令
Ｘｒｆ フィードバック制御系の位置指令
Ｘｍ モータの位置
Ｘｈ 負荷先端の位置
【発明の属する技術分野】
本発明は、位置指令部とフィードバック制御系との間にプレフィルタを備え、負荷先端の振動を抑制する位置決め制御装置に関する。
【０００２】
【従来の技術】
図１０は柔軟アームを有する産業用機械の位置決め制御系を示す一般的なブロック図で、モータ５と、負荷テープル８と、負荷先端１０と、負荷テープルと負荷先端を連結する柔軟アーム９と、モータと負荷テープルを連結するトルク伝達機構７とを備えている。制御系は、位置指令発生部１で生成した元位置指令Ｘｒをプレフィルタ２に通し、フィードバック制御系の位置指令Ｘｒｆを生成し、モータに連結したエンコーダー６のモータ位置信号Ｘｍをフィードバックし、フィードバック制御系の位置指令Ｘｒｆおよびモータ位置信号Ｘｍをフィードバック制御部に入力し、フィードバック制御部の出力をサーボドライバに入力しモータを駆動する。
一般の機械ではモータ５と負荷テープル８を連結するトルク伝達機構７の剛性は高く、フィードバック制御部３のゲインを高くとれ、負荷テープルの位置またはモータ位置信号Ｘｍをほぼ位置指令Ｘｒｆに追従させることができる。しかし、負荷テープル８と負荷先端１０を連結する柔軟アーム９の剛性が低い場合は、負荷テープル８は目標位置に到達しても、負荷先端１０は低周波数で振動し続けると言う問題があった。（図４、図７）このために、例えば、非特許文献１の例では、このような振動を抑制するためにプレフィルタ２を式（１）のように構成し、負荷機械の振動モードの極でゲインが０となるように係数Ａ１、Ａ２、Ａ３および時定数Ｔ２、Ｔ３を定め、位置決め完了後の負荷先端の残留振動を抑えていた。（図５）
Ｆ（ｓ）＝Ａ１＋Ａ２ｅｘｐ（−ｓＴ２）＋Ａ３ｅｘｐ（−ｓＴ３）・・（１）
【０００３】
【非特許文献１】
山浦：「制振シーク制御」計測自動制御学会、計測と制御、２００２・６、ｐ．４２１−４２７
【０００４】
【発明が解決しようとする課題】
しかしながら、非特許文献１の従来例の構成では、一つの振動モードでゲインが０となるようにプレフィルタを構成するので、負荷先端の質量が大きく変動するような場合は、負荷機械の固有振動周波数も大きく変動し、負荷先端の残留振動を抑えることができないという問題があった（図８）。
本発明は上記課題を解決するためになされたものであり、負荷機械の固有振動周波数が大きく変動しても負荷先端の残留振動を十分に抑制し、高速・高精度位置決めを実現することを目的とする。
【０００５】
【課題を解決するための手段】
上記問題を解決するため、本発明は次のように構成したものである。
請求項１に記載の発明は、位置指令を出力する位置指令部と、モータの位置を制御するフィードバック制御系と、前記位置指令部と前記フィードバック制御系との間にプレフィルタと、を備える位置決め制御装置において、前記プレフィルタが、前記位置指令を入力し、係数ベクトルおよび時定数ベクトルに基づいて、新たな位置指令を出力するフィルタであって、前記位置指令と前記新たな位置指令との定常偏差が０となる条件および負荷機械の複数の振動モードの極でゲインが０となる条件を満足するように、前記係数ベクトルおよび前記時定数ベクトルを定めたフィルタであるものである。
請求項２に記載の発明は、請求項１記載の発明における前記プレフィルタが、前記係数ベクトルおよび前記時定数ベクトルの次数ｍを、前記振動モードの数ｎより１大きい自然数以上とし、前記係数ベクトルおよび前記時定数ベクトルを定めたフィルタであるものである。
請求項３に記載の発明は、請求項１記載の発明における前記プレフィルタが、前記係数ベクトルおよび前記時定数ベクトルの次数ｍを、前記振動モードの数ｎの２倍より１大きい自然数以上とし、前記係数ベクトルおよび前記時定数ベクトルを定めたフィルタであるものである。
請求項４に記載の発明は、請求項１記載の発明における前記プレフィルタが、連続型あるいは離散型であるものである。
【００１０】
【発明の実施の形態】
以下、本発明の実施の形態について図に基づいて説明する。
図１は本発明の第１の実施例を示す制御装置のブロック図である。
図において、１１は連続型プレフィルタであり、１３はフィードバック制御系の位置指令Ｘｒｆからモータ位置Ｘｍまでの伝達関数、１４はモータ位置Ｘｍから負荷先端位置Ｘｈまでの伝達関数である。ここで、連続型プレフィルタ１１は式（２）で表される。
【００１１】
【数５】
ただし、ｍは３以上の自然数である。また、［Ａ１、Ａ２、・・・、Ａｍ］および［Ｔ１、Ｔ２、・・・、Ｔｍ］はそれぞれ後述するように無定常偏差条件およびロバストな振動抑制条件により定める係数ベクトルおよび時定数ベクトルである。
まず、無定常偏差条件を与える。
良く知られているように、フィードバック制御部が積分要素を含んでいれば、フィードバック系の位置指令Ｘｒｆとモータ位置Ｘｍの定常偏差は必ず０となる。ここで、問題とするのは連続型プレフィルタ１１の入力である元の位置指令Ｘｒとプレフィルタ通過後のフィードバック系の位置指令Ｘｒｆとの定常偏差が０となることである。
位置指令部１が生成した元の位置指令Ｘｒを式（３）で表す。
【００１３】
【数６】
ただし、Ｘｅは目標送り距離、ｔｅは指令時間である。
式（２）より、Ｘｒが連続型プレフィルタ１１を通過した後のフィードバック系の位置指令Ｘｒｆは式（４）となる。
【００１５】
【数７】
式（４）において、Ｔｄ＝ｍａｘ｛Ｔ１、Ｔ２、・・・、Ｔｍ｝とすると、［１，ｍ］に含まれるすべての整数ｉに対して、式（５）となるので、式（６）が成り立つ。
Ｘｒ（ｔ−Ｔｉ）＝Ｘｅ、（ｔ＞ｔｅ＋Ｔｄ） ・・・（５）
【００１７】
【数８】
式（６）から、明らかにｔ＞ｔｅ＋Ｔｄ時Ｘｒｆ（ｔ）＝Ｘｅ（無定常偏差条件）を満たすための必要十分条件は式（７）が成り立つことである。
【００１９】
【数９】
次に、ロバストな振動抑制条件を与える。
図２より、負荷機械の振動モードの極は式（８）となる。
ｓ１、ｓ２＝−ζ０ω０±ｊω０√（１−ζ０2） ・・・（８）
負荷機械の振動を抑制するため、連続型プレフィルタ１１は振動モードの極でゲインが０となる必要がある。ずなわち、振動抑制条件を式（９）のように与える。
【００２１】
【数１０】
式（９）を整理すると、振動抑制条件は式（１０）、式（１１）となる。
【００２３】
【数１１】
【数１２】
ただし、Ｋ＝ｅｘｐ（ζ０ω０）、ωｄ＝ω０√（１−ζ０2）である。
負荷先端の質量が変動し、負荷機械の固有振動モードが変化する場合、その変化範囲を包括するよう式（１２）から適当なｎ個の固有振動モードを選び、ζ０＝ζｋおよびω０＝ωｋを式（１０）および式（１１）に代入すると、ロバストな振動抑制条件は式（１３）、式（１４）のように与えられる。
ｓｋ１、ｓｋ２＝−ζｋωｋ±ｊωｋ√（１−ζｋ2） ・・・（１２）
（ｋ＝１、・・・、ｎ）
【００２６】
【数１３】
【数１４】
ただしＫｋ＝ｅｘｐ（ζｋωｋ）、ωｄｋ＝ωｋ√（１−ζｋ2）、ｋ＝１、・・・、ｎである。
最後に、係数ベクトル［Ａ１、Ａ２、・・・、Ａｍ］および時定数ベクトル［Ｔ１、Ｔ２、・・・、Ｔｍ］を定める。
プレフィルタ１１の係数ベクトルと時定数ベクトルを定める際に、無定常偏差条件の式（７）とロバストな振動抑制条件の式（１３）および式（１４）、全部で（２ｎ＋１）個方程式を同時に満たすようにしなければならない。
ｍが（ｎ＋１）以上であれば、（ｎ＋１）個の係数と（ｎ＋１）個の時定数は合わせて（２ｎ＋２）個以上の未定係数があるため、式（７）と式（１３）と式（１４）の連立方程式を解くと、前記未定係数を定めることができる。ところが、式（１３）と式（１４）は時定数ベクトルの非線形方程式であるため、前記連立方程式を解くことは大変困難である。そこで、ｍを（２ｎ＋１）以上に設定し、予め時定数ベクトル［Ｔ１、Ｔ２、・・・、Ｔｍ］を適当な値を与えておけば、式（７）と式（１３）と式（１４）は係数ベクトル［Ａ１、Ａ２、・・・、Ａｍ］の線形連立方程式となるので、係数ベクトル［Ａ１、Ａ２、・・・、Ａｍ］は簡単に求められる。
上記手段により、負荷機械の固有振動周波数が大きく変動しても負荷先端の残留振動を十分に抑制し、高速・高精度位置決めを実現できるようにした。
【００２９】
図２は本発明の第２の実施例を示すブロック図である。第２の実施例が第１の実施例と異なることは、図２の離散型プレフィルタ１２は図１の連続型プレフィルタ１１を離散化したものである。すなわち、式（２）におけるすべてのｉに対して、ｎｉを（Ｔｉ／Ｔ）の最も近い整数とし、遅れ要素ｅ―ｓＴｉをｚ−ｎｉに変換し、構成したものである。ただし、ｚはｚ変換演算子、Ｔはサンプル周期である。
以上のように離散化を行うと、プレフィルタの特性が少し変わるので、第１の実施の形態で定めた係数ベクトル［Ａ１、Ａ２、・・・、Ａｍ］をそのまま用いると、式（７）の無定常偏差条件および式（１３）と式（１４）のロバストな振動抑制条件が満たされない可能性がある。一般に、振動抑制条件は少し外れても、近似的に満足されれば十分に振動抑制されるが、無定常偏差条件は僅かに外れても、定常偏差が残ることになり、位置誤差が生じ精度が悪くなる。これは許されることではない。
以下、無定常偏差条件が常に満たされることを証明する。
まず、位置指令部１が生成した元の位置指令Ｘｒの離散形式を式（１５）で表すものとする。
【００３０】
【数１５】
ただし、Ｘｅが目標送り距離、ｎｅが指令のサンプル周期数である。
一方、Ｘｒが離散化プレフィルタ１２を通過した後のフィードバック系の位置指令Ｘｒｆは式（１６）になる。
【００３２】
【数１６】
式（１６）において、ｎｄ＝ｍａｘ｛ｎ１、ｎ２、・・・、ｎｍ｝とすると、式（１５）より、［１，ｍ］に含まれるすべての整数ｉに対して、式（１７）が成り立つ。
Ｘｒ（ｋ−ｎｉ）＝Ｘｅ （ｋ＞ｎｅ＋ｎｄ） ・・・（１７）
また、式（７）および式（１６）より、式（１８）が成立する。
【００３４】
【数１７】
式（１８）はフィードバック系の位置指令Ｘｒｆとモータ位置Ｘｍとの定常偏差がないことを意味する。
【００３６】
次に、本発明の効果を数字例を用いて説明する。
固有振動周波数が６Ｈｚ〜１６Ｈｚ変動し、減衰係数が０．０１６である負荷機械に対して、ｎ＝２，ζ１＝ζ２＝０．０１６，ω１＝２π×７，ω２＝２π×１４とし、ｍ＝５、Ｔ1＝０、Ｔ2=０．０６４３，Ｔ3=０．１０７３，Ｔ4=０．０５３５，Ｔ5=０．０７１５として式（７）、式（１３）および式（１４）に代入すると、以下の連立線形方程式が得られる。
Ａ１＋Ａ２＋Ａ３＋Ａ４＋Ａ５＝１
Ａ１−０．９９６７Ａ２＋０．００５１Ａ３−０．７３３３Ａ４−１．０５４２Ａ５＝０
０．３２５６Ａ２−１．０８２３Ａ３＋０．７３７９Ａ４−０．００３３Ａ５＝０
Ａ１＋０．８８７４Ａ２−１．１７１４Ａ３−０．００６８Ａ４＋１．１１１２Ａ５＝０
−０．６４９Ａ２−０．０１１Ａ３−１．０８２１Ａ４−０．００７Ａ５＝０
・・・（１９）
式（１９）の連立方程式を解くと、Ａ１＝０．３２５１、Ａ２＝−１．５４０３、Ａ３＝０．１６６８、Ａ４＝０．９２９３、Ａ５＝１．１１９１となる。ここで、ディジタ制御を行うため、連続型プレフィルタをサンプル周期Ｔ＝０．０００２５ｓで離散化する。ｎｉ＝Ｒｏｕｎｄ｛Ｔｉ／Ｔ｝（ｉ＝１、２、・・・、５）より、ｎ１＝０、ｎ２＝２５７、ｎ３＝４２９、ｎ４＝２１４、ｎ５＝２８６となる。よって、離散型プレフィルタ１２は式（２０）になる。
【００３７】
【数１８】
以上求めた離散型プレフィルタおよび従来技術のプレフィルタのボード線図を図３に示す。図３から、本発明の離散型プレフィルタのゲインは７Ｈｚの周辺で従来技術より減衰が少ないが、６Ｈｚ〜１６Ｈｚの広い範囲内で１０ｄＢ以上の減衰を保つことが分かる。また、負荷機械の固有振動周波数が７．５Ｈｚの場合は、プレフィルタを用いない場合と、従来技術のプレフィルタを用いた場合と、本発明の離散型プレフィルタを用いた場合とのシミュレーション結果をそれぞれ図４、図５および図６に示す。また、負荷機械の固有振動周波数が１５Ｈｚの場合は、プレフィルタを用いない場合と、従来技術のプレフィルタを用いた場合と、本発明の離散型プレフィルタを用いた場合とのシミュレーション結果をそれぞれ図７、図８および図９に示す。従来技術のプレフィルタを用いた場合は、７．５Ｈｚの振動を抑制できたが（図５）、１５Ｈｚの振動を抑制できなかった（図８）。一方、本発明の離散型プレフィルタを用いた場合は、７．５Ｈｚの振動および１５Ｈｚの振動を同時に抑制でき、しかも指令時間が短かった（図６、図９）。
【００３９】
【発明の効果】
以上述べたように本発明の実施例によれば、本制御装置は、複数の振動モードの極でゲインが０となるようにプレフィルタを構成し、指令発生部が生成した元の位置指令をプレフィルタに通させて得た信号をフィードバック制御系の位置指令とすることにより、負荷機械の固有振動周波数が広い範囲内で変動しても、負荷先端の残留振動を抑制し、高速・高精度位置決めができる。
【図面の簡単な説明】
【図１】本発明の第１の実施形態の制御装置を示すブロック図
【図２】本発明の第２の実施形態の制御装置を示すブロック図
【図３】本発明の離散型プレフィルタと従来技術のプレフィルタとのボード線図
【図４】負荷機械の固有振動数が７．５Ｈｚでありプレフィルタがない場合のシミュレーション結果
【図５】負荷機械の固有振動数が７．５Ｈｚであり従来技術のプレフィルタを用いた場合のシミュレーション結果
【図６】負荷機械の固有振動数が７．５Ｈｚであり本発明の離散型プレフィルタを用いた場合のシミュレーション結果
【図７】負荷機械の固有振動数が１５Ｈｚでありプレフィルタがない場合のシミュレーション結果
【図８】負荷機械の固有振動数が１５Ｈｚであり従来技術のプレフィルタを用いた場合のシミュレーション結果
【図９】負荷機械の固有振動数が１５Ｈｚであり本発明の離散型プレフィルタを用いた場合のシミュレーション結果
【図１０】柔軟アームを有する機械の位置決め制御系の構成図
【符号の説明】
１ 位置指令発生部
２ プレフィルタ
３ フィードバック制御部
４ サーボドライバ
５ モータ
６ エンコーダー
７ トルク伝達機構
８ 負荷テーブル
９ 柔軟アーム
１０ 負荷先端
１１ 連続型プレフィルタ
１２ 離散型プレフィルタ
１３ フィードバック制御系の位置指令からモータ位置までの伝達関数
１４ モータ位置から負荷先端位置までの伝達関数
Ｘｒ 元位置指令
Ｘｒｆ フィードバック制御系の位置指令
Ｘｍ モータの位置
Ｘｈ 負荷先端の位置
Claims (4)
- 位置指令を出力する位置指令部と、モータの位置を制御するフィードバック制御系と、前記位置指令部と前記フィードバック制御系との間にプレフィルタと、を備える位置決め制御装置において、
前記プレフィルタが、前記位置指令を入力し、係数ベクトルおよび時定数ベクトルに基づいて、新たな位置指令を出力するフィルタであって、
前記位置指令と前記新たな位置指令との定常偏差が０となる条件および負荷機械の複数の振動モードの極でゲインが０となる条件を満足するように、前記係数ベクトルおよび前記時定数ベクトルを定めたフィルタであることを特徴とする位置決め制御装置。 - 前記プレフィルタが、前記係数ベクトルおよび前記時定数ベクトルの次数ｍを、前記振動モードの数ｎより１大きい自然数以上とし、前記係数ベクトルおよび前記時定数ベクトルを定めたフィルタであることを特徴とする請求項１に記載の位置決め制御装置。
- 前記プレフィルタが、前記係数ベクトルおよび前記時定数ベクトルの次数ｍを、前記振動モードの数ｎの２倍より１大きい自然数以上とし、前記係数ベクトルおよび前記時定数ベクトルを定めたフィルタであることを特徴とする請求項１に記載の位置決め制御装置。
- 前記プレフィルタが、連続型あるいは離散型であることを特徴とする請求項１に記載の位置決め制御装置。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2003187631A JP4228389B2 (ja) | 2003-06-30 | 2003-06-30 | 位置決め制御装置 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2003187631A JP4228389B2 (ja) | 2003-06-30 | 2003-06-30 | 位置決め制御装置 |
Publications (3)
| Publication Number | Publication Date |
|---|---|
| JP2005025316A JP2005025316A (ja) | 2005-01-27 |
| JP2005025316A5 JP2005025316A5 (ja) | 2006-04-20 |
| JP4228389B2 true JP4228389B2 (ja) | 2009-02-25 |
Family
ID=34186423
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2003187631A Expired - Fee Related JP4228389B2 (ja) | 2003-06-30 | 2003-06-30 | 位置決め制御装置 |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP4228389B2 (ja) |
Families Citing this family (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| NL1036266A1 (nl) * | 2007-12-17 | 2009-06-18 | Asml Holding Nv | Pre-filter for a servo control loop, and applications thereof. |
| KR101378624B1 (ko) | 2009-09-30 | 2014-03-26 | 미쓰비시덴키 가부시키가이샤 | 위치결정 제어장치 |
Family Cites Families (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS6368903A (ja) * | 1986-09-10 | 1988-03-28 | Fujitsu Ltd | デイジタルサ−ボ制御装置 |
| JP3330213B2 (ja) * | 1993-12-08 | 2002-09-30 | 隆雄 藤井 | 液圧駆動型スピーカ |
| JP3761245B2 (ja) * | 1996-05-16 | 2006-03-29 | 東洋電機製造株式会社 | バックラッシュ制振制御方法 |
| JP3823397B2 (ja) * | 1996-10-29 | 2006-09-20 | 石川島播磨重工業株式会社 | アクティブ制振方法 |
| JP3313643B2 (ja) * | 1998-04-30 | 2002-08-12 | 東芝機械株式会社 | バイト工具によるオービット加工におけるサーボ制御方法およびオービット加工用のサーボ制御装置 |
| JP3815545B2 (ja) * | 2001-02-07 | 2006-08-30 | 株式会社安川電機 | 振動抑制位置決め制御装置 |
-
2003
- 2003-06-30 JP JP2003187631A patent/JP4228389B2/ja not_active Expired - Fee Related
Also Published As
| Publication number | Publication date |
|---|---|
| JP2005025316A (ja) | 2005-01-27 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP4577107B2 (ja) | 機械位置制御装置 | |
| Singhose et al. | Command generation for flexible systems by input shaping and command smoothing | |
| Mohamed et al. | Vibration control of a single-link flexible manipulator using command shaping techniques | |
| Teo et al. | A simplified method for discrete-time repetitive control using model-less finite impulse response filter inversion | |
| JP4228389B2 (ja) | 位置決め制御装置 | |
| Lim et al. | Torsional displacement compensation in position control for machining centers | |
| JP3504130B2 (ja) | 周期信号ドライブ装置 | |
| JP5441944B2 (ja) | モータ制御装置 | |
| JP5092831B2 (ja) | 位置決め制御装置 | |
| JP5407435B2 (ja) | モータ制御装置 | |
| JP4340846B2 (ja) | 位置決め制御装置 | |
| Lim et al. | Position control of XY table in CNC machining center with non-rigid ballscrew | |
| JP5246328B2 (ja) | モータ制御装置 | |
| JP4329438B2 (ja) | 電動機制御装置 | |
| Horng et al. | Rejection of limit cycles induced from disturbance observers in motion control | |
| Bristow et al. | High bandwidth control of precision motion instrumentation | |
| Zech et al. | Direct adaptive feedforward compensation of narrowband disturbances without explicit identification of the secondary path model | |
| JP2010130854A (ja) | リニアモータの推力リップル補償装置およびその補償方法 | |
| JP3805476B2 (ja) | モータ制御装置 | |
| WO1991018332A1 (en) | Observer control system | |
| JP2005508598A (ja) | 減衰の少ない電気機械チェーンの角速度制御方法および装置 | |
| JP4415631B2 (ja) | 制御装置 | |
| Zhong et al. | Gain-scheduling robust control with guaranteed stability for ball screw drives with uncertain load mass and varying resonant modes | |
| JP5084196B2 (ja) | 電動機制御装置および電動機制御方法 | |
| JP2000148250A (ja) | サーボ制御装置 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20060302 |
|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20060302 |
|
| A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20081105 |
|
| 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: 20081110 |
|
| 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: 20081123 |
|
| R150 | Certificate of patent or registration of utility model |
Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20111212 Year of fee payment: 3 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20121212 Year of fee payment: 4 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20131212 Year of fee payment: 5 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20141212 Year of fee payment: 6 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| LAPS | Cancellation because of no payment of annual fees |