Na Ile Sposobów Może Się to Poruszać?
Stopnie Swobody: Geometria Ruchu
Stopień swobody (DOF) to jeden niezależny sposób, w jaki obiekt może się poruszać. Zrozumienie DOF to pierwszy krok do zrozumienia, jak roboty wchodzą w interakcję z przestrzenią.
Pozycja w przestrzeni 3D wymaga 3 DOF: x (lewo/prawo), y (przód/tył), z (góra/dół). Punkt w przestrzeni ma 3 DOF.
Orientacja dodaje jeszcze 3: roll (obrót wokół osi przód-tył), pitch (obrót wokół osi bocznej), yaw (obrót wokół osi pionowej). Sztywne ciało w przestrzeni ma 6 DOF: 3 pozycja + 3 orientacja.
Ramiona robotów & DOF:
- Ramię z 6 osiami (jak robot przemysłowy) ma 6 przegubów, każdy dodający 1 DOF. Z 6 DOF, chwytak może osiągnąć dowolną pozycję i orientację w przestrzeni roboczej: ma pełną swobodę przestrzenną.
- Robot SCARA z 4 osiami ma 4 DOF: może się pozycjonować gdziekolwiek w płaszczyźnie i obracać, ale nie może pochylić swojego narzędzia. Dobry do pobierania i umieszczania na płaskich powierzchniach.
- Robot kartezjański/bramowy z 3 osiami ma 3 DOF: może się pozycjonować gdziekolwiek w kształcie pudełka, ale nie może orientować swojego narzędzia wcale. Dobry do drukarek 3D.
Więcej niż 6 DOF: robot z 7 osiami jest nadmiarowy: ma więcej DOF niż potrzeba do pełnego pozycjonowania przestrzennego. Dodatkowy DOF pozwala mu osiągać wokół przeszkód, jak ludzkie ramię sięgające za coś. Nadmiarowość to geometryczna zaleta.
DOF i Wymagania Zadań
Fabryka potrzebuje robota do trzech różnych zadań: (A) rozpylanie kleju wzdłuż 3D zakrzywionej ścieżki na panelu karoseryjnym samochodu, (B) pobieranie chipów z taśmy przenośnika & umieszczanie ich na płaskiej płytce drukowanej, & (C) spawanie złożonego połączenia 3D z wielu kątów.
Dwa Kierunki Geometrii Robota
Kinematyka: Geometria w Ruchu
Kinematyka to nauka o ruchu bez uwzględniania sił. W robotyce to czista geometria: zależność między kątami przegubów a pozycją i orientacją chwytaka.
Kinematyka prosta (FK): Mając wszystkie kąty przegubów → oblicz pozycję & orientację chwytaka. To jest kierunek 'łatwy'.
Dla ramienia planarnego z 2 ogniwami: jeśli przegub 1 jest pod kątem θ₁ & przegub 2 jest pod kątem θ₂, z długościami ogniw L₁ & L₂, chwytak jest na:
- x = L₁ cos(θ₁) + L₂ cos(θ₁ + θ₂)
- y = L₁ sin(θ₁) + L₂ sin(θ₁ + θ₂)
Dla ramienia z 6 osiami, FK używa łańcucha jednorodnych macierzy transformacji: każdy przegub wspomaga macierz 4×4 kodującą rotację i translację. Pomnóż wszystkie sześć macierzy razem, aby uzyskać pozę chwytaka. To mechaniczne, ale zawsze daje unikalną odpowiedź.
Kinematyka odwrotna (IK): Mając pożądaną pozycję & orientację chwytaka → oblicz kąty przegubów, które to osiągają. To jest kierunek 'trudny'.
IK jest trudna, ponieważ:
- Wiele rozwiązań: Ramię z 6 osiami często może osiągnąć ten sam punkt w wielu konfiguracjach (łokieć do góry vs. łokieć w dół, przegub przerzucony vs. nie). Może być 8 lub więcej ważnych rozwiązań.
- Brak rozwiązań: Jeśli cel jest poza przestrzenią roboczą, żadne kąty przegubów nie działają.
- Osobliwości: W pewnych pozach, dwie osie przegubów ustawiają się równolegle i robot traci DOF: jak blokada kardanów. Blisko osobliwości, małe ruchy kartezjańskie wymagają ogromnych prędkości przegubów.
Kinematyka Odwrotna: Dlaczego Jest Trudna?
Rozważ proste ramię planarne z 2 ogniwami z L₁ = L₂ = 1 metr. Chwytak musi osiągnąć punkt (1.0, 1.0).
Odległość od podstawy do celu to sqrt(1² + 1²) = sqrt(2) ≈ 1.414 m. Ponieważ L₁ + L₂ = 2 m > 1.414 m, punkt jest osiągalny.
Kształt Osiągalności
Przestrzeń Roboczy: Geometryczną Objętość, Którą Robot Może Osiągnąć
Obwiednia przestrzeni roboczej to zbiór wszystkich punktów, które chwytak może osiągnąć. Jej kształt zależy całkowicie od geometrii robota.
Ramię artykulacyjne (6-osi): Przestrzeń roboczy to mniej więcej pusta sfera. Zewnętrzna granica jest na maksymalnym zasięgu (wszystkie ogniwa rozciągnięte). Wewnętrzna granica istnieje, ponieważ ramię nie może się wystarczająco z powrotem zagiąć, aby osiągnąć punkty zbyt bliskie podstawie. Przekrój poprzeczny wygląda jak pączek (torus).
SCARA: Przestrzeń roboczy to cylinder. Ramię metla poziomo (generując okrągły przekrój poprzeczny) a oś Z porusza się pionowo. Wynik to płaska cylindryczna objętość: szeroki zasięg poziomo, ograniczony pionowo.
Kartezjański/Bramowy: Przestrzeń roboczy to prostokątne pudełko. Każda oś porusza się liniowo wzdłuż jednego wymiaru. Proste, przewidywalne, łatwe do programowania: ale nieporęczne, ponieważ robot musi być tak duży jak jego przestrzeń roboczy.
Osobliwości w przestrzeni roboczej: W pewnych pozach robot traci DOF. W pełni rozciągnięte ramię artykulacyjne (na zewnętrznej granicy jego przestrzeni roboczej) jest w osobliwości: nie może dalej poruszać chwytakiem. Osobliwości przegubu przychodzą, gdy dwie osie przegubu przegubu wyrównują się. W osobliwości, macierz Jacobianowa traci rangę, a efektywny DOF robota tymczasowo maleje.
Przestrzeń roboczy zręczna vs. przestrzeń roboczy osiągalna: Osiągalna przestrzeń roboczy to miejsce, w którym chwytak może osiągnąć w co najmniej jednej orientacji. Zręczna przestrzeń roboczy to gdzie może osiągnąć dowolną orientację. Zręczna przestrzeń roboczy jest zawsze podzbiorem osiągalnej przestrzeni roboczej: i często znacznie mniejsza.
Wybór Robota Według Przestrzeni Roboczej
Komórka fabryczna ma trzy stacje rozmieszczone w kształcie L. Stacja A znajduje się po lewej stronie, Stacja B jest bezpośrednio z przodu, Stacja C znajduje się po prawej i nieco wyżej (300 mm wyżej). Robot musi pobierać części z A, wykonywać operację w B i umieszczać gotowe części w C: wszystko z jednej pozycji montażu.
Przestrzeń Konfiguracyjna: Abstrakcyjna Geometria Robota
Przestrzeń Konfiguracyjna: Gdzie Żyje Planowanie Ruchu
Przestrzeń konfiguracyjna (C-space) jest jedną z najpotężniejszych abstrakcji geometrycznych w robotyce. Zamiast myśleć o fizycznym kształcie robota, reprezentuj całe jego państwo jako jeden punkt w N-wymiarowej przestrzeni.
Dla robota z N przegubami, C-space ma N wymiarów: jedna oś na kąt przegubu. Każda możliwa poza robota to jeden punkt w C-space. Ruch (sekwencja poz) to krzywa przez C-space.
Przeszkody w C-space: Fizyczna przeszkoda w rzeczywistym świecie staje się zabronioną regią w C-space. Jeśli umieszczenie robota w kątach przegubów (θ₁, θ₂, ..., θN) spowodowałoby kolizję, ten punkt jest w obrębie przeszkody C-space. Kształt przeszkód C-space jest złożony: proste pudełko w rzeczywistym świecie staje się dziwnie ukształtowaną regią w C-space.
Planowanie ścieżki = znalezienie wolnej od kolizji krzywej: Mając konfigurację początkową (punkt w C-space) & konfigurację celu (inny punkt), znaleź ciągłą krzywą łączącą je, która nie wchodzi w żadną zabronioną regię.
Algorytmy:
- A* (oparty na siatce): Diskretyzuj C-space na siatkę, szukaj najkrótszej ścieżki. Działa dobrze w niskich wymiarach (2-3 DOF) ale rozmiar siatki rośnie wykładniczo wraz z wymiarem.
- RRT (Rapidly-Exploring Random Tree): Zbuduj drzewo losowych próbek w C-space, rozwijające się w kierunku niezbadanych regionów. Działa w wysokich wymiarach (6+ DOF). Nie optymalny ale szybki w znalezeniu wykonalnych ścieżek.
- PRM (Probabilistic Roadmap): Wstępnie oblicz grafikę losowych wolnych od kolizji konfiguracji, następnie przeszukaj grafikę. Dobry dla powtarzanych zapytań w tym samym środowisku.
Geometryczna intuicja: problem planowania ścieżki robota z 6 DOF to problem krzywej-przez-6D-przestrzeń. Wymiarowość sprawia, że dokładne rozwiązania są niewykonalne: metody probabilistyczne (RRT, PRM) to praktyczne podejście.
Myśl o Przestrzeni Konfiguracyjnej
Ramię planarne z 2 ogniwami (2 DOF) działa w pokoju z jedną prostokątną przeszkodą. Przegub 1 zawiera się w przedziale od 0° do 360°, przegub 2 zawiera się w przedziale od 0° do 360°. Przestrzeń konfiguracyjna to kwadrat 2D: θ₁ na jednej osi, θ₂ na drugiej.