Algorytm odsprzęgania wej-wyj

Z Wikipedii

Algorytm odsprzęgania wej-wyj to algorytm, którego zadaniem jest poprowadzenie efektora manipulatora robotycznego tak, aby poruszał się on po linii prostej. Przedstawiany on jest na pokazach, gdy zadaniem robota jest umycie szyby przy pomocy odpowiedniego narzędzia.

Dlaczego ten algorytm jest taki ważny ? Przede wszystkim należy zwrócić uwagę na budowę manipulatorów. Głównie są one skonstruowane z elementów obrotowych. Dlatego też ich ruchy bez użycia algorytmu odsprzęgania przypominają bardziej łuki zamiast linii prostych. W takim przypadku nacisk efektora będzie różny dla punktów leżących na linii jego ruchu i możliwe jest zbicie szyby.

Spis treści 1 Warunki stosowania 2 Wzory 3 Sprzężenie zwrotne linearyzujące 4 Śledzenie trajektorii 5 Uwagi 6 Bibliografia

[edytuj] Warunki stosowania

1. Manipulator nie może być redundantny, tzn. nie może być np. manipulatorem typu "trąba słonia"
2. Liczba wyjść, którymi chcemy sterować jest równa liczbie wejść sterujących
3. Konfiguracje realizujące ruch nie mogą być osobliwe

[edytuj] Wzory

Przekształcamy model matematyczny manipulatora do postaci:

q'' = − M ^{− 1}Cq' − M ^{− 1}G + M ^{− 1}u,

i wprowadzamy dwie nowe współrzędne x,ξ:

x = q

ξ = q'.

Współrzędne te różniczkujemy po czasie otrzymując:

x' = ξ

ξ' = − M ^{− 1}Cξ − M ^{− 1}G + M ^{− 1}u = F + Hu (zapis uproszczający dalsze wory)

H = M ^{− 1}

Bierzemy i-te wyjście:

y_i = k_i(q) = k_i(x)

Uzyskany wzór na pochodną x wstawiamy do wzoru na i-te wyjście, a następnie liczymy druga pochodną y po t. W ten sposób uzyskujemy:

Po raz kolejny upraszczamy zapis wzoru:

Otrzymaliśmy wzór na jedno wyjście. Jeżeli policzymy kolejne wyjścia otrzymamy dokładnie taki sam wzór, a zatem ogólny wzór na wyjście układu będzie przedstawiał się następująco:

y'' = P(x,ξ) + J(x)H(x)u,

gdzie:

J(x) to jakobian,

Układ jest sterowalny, gdy macierz pochodząca z iloczynu J i H jest odwracalna ().

[edytuj] Sprzężenie zwrotne linearyzujące

Jako sygnał sterujący podajemy do układu sygnał w postaci: u = M(x)J(x) ^{− 1}[ − P + v], gdzie v to nowe wejście. Dzięki temu uzyskujemy układ o wzorze: y'' = v, który jest układem liniowym typu podwójny integator.

[edytuj] Śledzenie trajektorii

Przy śledzeniu trajektorii stosujemy podobny zabieg jak w przypadku pozostałych algorytmów. Jako sygnał sterujący v podajemy:

v = − k_d(y' − y_d') − k_p(y − y_d) + y_d''.

Po podstawieniu do równania uzyskujemy wzór:

y'' − y_d'' + k_d(y' − y_d') + k_p(y − y_d) = 0, a w ostateczności:

e'' + k_de' + k_pe = 0, gdzie:

e - błąd

k_p,k_d - wzmocnienie części P oraz D sterownika typu PD (PID)

y_d - zadana trajektoria

y_d'' - korekcja

Jeżeli macierze k_p oraz k_d spełniają warunek, że ich spektrum ma części rzeczywiste większe od zera, to błąd e będzie zmierzał do zera. A zatem można powiedzieć, że algorytm jest zbieżny.

[edytuj] Uwagi

W algorytmie stosowany jest Jakobian. Wymagana jest znajomość modelu manipulatora, bez której nie można wykonać linearyzacji układu.

[edytuj] Bibliografia

• K.Tchoń, A.Mazur, I.Dulęba, R.Hossa, R.Muszyński - Manipulatory i roboty mobilne: Modele, planowanie ruchu, sterowanie. Warszawa 2000r. (ISBN 83-7101-427-9)