Algorytm odsprzęgania wej-wyj

Z Wikipedii

Masz nowe wiadomości (różnica z poprzednią wersją).

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.

[edytuj] Warunki stosowania

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

[edytuj] Wzory

Przekształcamy model matematyczny manipulatora do postaci:

q'' = - M - 1 C q' - 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 + H u

(zapis uproszczający dalsze wory)

H = M - 1

Bierzemy i-te wyjście:

y i = k i (q) = k i (x)

$y'_i=\frac{\partial}{\partial x}k_i(x)\xi$

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:

$y''_i={\xi}^T \frac{{\partial}^2k_i}{\partial x^2}\xi+\frac{\partial k_i}{\partial x}[F(x,\xi)+H(x)u]$

Po raz kolejny upraszczamy zapis wzoru:

$y''_i=+P_i(x,\xi)+\frac{\partial k_i}{\partial x}[F(x,\xi)+H(x)u]$

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, $\frac{\partial k}{\partial x}$

Układ jest sterowalny, gdy macierz pochodząca z iloczynu J i H jest odwracalna ( $JM^{-1} \ne 0$ ).

[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 d e' + k p e = 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

Jak widać 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)

Źródło: "http://pl.wikipedia.org../../../a/l/g/Algorytm_odsprz%C4%99gania_wej-wyj.html"

Kategoria: Algorytmy w robotyce