ab ca gs s ci a b () x() x() b c x=ax+bu y=cx+du...2020/07/03  · a p a p hq hq hq a s a p a p hq...

2
ㅮ⩏㈨ᩱ : 1 ไᚚᕤᏛ 13ᅇ䞉➨14(2020/7/03) ≧ែኚ 䛜┤᥋ฟ⬟䛺ሙ䠄䛛䛺䜚⌮ⓗ䠅 c b A () t x () ut () t x () yt K 䝣䜱䞊䝗䝞䝑䜽䝀䜲䞁 㞃䜜䛯䝰䞊䝗䛿↓䛧䠈 (A b)䠖ไᚚᑐ䠈(c A)䠖ほ ᑐ 䛸௬ᐃ䛩䜛 n x R ┤᥋䝣䜱䞊䝗䝞䝑䜽䛷䛿䝀䜲䞁䛂1䛴䛃䛷 䝅䝇䝔䝮䛶䛾ᴟ䛜⛣䛩䜛 ≧ែ䝣䜱䞊䝗䝞䝑䜽䛷䛿 nಶ䛾タィ䝟䝷䝯䞊䝍䠄ᴟ㓄⨨䠅䛜タᐃ䛷䛝䜛 䠄」⣲ᴟ䛻㛵䛧䛶䛿䠈ඹᙺゎ䜢ᑐ䛻䛧䛶タᐃ䛩䜛䠅 ┤᥋䝣䜱䞊䝗䝞䝑䜽 䠄䝀䜲䞁⿵ൾ䠋Pไᚚ䠅 ㅮ⩏㈨ᩱ : 2 y t ut x = Ax + bu ไᚚᑐ㇟ 䠄ఏ㐩㛵䠋≧ែ᪉⛬ᘧ䠅 ไᚚ㔞 䠄ฟ㔞䠅 d(t) : ไᚚධຊ (᧯స㔞) d G s Ᏻᐃ⿵ൾჾ ไᚚ೫ᕪ et rt ┠ᶆ y=cx + du 䠄䝁䞁䝖䝻䞊䝷䠅 ᐃᖖ೫ᕪ⿵ൾჾ s G s ᕠఏ㐩㛵 䛾䝀䜲䞁䜢 0䛛䜙↓㝈䜎䛷ኚ䛥䛫䛯䛻䛭䛾䝅䝇䝔䝮䛾ᴟ䠄≉ᛶ᰿䠅䛜 」⣲ᖹ㠃䛻ᥥ䛟㌶㊧䜢᰿㌶㊧䛸䛔䛖 d s p Gs G sG sG s 䜢䛳䛶䠈䝁䞁䝖䝻䞊䝷䛾㐪䛔䛻䜘䜛䝅䝇䝔䝮䛾≉ᛶ䠄ᛂ⟅䠅䜢⪃䛘䜛 c d s G s G sG s 1 p G s s c I A b 䝣䜱䞊䝗䝞䝑䜽⣔䛾タィᵓ⠏ 䠄䝃䞊䝪⣔䛾ᵓᡂ䠅 ㅮ⩏㈨ᩱ : 3 y t ut x = Ax + bu ไᚚᑐ㇟ 䠄ఏ㐩㛵䠋≧ែ᪉⛬ᘧ䠅 ไᚚ㔞 䠄ฟ㔞䠅 d(t) : ไᚚධຊ (᧯స㔞) d G s Ᏻᐃ⿵ൾჾ ไᚚ೫ᕪ et rt ┠ᶆ y=cx + du 䠄䝁䞁䝖䝻䞊䝷䠅 ᐃᖖ೫ᕪ⿵ൾჾ s G s c d s G s G sG s 1 p G s s c I A b 1 K Gs ss 5 2 Ks Gs ss 2 1 3 4 5 Ks Gs s s s s 1 5 K Gs ss s 䝣䜱䞊䝗䝞䝑䜽⣔䛾タィᵓ⠏ 䠄䝃䞊䝪⣔䛾ᵓᡂ䠅 ㅮ⩏㈨ᩱ : 4 1 2 0 1 0 0 u c c § · § · ¨ ¸ ¨ ¸ © ¹ © ¹ x= x+ T T § · ¨ ¸ © ¹ x= t T T t T 2 f 1 c 1 f ≧ែ㔞 䜢䛸䜛䠄ș䛿ᅇ㌿ゅᗘ䠅 1 2 1 2 1 1 0 1 0 0 p s c s s c c ss c § · § · ¨ ¸ ¨ ¸ © ¹ © ¹ G = 1 0 y = x ≧ែ䝣䜱䞊䝗䝞䝑䜽䛸PIไᚚ 䠄䝃䞊䝪䝰䞊䝍䛾⨨ไᚚ⣔䠅 ┤ὶ䝃䞊䝪䝰䞊䝍䛾≧ែ᪉⛬ᘧ ㅮ⩏㈨ᩱ : 5 1 K Gs ss 5 1 2 Gs Ks ss § · ¨ ¸ ¨ ¸ © ¹ 2 1 1 3 4 5 s s Ks Gs s s § · ¨ ¸ ¨ ¸ © ¹ 5 1 1 K Gs s ss § · ¨ ¸ ¨ ¸ © ¹ ⿵ൾჾ䛾ᴟ䞉㞽Ⅼ䛸ไᚚຠᯝ䛸䛾㛵ಀ ㅮ⩏㈨ᩱ : 6 ⿵ൾჾ Pไᚚ ᐃᖖ⨨೫ᕪ䜢ᑠ䛥䛟䛩䜛䠊䝀䜲䞁䜢䛝䛟䛧䛩䛞䜛䛸Ᏻᐃᛶຎ I ไᚚ ᐃᖖ≉ᛶ䜢ᨵၿ䠊Ᏻᐃᛶ䛿ᨵၿ䛥䜜䛺䛔 䠄┦㐜䜜䛻┦ᙜ䠅 Dไᚚ Ᏻᐃᛶ䜢ᨵၿ䠊ᐃᖖ⨨೫ᕪ䛿0䛻䛷䛝䛺䛔 䠄┦㐍䜏䛻┦ᙜ䠅 ไᚚᑐ㇟ K p : ẚ䝀䜲䞁 T I : ✚ศ㛫 T D : ᚤศ㛫 p K 1 I Ts D Ts c s § · ¨ ¸ © ¹ 1 1 p D I G =K Ts Ts ᐇ⌧䛻䛿䠈ᚤศ 1 D D Ts Ts J 䜢䛖 ẚไᚚproportional✚ศไᚚintegralᚤศไᚚderivativePID Controler 䠄ẚ䠈✚ศ䠈ᚤศไᚚ䠅 ㅮ⩏㈨ᩱ : 7 ൾ๓ 䝀䜲䞁⿵ൾ ┦㐍䜏⿵ൾ ┦㐜䜜⿵ൾ 䛭䜜䛮䜜䛾⿵ൾ䛾≉ᛶ䜢Ⰻ䛟⌮ゎ䛩䜛 Pไᚚ䠅 Dไᚚ䠅 Iไᚚ䠅 ไᚚჾ䠄⿵ൾჾ䠅タィ䜎䛸䜑䠄࿘Ἴ䛸㛫ᛂ⟅䠅 ㅮ⩏㈨ᩱ : 8 y t ut x = Ax + bu y=cx + du ไᚚᑐ㇟ 䠄ఏ㐩㛵䠋≧ែ᪉⛬ᘧ䠅 ไᚚ㔞 䠄ฟ㔞䠅 ไᚚධຊ ⿵ൾჾ 䠄䝁䞁䝖䝻䞊䝷䠅 ไᚚ೫ᕪ et rt ┠ᶆ ┤⿵ൾჾ䜢⏝䛔䛶䠈㛢䝹䞊䝥⣔䛾ᴟ䜢௵ព䛻タᐃ䛷䛝䜛 c G s nn R u A A b c 䝅䝇䝔䝮 䛿ไᚚ䞉ほ 䛸䛩䜛 䛾䠈ไᚚᑐ㇟䛾ఏ㐩㛵䛿 1 1 1 0 1 1 1 0 n n p n n n h s hs h G s s a s as a " " nḟ䛾䝅䝇䝔䝮 ┤⿵ൾჾ䛾ఏ㐩㛵䜢 1 2 1 2 1 0 1 2 2 1 0 n n n n d n n n q s q s qs q G s s p s ps p " " 䛸䛚䛟 ኚ䠖n-1+n = 2n-1n-1ḟ䛾䝅䝇䝔䝮䠅 㛢䝹䞊䝥⣔䛾ఏ㐩㛵䠖 2n1 䠙 ┤⿵ൾჾ䛾ኚ䛾 ┤⿵ൾჾ 䠄ⓗ⿵ൾჾ䠅 d(t) : ㅮ⩏㈨ᩱ : 9 2 2 1 0 3 2 2 1 0 p Ns hs hs h G s Ds s as as a u x = Ax + b y = cx y t ut et d G s 33 R u A 2 2 1 0 2 1 0 d Qs qs qs q G s P s s ps p 䝅䝇䝔䝮䛾ఏ㐩㛵 ┤⿵ൾჾ䠖䠄2ḟ䠅 1 d p d p GG NsQs Gs GG DsPs NsQs 䜘䜚 ≉ᛶ᪉⛬ᘧ䛾᰿䠖 3 2 2 2 2 2 1 0 1 0 2 1 0 2 1 0 0 s as as a s ps p hs hs h qs qs q 5 4 3 1 2 2 2 2 1 0 1 2 2 1 1 s p hq a s ap p hq hq a s 䛣䜜䛜タᐃ䛧䛯䛔ᴟ䜢᰿䛸䛩䜛᪉⛬ᘧ 5 4 3 2 4 3 2 1 0 0 s ds ds ds ds d 䛸ಀ䜢ẚ㍑䛩䜛 2 1 1 2 0 0 2 1 1 2 0 0 0 1 1 0 0 1 1 0 0 0 0 0 ap ap hq hq hq a s ap ap hq hq s ap hq ┤⿵ൾჾ 䠄ィ⟬䠅 ㅮ⩏㈨ᩱ : 10 1 1 p G s ss 0 1 0 0 1 1 u § · § · ¨ ¸ ¨ ¸ © ¹ © ¹ x= x+ 1 0 y = x y t ut et d G s 㛢䝹䞊䝥䛾ᴟ䜢 3 3 4 j r 䛻タᐃ䛩䜛┤⿵ൾჾ䜢タィ 0 1 1 0 1 1 0 1 C O § · § · ¨ ¸ ¨ ¸ © ¹ © ¹ U U 䝅䝇䝔䝮䛿 䜘䜚ไᚚ䞉ほ 䛷ఏ㐩㛵䛿 ┤⿵ൾჾ䜢1ḟ䛷ᵓᡂ䠖 1 0 0 d qs q G s s p 㛢䝹䞊䝥⣔䛾≉ᛶ᪉⛬ᘧ䠖 1 0 d p G sG s 2 3 2 0 1 0 0 0 1 0 1 0 s s s p qs q s p s p q s q タᐃ䛧䛯䛔ᴟ䜢᰿䛸䛩䜛᪉⛬ᘧ 3 2 3 3 3 3 4 10 42 72 s j s j s s s s ಀ䜢ẚ㍑䛧䛶 33 72 9 d s G s s ┤⿵ൾჾ 䠄ィ⟬䠅

Upload: others

Post on 04-Sep-2020

0 views

Category:

Documents


0 download

TRANSCRIPT

Page 1: Ab cA Gs s cI A b () x() x() b c x=Ax+bu y=cx+du...2020/07/03  · a p a p hq hq hq a s a p a p hq hq s a p hq11 20 02 11 20 0 01 1001 10 0000 %$ 4/õ ~ þH 0£'ì [H 1n*O2( q: 10

: 113 14 (2020/7/03)

cb

A

( )tx( )u t ( )tx ( )y t

K

(A b) (c A)

nx R1

n

P: 2

y tu t x = Ax + bu

d(t) :

( )dG se tr t

y = cx+ dusG s

0d s pG s G s G s G s

c d sG s G s G s 1pG s sc I A b

: 3

y tu t x = Ax + bu

d(t) :

( )dG se tr t

y = cx+ dusG s

c d sG s G s G s 1pG s sc I A b

1KG s

s s52

K sG s

s s2

1 3 4 5K s

G ss s s s1 5

KG ss s s

: 4

1 2

0 1 00

uc c

x = x + x =

t t

2f

1c

1f1

2

1 2 1

1 01 0

0p

s css c c s s c

G =

1 0y = x

PI

: 5

1KG s

s s

5 12

G s K ss s

2 11 34 5 s s

K sG s

s s

51

1KG s

s s s

: 6

PID 0

Kp : TI :TD :

pK

1

IT s

DT s

c s 11p DI

G = K T sT s

1D

D

T sT s

proportional

integral

derivative

PID Controler

: 7

P D I

: 8

y tu t x = Ax + buy = cx+ du

e tr tcG s

n nRAA b c 1

1 1 01

1 1 0

nn

p n nn

h s h s hG ss a s a s a

n

1 21 2 1 0

1 22 1 0

n nn n

d n nn

q s q s q s qG ss p s p s p n-1+n = 2n-1n-1

2n 1

d(t) :

: 9

22 1 0

3 22 1 0

p

N s h s h s hG sD s s a s a s a

ux = Ax + by = cx

y tu te tdG s

3 3RA

22 1 02

1 0d

Q s q s q s qG sP s s p s p

2

1d p

d p

G G N s Q sG s

G G D s P s N s Q s3 2 2 2 2

2 1 0 1 0 2 1 0 2 1 0 0s a s a s a s p s p h s h s h q s q s q5 4 3

1 2 2 2 2 1 0 1 2 2 1 1s p h q a s a p p h q h q a s

5 4 3 24 3 2 1 0 0s d s d s d s d s d

21 1 2 0 0 2 1 1 2 0 0 0 1 1 0 0 1 1 0 0 0 0 0a p a p h q h q h q a s a p a p h q h q s a p h q

: 10

11pG s

s s

0 1 00 1 1

ux = x +

1 0y = x

y tu te tdG s 3 3 4j

0 1 1 01 1 0 1C OU U

1 1 0

0d

q s qG ss p

1 0d pG s G s2 3 2

0 1 0 0 0 1 01 0s s s p q s q s p s p q s q3 23 3 3 3 4 10 42 72s j s j s s s s

33 729d

sG ss

Page 2: Ab cA Gs s cI A b () x() x() b c x=Ax+bu y=cx+du...2020/07/03  · a p a p hq hq hq a s a p a p hq hq s a p hq11 20 02 11 20 0 01 1001 10 0000 %$ 4/õ ~ þH 0£'ì [H 1n*O2( q: 10

: 11

y tu t x = Ax + bu

d(t) :

( )dG se tr t

y = cx+ dusG s

c d sG s G s G s 1pG s sc I A b

: 12

1/sl

1/sl

l y tu t

( )dG se tr t

sG s pG s1sc I A b

r(t) e(t)1

1 p s d

E s R sG G G

0lims

e sE s

: 13

0

1) aR ss 0 0

1lim lim1 1 0s s

a ae sE s sG s G

2) 2

aR ss

20 00

1lim lim1 lims s

s

a ae sE s sG s sG s

3) 3

aR ss

3 20 00

1lim lim1 lims s

s

a ae sE s sG s s G s

0 0lims

sG s

2

0lims

s G s

0G

0

1/sl

1/sl

l

: 14

0

1

1 !lar t t

l laR ss

(l 1)

pcc p

c p

N sN s N sG s G s G s

D s D s D s

1 1

1

11

m ll l l

m

kka D aE sG s D N s s p s p s s

1 0lk k

pcl

DD a DD N s D N

ll 0

cc l

NGs

1/sl

1/sl

l

: 15

0

1

2

11 p

eK

0e

0e 0e

e e

e1

v

eK

1

a

eK

Kp :

Kv :

Ka :

Steady-state Response : 16

y tu t x = Ax + bu

d(t) :

dG se tr t

y = cx+ dusG s

d s pG s G s G s G s

F

1-1) 1-2)2)

: 17

y tu tdG se tr t

sG s

1-1) 1-2)

11 1 0

11 1 0

nn

n nn

h s h s hs a s a s a

1 21 2 1 0

1 22 1 0

n l n ln l n l

d n l n ln l

q s q s q s qG ss p s p s p

pG s

1lsdG s

Gc(s)

: 18

y tu te tr t

2) 1 2

1 2 1 01 2

2 1 0

n nn n

c l n nn

q s q s q s qG ss s p s p s p

pG s

1c dlG s G s

s

11 1 0

11 1 0

nn

n nn

h s h s hs a s a s a

: 19

y tu te tr t

sG s

1-1) 1-2)

11 2s s

pG s

1s

dG s

22 1 02

1 0

q s q s qs p s p

2) y tu te tr t

pG sdG s sG s

11 2s s

22 1 0

0

q s q s qs s p

: 20

y tu t x = Ax + bu

d(t) :

e tr t

y = cx+ duf

1z tlz t

1k

lkl

l

1 1

2 2

0 1 0 0

10 0 0l l

z zz z u

z z

0

0

x xA b

= +

c

u(t) z1 11

l ss

c I A b

11 l

l

zu k k

z

x

f x f