01 12 13 12 13 01
1 1 1 1
12 12 02 12 23 23 02
2 2 2 2
13 23 03 13 23 03
3 3 3 3
0 0 0 0
k k k k k k
m m m m
k k k k k
k
m m m m
k k k k k k
m m m m
A
21 5,5 , 22 5, 4
A I A 0
2 T
f K Kp n 0 0 0 0 0 0 0 0 B
f
0 0 0 0 0 1 0 0 0 0 0 0 0 0 0 0 0 1
C
た，構造的誤差を用いる場合，周波数重み関数を用いずにパラメータ変動を用 いて制御性能を決定することができる．ここでは，式(3-36)で示した誤差行列を 用いると，以下のような式が成立する．
1
a a
1
b b
1
c c
1
d D d
A I AI B I BI C I CI D I I
(6-21)
図6-16はこれらを考慮したブロック線図となる．これをH∞制御理論の制御問題 に置き換えて考えてみると，Aは3.2.2の外乱抑圧問題で説明した周波数重み として，Bは相補感度関数として，Cは準相補感度関数として考えることが できる．これは，コントローラ作成時にはロバスト性を持たせるだけではなく，
制御性能を決定する重みとして用いることができる．
Fig.6-16 Brock diagram of structured uncertainly
また，作成するH∞制御器は以下の目標を達成するように設計する．
1. 目標値への即応性及び定常偏差の改善
2. 制御対象に変動が生じた場合でも安定性を保つロバスト性
3. 搬送システムに衝撃が加わったことを想定した静止状態での外乱 4. 無視した高次モードに対するロバスト安定性
6.6.1 一般化プラントの作成
構造的誤差を用いる場合，重み関数を用いずにパラメータの変動を用いて制御 性能を決定する．ここでは，式(3.36)で示した誤差行列を用いる. ここで，このIa1，
1 b
I ，Ic1，Id1を外乱wに作用する重みとして，Ia，Ib，Ic，Idを抑えたい制御 量zに作用する重みとして配置し，このwからzまでの一巡伝達関数が式(3.6) を持たすことで内部安定性を保つことができる．また，目標値への追従性とス ピルオーバ回避のために，肩関節と目標値との誤差にローパスフィルタを，制 御入力にハイパスフィルタをそれぞれ配置する．ここで，一般化プラントを作 成する際に，設計モデルは変動モデルのパラメータを用いる．また，静止状態 の外乱は，各質点にインパルス応答に対する外乱とした．外乱の大きさは，変 動モデルの等価質量の逆数を一般化プラントに組み込んだ．
図6-17に構造的誤差を考慮した変動モデルの運動と振動を制御するためのH
∞ロバストサーボ系のブロック線図を示し，その状態方程式と出力方程式を以下 に示す．
Fig.6-17 The block diagram of robust servo taking account of structured uncertainty
(6-21)
a a f
b b
c c f
d d
sp sp sp sp cp2 f sp
se se se se
u
u
r u
Z AI X Z BI Z CI X Z CI
Z C X D C X D Z C X D
f f cu Id d Isp sp Ise se r
y C X D w w w
ここで，
sp se
p1 f
f p2
I 1 I 0
(2,:)
0 0 0 0 0 0 0 0 1
C A
C C
これらを一般化プラントにすると，以下のようになる．ここで，本研究で用い る制御系は厳密にプロパーなものとし，D11=0とする．
(6-23)
T
f sp se
T
a b c d sp se r
X X X X
W W W W W W W
1 1
f a b f
1z sp cp2 sp 1z sp 2z
se se
0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0
A 0 0 I I B
A B C A 0 B B B 0
0 0 A B
a
b c
1z 12z
d
p2 sp sp
se se
0 0 0
0 0 0
0 0 0
0 0 0
0 0
0 0
AI
BI
C CI D
DI C D C
C D
c1 d1 f2z f 21z 22Z
0 0 I I 0 0 0
, 0
0 0 0 0 0 0 1
C C 0 0 D D D
6.6.2 誤差パラメータの決定
ここでは，誤差関数の選定方法について説明する．本事例では，ノミナルモデ ルと変動モデルの2つを制御対象とし，低次元化物理モデル作成法を用いてそ れぞれ物理モデルを作成した物理モデルに変化が生じるのは，システム行列A， 入力行列B，出力行列C，直達行列Dである．本研究では，それらをシステム 誤差行列A，入力誤差行列B，出力誤差行列C，直達誤差行列⊿Dと呼ぶ．
これらの誤差行列はノミナルモデルから変動モデルの差であり，以下のように なる．
no min al fluctuated no min al fluctuated no min al fluctuated no min al fluctuated
A A A
B B B
C C C
D D D
(6-24)
6.6.3 重み関数の選定
重み関数は，非構造的誤差を考慮したハイパスフィルタと定常偏差を考慮した 積分特性を持ったローパスフィルタを用いた．ここで，ハイパスフィルタは2 つの制御対象の無視した高次モードである３次モードの両方に対して包含する ように設計する．図6-18に作成した重み関数の伝達特性線図を示す．
Fig.6-18 Weight function of control taking account of structured uncertainly
式(3-74)を用いた3次のローパスフィルタの伝達関数は以下のとおりである．
2 sp sp
sp 3 2 2 2
sp sp sp sp sp sp
6
sp sp sp
W s k
s 2 s 2 s
1.5 2 rad / s 0.90 10 k 300000
2次のハイパスフィルタの伝達関数は以下のとおりである．
2 2
se se1 se1 se1
se 2 2
se2 se2 se2
se1 se2 se1
se2 se
k s 2 s
W s s 2 s
15 2 rad / s 50 2 rad / s 0.96 0.26 k 2500