Moduł 07 · analiza

Singularności

det(J), manipulacyjność Yoshikawy, elipsoida manipulacyjności, zachowanie w pobliżu osobliwości.

Singularności — matematyka i skutki

Singularność kinematyczna to konfiguracja qq, w której jakobian J(q)∈R6×nJ(q) \in \mathbb{R}^{6 \times n} traci pełny rząd:rank J(q)<6\mathrm{rank}\,J(q) < 6. Fizycznie oznacza to, że pewien kierunek ruchu w przestrzeni zadaniowej (liniowy lub kątowy) jest niedostępny niezależnie od wyboru q˙\dot q. Ten sam warunek zapisany algebraicznie:

det⁡(J J⊤)=0⇔∃  ξ∈R6∖{0}:  ξ⊤J=0\det(J\,J^\top) = 0 \quad\Leftrightarrow\quad \exists\; \xi \in \mathbb{R}^6 \setminus \{0\}:\; \xi^\top J = 0

Konsekwencje praktyczne:

  • Utrata DOF zadaniowego — lokalnie manipulator przestaje być w stanie realizować pewne ruchy TCP.
  • Numeryczna eksplozja — pseudoinwersja J+J^+ ma wyznacznik dążący do zera, więc Δq=J+e\Delta q = J^{+}\mathbf{e} staje się dowolnie duże. W rezultacie przeguby fizyczne są „pchane" poza ograniczenia mechaniczne lub dynamiczne.
  • Niejednoznaczność rozwiązania analitycznego — dwie lub więcej gałęzi rozwiązań zlewa się w jedną (elbow up ≡ elbow down przy wyprostowanym łokciu).
Krok 1

Trzy typowe singularności Puma560

Dla manipulatora 6-DOF z nadgarstkiem sferycznym wyróżniamy trzy typy:

  • Singularność nadgarstka: osie 4 i 6 stają się równoległe. Matematycznie sin⁡q5=0\sin q_5 = 0 (wyrównanie środkowego przegubu). Konsekwencja: q4q_4 i q6q_6 stają się redundantne — jedynie ich suma jest określona przez wybraną orientację.
  • Singularność łokcia: łokieć wyprostowany, czylisin⁡q3=0\sin q_3 = 0. Ramię osiąga maksymalny zasięg; nie można się dalej „wyciągnąć" w kierunku radialnym.
  • Singularność barku: środek nadgarstka znajduje się na osi przegubu 1 (px2+py2=d32p_x^2 + p_y^2 = d_3^2). q1q_1 staje się nieokreślone — dowolny obrót bazy nie zmienia pozycji TCP.

W praktyce warto unikać każdej z tych trzech; najbardziej dokuczliwa jest singularność nadgarstka, bo pojawia się „w środku" przestrzeni roboczej i jest łatwa do napotkania przy typowych zadaniach (narzędzie prostopadłe do stołu, ramię wyprostowane).

Krok 2

Miara manipulacyjności Yoshikawy

Yoshikawa (1985) zaproponował skalarną miarę odległości konfiguracji od singularności:

w(q)=det⁡ ⁣(J(q) J(q)⊤)w(q) = \sqrt{\det\!\bigl(J(q)\,J(q)^\top\bigr)}

Dla n=6n = 6 i kwadratowego JJ upraszcza się dow=∣det⁡J∣w = |\det J|. Geometrycznie: objętość elipsoidy manipulacyjności rozpiętej w przestrzeni TCP przez kolumny jakobianu.

Alternatywne miary:

  • Najmniejsza wartość osobliwa σmin⁡(J)\sigma_{\min}(J) — bardziej czuła niż wyznacznik (patrzy na najsłabszy kierunek, nie iloczyn).
  • Warunkowanie \kappa(J) = \sigma_\max / \sigma_\min — jakość numeryczna; wysokie κ\kappa sygnalizuje pośrednią singularność.
  • „Manipulability index" oddzielnie dla translacji i rotacji (przydatne, gdy priorytetem jest pozycja lub orientacja).

Laboratorium singularności

Zmień wartości przegubów (szczególnie q3q_3 i q5q_5) i obserwuj zmiany w miarach i kształcie elipsoidy manipulacyjności. Elipsoida „spłaszczona" wzdłuż jednej osi wskazuje na kierunek, w którym prędkość TCP jest niemal niedostępna.

Konfiguracja przegubów

θ₁2.8°
θ₂-77.7°
θ₃6.8°
θ₄8.5°
θ₅-19.3°
θ₆172.0°

Manipulacyjność w bieżącej konfiguracji

w (pełna, Yoshikawa)= 3.11e-2w (pozycyjna)= 9.43e-2w (orientacyjna)= 2.46e+0osi elipsoidy pozycyjnejσ = (0.679, 0.524, 0.265)warunkowanie cond(Jp)= 2.6e+0
• nadgarstek OK
• łokieć OK

Elipsoida: półosi = σi(Jpos)\sigma_i(J_{\mathrm{pos}}) (wartości osobliwe jakobianu pozycyjnego), kierunki = odpowiadające wektory osobliwe lewostronne. W skrajnej singularności jedna półoś dąży do 0 i elipsoida zapada się w dysk/odcinek.

Profile manipulacyjności przez przestrzeń przegubową

Poniższe wykresy pokazują wartość w(q)w(q), gdy jeden z przegubów przejeżdża cały swój zakres (pozostałe trzymane w bieżącej wartości). Spadki do 0 to właśnie singularności.

Manipulacyjność vs q3

aktualne: q3 = 6.8°
0.0e+01.6e-23.2e-2-45°90°225°q3 [°]

Czerwona linia = bieżąca wartość kąta. Minima funkcji w(q) odpowiadają singularnościom.

Manipulacyjność vs q5

aktualne: q5 = -19.3°
0.0e+04.7e-29.4e-2-100°0°100°q5 [°]

Czerwona linia = bieżąca wartość kąta. Minima funkcji w(q) odpowiadają singularnościom.

Strategie omijania singularności

  • DLS / Adaptive DLS (moduł 3) — tłumienie regularyzujące pseudoinwersję; solver nie rozbiega się, kosztem błędu residualnego przy singularności.
  • Rzutowanie na przestrzeń zerową (null-space projection) dla manipulatorów redundantnych (n>6n > 6): drugorzędny cel to maksymalizacja w(q)w(q), rzutowana na przestrzeń zerową N(J)\,\mathcal{N}(J): q˙0=(I−J+J) ∇w(q)\dot q_0 = (I - J^+ J)\,\nabla w(q).
  • Planowanie trajektorii z barierą — dodaj do kosztu trajektorii penalty −γlog⁡w(q)-\gamma \log w(q) wymuszający zachowanie marginesu. Działa w SQP / trust-region IK z modułu 4.
  • Zmiana rodziny rozwiązań — przy zbliżaniu do singularności przełącz się na inną gałąź rozwiązań analitycznych (moduł 2). Wymaga analitycznego solvera i planowania "w przód".

Uwaga dydaktyczna

Singularności to nie tylko „błąd numeryczny" — to cecha geometryczna manipulatora, której nie można ominąć konstrukcyjnie bez dodania stopni swobody (robot redundantny) lub zmiany geometrii. Zrozumienie, że miara w(q)w(q) nie jest „jakąś metryką", lecz objętością odwzorowania różniczkowego J(q)J(q), daje studentowi solidne podstawy do dalszej pracy z jakobianami drugiego rzędu (Hessiany), dynamiką Lagrange'a i sterowaniem adaptacyjnym.