2.2. Parametry opisujące manipulatory i roboty
Manipulatory i roboty przemysłowe najczęściej posiadają
otwarty łańcuch kinematyczny. Łańcuchy te składają się z kilku ogniw czynnych
umożliwiających przestrzenne przemieszczanie i orientacje końcówki roboczej,
czyli efektora.
Liczba stopni swobody jest to
ilość zmiennych położenia, jaką należy podać w celu jednoznacznego określenia
układu w przestrzeni. W celu wyznaczenia liczby stopni swobody korzysta się ze
wzoru:
(2.1)
gdzie: w
- liczba stopni swobody
n - liczba członów ruchomych
pi
- liczba połączeń odpowiedniego rodzaju
Na podstawie podanego wzoru wyznaczono liczbę stopni
swobody dla kilku prostych manipulatorów.
|
Przykład
2.1
|
|
Dla przedstawionego na rys.2.4 manipulatora z czterema
parami kinematycznymi. Wyznaczyć liczbę stopni swobody oraz podać ilość
napędów, jaką trzeba zastosować, aby manipulator mógł spełniać swoje zadanie.
|
|

|
|
Rys.2.4
|
Rys.2.5
|
Rozwiązanie:
Na
podstawie rys.2.4 określono liczbę członów ruchomych manipulatora, która wynosi
n=4. Następnie określono liczbę połączeń odpowiedniego rodzaju, w
przypadku analizowanego manipulatora występują wyłącznie pary kinematyczne
klasy V, czyli p5=4 (2 przeguby obrotowe i 2 przeguby
pryzmatyczne).
Wykorzystując
równanie (2.1) wyznaczono liczbę stopni swobody w równą:
Aby
manipulator posiadał cztery stopnie swobody należy zastosować 4 napędy w sposób
przedstawiony na rys.2.5.
|
Przykład
2.2
|
|
Manipulator zilustrowany na rys.2.6 posiada pięć par
kinematycznych. Wyznaczyć liczbę stopni swobody oraz podać ilość napędów,
jaką trzeba zastosować, aby manipulator mógł spełniać swoje zadanie.
|
|

|
|
Rys.2.6
|
Rys.2.7
|
Rozwiązanie:
Podobnie
jak w przykładzie 2.1 wyznaczono n=5 natomiast p5=5 tak
więc liczba stopni swobody wynosi:

Należy
zastosować 5 napędów, tak jak przedstawiono to na rys.2.7, aby manipulator
spełnił określone zadania.
Jak łatwo można zauważyć liczba stopni swobody otwartego
łańcucha kinematycznego jest równa liczbie par kinematycznych klasy piątej
obrotowych i przesuwnych.
W przypadku wystąpienia par
kinematycznych klas innych niż piąta należy odpowiednio zastosować wzór (2.1)
lub zastąpić wszystkie te pary kinematyczne parami klasy piątej obrotowymi lub
przesuwnymi.
|
Przykład
2.3
|
|
Dla manipulatora zilustrowanego na rys.2.8 posiadającego
cztery pary kinematyczne. Wyznaczyć liczbę stopni swobody oraz podać ilość
napędów, jaką trzeba zastosować, aby manipulator mógł spełniać swoje zadanie.
|
|

|
|
Rys.2.8
|
Rys.2.9
|
Rozwiązanie:
Istnieje kilka sposobów rozwiązania tego zadania, można
zastąpić przegub kulowy na trzy przeguby obrotowe z zerowymi przemieszczeniami
lub podstawić do wzoru (2.1) odpowiednią klasę pary kinematycznej. Tak więc dla
schematu przedstawionego na rys.2.8 można zapisać iż n=4, p3=1,
p5=3. Wykorzystując wzór (2.1) otrzymano:

Jak wynika z obliczeń liczby stopni swobody należy
zastosować 6 napędów, które należy przyłożyć do poszczególnych członów tak jak
przedstawiono to na rys.2.9.
W tabeli 2.1 przedstawiono schematy manipulatorów z
wyznaczoną liczbą stopni swobody do samodzielnego przeanalizowania.
|

|

|
|

|

|
|
Przykład
2.1
|
Przykład
2.2
|
|

|

|
|

|

|
|
Przykład
2.3
|
Przykład
2.4
|
|

|

|
|

|

|
|
Przykład
2.5
|
Przykład
2.6
|
|

|

|
|

|

|
|
Przykład
2.7
|
Przykład
2.8
|
|

|

|
|

|

|
|
Przykład 2.9
|
Przykład 2.10
|
|

|

|
|

|

|
|
Przykład
2.11
|
Przykład
2.12
|
|

|

|
|

|

|
|
Przykład
2.13
|
Przykład
2.14
|
|

|

|
|

|

|
|
Przykład 2.15
|
Przykład 2.16
|
|

|

|
|

|

|
|
Przykład
2.17
|
Przykład
2.18
|
|

|

|
|

|

|
|
Przykład
2.19
|
Przykład
2.20
|
|
|
|
Tabela
2.1 Schematy manipulatorów
Elementy kinematyczne tworzące parę kinematyczną z
dołączonym napędem pozwalającym na realizację ruchów względnych elementów pary
kinematycznej, tworzą zespół ruchu. We współcześnie konstruowanych maszynach
manipulacyjnych znaczenie techniczne mają najczęściej połączenia członów V
klasy a więc pary o wzajemnym ruchu postępowym lub obrotowym. W mniejszym
stopniu znajdują zastosowanie w budowie jednostki kinematycznej pary
pozostałych klas szczególnie IV i III jednak trudności konstrukcyjne powodują,
że nie znajdują one zastosowania na szeroką skalę w przemyśle.
Jednostkę kinematyczną manipulatora tworzy mechanizm
kinematyczny wraz z dołączonymi napędami. Mechanizm maszyny manipulacyjnej
określają dwa parametry kinematyczne:
1.
ruchliwość -
liczba stopni swobody łańcucha kinematycznego mechanizmu z unieruchomionym
członem - podstawą;
2.
manewrowość -
liczba stopni swobody łańcucha kinematycznego mechanizmu z unieruchomionymi:
członem - podstawą i członem - ostatnim w łańcuchu kinematycznym;
Pierwszy z tych parametrów określa
liczbę więzów, jaką należałoby nałożyć na mechanizm, aby go całkowicie
unieruchomić. Drugi - podobnie, ale po dodatkowym jeszcze unieruchomieniu ostatniego
wolnego członu, a więc określa swobodę ruchu mechanizmu w przypadku gdy np.
chwytak lub narzędzie jednostki kinematycznej zajmuje ściśle określone
położenie.
|

|
|
Rys.2.10
Schemat kinematyczny manipulatora
|
Oprócz parametrów syntetycznych, jakimi są liczby
ruchliwości i manewrowości, mechanizm jednostki kinematycznej manipulatora
opisuje się przez podanie jego ogólnych właściwości geometrycznych, czyli tak
zwanej struktury kinematycznej, przedstawionej dla przykładowego manipulatora
na rys.2.10. Pod pojęciem struktury kinematycznej łańcucha lub mechanizmu
rozumie się określenie schematu kinematycznego w postaci szkicu,
wykorzystującego oznaczenia członów i połączeń par kinematycznych. Bardzo
częsty gdy struktura manipulatora jest skomplikowana istnieje możliwość
przedstawienia struktury kinematycznej w przestrzeni trójwymiarowej (np. w
izometrii), tak jak przedstawia to rys.2.11 dla przykładowego manipulatora
zilustrowanego na rys.2.10.
|

|
|
Rys.2.11
Schemat kinematyczny manipulatora w izometrii.
|
Struktura jednostki kinematycznej
wraz z opisem wymiarowym schematu kinematycznego i zakresem przemieszczeń
zespołów ruchu w sposób jednoznaczny określają przestrzeń ruchów mechanizmu, a
wynikowo przestrzeń ruchów chwytaka lub narzędzia. Ze względów użytkowych,
przestrzeń ta jest opisana, niezależnie od zwymiarowanego szkicu, także przez
podanie objętości. W przestrzeni roboczej wyróżnia się następujące obszary:
-
główną
przestrzeń roboczą - w obrębie której przemieszcza się konstrukcyjne zakończenie
ostatniego, wolnego, ale nierozdzielnie związanego z mechanizmem jednostki
kinematycznej członu, z reguły sprzęgu chwytaka lub narzędzia;
-
przestrzeń
kolizyjną - w obrębie której zawierają się wszystkie elementy konstrukcyjne i
przemieszczają się wszystkie zespoły ruchu - człony mechanizmu jednostki
kinematycznej;
-
przestrzeń
ruchów jałowych - przestrzeń kolizyjną z wyłączeniem głównej przestrzeni
roboczej;
-
strefę
zagrożenia - przestrzeń zabronioną przepisami lub normami BHP dla obsługi w
czasie pracy jednostki kinematycznej.
Przykładowo
dla struktury manipulatora przedstawionego na rys.2.10 główna przestrzeń
robocza została przedstawiona na rys.211.
|

|
|
Rys.2.12
Główna przestrzeń robocza manipulatora
|
Przestrzenie robocze i kolizyjne dzieli się na:
mechaniczne i sterownicze. Przestrzenie mechaniczne wynikają z konstrukcyjnych
właściwości jednostki kinematycznej z korekcjami pochodzącymi np.: od sumowania
luzów w połączeniach, statycznymi i dynamicznymi odkształceniami sprężystymi
itp. Przestrzenie te są z reguły większe od przestrzeni nominalnych określonych
na podstawie geometrii mechanizmu. Przestrzenie sterownicze uwzględniają
ograniczenia sterownicze wynikające z właściwości układów pomiarowych
przemieszczeń, ograniczenia wynikające z zakresu przetwarzania oraz właściwości
samego układu sterownia np. ograniczenia wynikające z zakresów pracy
serworegulatorów. Przestrzenie te są z reguły mniejsze od przestrzeni
nominalnej.
Stosunek objętości przestrzeni roboczej i jałowej lub
kolizyjnej określa poprawność przyjętego rozwiązania struktury jednostki
kinematycznej maszyny manipulacyjnej, rozwiązanie jest tym lepsze im większą
część przestrzeni kolizyjnej zajmuje przestrzeń robocza. Jako parametr zaproponowano
współczynniki określone wyrażeniami:
(2.2)
gdzie: Vr,
Vj, Vk - oznaczają odpowiednio objętość przestrzeni
roboczej, jałowej, oraz kolizyjnej. Dla niektórych schematów manipulatorów z
tabeli 2.1 zostały ustalone zakresy ruchu poszczególnych członów, a ich przykładowe
główne przestrzenie robocze zilustrowane w tabeli 2.2.
|

|

|
|
Manipulator
o 4-stopniach swobody
|
Główna
przestrzeń robocza
|
|
Przykład
2.21
|
|

|

|
|
Manipulator
o 5-stopniach swobody
|
Główna
przestrzeń robocza
|
|
Przykład
2.22
|
|

|

|
|
Manipulator o 6-stopniach
swobody
|
Główna przestrzeń robocza
|
|
Przykład 2.23
|
|

|

|
|
Manipulator
o 4-stopniach swobody
|
Główna
przestrzeń robocza
|
|
Przykład
2.24
|
|

|

|
|
Manipulator
o 4-stopniach swobody
|
Główna
przestrzeń robocza
|
|
Przykład
2.25
|
|

|

|
|
Manipulator
o 4-stopniach swobody
|
Główna
przestrzeń robocza
|
|
Przykład
2.26
|
|

|

|
|
Manipulator
o 6-stopniach swobody
|
Główna
przestrzeń robocza
|
|
Przykład
2.27
|
|

|

|
|
Manipulator
o 3-stopniach swobody
|
Główna
przestrzeń robocza
|
|
Przykład
2.28
|
|

|

|
|
Manipulator
o 4-stopniach swobody
|
Główna
przestrzeń robocza
|
|
Przykład
2.29
|
|

|

|
|
Manipulator
o 4-stopniach swobody
|
Główna
przestrzeń robocza
|
|
Przykład
2.30
|
Tabela
2.2 Przykładowe główne przestrzenie robocze manipulatorów
Dokonując analizy przykładowych struktur manipulatorów
zamieszczonych w tabeli 2.2 można stwierdzić duży wpływ na kształt przestrzeni
roboczej mają odpowiednie konfiguracje poszczególnych członów oraz ich zakresy
ruchu.
Ponieważ poniższy układ rozwiązuje układ dwóch równań
różniczkowych II rzędu należy odpowiednio przyjąć warunki początkowe, również
na rys.6.8 przedstawiono sposób przyjęcia tych warunków na podstawie danych do
zadania.
Parametry
symulacji zostały przyjęte w sposób analogiczny jak dla przykładu 6.2.
(rys.6.4).
W wyniku przeprowadzonej symulacji komputerowej rozwiązano
zadanie odwrotne dynamiki dla analizowanego dwuczłonowego manipulatora, a
rezultat obliczeń zamieszczono na rys.6.9.
|
 
|
|
Rys.6.9 Przemieszczenia, prędkości i
przyspieszenia poszczególnych członów.
|
W podobny
sposób można rozwiązywać zadanie odwrotne dynamiki dla bardziej złożonych
struktur manipulatorów.
|
7
LITERATURA
|
|
|
|
Niederliński
A.: Roboty przemysłowe, WSiP, Warszawa 1981
|
|
|
|
Craig
J. J.: Wprowadzenie do robotyki, WNT, Warszawa, 1995.
|
|
|
|
Spong
M. W., Vidyasagar M.: Dynamika i sterowanie robotów, WNT, Warszawa,
1997.
|
|
|
|
Tchoń
K., Mazur A., Dulęba I., Hossa R., Muszyński R.: Manipulatory i roboty
mobilne, Akademicka Oficyna Wydawnicza PLJ, Warszawa, 2000.
|
|
|
|
Olszewski
M., Barczyk J., Falkowski J. L., Kościelny W. J.: Manipulatory i roboty
przemysłowe - automatyczne maszyny manipulacyjne, WNT, Warszawa, 1992.
|
|
|
|
|
|
|
|
Bodo
H., Gerth W., Popp K.: Mechatronika - komponenty, metody, przykłady, PWN,
Warszawa, 2001.
|
|