昇降装置の制御システム
【課題】 荷物の把持と操作とを同時に行なって、良好な操作感覚で荷物を昇降させる。
【解決手段】サーボモータ１の正逆回転駆動によって巻上げ・巻下げされるロープ２により昇降されまたは位置が維持される荷物に、作業者が操作力を加え、望む方向へ望む速度で荷物を昇降させるためにサーボモータの回転駆動を制御するシステムでおいて、ロープの下部に掛かる力であって作業者の操作力、荷物の質量および荷物の加速度による力の大きさを計測する力計測手段３と、力計測手段の計測結果に基づき演算部がサーボモータの回転の方向および速度を演算してサーボモータに駆動指令の信号を出す第１制御手段と、荷物が着地する際にサーボモータの正逆回転駆動のための入出力が安定となる安定条件を、安定性理論により求める第２制御手段と、力計測手段の計測値が閾値を下回った瞬間に第１制御手段から第２制御手段に切り替える切換え手段を具備しる。
【解決手段】サーボモータ１の正逆回転駆動によって巻上げ・巻下げされるロープ２により昇降されまたは位置が維持される荷物に、作業者が操作力を加え、望む方向へ望む速度で荷物を昇降させるためにサーボモータの回転駆動を制御するシステムでおいて、ロープの下部に掛かる力であって作業者の操作力、荷物の質量および荷物の加速度による力の大きさを計測する力計測手段３と、力計測手段の計測結果に基づき演算部がサーボモータの回転の方向および速度を演算してサーボモータに駆動指令の信号を出す第１制御手段と、荷物が着地する際にサーボモータの正逆回転駆動のための入出力が安定となる安定条件を、安定性理論により求める第２制御手段と、力計測手段の計測値が閾値を下回った瞬間に第１制御手段から第２制御手段に切り替える切換え手段を具備しる。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、昇降装置の制御システムに係り、より詳しくは、サーボモータの正逆回転駆動によって巻上げ・巻下げされるロープにより昇降されまたは位置が維持される荷物に、作業者が操作力である力を加え、これにより、作業者が望む方向へ望む速度で当該荷物を昇降させるために前記サーボモータの回転駆動を制御するシステムに関する。
【背景技術】
【０００２】
従来、この種の制御システムの一つとして、荷役物を昇降する機構と、この昇降機構を駆動する駆動源と、この駆動源を制御する為の制御部及び操作部を有し、人間が操作部を持ち、荷役物を持ち上げようとする時に出す反重力方向への持上げ力の大きさを、操作部に設けた力センサーで検出し、その持上げ力の大きさに応じて荷役物搬送機の吊り上げ力を増幅させ、その持上げ力と吊り上げ力で荷役物を昇降させる力制御方法を有する荷役物搬送機において、荷役物を持ち上げようとする力が大きくなるにつれ、持上げ力に対する吊り上げ力の比率を常にまたは近似的に増大させることで、シリンダーへのエアー量を制御するようにしたものがある。
【０００３】
しかし、このように構成された従来の制御システムでは、作業者が荷物から分離された操作レバーを操作することにより、荷物の移動速度および方向の指令が出されるようになっているため、作業者は荷物の把持と操作とを同時に行うことができず、その結果、作業者は良好な操作感覚で荷物を昇降させることができない問題があった。
【特許文献１】特開平１１-１４７６９９号
【発明の開示】
【発明が解決しようとする課題】
【０００４】
本発明は上記の事情に鑑みてなされたもので、その目的は、作業者が荷物の把持と操作とを同時に行なって、良好な操作感覚で荷物を昇降させることができる昇降装置の制御システムを提供することにある。
【課題を解決するための手段】
【０００５】
上記の問題を解消するために本発明における昇降装置の制御システムは、サーボモータの正逆回転駆動によって巻上げ・巻下げされるロープにより昇降されまたは位置が維持される荷物に、作業者が操作力である力を加え、これにより、作業者が望む方向へ望む速度で当該荷物を昇降させるために前記サーボモータの回転駆動を制御するシステムであって、
前記ロープの下部に掛かる力であって作業者の操作力、荷物の質量および荷物の加速度による力の大きさを計測する力計測手段と、この力計測手段の計測結果に基づき演算部が前記サーボモータの回転の方向および速度を演算してサーボモータに駆動指令の信号を出す第１制御手段と、前記荷物が着地する際に前記サーボモータの正逆回転駆動のための入出力が安定となる安定条件を、演算部が非線形安定判別により求める第２制御手段と、
前記力計測手段の計測値が閾値を下回った瞬間に前記第１制御手段から前記第２制御手段に切り替える切換え手段と、を具備したことを特徴とする。
【０００６】
このように構成されたものは、作業者が望む方向へ荷物を上昇または下降させるため荷物に力を加えると、力計測手段は、作業者の操作力、荷物の質量および荷物の加速度による力の大きさを計測してその計測結果を制御手段に送信する。この力計測手段からの計測結果の送信により制御手段は、計測結果に対応したサーボモータの回転の方向および速度を演算してサーボモータに駆動指令信号を出す。これにより、作業者が加えた力に対応した力が付与されるとともに作業者が補助されて荷物は作業者の望む方向へ望む速度で移動される。
また、力計測手段の計測値が閾値を下回った瞬間に切換え手段が第１制御手段から第２制御手段に切り替える。これにより、荷物の接地時に荷物が上がる現象を防止することができる。
【０００７】
なお、本発明において、前記演算部は、 (式) Ｋｆ＝kp（ｂｓ＋ωn2 ） /(s2+2ζωns+ωn2)で表させるコントローラＫ１と、安定性の条件ｂ≧ωｎ／２ζを満たすコントローラＫ2とが記憶されていて、前記演算部は、前記力計測手段からの計測情報である、荷物の質量、作業者の操作力および荷物の加速度によって生じる力に基づき、前記コントローラーＫ1により最小時間で所定の昇降速度を演算して前記サーボモータに駆動指令を発信し、その後、前記力計測手段の計測値が閾値を下回った瞬間に、切換え手段からの指令により、前記コントローラＫ1からコントローラＫ2に切り換えることができる。
【０００８】
またなお、本発明において、演算部に(式)ｂ≧ωｎ／２ζで表させるコントローラＫ2が記憶することにより、力計測手段の計測値が閾値を下回った瞬間に切換え手段が第１制御手段から第２制御手段に切り替え、荷物の接地時に荷物が上がる現象を防止することができる。
【発明の効果】
【０００９】
以上の説明から明らかなように本発明は、サーボモータの正逆回転駆動によって巻上げ・巻下げされるロープにより昇降されまたは位置が維持される荷物に、作業者が操作力である力を加え、これにより、作業者が望む方向へ望む速度で当該荷物を昇降させるために前記サーボモータの回転駆動を制御するシステムであって、前記ロープの下部に掛かる力であって作業者の操作力、荷物の質量および荷物の加速度による力の大きさを計測する力計測手段と、この力計測手段の計測結果に基づき演算部が前記サーボモータの回転の方向および速度を演算してサーボモータに駆動指令の信号を出す第１制御手段と、前記荷物が着地する際に前記サーボモータの正逆回転駆動のための入出力が安定となる安定条件を、演算部が非線形安定判別により求める第２制御手段と、前記力計測手段の計測値が閾値を下回った瞬間に前記第１制御手段から前記第２制御手段に切り替える切換え手段と、を具備したから、作業者は荷物の把持と操作とを同時に行うことができるため、作業者は荷物に対して良好な操作感覚を得ながら荷物を望む方向へ望む速度で昇降させることが可能になり、しかも、力計測手段の計測値が閾値を下回った瞬間に切換え手段が第１制御手段から第２制御手段に切り替えるため、荷物の接地時に荷物が上がる現象を防止することができるなどの優れた実用的効果を奏する。
【発明を実施するための最良の形態】
【００１０】
以下、天井走行クレ−ンに装着された巻揚げ機に本発明を適用した実施例について図面に基づき詳細に説明する。図１に示すように、本巻揚げ機においては、ロープ巻上げドラム（図示せず）の回転軸にこれを正逆回転させるサーボモータ１の出力軸が連結してあり、さらにロープ巻揚げドラムから巻き下げられたロープ２の下端にはロープ２の下端に掛かる力の大きさを計測する力計測手段としてのロードセル３が装着してある。ロードセル３の下端には昇降させる荷物Wがフック（図示せず）を介して掛止されている。また、前記ロードセル３にはこれの計測結果に基づき、前記サーボモータ１の回転の方向および速度を演算する演算部としてのコンピュータを含みかつコンピュータの演算結果に基づき前記サーボモータ１に駆動指令信号を出す制御手段４が電気的に接続してある。
【００１１】
そして、前記制御手段４のコンピュータは、前記ロードセル３の計測結果に基づき前記サーボモータ１の回転の方向および速度を演算してサーボモータ１に駆動指令の信号を出す第１制御手段としての機能と、前記荷物Wが着地する際に前記サーボモータ１の正逆駆動のための入出力が安定となる安定条件を、非線形安定判別としてのポポフの安定性理論により求める第２制御手段としての機能と、前記ロードセル３の計測値が閾値を下回った瞬間に前記第１制御手段から前記第２制御手段に切り替える切換え手段としての機能と、を備えている。
【００１２】
次に、このように構成した巻揚げ機の作用について説明する。ロープ２によって吊り下げられた荷物Wを作業者が望む方向である上方または下方へ押すと、ロードセル３がロープ２に掛かる力の大きさを計測して制御手段４に送信する。すると、巻揚げ機を介しての作業者による荷物Wの昇降を補助すべく、制御手段４のコンピュータにおいては下記に示す原理に基づき演算が行われる。
【００１３】
すなわち、基本的な原理としては、図２に示すように、作業者が荷物Wに操作力ｆｈ［Ｎ］を加えると、ロードセル３が力ｆｍ［Ｎ］を検出して、コントローラＫｆは制御入力ｕ（＝ｒv［ｍ/ｓ］指示速度）を生成し、この結果、巻揚げ機は命じられた速度vに従って荷物Wを上昇または下降させる。
ここで、ｍ［kg］は荷物Wの質量である。
なお、z軸方向は下向きを正とする。
【００１４】
上述の作用は以下に示す理論によって行われる。すなわち、
制御された荷物Wの昇降速度v＝ｒv＝Ｋｆｆｍ
（１）
の関係式が成り立つ。
ここで、ロードセル３が検出する力ｆｍは操作力ｆｈから荷物Wの加速度ｄv/ｄｔによる見かけの重量を差し引いたものであるから、
ｆｍ＝ｆｈ−ｍｄv/ｄｔ
（２）
となり、荷物Wは操作力ｆｈにより以下の伝達関数で表させる昇降速度を得る。
Ｒv（ｓ）＝Ｋｆ（ｓ）Fｈ（ｓ）/[1+msＫｆ（ｓ）] （３）
したがって、Ｋｆ（ｓ）のゲインを大きくすることにより、作業者は僅かな力で荷物を昇降させることができる。
ここで、sはラプラス演算子[1/s]、Fｈは操作力［Ｎ］である。
【００１５】
ところで、コントローラのパラメータとして、定常状態で、制御された荷物Wの昇降速度ｒv＝kpｆｈとなる、操作力から巻き上げ下げ速度の変換係数kp[（m /s/N）]を定義する。
ここで、kpは操作力1[N]当りの荷重の移動速度[m /s]を示す。
この変数はユーザの要求によって決定され、荷物Wの搬送速度を遅くし荷物Wの正確な位置決めを行いたい場合にはkpを小さく選び、わずかな力で高速に搬送したい場合はkpを大きく選ぶ。
【００１６】
また、巻揚げ機の共振周波数とそのピークゲインの変動を乗法変動として考慮すると下記の（４）式のように表わすことができる。
【００１７】
【数１】
【００１８】
ここで、Pチルダは実際の伝達関数、Pは式P（ｓ）=Fm(s) /Rv=msで表されるノーマルな伝達関数、Δは変動である。
【００１９】
また、図3にモデル化誤差とおもみ関数の見積もりの関係を示す。この図3において、左図細線がΔを見積もった伝達関数であるとすると、ロバスト性の安定化のために、|Wr|>|Δ｜となる重み関数Wrを
Wr=ωps /ωc(s+ωp) （５）
として、図３の左図太線を得る。
なお、この図３において、ωc[rad /s]は交差角周波数、ωp[rad /s]はΔピークとなる周波数である。
【００２０】
また、本発明のように、混合感度問題の制御のブック図は図４に示すようになる。そして、wからz間での伝達関数は本システムの相補感度関数で、ロバスト安定の条件は重み関数Wrを考慮して||Twz2||∞<1となる。
したがって、要求するコントローラは下記の（６）式で示すように定式化できる。
【００２１】
【数２】
【００２２】
ここで、w(=ｆｈ)からz1までの伝達関数Twz1は、操作力ｆｈと荷物速度ｒvの誤差に相当する。本演算手段の目的はステップ状の操作力に対し、定常速度kp[（m /s/N）]にできるだけ速く整定するコントローラＫｆを設計することであるから、下記の（７）式のように重み関数Wsを決定する。
Ws=1 /s （７）
【００２３】
なお、上記のコントローラＫｆは、下記のようにして得られる。
すなわち、重み関数Wr、Wsおよびノーマルな伝達関数P（ｓ）の次数の合計が２であるので、最適コントローラは２次となる。したがって、コントローラの構造を下記の（８）式のように表すことができる。
Ｋｆ＝kp(as2+bs+c) /(s2+2ζωns+ωn2) （８）
ここで、aおよびbは定数、cは変数、sはラプラス演算子[1/s]、ζは減衰係数、ωnは固有角周波数[rad/s]である。
【００２４】
また、ロバスト安定性の観点から、a= 0とする。
【００２５】
定常状態における式v＝kp fを満たすために以下のように変数cを得る。
【００２６】
【数３】
【００２７】
したがって、コントローラの解析解は次の方程式となる。
Ｋｆ＝kp（ｂｓ＋ωn2 ） /(s2+2ζωns+ωn2) （１０）
【００２８】
作業者の操作力ｆｈと荷物Wの速度の伝達関数である（３）式と、コントローラ（１０）式から、操作力ｆｈと荷物Wの速度の伝達関数を求めると、下記の（１１）式となる。
【００２９】
【数４】
【００３０】
ところで、従来のロバスト性と、即応性を考慮した巻揚げ機では、荷物Wを接地させようとした時に荷物Wが上下運動を起こすという、リミットサイクルの問題が生じる。図６は３０．３［ｋｇ］の荷物Wに１０［Ｎ］の力を加え続けた際の荷物Wの位置を示し、また破線はシミュレーション結果を示す。なお、実験に用いたパラメータを下記の表１に示す。また、位置は下方向を正としている。
【００３１】
【表１】
図６からは、リミットサイクルが周期１．８[s]、振幅２１．０[ｍｍ]であり、シミュレーションに近い結果となっていることが分かる。
【００３２】
このリミットサイクルの原因としては、荷物Wが接地した際にロープ２が緩み、ロードセル３の検出する値が急激に小さくなることが考えられる。コントローラＫｆでは重力による加重を差し引いているため、接地によりロードセル３の検出する値が小さくなると、制御手段４のコンピュータが上方向に力が働いたと判断し、巻揚げ機は巻上げ動作を行ってしまうからである。
【００３３】
図７はシミュレーションにおけるリミットサイクルの位相面図を示す。上半平面ではモータ１は巻下げ動作を行い、また下半平面では巻上げ動作を行っている。図７からは、初期条件に関係なく、一定の軌跡に収束することが分かる。
【００３４】
また、図８はｘ＝０おいて、接地が行われる状態をブロック図によって示したものである。
（１１）式と図８のブロック図から、閉ループシステムの運動方程式は、下記の（１２）式となる。
【００３５】
【数５】
ここで、ｘはロードセル３の位置、またｘ（ｎ）はｘのｎ回微分をそれぞれ示す。（１２）式により、巻揚げ機は３次の線形微分方程式と非線系部φ（ｘ）から成り立っている。非線系部φ（ｘ）はｘにより値が変化するステップ関数である。
また、操作入力と位置ｘの関係は下記の（１３）式となる。
Ｔｘｆｈ（ｓ）＝Ｔｖｆｈ（ｓ）／ｓ （１３）
【００３６】
次に、リミットサイクルを抑制するために、巻揚げ機が入出力安定となる安定条件を、ポポフの安定定理より求める。
ここで、非線系部は０≦ｘφ（ｘ）≦ｋ、φ（０）＝０を満たす。
なお、ポポフの安定定理とは、非線形要素がある場合に、システムの安定判別が安易に行われるものである。
【００３７】
この時ポポフの条件式は下記の（１４）式となる。
Ｒｅ［Ｔｘｆｈ（ｊω）］−ｑωＩｍ［Ｔｘｆｈ（ｊω）］+１／ｋ＞０ （１４）
ここでｑはｑ≧０の任意の値である。
この（１４）式から、複素平面上の実軸にＲｅ［Ｔｘｆｈ（ｊω）］、また虚軸上にωＩｍ［Ｔｘｆｈ（ｊω）］をとり、ωについて描いた軌跡がポポフ軌跡となる
【００３８】
図９（ａ）に定数ｂ＝０、また図９（ｂ）に定数ｂ＝３０の際の結果をそれぞれ示す。そして、傾きが１／ｑ（任意）で、実軸を−１／ｋの値で横切る直線をポポフ直線といい、図９にそれぞれ結果を示す。
ここで、ｋ01、ｋｂ1はそれぞれ定数ｂ＝０、定数ｂ＝３０におけるｋの最小値であり、ｋ02、ｋｂ2はそれぞれ定数ｂ＝０、定数ｂ＝３０におけるｋの最大値である。また−１／ｋ0２、−１／ｋｂ２、−１／ｋ01、−１／ｋｂ1はそれぞれ定数ｂ＝０、定数ｂ＝３０において、実軸の切片である。この時、ポポフ軌跡がポポフ直線より右側にあることが安定である十分条件となる。
【００３９】
図９（ａ）の定数ｂ＝０において、ポポフ軌跡がポポフ直線より右、すなわち、システムが安定でリミットサイクルが生じない十分条件は、ポポフ直線のＸ軸切片が−１／ｋ01から−１／ｋ0２の間に存在することである。すなわち、非線形部φ（ｘ）の傾きがｋ01からｋ0２の範囲に存在することがある。ただし、−１／ｋ01＝−∞であるから、ｋ01＝０である。
このように、システムの安定性は、非線形部φ（ｘ）の傾きｋに依存していることが分かる。
【００４０】
また、図１０において、黒の点線の領域は定数ｂ＝０における安定性を保障する領域となる。そのため、黒の点線の領域において、非線形部φ（ｘ）が実線で示すような挙動を示したとしても、システムは安定となる。
しかし、本巻揚げ機のような図８に示すシステムは、ｘ＝０において−ｍｇからｆｈへ変化し、変化の傾きｋ＝∞となる。そのため、定数ｂ＝０のシステムは不安定となり、リミットサイクルが生じた。
【００４１】
そこで、このシステムの安定条件を次のように求めた。すなわち、システムを安定化させる非線形部φ（ｘ）の傾きの最大値はｋｂ２＝∞なので、この時のポポラ直線の実軸の切片は原点となる。また、（１４）式の虚数部はω→∞の時、０に収束する。それに応じて、（１４）式の虚数部を、原点を除き負の値になるようにすると、図９（ｂ）のように、−１／ｋｂ２＝０、すなわちｋｂ２＝∞を満たすことができる。これらにより、安定性条件は下記の（１５）式として求められる。
【００４２】
【数６】
ここで、分母は常に正であるため、（１５）式を満たすには分子が負である必要がある。この条件は、任意のωに対し、ωn−２ζｂ≦０と表すことができる。
これにより、本巻揚げ機において、任意の操作力ｆｈ（ｔ）と重力ｍｇに対する安定性条件は、下記の（１６）式で得ることができる。
ｂ≧ωn／２ζ （１６）
【００４３】
例として、（１６）式の安定性条件を満たす、ｂ＝３０における結果を図９（ｂ）に示す。この結果から、−１／ｋｂ1＝−∞から−１／ｋｂ２＝０、すなわちｋｂ1＝０からｋｂ２＝∞の領域において、ポポフ軌跡はポポフ直線の右側に存在することが分かる。これにより、図１０の灰色の点線の領域内において、システムがいかなる挙動を示そうとも、システムは安定となり、リミットサイクルが抑制される。
【実験例】
【００４４】
図１に示す巻揚げ機を用いかつ上述の表１に示す条件により実験を行った。
ここで、リミットサイクルが生じする定数ｂ＝０のコントローラをＫ１、また安定条件の（１６）式を満たすコントローラをＫ２とした。それぞれの実験結果を図１１に位相面で示す。実験結果から、コントローラＫ２は、リミットサイクルを非常に早く収束させていることが分かる。
【００４５】
実験において、コントローラＫ２は、リミットサイクルを短時間で減衰させることができた。しかし、このコントローラＫ２は速応性が悪い問題が存在するため、効率的な荷物Wの搬送を妨げる。そこで、図１２に示すように、コントローラＫ１、Ｋ２を切り替えることにより、効率的な搬送と、リミットサイクルの抑制を行う。切換えはロードセル３の加重が閾値を下回った瞬間に行い、接地するまではコントローラＫ１を、また接地後はコントローラＫ２をそれぞれ用いるようにする。
【００４６】
図１３の上図がコントローラＫ１のみを用いた結果であり、また下図が切換え手段としてのスイッチングコントローラを用いた結果である。実験結果から、コントローラの切換え後はリミットサイクルが徐々に減衰し、やがて振幅０．２［ｍｍ］の振動を繰り返すようになる。実験結果においてミットサイクルの振幅は従来のそれの１００分の１に減衰されたことが分かる。而して、スイッチングコントローラにより、効率的な荷物Wの搬送と、リミットサイクルの抑制を同時に行うことが可能になった。
【図面の簡単な説明】
【００４７】
【図１】本発明を適用した実施例の模式図である。
【図２】図１に示す実施例に係る制御システムのブロック図である。
【図３】モデル化誤差と重く関数の見積もりとの関係を示すグラフである。
【図４】混合感度問題のブロック図である。
【図５】図１に示す実施例における高次の振動モードの例を示す模式図である。
【図６】リミットサイクルの観測例である。
【図７】シミュレーションにおけるリミットサイクルの位相面図である。
【図８】ｘ＝０おいて、接地が行われる状態をブロック図によって示したものである。
【図９】図９（ａ）に定数ｂ＝０、また図９（ｂ）に定数ｂ＝３０の際の結果をそれぞれ示す。
【図１０】非線形要素φ（ｘ）への入力と安定領域を示す図である。
【図１１】リミットサイクルの抑制を位相面で示して図（Ｋ１：リミットサイクルあり、Ｋ２：リミットサイクル抑制）である。
【図１２】スイッチングコントローラのブロック図である。
【図１３】Ｋ１からＫ２へ切り替えることにより、リミットサイクルを抑制した例である。
【符号の説明】
【００４８】
1 サーボモータ
2 ロープ
3 ロードセル
4 制御手段
【技術分野】
【０００１】
本発明は、昇降装置の制御システムに係り、より詳しくは、サーボモータの正逆回転駆動によって巻上げ・巻下げされるロープにより昇降されまたは位置が維持される荷物に、作業者が操作力である力を加え、これにより、作業者が望む方向へ望む速度で当該荷物を昇降させるために前記サーボモータの回転駆動を制御するシステムに関する。
【背景技術】
【０００２】
従来、この種の制御システムの一つとして、荷役物を昇降する機構と、この昇降機構を駆動する駆動源と、この駆動源を制御する為の制御部及び操作部を有し、人間が操作部を持ち、荷役物を持ち上げようとする時に出す反重力方向への持上げ力の大きさを、操作部に設けた力センサーで検出し、その持上げ力の大きさに応じて荷役物搬送機の吊り上げ力を増幅させ、その持上げ力と吊り上げ力で荷役物を昇降させる力制御方法を有する荷役物搬送機において、荷役物を持ち上げようとする力が大きくなるにつれ、持上げ力に対する吊り上げ力の比率を常にまたは近似的に増大させることで、シリンダーへのエアー量を制御するようにしたものがある。
【０００３】
しかし、このように構成された従来の制御システムでは、作業者が荷物から分離された操作レバーを操作することにより、荷物の移動速度および方向の指令が出されるようになっているため、作業者は荷物の把持と操作とを同時に行うことができず、その結果、作業者は良好な操作感覚で荷物を昇降させることができない問題があった。
【特許文献１】特開平１１-１４７６９９号
【発明の開示】
【発明が解決しようとする課題】
【０００４】
本発明は上記の事情に鑑みてなされたもので、その目的は、作業者が荷物の把持と操作とを同時に行なって、良好な操作感覚で荷物を昇降させることができる昇降装置の制御システムを提供することにある。
【課題を解決するための手段】
【０００５】
上記の問題を解消するために本発明における昇降装置の制御システムは、サーボモータの正逆回転駆動によって巻上げ・巻下げされるロープにより昇降されまたは位置が維持される荷物に、作業者が操作力である力を加え、これにより、作業者が望む方向へ望む速度で当該荷物を昇降させるために前記サーボモータの回転駆動を制御するシステムであって、
前記ロープの下部に掛かる力であって作業者の操作力、荷物の質量および荷物の加速度による力の大きさを計測する力計測手段と、この力計測手段の計測結果に基づき演算部が前記サーボモータの回転の方向および速度を演算してサーボモータに駆動指令の信号を出す第１制御手段と、前記荷物が着地する際に前記サーボモータの正逆回転駆動のための入出力が安定となる安定条件を、演算部が非線形安定判別により求める第２制御手段と、
前記力計測手段の計測値が閾値を下回った瞬間に前記第１制御手段から前記第２制御手段に切り替える切換え手段と、を具備したことを特徴とする。
【０００６】
このように構成されたものは、作業者が望む方向へ荷物を上昇または下降させるため荷物に力を加えると、力計測手段は、作業者の操作力、荷物の質量および荷物の加速度による力の大きさを計測してその計測結果を制御手段に送信する。この力計測手段からの計測結果の送信により制御手段は、計測結果に対応したサーボモータの回転の方向および速度を演算してサーボモータに駆動指令信号を出す。これにより、作業者が加えた力に対応した力が付与されるとともに作業者が補助されて荷物は作業者の望む方向へ望む速度で移動される。
また、力計測手段の計測値が閾値を下回った瞬間に切換え手段が第１制御手段から第２制御手段に切り替える。これにより、荷物の接地時に荷物が上がる現象を防止することができる。
【０００７】
なお、本発明において、前記演算部は、 (式) Ｋｆ＝kp（ｂｓ＋ωn2 ） /(s2+2ζωns+ωn2)で表させるコントローラＫ１と、安定性の条件ｂ≧ωｎ／２ζを満たすコントローラＫ2とが記憶されていて、前記演算部は、前記力計測手段からの計測情報である、荷物の質量、作業者の操作力および荷物の加速度によって生じる力に基づき、前記コントローラーＫ1により最小時間で所定の昇降速度を演算して前記サーボモータに駆動指令を発信し、その後、前記力計測手段の計測値が閾値を下回った瞬間に、切換え手段からの指令により、前記コントローラＫ1からコントローラＫ2に切り換えることができる。
【０００８】
またなお、本発明において、演算部に(式)ｂ≧ωｎ／２ζで表させるコントローラＫ2が記憶することにより、力計測手段の計測値が閾値を下回った瞬間に切換え手段が第１制御手段から第２制御手段に切り替え、荷物の接地時に荷物が上がる現象を防止することができる。
【発明の効果】
【０００９】
以上の説明から明らかなように本発明は、サーボモータの正逆回転駆動によって巻上げ・巻下げされるロープにより昇降されまたは位置が維持される荷物に、作業者が操作力である力を加え、これにより、作業者が望む方向へ望む速度で当該荷物を昇降させるために前記サーボモータの回転駆動を制御するシステムであって、前記ロープの下部に掛かる力であって作業者の操作力、荷物の質量および荷物の加速度による力の大きさを計測する力計測手段と、この力計測手段の計測結果に基づき演算部が前記サーボモータの回転の方向および速度を演算してサーボモータに駆動指令の信号を出す第１制御手段と、前記荷物が着地する際に前記サーボモータの正逆回転駆動のための入出力が安定となる安定条件を、演算部が非線形安定判別により求める第２制御手段と、前記力計測手段の計測値が閾値を下回った瞬間に前記第１制御手段から前記第２制御手段に切り替える切換え手段と、を具備したから、作業者は荷物の把持と操作とを同時に行うことができるため、作業者は荷物に対して良好な操作感覚を得ながら荷物を望む方向へ望む速度で昇降させることが可能になり、しかも、力計測手段の計測値が閾値を下回った瞬間に切換え手段が第１制御手段から第２制御手段に切り替えるため、荷物の接地時に荷物が上がる現象を防止することができるなどの優れた実用的効果を奏する。
【発明を実施するための最良の形態】
【００１０】
以下、天井走行クレ−ンに装着された巻揚げ機に本発明を適用した実施例について図面に基づき詳細に説明する。図１に示すように、本巻揚げ機においては、ロープ巻上げドラム（図示せず）の回転軸にこれを正逆回転させるサーボモータ１の出力軸が連結してあり、さらにロープ巻揚げドラムから巻き下げられたロープ２の下端にはロープ２の下端に掛かる力の大きさを計測する力計測手段としてのロードセル３が装着してある。ロードセル３の下端には昇降させる荷物Wがフック（図示せず）を介して掛止されている。また、前記ロードセル３にはこれの計測結果に基づき、前記サーボモータ１の回転の方向および速度を演算する演算部としてのコンピュータを含みかつコンピュータの演算結果に基づき前記サーボモータ１に駆動指令信号を出す制御手段４が電気的に接続してある。
【００１１】
そして、前記制御手段４のコンピュータは、前記ロードセル３の計測結果に基づき前記サーボモータ１の回転の方向および速度を演算してサーボモータ１に駆動指令の信号を出す第１制御手段としての機能と、前記荷物Wが着地する際に前記サーボモータ１の正逆駆動のための入出力が安定となる安定条件を、非線形安定判別としてのポポフの安定性理論により求める第２制御手段としての機能と、前記ロードセル３の計測値が閾値を下回った瞬間に前記第１制御手段から前記第２制御手段に切り替える切換え手段としての機能と、を備えている。
【００１２】
次に、このように構成した巻揚げ機の作用について説明する。ロープ２によって吊り下げられた荷物Wを作業者が望む方向である上方または下方へ押すと、ロードセル３がロープ２に掛かる力の大きさを計測して制御手段４に送信する。すると、巻揚げ機を介しての作業者による荷物Wの昇降を補助すべく、制御手段４のコンピュータにおいては下記に示す原理に基づき演算が行われる。
【００１３】
すなわち、基本的な原理としては、図２に示すように、作業者が荷物Wに操作力ｆｈ［Ｎ］を加えると、ロードセル３が力ｆｍ［Ｎ］を検出して、コントローラＫｆは制御入力ｕ（＝ｒv［ｍ/ｓ］指示速度）を生成し、この結果、巻揚げ機は命じられた速度vに従って荷物Wを上昇または下降させる。
ここで、ｍ［kg］は荷物Wの質量である。
なお、z軸方向は下向きを正とする。
【００１４】
上述の作用は以下に示す理論によって行われる。すなわち、
制御された荷物Wの昇降速度v＝ｒv＝Ｋｆｆｍ
（１）
の関係式が成り立つ。
ここで、ロードセル３が検出する力ｆｍは操作力ｆｈから荷物Wの加速度ｄv/ｄｔによる見かけの重量を差し引いたものであるから、
ｆｍ＝ｆｈ−ｍｄv/ｄｔ
（２）
となり、荷物Wは操作力ｆｈにより以下の伝達関数で表させる昇降速度を得る。
Ｒv（ｓ）＝Ｋｆ（ｓ）Fｈ（ｓ）/[1+msＫｆ（ｓ）] （３）
したがって、Ｋｆ（ｓ）のゲインを大きくすることにより、作業者は僅かな力で荷物を昇降させることができる。
ここで、sはラプラス演算子[1/s]、Fｈは操作力［Ｎ］である。
【００１５】
ところで、コントローラのパラメータとして、定常状態で、制御された荷物Wの昇降速度ｒv＝kpｆｈとなる、操作力から巻き上げ下げ速度の変換係数kp[（m /s/N）]を定義する。
ここで、kpは操作力1[N]当りの荷重の移動速度[m /s]を示す。
この変数はユーザの要求によって決定され、荷物Wの搬送速度を遅くし荷物Wの正確な位置決めを行いたい場合にはkpを小さく選び、わずかな力で高速に搬送したい場合はkpを大きく選ぶ。
【００１６】
また、巻揚げ機の共振周波数とそのピークゲインの変動を乗法変動として考慮すると下記の（４）式のように表わすことができる。
【００１７】
【数１】
【００１８】
ここで、Pチルダは実際の伝達関数、Pは式P（ｓ）=Fm(s) /Rv=msで表されるノーマルな伝達関数、Δは変動である。
【００１９】
また、図3にモデル化誤差とおもみ関数の見積もりの関係を示す。この図3において、左図細線がΔを見積もった伝達関数であるとすると、ロバスト性の安定化のために、|Wr|>|Δ｜となる重み関数Wrを
Wr=ωps /ωc(s+ωp) （５）
として、図３の左図太線を得る。
なお、この図３において、ωc[rad /s]は交差角周波数、ωp[rad /s]はΔピークとなる周波数である。
【００２０】
また、本発明のように、混合感度問題の制御のブック図は図４に示すようになる。そして、wからz間での伝達関数は本システムの相補感度関数で、ロバスト安定の条件は重み関数Wrを考慮して||Twz2||∞<1となる。
したがって、要求するコントローラは下記の（６）式で示すように定式化できる。
【００２１】
【数２】
【００２２】
ここで、w(=ｆｈ)からz1までの伝達関数Twz1は、操作力ｆｈと荷物速度ｒvの誤差に相当する。本演算手段の目的はステップ状の操作力に対し、定常速度kp[（m /s/N）]にできるだけ速く整定するコントローラＫｆを設計することであるから、下記の（７）式のように重み関数Wsを決定する。
Ws=1 /s （７）
【００２３】
なお、上記のコントローラＫｆは、下記のようにして得られる。
すなわち、重み関数Wr、Wsおよびノーマルな伝達関数P（ｓ）の次数の合計が２であるので、最適コントローラは２次となる。したがって、コントローラの構造を下記の（８）式のように表すことができる。
Ｋｆ＝kp(as2+bs+c) /(s2+2ζωns+ωn2) （８）
ここで、aおよびbは定数、cは変数、sはラプラス演算子[1/s]、ζは減衰係数、ωnは固有角周波数[rad/s]である。
【００２４】
また、ロバスト安定性の観点から、a= 0とする。
【００２５】
定常状態における式v＝kp fを満たすために以下のように変数cを得る。
【００２６】
【数３】
【００２７】
したがって、コントローラの解析解は次の方程式となる。
Ｋｆ＝kp（ｂｓ＋ωn2 ） /(s2+2ζωns+ωn2) （１０）
【００２８】
作業者の操作力ｆｈと荷物Wの速度の伝達関数である（３）式と、コントローラ（１０）式から、操作力ｆｈと荷物Wの速度の伝達関数を求めると、下記の（１１）式となる。
【００２９】
【数４】
【００３０】
ところで、従来のロバスト性と、即応性を考慮した巻揚げ機では、荷物Wを接地させようとした時に荷物Wが上下運動を起こすという、リミットサイクルの問題が生じる。図６は３０．３［ｋｇ］の荷物Wに１０［Ｎ］の力を加え続けた際の荷物Wの位置を示し、また破線はシミュレーション結果を示す。なお、実験に用いたパラメータを下記の表１に示す。また、位置は下方向を正としている。
【００３１】
【表１】
図６からは、リミットサイクルが周期１．８[s]、振幅２１．０[ｍｍ]であり、シミュレーションに近い結果となっていることが分かる。
【００３２】
このリミットサイクルの原因としては、荷物Wが接地した際にロープ２が緩み、ロードセル３の検出する値が急激に小さくなることが考えられる。コントローラＫｆでは重力による加重を差し引いているため、接地によりロードセル３の検出する値が小さくなると、制御手段４のコンピュータが上方向に力が働いたと判断し、巻揚げ機は巻上げ動作を行ってしまうからである。
【００３３】
図７はシミュレーションにおけるリミットサイクルの位相面図を示す。上半平面ではモータ１は巻下げ動作を行い、また下半平面では巻上げ動作を行っている。図７からは、初期条件に関係なく、一定の軌跡に収束することが分かる。
【００３４】
また、図８はｘ＝０おいて、接地が行われる状態をブロック図によって示したものである。
（１１）式と図８のブロック図から、閉ループシステムの運動方程式は、下記の（１２）式となる。
【００３５】
【数５】
ここで、ｘはロードセル３の位置、またｘ（ｎ）はｘのｎ回微分をそれぞれ示す。（１２）式により、巻揚げ機は３次の線形微分方程式と非線系部φ（ｘ）から成り立っている。非線系部φ（ｘ）はｘにより値が変化するステップ関数である。
また、操作入力と位置ｘの関係は下記の（１３）式となる。
Ｔｘｆｈ（ｓ）＝Ｔｖｆｈ（ｓ）／ｓ （１３）
【００３６】
次に、リミットサイクルを抑制するために、巻揚げ機が入出力安定となる安定条件を、ポポフの安定定理より求める。
ここで、非線系部は０≦ｘφ（ｘ）≦ｋ、φ（０）＝０を満たす。
なお、ポポフの安定定理とは、非線形要素がある場合に、システムの安定判別が安易に行われるものである。
【００３７】
この時ポポフの条件式は下記の（１４）式となる。
Ｒｅ［Ｔｘｆｈ（ｊω）］−ｑωＩｍ［Ｔｘｆｈ（ｊω）］+１／ｋ＞０ （１４）
ここでｑはｑ≧０の任意の値である。
この（１４）式から、複素平面上の実軸にＲｅ［Ｔｘｆｈ（ｊω）］、また虚軸上にωＩｍ［Ｔｘｆｈ（ｊω）］をとり、ωについて描いた軌跡がポポフ軌跡となる
【００３８】
図９（ａ）に定数ｂ＝０、また図９（ｂ）に定数ｂ＝３０の際の結果をそれぞれ示す。そして、傾きが１／ｑ（任意）で、実軸を−１／ｋの値で横切る直線をポポフ直線といい、図９にそれぞれ結果を示す。
ここで、ｋ01、ｋｂ1はそれぞれ定数ｂ＝０、定数ｂ＝３０におけるｋの最小値であり、ｋ02、ｋｂ2はそれぞれ定数ｂ＝０、定数ｂ＝３０におけるｋの最大値である。また−１／ｋ0２、−１／ｋｂ２、−１／ｋ01、−１／ｋｂ1はそれぞれ定数ｂ＝０、定数ｂ＝３０において、実軸の切片である。この時、ポポフ軌跡がポポフ直線より右側にあることが安定である十分条件となる。
【００３９】
図９（ａ）の定数ｂ＝０において、ポポフ軌跡がポポフ直線より右、すなわち、システムが安定でリミットサイクルが生じない十分条件は、ポポフ直線のＸ軸切片が−１／ｋ01から−１／ｋ0２の間に存在することである。すなわち、非線形部φ（ｘ）の傾きがｋ01からｋ0２の範囲に存在することがある。ただし、−１／ｋ01＝−∞であるから、ｋ01＝０である。
このように、システムの安定性は、非線形部φ（ｘ）の傾きｋに依存していることが分かる。
【００４０】
また、図１０において、黒の点線の領域は定数ｂ＝０における安定性を保障する領域となる。そのため、黒の点線の領域において、非線形部φ（ｘ）が実線で示すような挙動を示したとしても、システムは安定となる。
しかし、本巻揚げ機のような図８に示すシステムは、ｘ＝０において−ｍｇからｆｈへ変化し、変化の傾きｋ＝∞となる。そのため、定数ｂ＝０のシステムは不安定となり、リミットサイクルが生じた。
【００４１】
そこで、このシステムの安定条件を次のように求めた。すなわち、システムを安定化させる非線形部φ（ｘ）の傾きの最大値はｋｂ２＝∞なので、この時のポポラ直線の実軸の切片は原点となる。また、（１４）式の虚数部はω→∞の時、０に収束する。それに応じて、（１４）式の虚数部を、原点を除き負の値になるようにすると、図９（ｂ）のように、−１／ｋｂ２＝０、すなわちｋｂ２＝∞を満たすことができる。これらにより、安定性条件は下記の（１５）式として求められる。
【００４２】
【数６】
ここで、分母は常に正であるため、（１５）式を満たすには分子が負である必要がある。この条件は、任意のωに対し、ωn−２ζｂ≦０と表すことができる。
これにより、本巻揚げ機において、任意の操作力ｆｈ（ｔ）と重力ｍｇに対する安定性条件は、下記の（１６）式で得ることができる。
ｂ≧ωn／２ζ （１６）
【００４３】
例として、（１６）式の安定性条件を満たす、ｂ＝３０における結果を図９（ｂ）に示す。この結果から、−１／ｋｂ1＝−∞から−１／ｋｂ２＝０、すなわちｋｂ1＝０からｋｂ２＝∞の領域において、ポポフ軌跡はポポフ直線の右側に存在することが分かる。これにより、図１０の灰色の点線の領域内において、システムがいかなる挙動を示そうとも、システムは安定となり、リミットサイクルが抑制される。
【実験例】
【００４４】
図１に示す巻揚げ機を用いかつ上述の表１に示す条件により実験を行った。
ここで、リミットサイクルが生じする定数ｂ＝０のコントローラをＫ１、また安定条件の（１６）式を満たすコントローラをＫ２とした。それぞれの実験結果を図１１に位相面で示す。実験結果から、コントローラＫ２は、リミットサイクルを非常に早く収束させていることが分かる。
【００４５】
実験において、コントローラＫ２は、リミットサイクルを短時間で減衰させることができた。しかし、このコントローラＫ２は速応性が悪い問題が存在するため、効率的な荷物Wの搬送を妨げる。そこで、図１２に示すように、コントローラＫ１、Ｋ２を切り替えることにより、効率的な搬送と、リミットサイクルの抑制を行う。切換えはロードセル３の加重が閾値を下回った瞬間に行い、接地するまではコントローラＫ１を、また接地後はコントローラＫ２をそれぞれ用いるようにする。
【００４６】
図１３の上図がコントローラＫ１のみを用いた結果であり、また下図が切換え手段としてのスイッチングコントローラを用いた結果である。実験結果から、コントローラの切換え後はリミットサイクルが徐々に減衰し、やがて振幅０．２［ｍｍ］の振動を繰り返すようになる。実験結果においてミットサイクルの振幅は従来のそれの１００分の１に減衰されたことが分かる。而して、スイッチングコントローラにより、効率的な荷物Wの搬送と、リミットサイクルの抑制を同時に行うことが可能になった。
【図面の簡単な説明】
【００４７】
【図１】本発明を適用した実施例の模式図である。
【図２】図１に示す実施例に係る制御システムのブロック図である。
【図３】モデル化誤差と重く関数の見積もりとの関係を示すグラフである。
【図４】混合感度問題のブロック図である。
【図５】図１に示す実施例における高次の振動モードの例を示す模式図である。
【図６】リミットサイクルの観測例である。
【図７】シミュレーションにおけるリミットサイクルの位相面図である。
【図８】ｘ＝０おいて、接地が行われる状態をブロック図によって示したものである。
【図９】図９（ａ）に定数ｂ＝０、また図９（ｂ）に定数ｂ＝３０の際の結果をそれぞれ示す。
【図１０】非線形要素φ（ｘ）への入力と安定領域を示す図である。
【図１１】リミットサイクルの抑制を位相面で示して図（Ｋ１：リミットサイクルあり、Ｋ２：リミットサイクル抑制）である。
【図１２】スイッチングコントローラのブロック図である。
【図１３】Ｋ１からＫ２へ切り替えることにより、リミットサイクルを抑制した例である。
【符号の説明】
【００４８】
1 サーボモータ
2 ロープ
3 ロードセル
4 制御手段
【特許請求の範囲】
【請求項１】
サーボモータの正逆回転駆動によって巻上げ・巻下げされるロープにより昇降されまたは位置が維持される荷物に、作業者が操作力である力を加え、これにより、作業者が望む方向へ望む速度で当該荷物を昇降させるために前記サーボモータの回転駆動を制御するシステムであって、
前記ロープの下部に掛かる力であって作業者の操作力、荷物の質量および荷物の加速度による力の大きさを計測する力計測手段と、
この力計測手段の計測結果に基づき演算部が前記サーボモータの回転の方向および速度を演算してサーボモータに駆動指令の信号を出す第１制御手段と、
前記荷物が着地する際に前記サーボモータの正逆回転駆動のための入出力が安定となる安定条件を、演算部が非線形安定判別により求める第２制御手段と、
前記力計測手段の計測値が閾値を下回った瞬間に前記第１制御手段から前記第２制御手段に切り替える切換え手段と、
を具備したことを特徴とする昇降装置の制御システム。
【請求項２】
請求項１に記載の昇降装置の制御システムにおいて、
前記演算部には、 (式) Ｋｆ＝kp（ｂｓ＋ωn2 ） /(s2+2ζωns+ωn2)で表させるコントローラＫ１と、安定性の条件ｂ≧ωｎ／２ζを満たすコントローラＫ2とが記憶されていて、前記演算部は、前記力計測手段からの計測情報である、荷物の質量、作業者の操作力および荷物の加速度によって生じる力に基づき、前記コントローラーＫ1により最小時間で所定の昇降速度を演算して前記サーボモータに駆動指令を発信し、その後、前記力計測手段の計測値が閾値を下回った瞬間に、切換え手段からの指令により、前記コントローラＫ1からコントローラＫ2に切り換えることを特徴とする昇降装置の制御システム。
ただし、kpは変換係数 [（m /s/N）]、ωnは固有角周波数[rad/s]、sはラプラス演算子[1/s]、ζは減衰係数である。
【請求項３】
請求項１に記載の昇降装置の制御システムにおいて、
前記非線形安定判別はポポフの安定性理論であることを特徴とする昇降装置の制御システム。
【請求項１】
サーボモータの正逆回転駆動によって巻上げ・巻下げされるロープにより昇降されまたは位置が維持される荷物に、作業者が操作力である力を加え、これにより、作業者が望む方向へ望む速度で当該荷物を昇降させるために前記サーボモータの回転駆動を制御するシステムであって、
前記ロープの下部に掛かる力であって作業者の操作力、荷物の質量および荷物の加速度による力の大きさを計測する力計測手段と、
この力計測手段の計測結果に基づき演算部が前記サーボモータの回転の方向および速度を演算してサーボモータに駆動指令の信号を出す第１制御手段と、
前記荷物が着地する際に前記サーボモータの正逆回転駆動のための入出力が安定となる安定条件を、演算部が非線形安定判別により求める第２制御手段と、
前記力計測手段の計測値が閾値を下回った瞬間に前記第１制御手段から前記第２制御手段に切り替える切換え手段と、
を具備したことを特徴とする昇降装置の制御システム。
【請求項２】
請求項１に記載の昇降装置の制御システムにおいて、
前記演算部には、 (式) Ｋｆ＝kp（ｂｓ＋ωn2 ） /(s2+2ζωns+ωn2)で表させるコントローラＫ１と、安定性の条件ｂ≧ωｎ／２ζを満たすコントローラＫ2とが記憶されていて、前記演算部は、前記力計測手段からの計測情報である、荷物の質量、作業者の操作力および荷物の加速度によって生じる力に基づき、前記コントローラーＫ1により最小時間で所定の昇降速度を演算して前記サーボモータに駆動指令を発信し、その後、前記力計測手段の計測値が閾値を下回った瞬間に、切換え手段からの指令により、前記コントローラＫ1からコントローラＫ2に切り換えることを特徴とする昇降装置の制御システム。
ただし、kpは変換係数 [（m /s/N）]、ωnは固有角周波数[rad/s]、sはラプラス演算子[1/s]、ζは減衰係数である。
【請求項３】
請求項１に記載の昇降装置の制御システムにおいて、
前記非線形安定判別はポポフの安定性理論であることを特徴とする昇降装置の制御システム。
【図１】
【図２】
【図３】
【図４】
【図５】
【図６】
【図７】
【図８】
【図９】
【図１０】
【図１１】
【図１２】
【図１３】
【図２】
【図３】
【図４】
【図５】
【図６】
【図７】
【図８】
【図９】
【図１０】
【図１１】
【図１２】
【図１３】
【公開番号】特開２００７−３１４２９０（Ｐ２００７−３１４２９０Ａ）
【公開日】平成１９年１２月６日（２００７．１２．６）
【国際特許分類】
【出願番号】特願２００６−１４５２１２（Ｐ２００６−１４５２１２）
【出願日】平成１８年５月２５日（２００６．５．２５）
【出願人】（０００１９１００９）新東工業株式会社 (474)
【出願人】（３０４０２７３４９）国立大学法人豊橋技術科学大学 (391)
【公開日】平成１９年１２月６日（２００７．１２．６）
【国際特許分類】
【出願日】平成１８年５月２５日（２００６．５．２５）
【出願人】（０００１９１００９）新東工業株式会社 (474)
【出願人】（３０４０２７３４９）国立大学法人豊橋技術科学大学 (391)
[ Back to top ]