Algorytmy sterowania

Z Wikipedii

Algorytmy sterowania opracowane zostały w celu jak najdokładniejszego sterowania położeniem i orientacją efektora w manipulatorze robotycznym. Mogą one być używane także w przypadku robotów mobilnych. Wymagana jest znajomość dynamiki robota oraz zadanej trajektorii.

Spis treści 1 Historia 2 Całkowita znajomość modelu 2.1 Dokładna linearyzacja 2.2 Slotine i Li 3 Częściowa nieznajomość modelu 3.1 Adaptacyjne wersje algorytmów przy całkowitej znajomości 3.2 Algorytm ślizgowy 3.3 Algorytm uniwersalny 4 Całkowita nieznajomość modelu 4.1 PD 4.2 Lambda-śledzenie 5 Cel 6 Dobieranie nastaw 6.1 Kryterium jakości 6.2 Przesterowania 7 Uwagi

[edytuj] Historia

Początkowo do sterowania robotem stosowano regulatory PID. Jednak bardzo szybko okazało się, że wyniki były dużo gorsze od oczekiwanych (głównie za sprawą nieliniowości). Badania wykazały, że skuteczniejszy jest regulator PD (pozbawiony części całkującej). Sposób ten przetrwał do dzisiaj i stosowany jest w przypadku robotów, dla których nie został wyznaczony model matematyczny (tzn. nie jest znany wzór na dynamikę robota). Ostatecznie opracowane algorytmy podzielone zostały na trzy grupy opisujące stan wiedzy o robocie.

[edytuj] Całkowita znajomość modelu

[edytuj] Dokładna linearyzacja

1.Model:

M(q)q^'' + C(q,q^')q^' + D(q) = u

2.Sterowanie:

u = M(q)v + C(q,q^')q^' + D(q), gdzie:

v - własne sterowanie

3.Równanie zamkniętej pętli:

M ^{− 1}(q)M(q)(q^'' − v) = 0

q^'' = v

4.Własności:

- globalny

- eksponencjalnie stabilny (patrz metody Lapunowa)

- n lokalnych sterowań PD z korekcją

[edytuj] Slotine i Li

1.Model:

M(q)q^'' + C(q,q^')q^' + D(q) = u

2.Sterowanie:

e = q − q_d - błąd śledzenia położenia

q_r - trajektoria referencyjna (nie trzeba znać)

- zmienna ślizgu

K_d - macierz, która spełnia warunek K_ds > 0

3.Równanie zamkniętej pętli:

Ms^' = − Cs − K_ds

4.Własności:

- globalny

- asymptotycznie stabilny

[edytuj] Częściowa nieznajomość modelu

[edytuj] Adaptacyjne wersje algorytmów przy całkowitej znajomości

[edytuj] Algorytm ślizgowy

1.Model:

M(q,θ)q^'' + C(q,q^',θ)q^' + D(q,θ) + d(t) = Y(q,q^',q^',q^'')θ + d(t)

θ - nieznane, stałe parametry, można oszacować pomiędzy θ_min, a θ_max

d(t) - nieznane ograniczone zakłócenie, braki w modelu

2.Sterowanie:

- K,K_d - macierze diagonalne, > 0

- θ_est nie zależy od czasu i zawiera się w przedziale [θ_min,θ_max]

- nie ma identyfikatora

- sterowanie jest nieciągłe

3.Równanie zamkniętej pętli:

Yθ + d = Y_rθ_est − K_ds − Ksgn(s)

Yθ − Y_rθ = Y_rθ_est − Y_rθ − K_ds − Ksgn(s) − d

= Ms^' + Cs

Ms^' = Y_r(θ_est − θ) − K_ds − Ksgn(s) − d − Cs

[edytuj] Algorytm uniwersalny

[edytuj] Całkowita nieznajomość modelu

[edytuj] PD

Jest to podstawowy sposób sterowania robotem przy całkowitej nieznajomości modelu. Przyjmuje się, że robot to układ z wejściem u i wyjściem x. Wartość x porównuje się z wartością zadaną, a uzyskany wynik e podawany przez poprzez układ PD jako nowe sterowanie u. Nie stosuje się członu całkującego, ponieważ komplikuje on układ i nie wnosi poprawy w sterowaniu. Ostatnim etapem jest ustawienie odpowiednio dużej wartości P oraz D. Przy odpowiednio dużych wartościach jesteśmy w stanie uzyskać dość mały błąd. Niestety nie jesteśmy w stanie określić wartości tego błędu.

[edytuj] Lambda-śledzenie

Algorytm ten podobny jest do PD, z tą różnicą, że błąd podawany jest poprzez układ (moduł) wzmacniający K. Przyjmuje się, że moduł ten ma zmienną wartość wzmocnienia. Przy czym wartość wzmocnienia może ulec jedynie zwiększeniu. Następuje to w momencie, gdy błąd przekroczy zadany poziom λ. Metoda ta pozwala oszacować wartość błędu z jakim porusza się robot.

[edytuj] Cel

Celem w.w. algorytmów jest śledzenie zadanej tajektorii q_d(t), to jest takie działanie, aby e(t) = q(t) − q_d(t) − > 0. Część algorytmów ma już zaszyty w sobie wzór błędu (ew. także wzór na jego pochodną), inne wymagają podania dodatkowych informacji.

W przypadku algorytmu dokładnej linearyzacji przyjmujemy, że:

.

Po podstawieniu do wzoru:

q^'' = v

otrzymujemy:

,

,

e^'' = − K_de^' − K_pe,

gdzie:

- korekcja.

Na koniec należy zapewnić postać macierzy K_d,K_p taką, że spełnione zostaną warunki Hurwitza. Warunki te spełniają np. macierze diagonalne, w których wszystkie składniki na głównej diagonali są większe od zera.

Nazwy macierzy dobrane zostały nieprzypadkowo, ponieważ K_d występuje przy pochodnej błędu, a K_p przy błędzie. W ten sposób otrzymaliśmy sterownik PD.

[edytuj] Dobieranie nastaw

Jest to ostatni punkt w trakcie wykonywania symulacji komputerowych. Polega on na określeniu wartości, jakie muszą przyjąć odpowiednie macierze. W tym celu przeprowadza się szereg symulacji dla kilku różnych wartości. Po określeniu wpływu poszczególnych macierzy oraz przedziału w którym uzyskuje się oczekiwaną jakość sterowania (kryterium jakości) można wykonać dodatkowe obliczenia zawarte w otrzymanym przedziale, aby otrzymać wynik zbliżony do optymalnego.

[edytuj] Kryterium jakości

Kryterium to przedstawia sumaryczny błąd od początku do końca sterowania i zapisywane jest jako:

, gdzie:

| e | - moduł błędu (suma różnic pomiędzy kolejnymi współrzędnymi).

Mniejsza wartość E oznacza, że robot szybciej zaczyna poruszać się zgodnie z ruchem punktu na trajektorii. Jednakże nie oznacza ona, że z punktu widzenia osoby obsługującej manipulator (lub robot mobilny) nastawy z nią związane są najlepsze. Wynika to z faktu, iż mogą pojawić się dodatkowe przesterowania.

[edytuj] Przesterowania

W automatyce obserwowane jest zjawisko przesterowania polegające na tym, że wyjście układu przekracza zadaną wartość, a następnie zaczyna maleć aż osiągnie wartość ustaloną. Podobnie jest także w przypadku algorytmów sterowania robotów manipulacyjnych i mobilnych. Wyróżnić można dwa zachowania odbiegające od oczekiwanych:

1. przekroczenie trajektorii - robot mija krzywą wyznaczoną przez trajektorię i zaczyna poruszać się po jej drugiej stronie
2. oscylacja wokół trajektorii - robot zaczyna poruszać się "po gasnącej sinusoidzie", w której wartością średnią jest trajektoria

Ad.1 - Pojawia się, gdy jest zbyt duża wartość macierzy stojącej przy wartości błędu (e).

Ad.2 - Pojawia się, gdy jest zbyt duża wartość macierzy stojącej przy szybkości zmian błędu (e^').

Obydwa zachowania są nie do przyjęcia, gdy robot ma się poruszać np. wzdłuż ściany (mógłby w takim przypadku zderzać się ze ścianą). W przeciwnym przypadku należy określić czy takie zachowanie robota nie będzie przeszkadzało w wykonywaniu zadania.

[edytuj] Uwagi

Wszystkie pochodne występujące we wzorach wyliczane są względem czasu tj. .