q1 q2 z2 z0 z1 z3 q3
Transkrypt
q1 q2 z2 z0 z1 z3 q3
Ćwiczenia nr 6 z “Robotyki 1” Kolokwium nr 1 odbędzie się w tygodniu następnym po przerobieniu listy nr 7. Uwaga: podczas wyliczania kinematyki proszę narysować zerowe ułożenie manipulatora, czyli odpowiadające zerowej konfiguracji q = 0 T . Wybrane (może wszystkie?) ćwiczenia wykonać przy minimum dwóch zerowych ułożeniach manipulatora. 1. Korzystając z algorytmu DH wyznaczania kinematyki wypełnić tabele parametrów DH odpowiednią zawartością dla manipulatorów o zadanych osiach obrotu (uwaga 1): dookreślić układy podstawowy i efektora, początki kolejnych układów Oi i ich osie xi 2) zwrócić uwagę, że jeśli obracamy pewien wektor r1 na wektor r2 wokół prostopadłego do nich wektora k, to kierunek obrotu jest dodatni, gdy zwroty k i r1 × r2 są zgodne; gdy są przeciwne - kąt obrotu jest ujemny) Przykład 1: Manipulator RRT (uwaga z1 jest prostopadłe do płaszczyzny rysunku) z0 z2 z3 q3 q2 z1 q1 Przykład 2: Manipulator RR (nieplanarny) osie zmiennych ruchu z0 i z1 prostopadłe do siebie. Przykład 3: Manipulator TTR (uwaga z2 , z3 prostopadłe do płaszczyzny rysunku, z0 , z1 w płaszczyźnie rysunku) z1 q3 q2 z3 z2 q1 z0 Przykład 4: Manipulator RRR (uwaga z1 prostopadłe do płaszczyzny rysunku, z0 , z2 , z3 w płaszczyźnie rysunku) z3 z2 q3 q2 z1 z0 q1 2. Dla wybranego (lub wybranych) z poprzednich manipulatorów wyliczyć kinematykę (∈ SE(3)) Sprawdzić czy dla zerowych q1 , q2 , q3 , położenie końca efektora (x, y, z)T czyli elementy (1,4), (2,4), (3,4) wynikowej macierzy jest tam, gdzie oczekiwaliśmy (bez liczenia kinematyki). 3. Ćwiczenie 1 powtórzyć dla wymyślonego przez siebie manipulatora o 3 stopniach swobody. 4. (*) Zastanowić się, dlaczego kąty αi (i Θi , gdy przegub nie jest obrotowy) wynoszą najczęściej kπ/2 , gdzie k jest liczbą całkowitą i małą. Jest to prawidłowość ważna także dla manipulatorów przemysłowych. 5. (*) Oszacować (bardzo grubo), przy pomocy parametrów DH, jak daleko może być koniec efektora od punktu O0 .