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

Filtr Madgwika

Autor metody
Sebastian Madgwick
Rok
2010
Typ
Filter algorithm
Rodzina
Gradient Descent Filtering

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

Rozmiar czcionki

Do czego służy?

Filtr Madgwika to obliczeniowo lekki algorytm estymacji postawy, który łączy pomiary inercyjne (akcelerometr, żyroskop) z pomiarami magnetycznymi (magnetometr) w celu obliczenia orientacji za pomocą kwaternionu.

Wprowadzony przez Sebastiana Madgwika w 2010 roku, algorytm wykorzystuje optymalizację metodą spadku gradientu do minimalizacji błędu między zmierzonymi a oczekiwanymi wynikami czujników, zapewniając dokładne, nie dryfujące estymaty postawy na systemach wbudowanych przy minimalnym koszcie obliczeniowym. Filtr Madgwika jest obecnie wszechobecny w elektronice użytkowej, robotyce i systemach lotniczych.

Intuicja stojąca za metodą

Ideą jest znalezienie kwaternionu (orientacji), który najlepiej wyjaśnia obserwowane pomiary czujników. Akcelerometr i kompas wskazują, gdzie znajdują się grawitacja i północ magnetyczna; żyroskop wskazuje, jak szybko się obracamy. Algorytm oblicza kierunek (gradient) korekty postawy, który przybliża estymowane i zmierzone wektory, a następnie wykonuje niewielki krok w tym kierunku. Powtarzane wiele razy na sekundę, daje to płynną, działającą w czasie rzeczywistym estymatę postawy, która nie dryfuje.

Historia

Sebastian Madgwick opracował algorytm około 2010 roku podczas badań nad przechwytywaniem ruchu i analizą ruchu człowieka. Algorytm został opublikowany na konferencji IEEE International Conference on Rehabilitation Robotics w 2011 roku i udostępniony jako kod open-source. Szybko zyskał popularność w społecznościach robotyki DIY i makerów dzięki swojej prostocie i skuteczności. Główne firmy produkujące elektronikę konsumencką (smartfony, zestawy VR, trackery fitness) przyjęły jego warianty. Filtr Madgwika pozostaje popularny w systemach wbudowanych i edukacji, często służąc jako wprowadzenie do fuzji czujników dla studentów.

Kiedy stosować

Użyj Filtru Madgwika, gdy potrzebujesz lekkiej, działającej w czasie rzeczywistym estymacji postawy na urządzeniach o ograniczonych zasobach (mikrokontrolery, telefony komórkowe, urządzenia noszone). Idealny do zastosowań, gdzie złożoność Filtru Kalmana jest nadmierna. Skuteczny wewnątrz i na zewnątrz, w pojazdach, dronach i urządzeniach noszonych. Zastosuj, gdy masz IMU 9-DOF i chcesz uniknąć strojenia wielu parametrów Filtru Kalmana. Używaj do elektroniki użytkowej, robotyki hobbystycznej i systemów sterowania w czasie rzeczywistym.

Ograniczenia i uwagi

  • Heurystyczny, nie optymalny; nie minimalizuje formalnej funkcji kosztu (w przeciwieństwie do Filtru Kalmana).
  • Wydajność krytycznie zależy od bety (wielkości kroku); brak automatycznej adaptacji w przypadku zmiany jakości czujnika lub ruchu.
  • Zakłócenia magnetometru mogą zniekształcić kierunek; wymaga ręcznej kalibracji; nie wykrywa ani nie odrzuca automatycznie błędnych pomiarów.
  • Duże przyspieszenia (w wariancie MARG) powodują tymczasowe błędy, ponieważ akcelerometr nie jest wyrównany z grawitacją; odzyskiwanie filtra jest heurystyczne, nie oparte na zasadach.

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

Mocne strony

  • Minimalny koszt obliczeniowy; zaimplementowany w < 100 liniach kodu; działa na mikrokontrolerach i procesorach mobilnych.
  • Nie wymaga macierzy ani złożonej algebry liniowej; tylko algebra kwaternionów i iloczyny skalarne.
  • Zapewnia warianty tylko dla IMU (6-DOF) i MARG (9-DOF); adaptowalny do dostępnych czujników.
  • Pojedynczy parametr strojenia (beta) ułatwia dostosowanie; brak macierzy kowariancji lub odwracania macierzy.

Zastosowania

  • Śledzenie ruchu smartfonów i urządzeń noszonych: umożliwia rozpoznawanie gestów ruchowych i rozszerzoną rzeczywistość bez intensywnych obliczeń.
  • Stabilizacja quadkopterów i dronów: zapewnia estymaty przechyłu, pochylenia i odchylenia dla sterowania lotem na ograniczonych zasobach autopilotach.
  • Śledzenie ruchu zestawów VR: orientacja głowy w czasie rzeczywistym dla immersyjnych wyświetlaczy.
  • Przechwytywanie ruchu i animacja ludzka: śledzi orientację segmentów ciała do analizy chodu i animacji.
  • Robotyka i drony hobbystyczne: lekka alternatywa dla Filtrów Kalmana do estymacji postawy na Arduino, Raspberry Pi.

Jak to działa

Jak to działa

1

Zbierz pomiary z IMU 9-DOF: 3-osiowy akcelerometr, 3-osiowy żyroskop i 3-osiowy magnetometr z częstotliwością 50+ Hz.

2

Znormalizuj wektory akcelerometru i magnetometru do długości jednostkowej; przechowuj wektor prędkości kątowej z żyroskopu; zastosuj znaną kalibrację czujnika (przesunięcie, współczynnik skali).

3

Oblicz gradient błędu pomiaru względem kwaternionu; przesuń kwaternion w kierunku minimalizującym błąd (spadek gradientu); całkuj prędkość kątową z żyroskopu, aby przewidzieć ewolucję kwaternionu.

Wzór
\nabla f = \frac{\partial f}{\partial \vec{q}}
4

Połącz korektę metodą spadku gradientu z integracją żyroskopu za pomocą pojedynczego parametru (beta), który kontroluje siłę korekty; wyprowadź kwaternion przy każdej aktualizacji.

5

Przekonwertuj kwaternion na kąty Eulera (przechył, pochylenie, odchylenie) lub użyj kwaternionu bezpośrednio; zgłoś postawę; oceń pewność na podstawie niezawodności czujnika i stanu ruchu.

Częste pułapki

  • Wybranie zbyt dużej bety powoduje szybkie oscylacje i dywergencję; zbyt mała powoduje powolną reakcję; typowy zakres to 0.01–0.1, dostrajany empirycznie.
  • Ignorowanie kalibracji magnetometru; zniekształcenia żelaza miękkiego i twardego mogą powodować błędy kierunku; kalibracja jest kluczowa dla dokładnego odchylenia.
  • Zakładanie, że akcelerometr jest zawsze prawidłowy; podczas intensywnego przyspieszenia akcelerometr nie może być używany do estymacji przechyłu/pochylenia; niektóre algorytmy wykrywają i ignorują akcelerometr podczas manewrów.
  • Wdrożenie bez inicjalizacji; algorytm zbiega się w ciągu kilku sekund, ale najlepiej inicjalizować go, gdy pojazd jest w spoczynku (inicjalizacja statyczna).

Najczęściej zadawane pytania

Jak wybrać parametr beta?

Beta kontroluje szybkość korekty metodą spadku gradientu. Zacznij od beta = 0.041 (wartość użyta przez Madgwika). Jeśli filtr jest powolny (wolno reaguje na ruch), zwiększ beta (do 0.1–0.5). Jeśli filtr oscyluje lub dryfuje, zmniejsz beta (do 0.01). Dostrój empirycznie, obserwując reakcję postawy na znane ruchy.

Jaka jest różnica między wariantami IMU (6-DOF) a MARG (9-DOF)?

Wariant IMU wykorzystuje tylko akcelerometr i żyroskop; zapewnia przechył i pochylenie, ale odchylenie dryfuje bez odniesienia. Wariant MARG dodaje magnetometr dla absolutnego odchylenia; zapewnia stabilną postawę 3-DOF, ale jest wrażliwy na zakłócenia magnetyczne. Używaj IMU do krótkich lotów; używaj MARG do nawigacji stacjonarnej lub powolnej.

Czy mogę uruchomić Filtr Madgwika na mikrokontrolerze 32-bitowym?

Tak. Algorytm jest bardzo wydajny; ARM Cortex-M4 może go uruchamiać z prędkością 200+ Hz. Nawet mikrokontrolery 8-bitowe (z bibliotekami zmiennoprzecinkowymi) mogą obsłużyć 50+ Hz. Wydajność zależy od częstotliwości taktowania i obsługi zmiennoprzecinkowej. Przy arytmetyce stałopunktowej skaluje się do znacznie wolniejszych procesorów.

Jak wykryć zakłócenia magnetyczne?

Monitoruj wielkość magnetometru; pole Ziemi wynosi ~50 mikro-Tesla; większe odchylenie wskazuje na zakłócenie. Porównaj kierunek kompasu (z magnetometru) z kierunkiem z integracji żyroskopu; duża niezgodność sygnalizuje zakłócenie. Łagodzenie: tymczasowo ignoruj aktualizacje magnetometru podczas zakłóceń lub zmniejsz jego wagę (niższa beta_m w niektórych wariantach).

Pokrewne metody

Źródła

  1. Madgwick, S. O. H., Harrison, A. J. L., & Vaidyanathan, R. (2011). Estimation of IMU and MARG orientation using a gradient descent algorithm. IEEE International Conference on Rehabilitation Robotics (ICORR), 1–7.

    Otwórz odnośnik do publikacji
    Skopiowano.
  2. Madgwick, S. O. H. (2010). An efficient orientation filter for inertial and inertial/magnetic sensor arrays. Report x-io Technologies, University of Bristol, UK.

    Otwórz odnośnik do publikacji
    Skopiowano.
  3. Sabatini, A. M. (2006). Quaternion-based extended Kalman filter for determining orientation by inertial and magnetic sensing. IEEE Transactions on Biomedical Engineering, 53(7), 1346–1356.

    Otwórz odnośnik DOI
    Skopiowano.