Wprowadzenie do IK

Po co właściwie potrzebujemy odwrotnej kinematyki?

Wyobraź sobie, że pokazujesz palcem punkt w przestrzeni i mówisz robotowi: „chwyć to". Człowiek robi to bez myślenia — mózg automatycznie znajduje konfigurację ramienia, dłoni i palców. Robot potrzebuje tłumacza między „gdzie ma być końcówka" a „jakie kąty muszą przyjąć przeguby" — i tym tłumaczem jest właśnie algorytm kinematyki odwrotnej (IK).

Bez IK żadna z poniższych aplikacji nie działa:

Każda z tych aplikacji ma własne wymagania: szybkość (gry, VR), niezawodność (medycyna), powtarzalność (przemysł). Stąd różne metody IK — i stąd ten moduł. Nie ma jednego algorytmu „najlepszego" — jest algorytm najlepszy do Twojego problemu.

Czym jest PUMA 560 i dlaczego cały kurs jej używa?

Wszystkie moduły 0–7 pracują na jednym konkretnym robocie: PUMA 560. Wybór nie jest przypadkowy — to klasyczny manipulator, którego każdy podręcznik robotyki używa jako modelu referencyjnego. Krótko, dlaczego:

Krótka historia

• 1969 — Victor Scheinman buduje na Uniwersytecie Stanforda „Stanford Arm" (poprzednik PUMA), pierwszy elektryczny manipulator komputerowo sterowany przeznaczony do prac montażowych.
• 1978 — firma Unimation (założona przez Josepha Engelbergera, „ojca robotyki") wprowadza komercyjnie PUMA — Programmable Universal Machine for Assembly. Główny klient: General Motors, z myślą o linii montażowej.
• Lata 80.–90. — dominacja na liniach motoryzacyjnych w USA i Europie. Setki tysięcy sztuk w produkcji.
• Dzisiaj — wycofana z produkcji nowych jednostek, ale pozostaje kanonicznym przykładem dydaktycznym w każdym podręczniku robotyki (Craig, Spong, Siciliano, Murray–Li–Sastry). Niemal każda praca o IK manipulatora 6-DOF pokazuje wyniki na Pumie.

Dlaczego idealna jako przykład dydaktyczny

Co robimy w innych modułach: M9–M11 (dynamika, silnik DC, dobór napędów) korzystają z robota ES5 z dysertacji [Gruszka 2024] — ma inną geometrię (forma B Piepera, równoległe osie q₂q₃q₄), ale algorytmy dynamiki działają identycznie. Pokazujemy więc dwa przykłady obok siebie.

Jak korzystać z tej aplikacji — mapa modułów

Aplikacja zawiera 11 modułów, ale nie wszystkie są równie ważne dla każdego. Poniżej trzy ścieżki dla różnych odbiorców — wybierz tę, która pasuje do Twoich celów:

Wszystkie moduły działają jako referencja — wracaj do nich wybiórczo gdy potrzebujesz konkretnego wzoru, wyprowadzenia albo przykładu liczbowego. Każdy moduł zawiera ściągę formuł na końcu i co najmniej jeden wzorzec liczbowy, który możesz sprawdzić we własnej implementacji.

Od kinematyki prostej do odwrotnej

Manipulator o n stopniach swobody opisuje odwzorowanie $f: Q \to SE(3)$, gdzie $Q \subset \mathbb{R}^n$ to przestrzeń konfiguracji (wektory wartości przegubów), a $SE(3)$ — grupa transformacji sztywnych 3D opisujących pozę efektora. Kinematyka prosta (FK) oblicza $T_0^{n} = f(q_1,\dots,q_n)$ bezpośrednio z iloczynu macierzy transformacji kolejnych ogniw:

Problem odwrotny (IK) polega na wyznaczeniu $q \in Q$ takiego, że $f(q) = T^*$, gdzie $T^*$ to zadana poza. Jest on zasadniczo trudniejszy: nieliniowy, wielokrotnie zdegenerowany, a często nieposiadający rozwiązania analitycznego. Poniższy diagram zestawia obie kierunki rozumowania:

Nie tylko Puma — różne typy manipulatorów

Większość modułów koncentruje się na klasycznym manipulatorze przegubowym (anthropomorphic, articulated) — sześć przegubów obrotowych w łańcuchu szeregowym (typowy układ Puma560, Fanuc R-2000, ABB IRB). Ale w przemyśle istnieje cała rodzina innych konstrukcji, każda z własną charakterystyką i podejściem do IK:

• SCARA (Selective Compliance Articulated Robot Arm) — cztery osie, dwa pierwsze obroty w płaszczyźnie poziomej, jeden ruch wzdłuż Z, jedna rotacja narzędzia. Idealny do montażu PCB i przenoszenia.
• Delta — równoległy, trzy ramiona połączone u góry, ruch translacyjny TCP. Bardzo szybki (pick-and-place), ale małą przestrzeń roboczą.
• Kartezjański (gantry) — trzy osie translacyjne, prostokątna przestrzeń robocza. IK trywialne (każda oś niezależna), ale duże gabaryty.
• Cylindryczny / sferyczny — historyczne układy, ograniczone zastosowania.

Każdy z tych typów ma specyficzne wzory IK — często znacznie prostsze niż dla Pumy. Metody iteracyjne (Jakobianowe, optymalizacyjne) z modułów 3–4 są uniwersalne — działają niezależnie od typu konstrukcji.

Kluczowe trudności IK

1. Wielokrotność rozwiązań. Dla typowego przemysłowego manipulatora 6-DOF (Puma, Fanuc, ABB) istnieje do ośmiu konfiguracji osiągających tę samą pozę — shoulder L/R, elbow up/down, wrist flip. Solver musi wybrać jedną, np. najbliższą bieżącej konfiguracji.
2. Osiągalność. Zbiór poz osiągalnych jest ograniczony (workspace) — zadanie poza nim nie ma rozwiązania.
3. Singularności. W punktach, w których jakobian traci rząd (np. przy $q_5 = 0$ w nadgarstku sferycznym), solver numeryczny rozbiega się albo traci stabilność; rozwiązanie zamknięte w tym miejscu jest ciągłe, ale kierunek ruchu nadgarstka staje się niejednoznaczny.
4. Ograniczenia przegubowe i kolizje. Matematyczne rozwiązanie może być fizycznie nierealizowalne.

Klasyfikacja metod IK

W kolejnych modułach każda z tych rodzin jest omówiona osobno — z wyprowadzeniem, implementacją referencyjną i porównaniem na tym samym zbiorze testowych poz.