(57)【要約】 【課題】搬送時に搬送物に生じる振動を防止し、かつ制御系の設計及びコントロ−ラの導出も平易な搬送用制振制御システムのフィ−ドバックコントロ−ラを提供する。【解決手段】  フィ−ドバックコントロ−ラの形を、少なくともノッチフィルタ若しくはロ−パスフィルタを有する周波数制御要素と位置制御要素の組み合わせに限定し、そのフィ−ドバックコントロ−ラの要素の値を最適に与えるために、設計仕様を周波数仕様と時間仕様の両方で与える。【選択図】    図９
2009259264.tif 000002
【特許請求の範囲】
【請求項１】
搬送用制振制御システムのフィ−ドバックコントロ−ラであって、その形を、少なくともノッチフィルタ若しくはロ−パスフィルタを有する周波数制御要素と位置制御要素の組み合わせに限定し、そのフィ−ドバックコントロ−ラの要素の値を最適に与えるために、設計仕様を周波数仕様と時間仕様の両方で与えることを特徴とする搬送用制振制御システムのフィ−ドバックコントロ−ラ。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、搬送時に搬送物に生じる振動を防止する制振制御システムのフィ−ドバックコントロ−ラに関する。
【背景技術】
【０００２】
従来、各種工場において、振動を防止しながら搬送物を搬送するシステムは知られている。たとえば、液体の搬送の際に、液体の振動と、液体搬送タンクの搬送位置という２出力をフィ−ドバックし、高速高精度位置決めと残留振動抑制を行なう液体搬送制御は公知である。つまり、この制振制御システムは搬送位置をセンシングすると共に搬送物の振動をセンシングして制振制御している。
【先行技術文献】
【特許文献】
【０００３】
【特許文献１】特開平０９−０９１００５
【発明の概要】
【発明が解決しようとする課題】
【０００４】
しかし、このような搬送中の搬送物の振動をセンシングすることを前提とする制振搬送制御システムは、搬送物にセンサを取り付けることが困難な場合には機能しない。また、外乱などでセンシングシングの精度が悪い場合には、その値をフィ−ドバックするとかえって制御性能が劣化する。センシングに時間がかかってしまう時も、制振搬送制御は機能しない。更に、多くのセンサを使用する場合には制振制御システムは高価になる。
一方、最近Ｈ無限大ロバスト制御など、振動抑制に有力な制御法が提案されているが、得られたコントロ−ラの次元が大きくなり、計算などの点から非実用的な場合が多い。また、Ｈ無限大ロバスト制御は、周波数領域の設計法であるため、時間仕様を満足させるためには試行錯誤が多い（特許文献１参照）。
【０００５】
本発明は、上記の問題に鑑みなされたものであり、その目的は制御系の設計及びコントロ−ラの導出も平易な搬送用制振制御システムのフィ−ドバックコントロ−ラを提供することを目的とする。
【課題を解決するための手段】
【０００６】
上記の目的を達成するため、本発明にかかる搬送用制振制御システムのフィ−ドバックコントロ−ラは、その形を、少なくともノッチフィルタ若しくはロ−パスフィルタを有する周波数制御要素と位置制御要素の組み合わせに限定し、そのフィ−ドバックコントロ−ラの要素の値を最適に与えるために、設計仕様を周波数仕様と時間仕様の両方で与えることを特徴とする。
【発明の効果】
【０００７】
本発明によれば、モータによる駆動系の運動モデルは従来のモデルより簡単なモデルで表されることから既知とするが、振動系のモデルは不要で振動系の固有振動数のみ必要であるというモデリング作業が簡単な設定のもとで、フィ−ドバックコントロ−ラの次元が小さくでき、制御系の設計及びフィ−ドバックコントロ−ラの導出も平易なことから、実用性の高いものとなる。
【図面の簡単な説明】
【０００８】
【図１】本発明のフィ−ドバック制御系を示す概念図である。
【図２】本発明の参考例の搬送駆動システムを示す概要図である。
【図３】本発明の参考例に用いた評価関数を示す図である。
【図４】本発明の参考例に用いたフィ−ドバックコントロ−ラのゲイン線図である。
【図５】本発明の参考例に用いたシミュレ−ションの結果を示す図である。
【図６】本発明の参考例の結果を示す図である。
【図７】本発明の比較例の結果を示す図である。
【図８】本発明の実施例に用いた液面挙動シミュレ−ションの結果を示す図である。
【図９】本発明の実施例の設計手順を示すフロ−図である。
【発明を実施するための形態】
【０００９】
本発明においては、図１に示すようなフィ−ドバック制御系を考えている。具体的には、駆動系の目標値に対して出力が追従するサ−ボ系である。
【００１０】
設計手順を以下に述べる。
（１）フィ−ドバックコントロ−ラの選択
フィ−ドバックコントロ−ラＫ(s)に望ましい特性を持たせるため、フィ−ドバックコントロ−ラの伝達関数を式（１）のように定義し、Ｋｉ(s)を与えていく。
【００１１】
【数１】
2009259264.tif 000003
【００１２】
次数や計算時間等の制約がなければ、ｎを無限に大きくし、複雑な周波数特性を持つフィ−ドバックコントロ−ラを求めることも可能である。以下に、フィ−ドバックコントロ−ラの構成要素Ｋｉ(s)のいくつかの例を示す。
【００１３】
［１］位置制御コントロ−ラ：  駆動を与えるコントロ−ラを与える。制御対象Ｇ(s)や制御仕様に応じて、Ｐ制御、ＰＩ制御、ＰＩＤ制御などから選択する。ただし、定常位置偏差をなくすために、一巡伝達関数Ｇ(s)Ｋ(s)に少なくともひとつの積分要素を含むようにコントロ−ラを選ぶ必要がある。
【００１４】
【数２】
2009259264.tif 000004
【００１５】
［２］ロ−パスフィルタ：  フィ−ドバックコントロ−ラＫ(s)にロ−パス特性を持たせたい場合には、次の伝達関数を用いる。
【００１６】
【数３】
2009259264.tif 000005
【００１７】
［３］ハイパスフィルタ：  フィ−ドバックコントロ−ラＫ(s)にハイパス特性を持たせたい場合には、次の伝達関数を用いる。
【００１８】
【数４】
2009259264.tif 000006
【００１９】
［４］ノッチフィルタ：  フィ−ドバックコントロ−ラＫ(s)のゲイン特性を、ある帯域だけ低くしたい場合には、次の伝達関数を用いる。
【００２０】
【数５】
2009259264.tif 000007
【００２１】
ここで、
【００２２】
【数６】
2009259264.tif 000008
【００２３】
ζｎに対する制約は、この伝達関数がピ−クをもつための条件である。  このフィルタは、振動数ωｎのときに下向きにピ−クを持つ。また、ζｎ＝０．０００１として、ω〜ｎ＝ａωｎ（ａはωｎとω〜ｎの比）とすると、０．９＜ａ＜１．１では、ゲインを相対的に最低２０ｄＢ低く整形できる特性を持つ。
また、０．７５＜ａ＜１．４５では、ゲインを相対的に最低１０ｄＢ低く整形できる特性を持つ。
【００２４】
［５］バンドパスフィルタ：  フィ−ドバックコントロ−ラＫ(s)のゲイン特性を、ある帯域だけ高くしたい場合には、次の伝達関数を用いる。
【００２５】
【数７】
2009259264.tif 000009
【００２６】
ここで、
【００２７】
【数８】
2009259264.tif 000010
【００２８】
このフィルタは、振動数ωｂのときに上向きのピ−クをもつ。また、ζｂ＝０．００１として、
ω〜ｂ＝ａωｂ（ａはωｂとω〜ｂの比）とすると、０．９＜ａ＜１．１では、ゲインを相対的に最低２０ｄＢ高く整形できる特性を持つ。
また、０．７５＜ａ＜１．４５では、ゲインを相対的に最低１０ｄＢ高く整形できる特性を持つ。
【００２９】
（２）制御仕様の定式化
制御系を設計するには、種々の制御仕様を与えることができる。本発明では、その仕様を最適化問題のペナルティ項として定式化し、仕様を満足するフィ−ドバックコントロ−ラＫ(s)を導出する。以下に、時間領域、周波数領域における制約条件のいくつかの例を示す。
【００３０】
［１］安定性：  制御対象とする駆動系の制御システムに関して、閉ル−プ系の安定性を保証するためには、次の場合にペナルティを課せばよい。  
【００３１】
【数９】
2009259264.tif 000011
【００３２】
ただし、ｒｃｌは閉ル−プの特性根である。または、次の場合にペナルティを課せばよい。
【００３３】
【数１０】
2009259264.tif 000012
【００３４】
ただし、Ｇｍ、Ｐｍは、それぞれ、一巡伝達関数Ｇ(s)Ｋ(s)のゲイン余裕、位相余裕である。        
フィ−ドバックコントロ−ラＫ（ｓ）の安定性を保証するためには、次の場合にペナルティを課せばよい。
【００３５】
【数１１】
2009259264.tif 000013
【００３６】
ただし、ｒｋはフィ−ドバックコントロ−ラの特性根である。
【００３７】
［２］フィ−ドバックコントロ−ラの周波数特性：特定の周波数ωｃでフィ−ドバックコントロ−ラのゲインをｋｃ以下（以上）にしたい場合には、次の場合にペナルティを課せばよい。
【００３８】
【数１２】
2009259264.tif 000014
【００３９】
また、細かく周波数整形を行う場合には、この制約を複数個課すことにより、実現できる。なお、振動の固有振動数に対して、この仕様を課すことにより、振動系の制振性を保証することができる。
【００４０】
［３］オ−バ−シュ−ト：  目標位置に対するオ−バ−シュ−トの量を制限するには、次の場合にペナルティを課せばよい。
【００４１】
【数１３】
2009259264.tif 000015
【００４２】
ただし、Ｏｓはシミュレ−ションにより求まるオ−バ−シュ−ト量、ｏｐは許容できるオ−バ−シュ−ト量である。
【００４３】
［４］入力制限：  制御入力量ｕを制限するには、次の場合にペナルティを課せばよい。
【００４４】
【数１４】
2009259264.tif 000016
【００４５】
ただし、ｕはシミュレ−ションにより求まる制御入力量、ｕｐは入力に対する制限である。これらの制御仕様以外にも、閉ル−プ系の周波数特性に関する制約や、立ち上がり時間、遅れ時間、整定時間などの時間応答に関する制約など、いくらでもその制御系に応じて加えることが可能である。
【００４６】
（３）最適化問題の定式化
上記の制約条件を考慮して、式(１５)に示すように最適化問題を定式化する。
【００４７】
【数１５】
2009259264.tif 000017
【００４８】
ここで、Ｗｉは重み、Ｊｉは目的評価関数、Ｊｐはペナルティ項である。評価関数Ｊｉは、搬送の整定時間Ｔｓを評価するのであれば、次のように与えることができる。
【００４９】
【数１６】
2009259264.tif 000018
【００５０】
ただし、ｔは時間、ｙ(ｔ)は時間ｔにおける搬送位置、ｙｆは目標到達位置、ｙεは許容偏差である。また、過度応答を評価する場合は、目標軌道と搬送位置との２乗誤差を評価関数として与える。
【００５１】
【数１７】
2009259264.tif 000019
【００５２】
ｒ(ｔ)はｔにおける目標軌道である。当然、整定時間と過度応答を同時に評価することも可能である。
【００５３】
【数１８】
2009259264.tif 000020
【００５４】
（４）フィ−ドバックコントロ−ラの算出
最終的に式(１５)のペナルティ項を含んだ制約付きの最適化問題を、例えば、シンプレックス法により解き、式(１)で与えられたフィ−ドバックコントロ−ラＫ(s)のパラメ−タを決定する。
【００５５】
（５）以上のように、決定されたフィ−ドバックコントロ−ラＫ(ｓ)のパラメ−タを、前記搬送駆動システムのコントロ−ラに搭載することで搬送用制振制御ができる。
なお、本発明では、搬送時に搬送物に生じる振動を防止する制振制御システムについて述べたが、搬送系（駆動系）と搬送物（振動系）を含むシステムであれば、本発明は、適用可能であり、またさらに駆動系が振動をもつ場合も適用可能である。例えば、クレ−ンなどでは、駆動系は荷物を動かすガ−タや台車であり、振動系は荷物を吊すロ−プである。また、ロボットア−ムでは駆動系は各関節部を動かすモ−タであり、振動系はア−ム先端位置の振れである。
【００５６】
（参考例）
以下、本発明の参考例を図面に基づき説明する。
図２は、本発明の有効性を確認するための搬送駆動システムの概要図である。図１において、タンク１は、ＡＣサ−ボモ−タ２によりボ−ルネジ３を介して直線搬送される。タンク１は、容積が底面０．１４×０．１４ｍ２、高さ０．３ｍのものを使用しており、タンク１の搬送距離は１．０ｍである。また、タンク１内には水Ｗが静止液位ｈｓ＝０．１４ｍとした。タンク１の位置は、モ−タ２に取り付けられたロ−タリ−エンコ−ダ４により測定する。液面の挙動は、タンク１に取り付けられてたレベルセンサ５により測定する。レベルセンサ５は、直径２×１０−３の２本のステンレス線を電極として、液位変化（スロッシング）を両電極間の抵抗の変化として捉えることにより液位を検出する。レベルセンサ５は、タンク１の内壁から、５×１０−３ｍの位置に取り付けた。
また、ＡＣサ−ボモ−タ２は、ドライバ６、コントロ−ラ７で制御されるように構成されており、さらに、コントロ−ラ７は、記憶媒体８を介して入力演算手段９に接続可能になっている。そして、ＡＣサ−ボモ−タに付属したロ−タリ−エンコ−ダ４から、ドライバ６に制御信号が送出され、さらに、コントロ−ラ７に送出される。
【００５７】
以下、このように構成された搬送駆動システムへの搬送用制振制御の適用を順を追って説明する。
【００５８】
（１）モ―タ特性及び駆動系のモデリング
本実施の形態では、入力電圧Ｅ(ｓ)からタンクの速度Ｖ(ｓ)までの伝達関数を一次遅れ系として、式（１９）の様に表現する。
【００５９】
【数１９】
2009259264.tif 000021
【００６０】
ここで、モ−タ２のゲインＫｍと時定数Ｔｍは、ステップ状の入力を加え、シミュレ−ション結果と実験結果が等しくなるように求めた。駆動系のモデリングについては、後述する。結果として、ゲインＫｍと時定数Ｔｍは、以下のように求まった。  
【００６１】
【数２０】
2009259264.tif 000022
【００６２】
【数２１】
2009259264.tif 000023
【００６３】
よって、プラントＧ(ｓ)における入力電圧からタンク位置までの伝達関数は、式（２２）の様になる。
【００６４】
【数２２】
2009259264.tif 000024
【００６５】
（２）スロッシング特性
フィ−ドバックコントロ−ラに、スロッシングを励起しない特性を与えるためには、まず、スロッシングの固有振動数を特定する必要がある。
一般に、完全流体の２次元容器や３次元直方体容器内におけるスロッシングの各モ−ド振動数ｆｎは、式（２３）で与えられる。
【００６６】
【数２３】
2009259264.tif 000025
【００６７】
ただし、ｋ＝（πｎ）／ｌｓ、ｎ＝１，２，・・・であり、また、ｈｓは静止液位、ｌｓは容器の搬送方向の長さ、ｎはモ−ドの字数である。
本実施の形態における一次モ−ド振動数ｆ１は、ｈｓ＝０．１４ｍ、ｌｓ＝０．１４ｍ、i=1を代入することによって得られ、ｆ１＝２．３５５８＝２．３６Ｈｚとなる。
【００６８】
（３）フィ−ドバックコントロ−ラの選択
ここでは、振動モデルを用いず、式（１９）の駆動系のモデルと振動系の固有振動数の情報のみを用いてフィ−ドバックコントロ−ラの設計を行う。
【００６９】
式（１９）より、フィ−ドバックコントロ−ラＫ(s)によらず、一巡伝達関数に積分器を一つ含んでいることがわかる。従って、内部モデル原理より、フィ−ドバックコントロ−ラＫ(s)に積分特性を持たせなくても目標位置軌道への定常位置偏差のない制御系を構築できることが分かる。そこで、搬送コントロ−ルとしてはＰ制御を用いることとする。
【００７０】
【数２４】
2009259264.tif 000026
【００７１】
次に、フィ−ドバックコントロ−ラにスロッシングを励起させない特性を持たせるために、ノッチフィルタを用いる。
【００７２】
【数２５】
2009259264.tif 000027
【００７３】
式（２３）より、１次モ−ドの固有振動数は、２．３６Ｈｚ（１４．８rad/s）である。よって、
ωｎ＝１４．８、ζｎ＝０．０００１とする。これにより、スロッシングの固有振動数でフィ−ドバックコントロ−ラのゲインを相対的に最低でも２０ｄＢ低く整形できる。本参考例では、一つのノッチフィルタのみで周波数整形を行うこととした。また、高次モ−ドの影響が大きい場合や複数の振動のモ−ドを持つ制御対象に対しては式（５）に示すノッチフィルタを複数個用いることにより、周波数整形を行うことができる。
【００７４】
次に、ノイズや高次モ−ドの影響を防ぐために、高周波領域でゲインが低くなるように、ロ−パス特性を持たせる。
【００７５】
【数２６】
2009259264.tif 000028
【００７６】
結果として、式（１）、式（２４）〜式（２６）より、最終的なフィ−ドバックコントロ−ラの伝達関数は次式のようになる。
【００７７】
【数２７】
2009259264.tif 000029
【００７８】
式（２７）において、未知のパラメ−タはＫｐ及びＴｌである。Ｔｌに関しては、スロッシングの高次モ−ドでゲインが低くなるようにＴｌを決めることもできる。しかし、本発明では、Ｔｌはフィ−ドバックコントロ−ラのバンド幅に関係するために、整定時間や過渡応答性などに強く影響を与えるので、Ｔｌは未知のパラメ−タとして扱い、最適化問題を解くことにより決定する。
【００７９】
（４）設計仕様の定式化
フィ−ドバックコントロ−ラの仕様としては、以下のものを挙げ、ペナルティ関数として定式化した。
［１］閉ル−プ系及びフィ−ドバックコントロ−ラが安定。
【００８０】
【数２８】
2009259264.tif 000030
【００８１】
【数２９】
2009259264.tif 000031
【００８２】
［２］スロッシングの固有振動数において、フィ−ドバックコントロ−ラのゲインが−２０ｄＢ以下。
【００８３】
【数３０】
2009259264.tif 000032
【００８４】
［３］ノイズや高次モ−ドの影響低減のために、ωｌ＝３１４ｒａｄ／ｓ（５０Ｈｚ）で、フィ−ドバックコントロ−ラゲインが０ｄＢ以下。
【００８５】
【数３１】
2009259264.tif 000033
【００８６】
［４］装置の制限である入力電圧が±５Ｖを越えない。
【００８７】
【数３２】
2009259264.tif 000034
【００８８】
［５］最大オ−バ−シュ−ト量が、０．００１ｍを越えない。
【００８９】
【数３３】
2009259264.tif 000035
【００９０】
（５）最適化問題の定式化
式（２８）〜式（３３）の仕様を、次のペナルティ項を用いた制約付きの最適化問題に定式化した。
【００９１】
【数３４】
2009259264.tif 000036
【００９２】
ただし、
【００９３】
【数３５】
2009259264.tif 000037
【００９４】
である。また、Ｔｓは、目標位置１．０ｍ、許容誤差１．０×１０−３ｍとしたときの整定時間である。パナルティ関数ωｉは、ωｉ＝１０８（ｉ＝１，２，・・・，８）と与えた。最適値計算において、上記のペナルティ条件が成立した場合には、莫大な評価関数値になる。このため、パラメ−タの変更はその組み合わせ以外の方向に進む結果となり、仕様を満足するようなフィ−ドバックコントロ−ラが算出される。
【００９５】
（６）フィ−ドバックコントロ−ラの算出
評価関数の最適化には、シンプレックス法を用いた。ただし、鏡像係数α＝１．０、収縮係数β＝０．５、拡張係数γ＝２．０とした。また、初期シンプレックスを表１に示すように設定した。これらの値は、数回の試行の結果、Ｊが最小となったときの組み合わせである。
また、制御シミュレ−ションにおける位置の目標軌道は、加速度２．０ｍ／ｓ２で加速し、速度０．５ｍ／ｓで等速移動し、さらに加速度−２．０ｍ／ｓ２で減速して目標位置に到達させる台形型速度カ−ブを積分することにより求めた。
【００９６】
【表１】
2009259264.tif 000038
【００９７】
計算の結果、４回目のイタレ−ションでペナルティにかからなくなり、評価関数の値は、２９回の繰り返し計算で一定になった。最適解が求まるまでの実際の計算時間は、クロック・スピ−ド６００ＭＨｚのＣＰＵ搭載のパソコンで２０秒程度であった。このときの評価関数を図３に示す。
【００９８】
結果として、Ｊ＝Ｔｓ＝２．８２ｓが最小となり、そのときＫｐ＝１．７×１０、Ｔｌ＝５．４４×１０−２となった。また、特性根部は、−７０７９７８×１０、−１．０４５４×１０±１．２３３２×１０ｊ、−５．６２２１±３．４０３５ｊであり、フィ−ドバックコントロ−ラの特性根は、−１．８３７８×１０、−７．４１４２±１．２８４２×１０ｊであり、実部が全部負であるので、閉ル−プ、フィ−ドバックコントロ−ラともに安定であることがわかる。よって本制御システムは安定である。
【００９９】
次に、求められたフィ−ドバックコントロ−ラのゲイン線図を図４に示す。図４により、スロッシングの固有周波数２．３６Ｈｚでは、ノッチ状にゲインが低く、制御仕様どおりに−２０ｄＢ以下になっていることが分かる。また、設計仕様で指定した周波数５０Ｈｚにおいても、仕様どおり０ｄＢ以下になっていることが確認できた。高周波領域では単調減少しており、制振効果及び高次モ−ドの影響低減という特性が得られた。さらに、低周波域において、ハイゲインとなっていることから搬送の高速化が図られていることが伺える。
【０１００】
このフィ−ドバックコントロ−ラによる制御シミュレ−ションの結果を、図５に示す。ここで、図中において、上図は搬送位置を示し、下図は制御入力を示す。図５により、オ−バ−シュ−トのない搬送を行っていること確認できた。また、ｍａｘ（Ｏｓ）＝０．０００９ｍ、ｍａｘ｜ｕ｜＝３．００８４Ｖであり、仕様を満たすフィ−ドバックコントロ−ラであることが分かった。
【０１０１】
また、図６は、本発明の実験実証結果を示している。なお、図６（ａ）は、タンク位置、図６（ｂ）は、制御入力、図６（ｃ）は、液面振動値を示す。これにより、オ−バ−シュ−トすることなく、位置決めを行った上で、スロッシング現象をほぼ完璧に制振することが可能になった。なお、図６においては、図５のシミュレ−ションの結果も併せて表示しているが、シミュレ−ション結果は、実験結果とほぼ同じ結果を示していることから、モ−タおよび、スロッシングのモデルの妥当性が確認できた。また、この際には、記憶媒体８を介してコントロ−ラ７及びドライバ６に信号を与えてモ−タ２を位置速度制御した。
【比較例】
【０１０２】
ノッチ特性をフィ−ドバックコントロ−ラに加えずに、Ｐ制御のみにより、位置決め制御を行った場合の制御実験結果を図７に示す。その他の条件は、参考例と同じである。ここで、Ｐ制御のゲインとしては、本発明による手法と最終目標値への整定時間が等しくなるようにＫｐ＝３６．０とした。なお、図７（ａ）は、タンク位置、図７（ｂ）は、制御入力、図７（ｃ）は、液面振動値を示す。
【０１０３】
図７（ｃ）により、Ｐ制御では、位置決め制御はシミュレ−ションと同様に行えているが、スロッシング抑制を考慮していないため、大きくスロッシングを発生している。
【実施例】
【０１０４】
次に、本発明の実施例を説明する。
図５にて得られた制御入力を式（３６）に示す単振り子型モデルに適用した場合の液面挙動シミュレ−ション結果を図８に示す。ここで、単振り子型モデルは、液面を直線で近似し、タンク中心よりＬ離れた観測点での液位ｈを振子の振れ角θの関数として表現したものである。
【０１０５】
【数３６】
2009259264.tif 000039
【０１０６】
ただし、αはタンクに加えられる加速度、ｃは液体自身の粘性や、液体と容器壁面の摩擦を考慮した等価粘性係数、ｍはタンク内液体質量、ｇは重力加速度、ｌは等価振子長さを示す。ここで、液位がｈｓ＝０．１４ｍのとき、ｃ＝１．８８Ｎｓ／ｍ、ｍ＝２．７４Ｋｇ、ｌ＝４．４６×１０−２ｍである。
【０１０７】
この結果、本発明の制御方法で求められたフィ−ドバックコントロ−ラにより、設計時に要求した制御仕様を満たしつつ、液体の残留振動も殆ど起こすことなく、搬送制御できていることがわかった。このことにより、液体若しくは搬送物の固有振動数のみを事前に把握しておけば、液体（搬送物）の動的モデルを用いることなく、制振制御の設計が可能であることが分かった。
【０１０８】
以上の設計手順を、図示すると、図９に示すようになる。なお、図９において、設計仕様の定式化から、フィ−ドバックコントロ−ラを算出する際には、必ずしも、最適化問題を定式化してくても良い。
（１）モ―タ特性及び駆動系のモデリング
（２）スロッシング特性（搬送物の固有振動数）の同定
（３）フィ−ドバックコントロ−ラの選択
（４）設計仕様の定式化
（５）フィ−ドバックコントロ−ラの算出
【符号の説明】
【０１０９】
２  モ−タ
４  ロ−タリ−エンコ−ダ 
６  ドライバ
７  コントロ−ラ
８  記憶媒体
９  入力演算手段
【図１】
2009259264.tif 000040
【図２】
2009259264.tif 000041
【図３】
2009259264.tif 000042
【図４】
2009259264.tif 000043
【図５】
2009259264.tif 000044
【図６】
2009259264.tif 000045
【図７】
2009259264.tif 000046
【図８】
2009259264.tif 000047
【図９】
2009259264.tif 000048