Számítógépvezérelt irányítás és szabályozás elmélete (Bevezetés a rendszer- és irányításelméletbe, Computer Controlled Systems) 9. előadás Szederkényi Gábor Pázmány Péter Katolikus Egyetem Információs Technológiai Kar e-mail: szederkenyi@itk.ppke.hu PPKE-ITK, 2013. április 25. Szederkényi G. (PPKE) Computer Controlled Systems PPKE-ITK 1 / 36
Tartalom 1 Optimális szabályozás: problémafelvetés 2 Variációszámítási alapok 3 Az LQR probléma megoldása 4 Példák Szederkényi G. (PPKE) Computer Controlled Systems PPKE-ITK 2 / 36
1 Optimális szabályozás: problémafelvetés 2 Variációszámítási alapok 3 Az LQR probléma megoldása 4 Példák Szederkényi G. (PPKE) Computer Controlled Systems PPKE-ITK 3 / 36
LQR: problémafelvetés Adott egy (MIMO) LTI állapottér-modell ẋ(t) = Ax(t)+Bu(t), x(0) = x 0 y(t) = Cx(t) egy funkcionál (szabályozási cél) J(x,u) = 1 2 T ahol Q T = Q, Q > 0 és R T = R, R > 0. 0 [x T (t)qx(t)+u T (t)ru(t)]dt Kiszámítandó beavatkozás: {u(t), t [0, T]}, amellyel J minimális az állapottér-modell megoldásai mentén (megszorítás) Szederkényi G. (PPKE) Computer Controlled Systems PPKE-ITK 4 / 36
1 Optimális szabályozás: problémafelvetés 2 Variációszámítási alapok 3 Az LQR probléma megoldása 4 Példák Szederkényi G. (PPKE) Computer Controlled Systems PPKE-ITK 5 / 36
Variációszámítás 1 Probléma: Minimalizáljuk u-ra: J(x,u) = T 0 F(x,u,t)dt feltétel: ẋ = f(x,u,t). Megoldás: vektor Lagrange-multiplikátorokkal λ(.) J(x,ẋ,u) = T Hamilton-függvény H = F +λ T f. 0 [F(x,u,t) +λ T (t)(f(x,u,t) ẋ)]dt J = T 0 [H λ T ẋ]dt Szederkényi G. (PPKE) Computer Controlled Systems PPKE-ITK 6 / 36
Variációszámítás 2 ẋ parciális integrálással elmininálható [λ T x] T 0 = T 0 T λ T x + λ T ẋ 0 ekkor J = T 0 [H λt ẋ]dt-ból kapjuk: x és u variációja: J = [λ T x] T 0 + T 0 [H + λ T x]dt x(t) x(α,t) = x(t)+αη(t) u(t) u(β,t) = u(t)+βγ(t) Szederkényi G. (PPKE) Computer Controlled Systems PPKE-ITK 7 / 36
Euler-Lagrange egyenletek 1 Kritériumfüggvény: I(α,β) = [λ T (t)x(α,t)] T 0 + + T 0 x-hez és u-hoz I szélsőértéke tartozik, ha [H(x(α,t),u(β,t),t) + λ T (t)x(α,t)]dt I T α = I β = I α = 0, I β = 0 0 T 0 [ ] H x + λ T (t) η(t)dt = 0 H u γ(t)dt Szederkényi G. (PPKE) Computer Controlled Systems PPKE-ITK 8 / 36
Euler-Lagrange egyenletek 2 Euler-Lagrange egyenletek H x + λ T = 0 H u = 0 Szederkényi G. (PPKE) Computer Controlled Systems PPKE-ITK 9 / 36
1 Optimális szabályozás: problémafelvetés 2 Variációszámítási alapok 3 Az LQR probléma megoldása 4 Példák Szederkényi G. (PPKE) Computer Controlled Systems PPKE-ITK 10 / 36
LQR Euler-Lagrange egyenletek Euler-Lagrange egyenletek a H = F +λ T f Hamilton-függvénnyel: H x + λ T = 0, H u = 0 LTI rendszerekre: f = Ax + Bu F = 1 2 (xt Qx + u T Ru) H = 1 2 (xt Qx + u T Ru)+λ T (Ax + Bu) LQR Euler-Lagrange egyenletek: x (xt Qx) = 2x T Q λ T + x T Q +λ T A = 0, λ T (T) = 0 u T R +λ T B = 0 Szederkényi G. (PPKE) Computer Controlled Systems PPKE-ITK 11 / 36
Állapotok és társ-állapotok dinamikája Átrendezett Euler-Lagrange egyenletek λ+qx + A T λ = 0 u = R 1 B T λ Állapotegyenlet: ẋ = Ax(t)+Bu(t), x(0) = x 0 Mátrix-vektor alak [ ] [ ẋ(t) A BR = 1 B T λ(t) Q A T ][ x(t) λ(t) ], x(0) = x 0 λ(t) = 0 Rendszerdinamika + Hammerstein társ-állapot diff.e. Szederkényi G. (PPKE) Computer Controlled Systems PPKE-ITK 12 / 36
LQR: irányítható&megfigyelhető eset Lemma * Ha (A, B) irányítható, akkor λ(t) = K(t)x(t), K(t) R n n A módosított állapot- és társ-állapot-egyenletek λ+qx + A T λ = 0 Kx + Kẋ = A T Kx Qx u = R 1 B T λ u = R 1 B T Kx ẋ = Ax + Bu ẋ = Ax BR 1 B T Kx Kx + K[A BR 1 B T K]x + A T Kx + Qx = 0 x(t). Mátrix Riccati differenciálegyenlet K(t)-re K + KA+A T K KBR 1 B T K + Q = 0 Szederkényi G. (PPKE) Computer Controlled Systems PPKE-ITK 13 / 36
Stacionárius eset Speciális eset: stacionárius megoldás T J = 0 (x T Qx + u T Ru)dt lim K(t) = K i.e. K = 0 t Control Algebraic Riccati Equation (CARE) KA+A T K KBR 1 B T K + Q = 0 Tétel: (R. Kalman) Ha (A,B) irányítható, akkor a CARE-nak egyértelmű pozitív definit szimmetrikus megoldása van (K). Szederkényi G. (PPKE) Computer Controlled Systems PPKE-ITK 14 / 36
LQR és tulajdonságai Megoldás: lineáris statikus teljes állapotvisszacsatolás u 0 (t) = R 1 B T Kx(t) = Gx(t) ahol G = R 1 B T K. Zárt kör dinamikája ẋ = Ax BR 1 B T Kx = (A BG)x, x(0) = x 0 A zárt kör tulajdonságai a zárt kör aszimptotikusan stabil függetlenül A,B,C,R,Q értékétől, azaz Re λ i (A BG) < 0, i = 1,2,...,n a zárt kör pólusai Q és R megválasztásától függnek Szederkényi G. (PPKE) Computer Controlled Systems PPKE-ITK 15 / 36
1 Optimális szabályozás: problémafelvetés 2 Variációszámítási alapok 3 Az LQR probléma megoldása 4 Példák Szederkényi G. (PPKE) Computer Controlled Systems PPKE-ITK 16 / 36
1. Példa: az RLC-kör szabályozása Rendszer: RLC kör. A nyitott kör (u = 0V ) válasza x(0) = [1 1] T kezdeti érték esetén. (Pólusok: 5 ± 8.6603i) 1.5 i [A] u C [V] 1 0.5 0 0.5 1 0 0.5 1 1.5 idö [s] Szederkényi G. (PPKE) Computer Controlled Systems PPKE-ITK 17 / 36
1. Példa: az RLC-kör szabályozása Q = [ 1 0 0 1 ], R = 0.1 Visszacsatolási erősítés: G = [2.9539, 2.3166] A zárt kör (A BG) pólusai: λ 1 = 27.4616, λ 2 = 12.0773 Szederkényi G. (PPKE) Computer Controlled Systems PPKE-ITK 18 / 36
1. Példa: az RLC-kör szabályozása A zárt kör működése 1.2 1 i [A] u C [V] 0.8 0.6 0.4 0.2 0 0.2 0.4 0.6 0.8 0 0.5 1 1.5 idö [s] Szederkényi G. (PPKE) Computer Controlled Systems PPKE-ITK 19 / 36
1. Példa: az RLC-kör szabályozása A szabályozó által generált bemenet 1 u be 0 1 feszültség [V] 2 3 4 5 6 0 0.5 1 1.5 idö [s] Szederkényi G. (PPKE) Computer Controlled Systems PPKE-ITK 20 / 36
1. Példa: az RLC-kör szabályozása Q = [ 1 0 0 1 ], R = 1 Visszacsatolási erősítés: G = [0.6818, 0.4142] A zárt kör (A BG) pólusai: λ 1,2 = 8.409±8.409i Szederkényi G. (PPKE) Computer Controlled Systems PPKE-ITK 21 / 36
1. Példa: az RLC-kör szabályozása A zárt kör működése 1.2 1 i [A] u C [V] 0.8 0.6 0.4 0.2 0 0.2 0.4 0.6 0.8 0 0.5 1 1.5 idö [s] Szederkényi G. (PPKE) Computer Controlled Systems PPKE-ITK 22 / 36
1. Példa: az RLC-kör szabályozása A szabályozó által generált bemenet 0.2 u be 0 0.2 feszültség [V] 0.4 0.6 0.8 1 1.2 0 0.5 1 1.5 idö [s] Szederkényi G. (PPKE) Computer Controlled Systems PPKE-ITK 23 / 36
1. Példa: az RLC-kör szabályozása Q = [ 1 0 0 1 ], R = 10 Visszacsatolási erősítés: G = [0.0944, 0.0488] A zárt kör (A BG) pólusai: λ 1,2 = 5.4718±8.6568i Szederkényi G. (PPKE) Computer Controlled Systems PPKE-ITK 24 / 36
1. Példa: az RLC-kör szabályozása A zárt kör működése 1.5 i [A] u C [V] 1 0.5 0 0.5 1 0 0.5 1 1.5 idö [s] Szederkényi G. (PPKE) Computer Controlled Systems PPKE-ITK 25 / 36
1. Példa: az RLC-kör szabályozása A szabályozó által generált bemenet 0.04 u be 0.02 0 0.02 feszültség [V] 0.04 0.06 0.08 0.1 0.12 0.14 0.16 0 0.5 1 1.5 idö [s] Szederkényi G. (PPKE) Computer Controlled Systems PPKE-ITK 26 / 36
2. Példa: a szeparációs elv alkalmazása Szabályozandó rendszer: egyenáramú motor Paraméterek: J tehetetlenségi nyomaték 0.01 kg m 2 /s 2 b csillapítási tényező 0.1 Nm s K elektromotoros erő tényező 0.1127 Nm/A R ellenállás 1 ohm L induktivitás 0.5 H állapotváltozók, bemenet, kimenet: x 1 = θ szögsebesség [rad/s] x 2 = i átfolyó áram [A] u bemenő feszültség [V] y = x 1 Szederkényi G. (PPKE) Computer Controlled Systems PPKE-ITK 27 / 36
2. Példa: a szeparációs elv alkalmazása Állapottér-modell: [ ẋ1 ẋ 2 ] [ b = J K L y = [ 1 0 ][ x 1 x 2 K J R L ] ][ x1 x 2 ] +[ 0 1 L ] u Pólusok: -9.669, -2.331 Szederkényi G. (PPKE) Computer Controlled Systems PPKE-ITK 28 / 36
2. Példa: a szeparációs elv alkalmazása A szabályozatlan rendszer működése u(t) = 5V bemenetre: 5 x 1 x 2 4.5 4 x 3.5 3 2.5 2 0 0.5 1 1.5 2 2.5 3 3.5 4 idö [s] Szederkényi G. (PPKE) Computer Controlled Systems PPKE-ITK 29 / 36
2. Példa: a szeparációs elv alkalmazása Állapotmegfigyelő tervezése Az állapotmegfigyelő előírt pólusai: -15, -16 ("gyorsabbak" az eredeti rendszer pólusainál) Az L mátrix értéke: [ ] 19 L = 15.923 Szederkényi G. (PPKE) Computer Controlled Systems PPKE-ITK 30 / 36
2. Példa: a szeparációs elv alkalmazása Stabilizáló állapotvisszacsatolás tervezése A tervezendő LQR szabályozó paraméterei: [ ] 100 0 Q =, R = 1 0 10 A kapott visszacsatolási erősítés: G = [ 3.807 6.342 ] Szederkényi G. (PPKE) Computer Controlled Systems PPKE-ITK 31 / 36
2. Példa: a szeparációs elv alkalmazása Az állapotbecslővel kombinált stabilizáló visszacsatolás viselkedése A szabályozó által generált bementi feszültség: 13 12 11 10 9 u [V] 8 7 6 5 4 0 0.5 1 1.5 2 2.5 3 3.5 4 idö [s] Szederkényi G. (PPKE) Computer Controlled Systems PPKE-ITK 32 / 36
2. Példa: a szeparációs elv alkalmazása A visszacsatolt rendszer állapotváltozói 5.5 5 4.5 4 x 3.5 x 1 x 2 3 2.5 2 0 0.5 1 1.5 2 2.5 3 3.5 4 idö [s] Szederkényi G. (PPKE) Computer Controlled Systems PPKE-ITK 33 / 36
2. Példa: a szeparációs elv alkalmazása Az állapotbecslő működése 5.5 5 4.5 x 4 3.5 3 x 1 (tényleges) x 1 (becsült) x 2 (tényleges) x 2 (becsült) 2.5 2 1.5 1 0 0.1 0.2 0.3 0.4 0.5 0.6 idö [s] Szederkényi G. (PPKE) Computer Controlled Systems PPKE-ITK 34 / 36
3. Példa: Inverz inga szabályozása A súlyozómátrixok (tervezési paraméterek): A kiszámított visszacsatolási erősítés: Q = I 4 4, R = 1 G = [ 1 23.227878 2.1084534 7.8899369 ] A zárt rendszer sajátértékei: λ = 13.169677 1.0463076 + 0.3589175i 1.0463076 0.3589175i 3.1028591 Szederkényi G. (PPKE) Computer Controlled Systems PPKE-ITK 35 / 36
3. Példa: Inverz inga szabályozása A szabályozó működése: ipend_lq_1.avi Szederkényi G. (PPKE) Computer Controlled Systems PPKE-ITK 36 / 36