Przejdź do treści
Wróć do wyników wyszukiwania

Kwaternionowe położenie

Autor metody
William Hamilton (quaternions), aerospace engineers
Rok
1843
Typ
Mathematical framework
Rodzina
Representation

Ten tekst jest tłumaczeniem maszynowym i nie został jeszcze sprawdzony. Przeczytaj oryginał po angielsku

Rozmiar czcionki

Do czego służy?

Kwaternionowe położenie to matematyczne ramy opisu trójwymiarowych obrotów za pomocą czterowymiarowych wektorów (kwaternionów).

W porównaniu z kątami Eulera, kwaterniony są wolne od osobliwości (blokady kardana) i stanowią standardową reprezentację w nowoczesnej estymacji położenia, sterowaniu statkami kosmicznymi i grafice komputerowej 3D. Kwaternionowa kinematyka elegancko opisuje ewolucję położenia pod wpływem pomiarów prędkości kątowej z żyroskopów.

Intuicja stojąca za metodą

Kwaternion to czteroelementowy wektor q = [q0, q1, q2, q3] lub q = [q_skalar, q_wektor], który reprezentuje obrót wokół dowolnej osi. W przeciwieństwie do kątów Eulera (przechył, pochylenie, odchylenie), które mogą stać się osobliwe lub niejednoznaczne przy pewnych kątach, kwaterniony są gładkie wszędzie. Kwaternion naturalnie łączy oś i kąt obrotu; mnożenie kwaternionów odpowiada składaniu obrotów.

Historia

William Hamilton wynalazł kwaterniony w 1843 roku jako uogólnienie liczb zespolonych. Leonhard Euler używał wcześniej reprezentacji podobnych do kwaternionów; kwaterniony zostały ponownie odkryte i zastosowane do dynamiki ciał sztywnych w XX wieku. W lotnictwie kwaterniony stały się standardem po programie Apollo, kiedy to określanie położenia statków kosmicznych wymagało globalnych, pozbawionych osobliwości reprezentacji. Nowoczesne IMU, silniki gier i robotyka wykorzystują kwaterniony.

Kiedy stosować

Używać reprezentacji kwaternionowej wszędzie tam, gdzie potrzebna jest ciągła, pozbawiona osobliwości reprezentacja położenia. Obowiązkowe dla systemów sterowania lotem, przetwarzania danych z IMU i określania położenia statków kosmicznych. Wdrożyć we wszystkich nowoczesnych systemach nawigacji i sterowania. Używać do propagacji położenia w czasie rzeczywistym i fuzji czujników. Unikać kątów Eulera w pętlach sterowania ze względu na ryzyko blokady kardana.

Ograniczenia i uwagi

  • Podwójne nakrycie; dwa kwaterniony (q i -q) reprezentują ten sam obrót; należy śledzić ciągłość znaku.
  • Mniej intuicyjne; kwaterniony są abstrakcyjne; inżynierowie muszą przekształcać je na kąty Eulera w celu wizualizacji i intuicji.
  • Osobliwość kinematyczna w całkowaniu; propagacja przez dq/dt = 0.5 q ⊗ ω wymaga starannego całkowania numerycznego w celu utrzymania normy jednostkowej.
  • Niejednoznaczność w interpretacji osi i kąta; oś obrotu nie jest jednoznaczna, gdy kąt jest bliski 0 lub 2π.

Warunki podane w źródle nie zastępują niezależnego przeglądu naukowego ani walidacji przez silnik analityczny.

Mocne strony

  • Brak osobliwości; kwaterniony unikają blokady kardana; położenie może przyjmować dowolną orientację bez matematycznego załamania.
  • Wydajna obliczeniowo; mnożenie kwaternionów jest szybsze niż operacje macierzowe; nadaje się do sterowania w czasie rzeczywistym.
  • Znormalizowana reprezentacja; ograniczenie do kwaternionu jednostkowego jest naturalne; brak potrzeby normalizacji euklidesowej, jak w przypadku macierzy obrotu.
  • Gładka interpolacja; kwaternionowa interpolacja liniowo-sferyczna (SLERP) zapewnia płynną interpolację położenia między klatkami kluczowymi.

Zastosowania

  • Określanie położenia statków kosmicznych: reprezentacja orientacji satelitów i statków kosmicznych bez blokady kardana.
  • Autopilot i sterowanie lotem samolotu: prawa sterowania oparte na kwaternionach do regulacji położenia samolotu i śledzenia trajektorii.
  • Przetwarzanie danych z jednostki pomiarowej inercyjnej (IMU): całkowanie pomiarów żyroskopowych w celu estymacji położenia kwaternionowego.
  • Grafika komputerowa 3D i silniki gier: płynna reprezentacja obrotu i interpolacja do animacji.
  • Robotyka i pojazdy autonomiczne: śledzenie orientacji do nawigacji i planowania ruchu.

Jak to działa

Jak to działa

1

Położenie należy określić jako kwaternion q = [q0, q1, q2, q3], gdzie q0 jest składową skalarną, a [q1, q2, q3] częścią wektorową; należy zapewnić normę jednostkową (q0^2 + q1^2 + q2^2 + q3^2 = 1).

2

W razie potrzeby należy znormalizować kwaternion; przekształcić między reprezentacjami (kąty Eulera, macierz obrotu) zgodnie z wymaganiami do wyświetlenia.

3

Propagować kwaternion w czasie za pomocą równania kinematycznego: dq/dt = 0.5 * q ⊗ ω, gdzie ω to prędkość kątowa; całkować numerycznie.

Wzór
\dot{\vec{q}} = \frac{1}{2}\vec{q} \otimes \vec{\omega}
4

Zaktualizować kwaternion przy użyciu nowych pomiarów prędkości kątowej z żyroskopu; zastosować filtr (Kalmana, komplementarny) w przypadku łączenia danych z innych czujników.

5

Przekształcić kwaternion na kąty Eulera (przechył, pochylenie, odchylenie) do wyświetlania dla pilota; używać kwaternionu bezpośrednio do praw sterowania i dynamiki; ocenić pewność położenia.

Częste pułapki

  • Zapomnienie o normalizacji kwaternionu; dryf numeryczny powoduje kumulację błędów; okresowa normalizacja jest niezbędna.
  • Nieprawidłowa kolejność mnożenia kwaternionów; q1 ⊗ q2 ≠ q2 ⊗ q1 (nieprzemienne); kolejność ma znaczenie dla składania.
  • Mylenie sprzężenia kwaternionu z odwrotnością; dla kwaternionu jednostkowego odwrotność = sprzężenie, ale nie dotyczy to kwaternionów niejednostkowych.
  • Nieobsłużenie podwójnego nakrycia (q vs. -q) w filtrowaniu; jeśli filtr nie śledzi znaku, występują nieciągłości; zapewnić ciągłość ścieżki kwaternionu.

Najczęściej zadawane pytania

Jaka jest różnica między kwaternionem a macierzą obrotu?

Kwaternion q = [q0, q1, q2, q3] to 4-elementowa reprezentacja; macierz obrotu R to ortogonalna macierz 3x3. Oba reprezentują ten sam obrót. Mnożenie kwaternionów jest szybsze (16 operacji vs. 27 dla mnożenia macierzy); kwaterniony są bardziej zwarte (4 vs. 9 elementów). Konwersja między nimi jest prosta.

Dlaczego q i -q reprezentują ten sam obrót?

Kwaternion jednostkowy q = [cos(θ/2), sin(θ/2) * n] reprezentuje obrót o kąt θ wokół osi n. Kwaternion -q = [-cos(θ/2), -sin(θ/2) * n] reprezentuje ten sam obrót (oba dają tę samą macierz obrotu). To podwójne nakrycie jest obsługiwane w filtrowaniu poprzez utrzymanie ciągłości (unikanie nagłych zmian znaku).

Jak całkować kwaternionową kinematykę?

Użyj dq/dt = 0.5 * q ⊗ ω_body, gdzie ω_body to prędkość kątowa w układzie odniesienia ciała. Całkować numerycznie, używając metody Eulera, RK4 lub innych integratorów. Kluczowe: renormalizować kwaternion po każdym kroku, aby utrzymać normę jednostkową (||q|| = 1). Alternatywnie, użyć całkowania z mapą wykładniczą dla wyższej dokładności.

Jak przekształcić kwaternion na kąty Eulera?

Kąty Eulera (przechył φ, pochylenie θ, odchylenie ψ) z kwaternionu q = [q0, q1, q2, q3] obejmują funkcje arcus tangens. Formuły zależą od konwencji kątów (ZYX, XYZ itp.). Uważać na osobliwości blokady kardana (θ = ±90°) podczas konwersji; w pobliżu osobliwości używać kwaternionu bezpośrednio do sterowania.

Pokrewne metody

Źródła

  1. Shuster, M. D. (1993). A survey of attitude representations. Journal of the Astronautical Sciences, 41(4), 439–517.

    Otwórz odnośnik do publikacji
    Skopiowano.
  2. Titterton, D. H., & Weston, J. L. (2004). Strapdown Inertial Navigation Technology (2nd ed.). Institution of Engineering and Technology.

    Otwórz odnośnik DOI
    Skopiowano.
  3. Savage, P. G. (2000). Strapdown inertial navigation integration algorithm design. Part 1: Attitude algorithms. Journal of Guidance, Control, and Dynamics, 21(1), 19–28.

    Otwórz odnośnik DOI
    Skopiowano.