摩擦と特性変動を補償したクレーンの制御—外乱オブザーバとゲインスケジューリング—
M2008MM034 安江弘嗣
指導教員：高見勲1

はじめに世の中に存在する機械システムの大半は何らかの非線形性要素が存在する．そのため，線形モデルに基づく設計方法で制御系を設計すると，シミュレーションでは良好な制御が出来たとしても実用となると期待通りに制御できず，何度も試験を繰り返して調整しなければならない．しかし，試験を繰り返す事はコストがかかるため，回避すべきである．そのため，非線形要素を含めた精度の良いシミュレータ及び制御系の設計は重要である．
建設現場や港，工場などで広く用いられてクレーンでも非線形要素が制御性能の劣化を招き，クレーン自体の破損や横転，吊り荷の落下などの事故に繋がり，甚大な被害が生じてしまう．そのような事故を防ぐ点においても，非線形要素を考慮に入れた制御系の設計は有効であり，クレーンに対するモデリングや制御に関する研究が盛んに行われている[1][2]．特に近年では特性変動に関する研究が多く見られ，計算量の削減や保守性の緩和に力を入れている[3][4]．
また，産業用ロボットや工作機械などに代表されるメカトロニック機器ではボールねじなどの駆動系に存在する様々な非線形要素が位置決め精度の劣化に影響を及ぼしている[5]．特に非線形摩擦は位置決め精度の劣化の要因の一つであり，位置決め精度向上のために非線形摩擦をモデリングし，補償する研究が行われている[6][7]．
本研究で用いるクレーンにも次のような非線形要素が制御性能の劣化を招くと考えられる．

•

滑車・レール間に発生する摩擦

2ジブシステムの制御

ジブシステムは，滑車を移動させて吊り荷を運搬するシステムである．ジブシステムの概略図を図1に示す．
y0xj
RailJib motorx0xp

m trolley

BeltPayload
γ

ypmp

lp

Trolleyxp (t)：x方向の位置
yp (t)：y 方向の位置
xj (t)：滑車の位置
γ(t) ：ワイヤの角度
mp ：吊り荷の質量
lp ：ワイヤの長さ

図 1: Jib system2.1 非線形摩擦を考慮したシミュレータの設計
摩擦をシミュレーション上で再現する事により，シミュレーションの精度向上を図る．ラグランジュの運動方程式により，摩擦を含めた微分方程式を導出すると下式のようになる．
ẍj (t) = −−γ̈(t) = −−2
mp rj·pg
rj·p Kj·dγ(t) +uj (t)HjHj2rj·p(Fj·c (t) + fj·v ẋj (t))
Hj

(1)

2
2
2g(mt rj·p+ mp rj·p+ Jψ Kg·j)
rj·p Kj·dγ(t) +uj (t)
Hj lp
Hj lp
2
rj·p(Fj·c (t) + fj·v ẋj (t))
Hj lp

22
Hj = mt rj·p+ Jψ Kg·j(2)(3)• 滑車や吊り荷の位置の移動による特性変動
uj (t)：ジブモータの入力電流
そこで，本研究では摩擦を再現したシミュレータの設
mt ：滑車の質量，g ：重力加速度計を行い，制御系設計の際に上記2つの項目を補償する事
rj·p ：ジブモータのギヤの半径を考える．滑車や吊り荷の移動はセンサーによって観測Jψ ：ジブモータの等価慣性モーメント可能なため，その情報を基にゲインスケジューリングを
Kj·d ：ジブモータのトルク定数行う事で特性変動を補償し，観測できない摩擦について
Fj·c (t)：摩擦力，fj·v ：粘性摩擦係数
は外乱オブザーバを用いて推定し，その影響を相殺する
こ こ で ，最 大 静 止 摩 擦 力 をFj·static ，動 摩 擦 力 を事により制御性能の向上を図る．
Fj·sliding として，u(t)を滑車に加えられた力とすると，また，クレーンは吊り荷を吊るしているケーブルの巻き F (t)は下式で与えられる．
j·c
上げを行うペイロードシステム，滑車の並進運動を行う(sgn(ẋj (t))Fj·sliding ẋj (t) 6= 0
ジブシステム，タワーアームの旋回を行うタワーシステ F (t) =u(t)ẋj (t) = 0, |u(t)| < Fj·static
j·c
ムの3システムにより，3次元空間内で吊り荷を任意の位
sgn(uj (t))Fj·staticẋj (t) = 0, |u(t)| ≥ Fj·static
置に運搬する事のできる実験用設備であり，本研究では(4)3システムに対してそれぞれ異なった制御器を用いる[8]．
上記の方程式で表わされるモデルの挙動をシミュレーショ
さらに，本研究では摩擦と特性変動の両方が制御性能ンした．得られた結果と実験との比較を図2，3に示す．シに影響するジブシステムと特性変動のみが影響すると考ミュレーション，実験共に入力の大きさは振幅0.8[A]，周えられるタワーシステムの2システムに着目する．研究対
波数2[rad/s]の正弦波である．図2，3より，シミュレーショ象外のペイロードシステムに関しては最適レギュレータン結果と実験結果がほぼ一致している事から，シミュレーに基づいて設計した制御器を用いる事とする．
ション上で摩擦が再現できたと考えられる．

ぐため，0.2[m/s]の速さで変化するランプ状の信号を与えた．
図6では，吊り荷の振れが発散してしまうため実験開始から約9秒で実験を中止した．図7では，制御器をスケジューリングする事により，吊り荷の振動を抑えている事がわかる．

図 2: Comparison of Jib po- 図 3: Comparison of Jib velocitysition

2.2

ゲインスケジューリング（ＧＳ）による特性変動の補償

ゲインスケジューリングは，制御系の動作範囲の変化に応じてあらかじめ定められたコントローラパラメータの変更テーブルに従って，制御器を修正する制御方法である．制御対象が変動するパラメータを実時間で測定する事が出来る場合，その情報を生かして制御系を設計する事でより良い制御性能を得る事が期待できる．ジブシ
ステムを動かす際，ペイロードシステムも同時に動かすと，ワイヤの長さlp が変動し，ジブシステムの特性が変動してしまう．そこで，lp の変動を0.3 ≤ lp ≤ 0.8と設定し，その最小，最大を考え2つの端点を設ける．各端点でLQRにより設計した端点制御器を内挿し，制御器のスケジューリングを行う事によりジブシステムの特性変動を補償する．制御パラメータベクトルK(lp )（4行1列）は下式で与えられる．

K(lp ) =2X

αi (lp )Ki

(5)

i=1

ここで，K1 ，K2 はそれぞれlp を0.3，0.8と固定して設計した制御パラメータベクトル（4行1列）であり，αi は下式で与えられる．

α1 =
2.3

0.8 − lp
lp − 0.3，
α2 =0.8 − 0.3
0.8 − 0.3

シミュレーション及び実験(6)

図 4: Simulation results1

図 5: Simulation results2

図 6: Experimental results1 図 7: Experimental results2

2.4

外乱オブザーバ（ＤＯＢ）による摩擦補償

外乱オブザーバはシステムに侵入する外乱をシステムの状態の一部として推定するものである．そのため，新たにセンサを設けることなく，クレーン制御用の既に設けられているセンサを利用するため，コスト等の実用的観点からも有利となる制御手法である．本研究では，ジブシステムの線形モデルに対し，非線形な摩擦を外乱として捉え，外乱オブザーバにより補償する．外乱オブザー
バは下式に基づいて構成する．

x̂˙ j·e (t) = Aj·e x̂j·e (t) + Bj·e uj (t) − Gj εj (t)(7)

ŷj (t) = Cj·e x̂j·e (t), εj (t) = ŷj (t) − yj (t)(8)
線形化したモデルに対し，滑車の目標値を0[m]から ここで，y (t)は吊り荷の位置を表し，x̂ (t), ŷ (t)はそれ
jj·e
j0.5[m]へステップ状に変化させると同時に，lp を0.07[m/s] ぞれ，xj·e (t), yj (t)の推定値であり，»–»–»–の速さで0.8[m]から0.3[m]まで変動させた際のシミュレーx̂j (t)Aj DjBjx̂j·e (t) =，Aj·e =
Bj·e =ション結果を図4，5に示す．各図において破線は目標値ŵj (t)000T応答であり，実線は吊り荷の位置を表している．図4では，
Cj·e = [ Cj 0 ] ，
Dj = [ 0 0 1 0 ]始動点lp = 0.8で設計した制御器のみで制御しようとしである．また，Aj ,Bj ,Cj はそれぞれジブシステムのシた結果，発散してしまっている．図5では，制御器をスケステム行列，駆動行列，出力行列で，wj (t)はシステムにジューリングする事により，発散やオーバーシュートす侵入する外乱ベクトル，Gj はオブザーバゲインである．
る事なく目標値に追従している事がわかる．
拡張系で推定した外乱を電流に変換し，フィードバック次に，制御器をlp = 0.8と固定して設計した制御器を用することで，外乱の影響をモデルから除去する．その際，いて行った実験結果を図6に，制御器をスケジューリングフィードバックする電流uj·d (t)は，して行った実験結果を図7に示す．各図において破線が目Hj
標値応答，実線が吊り荷の位置を示している．
ŵj (t)(9)
uj·d (t) =K
rj·d j·pulley
尚，シミュレーションでは目標値信号をステップ状で与えたが，実験では急激な旋回による吊り荷の振れを防 である．

2.5

シミュレーション及び実験2

2.6

シミュレーション及び実験3

外乱オブザーバを最適レギュレータ理論（LQR）に基摩擦を含めた非線形モデルのジブシステムに対してゲづいて設計した制御器に付加した．シミュレーション及 インスケジューリングのみを適用した場合と，ゲインスケ
び実験結果を下図に示す．尚，今回は外乱オブザーバの ジューリングと外乱オブザーバを併用した場合についてみの有効性を確認するため，シミュレーション，実験共 のシミュレーション及び実験を行った．ゲインスケジューに制御器はスケジューリングせず，lp は0.8[m]と固定し， リングと外乱オブザーバを併用した際のブロック線図を0.2[m/s]の速さで変化するランプ状の信号を与えた．
図12に示し，シミュレーション結果を図13，14に，実験
図8は滑車を0.5[m]移動させた時のシミュレーション結 結果を図15，16に示す．その際，lp を0.07[m/s]の速さで果である．外乱オブザーバ適用前を破線，適用後を実線 0.8[m]から0.3[m]まで変動した．図13〜16で破線は目標値で表す．適用後では，外乱オブザーバで摩擦の影響を相 応答であり，実線は吊り荷の位置を表している．図13で殺する事により，目標値へ追従している事がわかる．図9 は摩擦モデルの影響により，吊り荷の揺れを抑えていなは図8の結果を100[s]まで観察したものである．外乱オブ いが，図14ではその現象が改善されている事がわかる．
ザーバ適用前ではリミットサイクルが起きてしまってい実験においても，図15では吊り荷の揺れを抑えていなるが，適用後には改善されている事がわかる．図10は図 いが，図16ではその現象が改善されており，ゲインスケ
8で用いた制御器により実験を行った結果である．外乱オ ジューリングと外乱オブザーバを併用する事により実験にブザーバ適用前を破線，適用後を実線で表す．実験でも外 おいても特性変動と摩擦の影響を抑えている事がわかる．
乱オブザーバの効果により目標値に追従している事がわかる．また，図8のシミュレーション結果とほぼ同等の結uDOB
果を出力出来ている事から，2.1節で設計したシミュレー
xx+++タの有効性を再確認できた．図11は図8の実線におけるシyrkBC∫∫+u+
ミュレーション上の摩擦と図10の実線における外乱推定
Aとの比較の図である．シミュレーション上の摩擦を破線，外乱オブザーバによる外乱推定を実線で示す．シミュレー
GSションでは，目標値付近で摩擦力の急激な変化が見られるが，これは滑車が何度か一時的に静止した状態になる事で動摩擦から静止摩擦に切り替わった事が原因で発生
図 12: Block diagram of GS and DOBした現象である．逆に，実験では滑車が完全には停止せずに動き続けたため，そのような現象が発生しなったと考えられる．摩擦は実験機の置かれている部屋の室温や経年劣化によって微妙に変化するので図11のような波形の違いが表れる事は十分に起こり得る事である．その点を除けば外乱オブザーバが摩擦を推定出来ており，良好な結果が得られたと考えられる．
j⋅d•jjjj⋅5jjjjj

図 13: Simulation results 1 図 14: Simulation results 2(GS and DOB)(GS)

図 8: Simulation results 1

図 9: Simulation results 2

図 15: Experimental results 1 図 16: Experimental results 2(GS)(GS and DOB)
図 10: Experimental results 図 11: Experimental results
fo Jib positionof estimated friction

3

タワーシステムの制御響を与えない事を確認するため，シミュレーション，実験共に同じ0.2[rad/s]の速さで変化するランプ状の信号を与えた．ゲインを変動させた事により，吊り荷の振動を抑えている事がわかる．

タワーシステムの概略図を図17，18に示す．また，タワーシステムでは摩擦の影響がジブジステムほど制御系に影響を与えないので，特性変動のみを扱う．
zyl p sinαl j sinθl j cosθθylj

mplj
βαx

lp

φ=θ-βθ

l p cosαx0

図 19: Simulation results 図 20: Experimental resultsm p l p sinα

図 17: Tower system

図 18: Top view of the towersystem
4

θ：タワーの旋回角度（反時計回りを正）α：吊り荷の振れ角（鉛直方向から時計回りを正）β ：x − y 平面に射影したタワーと吊り荷の成す角
lj :タワーの軸から滑車の重心までの距離
3.1

ゲインスケジューリング（ＧＳ）

タワーシステムではlp だけでなくlj も影響するので，両方の変動の最小，最大の組み合わせにより4つの端点を設け，各端点でLQRにより設計した制御器を2次元平面上で内挿することで，ゲインスケジューリングを行う．lp ，ljをそれぞれスケジューリングパラメータとし，有界閉集合Φを下式のように設定し，制御器をスケジューリングした．
2

Φ = {l ∈ R | 0.3 ≤ lp ≤ 0.8, 0.1 ≤ lj ≤ 0.6} (10)
また，タワーシステムの微分方程式は下式で表される．

mp gljKtα(t) +ut (t)JθJθ¡¢
g mp lj2 + JθKt ljα̈(t) = −α(t) −ut (t)Jθ lpJθ lp
θ̈(t) =(11)(12)ut (t)：タワーモータの入力電流
Kt :タワーモータのトルク定数
Jθ ：タワーの慣性モーメント3.2

シミュレーション及び実験結果

シミュレーション，実験共に吊り荷の旋回角度を0度から90度まで旋回した．また，旋回と同時にワイヤを0.07[m/s]の速さで0.8[m]から0.3[m]まで巻き上げ，滑車を2.6 節で用いた制御器により0.1[m]から0.6[m]まで移動させた．シミュレーション結果を図19に，実験結果を図20に示す．図19，20において，破線は目標値応答であり，細線は始動位置（lp = 0.8[m]，lj = 0.1[m]）に固定して設計した制御器で，太線はゲインスケジューリングによってそれぞれシミュレーション及び実験を行った結果である．尚，摩擦の影響を考慮せずにモデリングを行っても制御系に影おわりに本研究では，クレーンに存在する非線形摩擦をシミュレーション上で再現する事によりシミュレーションの精度向上を実現した．そして，クレーンの制御系に影響を及ぼす摩擦と特性変動との2つの非線形要素についての補償を行った．ジブシステムに存在する摩擦を外乱オブザーバで補償すると同時に，特性変動に対して最適レギュレータ理論に基づいて設計した端点制御器をスケジューリングする事により，線形モデルを用いて設計した制御器をそのまま搭載した状態で，制御系が有効に働く事をシミュレーション及び実験によって示した．また，タワーシステムの制御器もスケジューリングする事により，クレーン全体に対して良好な制御結果を得る事が出来た．

参考文献[1] Y．S．Kim，K．S．Hong，S．K．Sul：Anti-Sway
Control of Container Cranes，International Journalof Control Autometion and Systems，2-4，435/449，（2004）[2] P．Apkarian，P．Gahinet and G．Becker：SelfScheduled H∞ Control of Liner Parameter-varing
Systems：A Design Example，Automatica，31-9，1251/1261（1995）[3] 高木，西村：タワークレーンの吊り荷ケーブル長変動に対する起伏・旋回方向のゲインスケジュールド分
散制御，日本機械学会論文集Ｃ編，69-680，914/922（2003）[4] 青木，高見，大石： 2乗和多項式に基づくクレーンのゲインスケジュールド制御，計測自動制御学会論文集，45-4，208/214 (2009)[5] 前田，川福，岩崎，平井：非線形摩擦のモデル化と摩擦補償による位置決め制御系の高精度化，電学論D，126-6，732/740（2006）[6] 山元，岩崎，伊藤，松井：ボールねじ駆動テーブルシ
ステムの機械特性変動に対する位置決め精度の解析と性能向上，電学論D，128-6，839/848（2008）[7] 浅海，藤本：多段可変自然長ばねモデルと外乱オブザーバに基づくボールねじステージの非線形摩擦補償，平成20年電気学会産業計測制御研究会，IIC-08144，65/70，（2008）[8] 高木，西村：タワークレーンの起伏・旋回の分散制御，
日本機械学会論文集Ｃ編，65-640，4692/4699（1999）