(57)【特許請求の範囲】
【請求項１】
指定された移動距離を走行する台形の速度パターンに対し、起動開始時の加速からマスト揺動の固有周期の１／６の時間経過後に等速に遷移し、その状態をマスト揺動の固有周期の１／６だけ維持し、再度、加速に移るようにし、また加速の終了時点の手前でマスト揺動の固有周期の１／６の等速時間と、マスト揺動の固有周期の１／６の加速時間を設け、加速を終了して等速運転に移行し、次に、減速開始時の減速からマスト揺動の固有周期の１／６の時間経過後に等速に遷移し、その状態をマスト揺動の固有周期の１／６だけ維持し、再度、減速に移るようにし、また減速の終了時点の手前でマスト揺動の固有周期の１／６の等速時間と、マスト揺動の固有周期の１／６の減速時間を設け、減速を終了して停止する、２値の加速度の切替によりスタッカクレーンのマスト揺動の固有周波数成分を加振の信号源となる速度と加速度から除去した運転パターンによりスタッカクレーンの振動を抑制するようにしたことを特徴とするスタッカクレーンの制振制御方法。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、スタッカクレーンの制振制御方法に関し、特に、インバータあるいはサーボモータで走行軸の駆動制御を行うようにした自動倉庫あるいはクリーンルーム内で稼動する液晶カセット搬送用のスタッカクレーンで、マスト上部に機械的な制振装置を用いることなく、マストの揺動を確実に低減するようにしたスタッカクレーンの制振制御方法に関するものである。
【背景技術】
【０００２】
従来、天井クレーンの振止めに関しては、特許文献１〜３に示すような速度パターンでクレーンの振れを止める技術が公開されている。
特許文献１（特開平６−２５５９８４号公報）は、制振パターンの計算方法において、加速側と減速側が非対称になっている。
特許文献２（特開２０００−１５３９８９号公報）は、加速度が２値の速度パターンであるが、絶対値が同じで極性の異なる加速度を使用している。このため、最短時間の加減速時間で移動可能な速度パターンになるが、加速度と速度の周波数に着目した場合、振動の固有周波数よりも高い周波数成分を多く含み、高次の振動やクレーンの吊具（トング）の振動を誘発しやすい。
特許文献３（特開２００５−６７７４７号公報）は、振動を誘起しないようなフィードフォワードの制御入力をデジタル処理によるノッチフィルタで実現しているので、制御が複雑となる。
【０００３】
ところで、天井クレーンは、荷の振れを単振子の運動として捉え、スタッカクレーンは梁の振動として振動を捉えるが、走行の加速度により固有の振動数で振動を起こす点では本質的に同様な物理現象である。しかしながら天井クレーンの技術をスタッカクレーンに転用するには以下の理由により不都合が生じる。
（１）スタッカクレーンのマスト揺動の固有振動数は天井走行の振動数に比較して振動数は１Ｈｚ近傍の値と非常に高く、動作も短時間の加減速を繰り返すため、走行駆動の速度、加速度に含まれる周波数成分が広範囲にわたり、固有周波数以外の高次の周波数でも振動を起こしやすくなる。
（２）制御装置に汎用のＰＬＣ（シーケンサ）とサーボモータあるいはインバータ駆動の誘導電動機で駆動することが多く、据付調整にかかる時間が長くなる。このため、据付調整時間を短縮し、短期間で装置を稼動させるために、これらの汎用制御装置で制御が行いやすく、調整が容易に行える簡便な制御方法が望まれている。
【０００４】
また、スタッカクレーンのマストの揺動を低減する方法として、特許文献４（特開２００５−２１２９１９号公報）に示すものが提案されている。
この方法は、スタッカクレーンのマストの揺動を低減するため、マストの上部にも走行方向の駆動力を発生するモータを取り付けて、マスト下部の走行駆動を行う下部駆動モータの速度指令を上部駆動モータにも与え、マストの上部と下部で速度差が生じた場合に速度差に比例したトルクを発生しマストの揺動を抑制する上部の駆動機構とその機構を制御する制御装置を具備するようにしている。
【０００５】
ところで、この方法ではマストの上部に上部駆動装置及びその制御装置を要するとともに、スタッカクレーン本体の軽量化に限度があり、またクリーンルーム内の搬送においては、該上部駆動により塵挨が発生し、該塵挨がクリーンルームの上部から気流を下に流すダウンフローにより搬送物を汚染させるという問題があった。
また、発生塵挨による汚染から搬送物を防ぐための対策、例えば、ＦＦＵ（ファンフィルタユニット）等の清浄装置の取り付けなどにコストがかかるという問題もあった。
【０００６】
【特許文献１】特開平６−２５５９８４号公報
【特許文献２】特開２０００−１５３９８９号公報
【特許文献３】特開２００５−６７７４７号公報
【特許文献４】特開２００５−２１２９１９号公報
【発明の開示】
【発明が解決しようとする課題】
【０００７】
本発明は、スタッカクレーンの制振制御方法の有する問題点に鑑み、インバータあるいはサーボモータで走行軸の駆動制御を行う自動倉庫、あるいはクリーンルーム内で稼動する、特に限定されるものではないが、例えば、液晶カセット搬送用のスタッカクレーンにおいて、簡易な方法で確実にマストの揺動を低減するようにしたスタッカクレーンの制振制御方法を提供することを目的とする。
【課題を解決するための手段】
【０００８】
上記目的を達成するため、本発明のスタッカクレーンの制振制御方法は、指定された移動距離を走行する台形の速度パターンに対し、起動開始時の加速からマスト揺動の固有周期の１／６の時間経過後に等速に遷移し、その状態をマスト揺動の固有周期の１／６だけ維持し、再度、加速に移るようにし、また加速の終了時点の手前でマスト揺動の固有周期の１／６の等速時間と、マスト揺動の固有周期の１／６の加速時間を設け、加速を終了して等速運転に移行し、次に、減速開始時の減速からマスト揺動の固有周期の１／６の時間経過後に等速に遷移し、その状態をマスト揺動の固有周期の１／６だけ維持し、再度、減速に移るようにし、また減速の終了時点の手前でマスト揺動の固有周期の１／６の等速時間と、マスト揺動の固有周期の１／６の減速時間を設け、減速を終了して停止する、２値の加速度の切替によりスタッカクレーンのマスト揺動の固有周波数成分を加振の信号源となる速度と加速度から除去した運転パターンによりスタッカクレーンの振動を抑制するようにしたことを特徴とする。
【発明の効果】
【０００９】
本発明のスタッカクレーンの制振制御方法によれば、スタッカクレーンのマストの上部に駆動機構やその機構を制御する制御装置、さらにはＦＦＵ等の清浄装置を設けることなく、スタッカクレーン下部の駆動装置の制御のみでマストの揺動を確実に、かつ簡易な方法で低減することができ、メンテナンスも簡易に行うことができる。
【発明を実施するための最良の形態】
【００１０】
以下、本発明のスタッカクレーンの制振制御方法の実施の形態を、図面に基づいて説明する。
【実施例１】
【００１１】
図１〜図６に、本発明のスタッカクレーンの制振制御方法の一実施例を示す。
本発明の制御構成の制御ブロック図を示す図１に基づいて説明する。なお、本発明に関係する走行制御に関してのみ説明し、直接関係のない荷の移載関係については言及しないものとする。
【００１２】
図１において、まず、スタッカクレーンの移動に関係する動作指令と現在のスタッカクレーンの状態から移動距離と加速できる最大の速度を決定する。また、移動条件として搬送物に許容される加速度あるいは機械的条件から加速できる加速度、機械の定格速度を制約条件として移動できる速度を決定する。
速度パターンを、特に限定されるものではないが、例えば、図２に示すように、台形状とし、加速と減速を対称になるように速度を決定する。その他の制約条件として、加速終了後の等速時間を条件設定された値を限度として指定時間以上の等速移動時間が得られない場合には加速する限界の最大速度を下げ、等速時間を確保し、後述する速度パターンの変形に対応するようにする。なお、この場合、サーボコントローラには位置指令を与え位置を制御するようにする。
【００１３】
なお、汎用されているサーボコントローラでは、位置の指令をパルス列で与え、パルスの数が移動距離に比例し、パルスの発生間隔がモータの回転数に比例する、コントローラと、サーボコントローラに移動距離データを通信により数値データとして与え、サーボコントローラの内部で移動距離データから速度パターンに展開するタイプと、アナログの電圧指令により速度指令を行うタイプ等があるが、インターフェースの相違や速度パターンを展開する制御装置がサーボの内部か外部化の相違は、本発明と本質的な相違はないが、本発明では通信により移動指令をサーボコントローラに与え、サーボコントローラ内部で速度パターンを展開する構成で説明する。
【００１４】
制御装置は、動作中に加速度を切り替える時刻に達したら動作条件の変更をサーボコントローラに指示する。このサーボコントローラは位置制御ループ、速度制御ループ、図では省略しているトルク制御ループの多重フィードバック系でサーボモータ軸の設けたエンコーダ信号により速度と位置を帰還し、サーボモータの速度制御と位置制御を行い、指令された位置までスタッカクレーンを走行するようにする。
サーボコントローラの位置指令と速度指令の間のフィルタ処理としては、特に限定されるものではないが、例えば、Ｓ字加減速機能、振動抑制フィルタにて行う。
【００１５】
図２に速度と加速度の関係を示す。該図において、指定の移動距離を走行する台形の速度パターンに対し、マスト揺動の固有周期をＴとし、起動から固有周期の１／６の時間経過後に等速に遷移し、その状態を固有周期の１／６だけ維持し、再度、加速に移るようにし、また加速の終了時点の手前でも固有周期の１／６の等速時間と、固有周期の１／６の加速時間を設け、加速を終了するようにする。
このような加速を行うと、加速時の加速度と速度にはマスト揺動の固有周波数を含まない速度パターンを得ることができる。このため、初期条件としてマストの揺動がない状態でスタートしたスタッカクレーンは、加速終了時点でも振れを起こさない運転が可能になる。この加速ではマスト揺動の固有周期の１／６の等速時間が台形加速に対して動作時間が長くなる。また、減速側も加速と対称に、固有周期の１／６で減速開始と停止前に等速領域を設けるようにする。
このような速度パターンを展開すると、加速度が加速領域では正の値とゼロの２値を、減速領域では加速領域と絶対値が同じで極性が負に反転した値とゼロの２値をとる。
速度の切り替え点は、マスト揺動の固有周期に対してタイマで時刻管理をすることで決定でき、処理としては、スタッカクレーンの移動している速度を、切り替え点で、目標速度を速度パターン展開で得られた上限速度と現在速度のいずれかを選択的に再設定することで、２値の加速度を切り替えることができる。
【００１６】
本実施例では、特に限定されるものではないが、固有周期がＴ＝１．４３ｓ、即ち固有周波数がｆ＝０．７Ｈｚ、ω＝２πｆ＝４．４ｒａｄ／ｓとして説明している。
スタッカクレーンでは、昇降体は昇降体と搬送物の合計質量と釣り合うカウンタウエイトを装備するようにしているが、昇降体の上下方向の位置が変わってもマスト揺動の固有振動数が大きく変わらない。このような場合には昇降位置に関係なく単一の固有振動数に対して制振パターンを展開することができる。
一方、カウンタウエイトを装備しない場合やカウンタウエイトを装備していても、昇降体質量に対して搬送物の質量が大きい場合、不完全な釣り合い状態になり昇降体の位置によっては固有振動数が変化する場合がある。この場合、加速領域と減速領域での固有振動数に対して制振パターンを展開するようにする。
【００１７】
スタッカクレーンに移動指示がなされた後の処理の、動作のフローチャートを図３に示す。速度パターン展開を行い、マストの固有周期から速度変更を行う時刻を決定する。次にサーボコントローラに必要な動作パラメータの設定を行い、全ての動作パラメータを設定した後にサーボに起動を指令し移動開始する。
移動開始後は速度の変更時刻に時刻が到達するのを待って目標速度を更新する。速度変更時刻に達したかを知る方法としては周期的に時刻を監視する方法や、イベント発生タイマを設定し、イベント発生を待つ手法などがあり、制御を実装する制御装置に適した方法で時間監視を行う。
目標位置に到着すれば、停止処理を行う。この一連の走行移動はスタッカクレーンの移動、搬送の中で適宜行う。
【００１８】
図２に示す速度と加速度のパターンは時間的に不連続であり、不連続点で加速度が急変することで、その周波数は非常に幅の広い周波数帯域を含むことになり、マスト揺動の固有周波数の成分は小さいが、それよりも高い周波数の加速度成分を含み、これが加振の信号源となって振動を発生するものとなる。
図５（ａ）に速度パターンを示す。速度３ｍ／秒まで５秒で加速する台形の加減速を行う場合と、固有周期の１／６の時間で速度変更を行う制振運転の場合のスタッカクレーンの速度を示す。
図５（ｂ）に制振運転を行った系の台形速度パターンに対するスタッカクレーンの伝達関数の振幅線図を示す。振幅線図の（ア）の点はマスト揺動の固有振動周波数を示し、固有振動周波数よりも周波数の低い領域での差は少ないが、この（ア）の固有振動周波数よりも高い周波数領域では振幅が増加する、振動を起こしやすい、不安定な系であることを示している。
【００１９】
次にこの系の持っている不安定要因を解消するフィルタ処理について説明する。図１のフィルタ処理は時々刻々と変化する位置指令に対してのフィルタ処理として移動平均を例に説明する。移動平均の角周波数ωに対する伝達関数Ｈ（ω）は、式１で示される。該式において、Ｍは移動平均をとるデータの数、ｔｓはサンプリング間隔を示す。
【００２０】
【数１】
0004982797.tif 000002
【００２１】
この式１は、移動平均をとるデータ数が多いほうが減衰が大きく、最大の減衰が得られる角周波数は周期的に発生することを示している。また減衰がほとんど得られない角周波数の周期的に発生する。
スタッカクレーンではマストの固有振動数以外に３次の振動が発生しやすい。更に高次の５次、７次あるいはそれ以上の振動は振動の減衰が大きく、また走行駆動を行うサーボ系が追従できないこともあり、固有周期、３次、５次の振動を抑制することが望ましい。
最初の最大減衰の得られる周波数をマスト揺動の固有振動数の３倍に設定することで、基本となる固有振動数と３次振動数の周波数成分、更に高次の周波数成分も効果的に減衰することができる。
【００２２】
図６（ａ）に制振パターンと移動平均のフィルタ処理を併用した場合のスタッカクレーンの走行速度と台形加減速の速度を比較した速度線図を示す。図６（ｂ）にはその場合の台形の速度指令に対する速度伝達関数の振幅線図を示す。図６（ａ）における（イ）の点がマスト揺動の固有振動を示す。この値は図５（ｂ）における（ア）の点と同じ周波数となっているのは制振パターンによるものである。
一方、図６（ａ）における（ウ）の周波数は移動平均により図６（ａ）における（イ）の周波数の３倍の周波数に選んだ点を示し、（イ）と（ウ）で減衰し、（ウ）よりも高い周波数でも減衰する。図６（ａ）における（エ）は移動平均による効果とサーボ系が応答できないため、図５（ｂ）でもある程度減衰していたものが、移動平均により５次の高調波振動の周波数近傍での減衰が大きくなっている。このようにマスト揺動の原因となる周波数の成分を速度指令の値を加減速中に操作することと、汎用サーボコントローラが装備している付加機能のＳ字加速、制振機能等のフィルタ機能を併用する簡便な方法でマストの揺動を起こしにくくする制振制御を実現することができる。
【００２３】
本実施例ではフィルタ処理は移動平均を例にとって説明したがこれに限定するものではない。
移動平均はＦＩＲフィルタ（Finite Impulse Response filter）の一種類でそれ以外のデジタルフィルタでも最大減衰点の周波数が固有振動の３倍の周波数に設定できればその種類を問わない。
【００２４】
また、汎用サーボコントローラは速度指令や位置指令に対するフィルタ機能を装備していたい場合でも、トルク指定に対してのノッチフィルタで特定周波数の振動成分を駆動トルクから減衰させる機能を図４に示すような構成で装備することもできる。このノッチフィルタで固有振動数の３倍の周波数を減衰することで、図１の構成と同様な効果を得ることもできる。
【００２５】
また本発明の方法はスタッカクレーンだけでなく、天井クレーンやジブクレーン等の吊荷の制振制御に対しても有効である。
【００２６】
以上、本発明のスタッカクレーンの制振制御方法について、実施例に基づいて説明したが、本発明は上記実施例に記載した構成に限定されるものではなく、その趣旨を逸脱しない範囲において適宜その構成を変更することができるものである。
【産業上の利用可能性】
【００２７】
本発明のスタッカクレーンの制振制御方法は、発塵を抑制してマストの揺動を低減するという特性を有していることから、クリーンルーム内で稼動するスタッカクレーンの用途に好適に用いることができるほか、例えば、天井クレーンやジブクレーン等の吊荷の制振制御の用途にも用いることができる。
【図面の簡単な説明】
【００２８】
【図１】本発明のスタッカクレーンの制振制御方法の一実施例を示す制御のブロック説明図である。
【図２】速度と加速度のパターン図である。
【図３】動作のフローチャート図である。
【図４】ノッチフィルタのブロック説明図である。
【図５】制振パターンを示し、（ａ）は台形の加減速を行う場合と固有周期で速度変更を行う制振運転の場合のスタッカクレーンの速度線図、（ｂ）は制振運転を行った系の台形速度パターンに対するスタッカクレーンの伝達関数の振幅線図である。
【図６】制振パターンと移動平均のフィルタ処理を併用した場合のグラフを示し、（ａ）はスタッカクレーンの走行速度と台形加減速の速度を比較した速度線図、（ｂ）はその台形の速度指令に対する速度伝達関数の振幅線図である。
【図１】
0004982797.tif 000003
【図２】
0004982797.tif 000004
【図３】
0004982797.tif 000005
【図４】
0004982797.tif 000006
【図５】
0004982797.tif 000007
【図６】
0004982797.tif 000008