2014-05-12 17 views
5

Próbuję użyć IMU algorithms Sebastiana Madgwicka, aby uzyskać przechył, skok i odchylenie z mojego czujnika, którym jest MPU-9150. Pobrany przeze mnie folder zawierał pewne przykładowe dane, a ja po prostu zamieniłem te dane na własne, upewniając się, że jednostki/konwencje są takie same itd. Problem w tym, że kąty wynikowe z algorytmu z danymi nie mają większego sensu i są bardzo głośne, zwłaszcza kąt odchylenia. Rzut i skok wydają się wiarygodne, ale mogę uzyskać lepsze wyniki z danych z mojego akcelerometru/żyroskopu. Dołączyłem wykres jego przykładowych danych (które działają), moje dane i moje wyniki.Implementacja algorytmu IMU firmy Madgwick

Czy istnieje jakieś dodatkowe filtrowanie, które muszę zrobić z moimi danymi, zanim spróbuję użyć tych algorytmów? Do tej pory bawiłem się medianą filtrowania i nie miało to większego znaczenia.

Dzięki

Example data Example data output My data My data output

+0

Czy zdajesz sobie sprawę z [niestabilności kątów Eulera] (http://stackoverflow.com/q/5010978/341970)? Sądzę, że to jest to, co widzisz, ale nie mogłeś zdecydować, pytanie nie jest dla mnie jasne. – Ali

+0

@Ali implementacja odwołuje się do użytych kwaternionów wewnętrznie, więc prawdopodobnie nie będzie niestabilna, chociaż może to być problem z konwersją kątów Eulera. Prawdopodobnie c0redumb jest poprawny. – kerblogglobel

Odpowiedz

3

zdarzyło mi się znaleźć kilka noty w kwestii niestabilności algorytmu Magdwick poprzez Tobias Simon, jak opisano tutaj

http://diydrones.com/forum/topics/madgwick-imu-ahrs-and-fast-inverse-square-root

The problem był z szybkim inv erse pierwiastek kwadratowy używany w implementacji Magdwick. Nie wiedziałem, gdzie jest problem. Może to z precyzją algorytmu, a może dlatego, że oryginalny kod nie działał na maszynie 64-bitowej. Zastąpienie implementacji innym (lepszym?) Zyskuje zaskakująco lepsze i bardziej stabilne obliczenia AHRS. (Lub dokonania jakiejś małej zmiany w kodzie 64-bitowym komputerze również rozwiązać ten problem? Proszę przeczytać komentarze oryginalnej nucie Tobias Simon.)

Lepszym odwrotny realizacja pierwiastek kwadratowy można znaleźć tutaj

https://pizer.wordpress.com/2008/10/12/fast-inverse-square-root/

Powiązane problemy