Regulator liniowo kwadratowy na przykładzie wahadła odwróconego kwiecień 2012
Sterowanie Teoria Przykład wahadła na wózku
Dany jest system dynamiczny postaci: ẋ = f (x, u) (1) y = h(x) (2) Naszym zadaniem jest wyznaczyć takie u(t), by układ znalazł się w pożądanym stanie x r. Układ regulacji nadążnej - x r (t) jest nieznaną z góry funkcją czasu.
Wyzwania:
Wyzwania: szum w układzie - sprzężenie zwrotne (zamknięty system regulacji)
Wyzwania: szum w układzie - sprzężenie zwrotne (zamknięty system regulacji) szum w pomiarach - filtracja (np. filtr Kalmana)
Wyzwania: szum w układzie - sprzężenie zwrotne (zamknięty system regulacji) szum w pomiarach - filtracja (np. filtr Kalmana) niepełna informacja o stanie - obserwatory (np. obserwator Luenbergera)
Wyzwania: szum w układzie - sprzężenie zwrotne (zamknięty system regulacji) szum w pomiarach - filtracja (np. filtr Kalmana) niepełna informacja o stanie - obserwatory (np. obserwator Luenbergera) optymalizacja sprzężenia zwrotnego -
Sprzężenie zwrotne Sprzężeniem od stanu nazywamy realizację sygnału sterującego według następującej formuły: u = w(x) (3) Sprzężeniem od wyjścia nazywamy realizację sygnału sterującego według następującej formuły: u = v(y) (4)
Dany jest liniowy system ciągły opisywany równaniem: ẋ = Ax + Bu (5) Optymalizujemy całkowy, kwadratowy wskaźnik jakości: J = dt (x T Qx + u T Ru) (6) 0 Q jest dodatnio półokreślona, R dodatnio określona.
Rozwiązanie: u = Kx (7) K = R 1 B T P (8) Macierz P należy wyznaczyć z algebraicznego równania Riccatiego: A T P + PA PBR 1 B T P + Q = 0; (9)
Metody wyprowadzenia: Mnożniki Lagrange a + rachunek wariacyjny Programowanie dynamiczne
Równania ruchu i linearyzacja Klasyczny przykład zastosowania - wahadło odwrócone
Równania ruchu i linearyzacja Lagranżian L = M + m ẋ 2 + ml 2 2 2 α2 + ml αẋ cos α + mgl cos α (10) Stąd otrzymujemy równania: { (M + m)ẍ + ml α cos α = ml α 2 sin α + u cos αẍ + l α = g sin α (11)
Równania ruchu i linearyzacja Kładziemy dla prostoty M = m = g = l = 1 i rozwiązujemy liniowy układ równań algebraicznych względem drugich pochodnych: { ẍ = 1 2 cos 2 α (u + α2 sin α + sin α cos α) α = 1 (12) (u cos α + α sin α cos α + 2 sin α) 2 cos 2 α
Równania ruchu i linearyzacja Kładziemy dla prostoty M = m = g = l = 1 i rozwiązujemy liniowy układ równań algebraicznych względem drugich pochodnych: { ẍ = 1 2 cos 2 α (u + α2 sin α + sin α cos α) α = 1 (12) (u cos α + α sin α cos α + 2 sin α) 2 cos 2 α System dynamiczny nieliniowy!
Równania ruchu i linearyzacja Zapisujemy w postaci czterowymiarowej i linearyzujemy w górnym punkcie równowagi: ẋ v φ ω = 0 1 0 0 0 0 1 0 0 0 0 1 0 2 0 0 x v φ ω +u 0 1 0 1 (13) Na podstawie tak wyznaczonych macierzy A i B obliczamy macierz (w naszym wypadku wektor) regulatora proporcjonalnego K
Równania ruchu i linearyzacja Parametry regulatora wyznaczone ręcznie :
Równania ruchu i linearyzacja Parametry regulatora wyznaczone ręcznie :
Równania ruchu i linearyzacja Parametry regulatora wyznaczone ręcznie :
Równania ruchu i linearyzacja :
Równania ruchu i linearyzacja :
Równania ruchu i linearyzacja :
Równania ruchu i linearyzacja Baseny atrakcji:
Równania ruchu i linearyzacja Baseny atrakcji:
Równania ruchu i linearyzacja Baseny atrakcji:
Literatura: [1] H. Górecki; Optymalizacja i sterowanie systemów dynamicznych (2006, ISBN 8374640219) [2] Stephen Boyd, lecture slides (http://www.stanford.edu/class/ee363/lectures.html)