Dzisiaj zaprezentuję jak wyeliminowałem wpływ dryftu żyroskopu z pomiaru prędkości kątowej wykorzystując Rozszerzony Filtr Kalmana. Będzie miejsce na teoretyczny opis problemu i implementację najpierw w środowisku symulacyjnym, a następnie w robocie Micromouse.
W ten weekend miałem przyjemność uczestniczyć w hackatonie świątecznym organizowanym przez gdański hackerspace. Hackerspace chciałem odwiedzić już od dłuższego czasu. ale jakoś nigdy nie mogłem się zebrać. Wystartowanie w hackatonie też było na mojej checkliście. Tak więc była możliwość upiec dwie pieczenie na jednym ogniu.
W dzisiejszym wpisie przedstawię implementację Rozszerzonego Filtru Kalmana dla robota Micromouse. Aby dojść do tego momentu musiałem najpierw wyznaczyć model ruchu robota oraz sprawdzić działanie EKF w środowisku symulacyjnym. Można o tym poczytać we wcześniejszych wpisach.
W dniach 14-15 listopada byłem na konferencji code::dive we Wrocławiu. Jest ona głównie poświęcona C++, ale dodatkowymi tematami miały być Rust, Go, Embedded, IoT, Security, czy Python. Wstęp jest darmowy, ale liczba miejsc jest ograniczona. Swoje zgłoszenie wysłałem dosyć późno i byłem pewny, że się nie załapie. Jednak w ostatniej chwili zwolniły się jakieś miejsca…
Mając gotowe regulatory prędkości silników mogę przystąpić do modułu estymacji pozycji. W tym wpisie umieszczę garść ogólnych informacji dotyczących pracy estymatora, a także wyprowadzenie modelu matematycznego robota, który będzie potrzebny do wewnętrznych obliczeń.
W końcu udało mi się zakończyć pracę nad regulatorem prędkości obrotowej robota, z którym walczyłem od dłuższego czasu. W poprzednich wpisach opisywałem problemy z żyroskopem i spalenie płytki, co wiązało się z nowym projektem PCB. Nareszcie udało doprowadzić się temat do końca. We wpisie znajdziecie trochę matmy, dużo wykresów i opis kolejnych przygód z zepsutym…
Po zlutowaniu nowego PCB, zgodnie z planem opisanym poprzednio, przystąpiłem do strojenia regulatorów silników. O ile z ruchem postępowym poszło szybko – w końcu robiłem to już któryś raz – tak z ruchem obrotowym natrafiłem na kolejne problemy. Jako sprzężenie zwrotne dla regulatora używam żyroskopu i okazało się, że odczyty są mocno zaszumione. Zakłócenia są…
Pracując nad regulatorami silników zrobiłem zwarcie na płytce czyniąc ją niezdatną do użytku. Pisałem o tym w poprzednim tekście o Micromouse – link. Miałem w zapasie jeszcze części i PCB, więc przystąpiłem do lutowania. Niestety na drugiej płytce również miałem problemy z poprawnym działaniem robota. Przy okazji spaliłem programator ostatecznie tracąc szanse na sprawdzenie czegokolwiek…
Dawno nic nie było o postępach w pracach nad Micromousem, więc pora na mały update. Od ostatniego wpisu o regulatorze obrotów z sierpnia udało się zrobić parę rzeczy. Udało się również parę rzeczy zepsuć. Projekt posunął się do przodu na różnych frontach, ale postępy przystopowało trochę spalenie płytki.
Dzisiaj omówię, w jaki sposób zaprojektować regulator obrotów silnika. Pokażę jak zebrać dane pomiarowe, a następnie dokonać ich analizy i obróbki. W trakcie tego procesu wytłumaczę jakich narzędzi używam i w jaki sposób je wykorzystuję. Podobny artykuł napisałem kiedyś na Forbocie – link. Jednak jest kilka istotnych różnic. Przede wszystkim tam był brany pod uwagę…
End of content
End of content
No products in the cart.