miniaturyzacja czujników
Potrzeba coraz większej miniaturyzacji urządzeń elektronicznych w celu zastosowania ich w narzędziach codziennego użytku, miniaturowych robotach i bezzałogowych statkach powietrznych (UAV) jest przewidywana do zatrzymania na kilka lat przed dalszym przeskokiem od mikro do nano wielkości urządzeń. Dlatego obecnie dostępne na rynku inercyjne jednostki pomiarowe wymagają przeglądu. Istnieje wiele komercyjnych inercyjnych jednostek pomiarowych dostępnych na rynku. Na przykład 3DM-GX 1 firmy MicroStrain, MTi-G firmy Xsens Technologies, Crista IMU firmy Cloud Cap Technology, μNAV firmy Crossbow Technology, AHRS200AV2.5 firmy Rotomotion oraz ADIS 16400/405 firmy Analog Devices. W celu weryfikacji możliwości wymienionych rozwiązań porównaliśmy jego charakterystykę z aktualnym stanem techniki miniaturowych MEMS IMU 5 opracowanych przez autorów tekstu. Porównanie widoczne jest w zakładce. 1.
Obecny stan techniki IMU 5 10-DOF pozwala na pomiar kątów w trzech wymiarach, przyspieszeń również w trzech wymiarach, kierunku najsilniejszego sygnału magnesu oraz temperatury otoczenia. Wykorzystuje technologię MEMS w celu zmniejszenia zarówno rozmiaru jak i wagi czujnika. Czujnik waży zaledwie 1,13 bez mocowania i 3,13 z mocowaniem standardowym.
Dane pomiarowe z czujnika IMU 5 w zależności od wersji mogą być przesyłane przez magistralę USB, CAN lub RS-232, które są typowymi standardami przemysłowymi przesyłu danych. Elastyczność jest wymagana od nowoczesnych czujników w celu zintegrowania ich z istniejącymi systemami. Z tego samego powodu czujnik posiada elastyczną konfigurację danych wyjściowych. Dane wyjściowe z czujnika mogą być pobierane w trzech wersjach: jako surowe dane z czujnika, jako dane po kalibracji i kompensacji temperatury lub jako wyjście filtra przetwarzającego. Dane z czujników mogą być również dostarczane w różnych postaciach do użytkownika. Pierwszą formą jest macierz obrotu, która jest generowana na podstawie danych z urządzenia. Dane mogą być również dostarczane do użytkownika końcowego w postaci kątów Eulera i ich wartości podawanych w stopniach lub radianach. Trzecim rodzajem reprezentacji danych wyjściowych jest wykorzystanie kwaternionów.
Schemat działania mikrojednostki pomiarowej przedstawiono na rys. 3, a charakterystykę wewnętrzną w tab. 2.
Jednym z podstawowych czujników inercyjnych jest żyroskop mierzący prędkość kątową Ω (w schemacie GYRO(X), GYRO(Y), GYRO(Z)). Czujniki te zostały zorientowane w taki sposób, że ich osie pomiarowe tworzą prawoskrętny kartezjański układ współrzędnych. Wyjście sygnałów analogowych typu MEMS jest filtrowane przez konfigurowalny filtr dolnoprzepustowy (12.5, 25, 50, 110 Hz). Po filtracji sygnał jest zamieniany na postać cyfrową przez przetwornik analogowo-cyfrowy o rozdzielczości 16 bitów. Sygnał cyfrowy może być dalej filtrowany przez konfigurowalne filtry dolno- i górnoprzepustowe. Częstotliwość danych z żyroskopów może być ustawiona na 100, 200, 400 lub 800 Hz. Rozdzielczość pomiarów może być konfigurowana z modyfikowaną dokładnością w zakresie od 250°/s do 2000°/s.
Kolejnym ważnym elementem schematu jest blok czujników przyspieszeń liniowych (w schemacie ACC(X), ACC(Y), ACC(Z)). Czujniki zostały zorientowane w taki sposób, aby osie pomiarowe również tworzyły prawoskrętny kartezjański układ współrzędnych. Sygnały analogowe z wyjścia MEMS czujników zostały przekierowane do filtra i dalej do przetwornika analogowo-cyfrowego. Maksymalna rozdzielczość mierzonych przyspieszeń może być skonfigurowana na ±2/±4/±8 (g ≇9.81m/s2). Czułość akcelerometrów była mierzona jako 1 .
Producent | MicroStrain | Xsens Technologies | Cloud Cap Technology |
Model | 3DM-GX1 | MTi-G | Crista IMU |
Czujniki wewnętrzne | akcelerometry, żyroskopów, magnetometrów, czujnika temperatury | akcelerometrów, magnetometrów, żyroskopów, GPS | akcelerometrów, żyroskopów, czujnik temperatury |
zakres żyroskopów | ± 300°/sek | ± 300°/sek | ± 300°/sek |
Zakres przyspieszeniomierzy | ± 5 g | ± 5 g | ± 10 g |
Wyjście cyfrowe | RS-.232, RS-485 | RS-232, USB | RS-232, CAN |
Zakres temperatur | -40°C do +70°C | -20°C do +60°C | -40°C do +70°C |
Wymiary z montażem | 64x90x25 | 58x58x33 | 52.07×38,8×25,04 |
Waga | 75 | 68 | 38.6 |
Producent | Crossbow Technology | Analog Devices | Rotomotion |
Model | μNAV | ADIS 16400/405 | AHRS200AV2.5 |
Czujniki wewnętrzne | akcelerometry, żyroskopy, magnetometry, czujnik temperatury, GPS | akcelerometry, magnetometry, żyroskopy, czujnik temperatury | akcelerometry, żyroskopy, magnetometry |
żyroskopy zakres | ± 150°/sek | ± 75-300°/sek | ± 90°/sek |
Zakres akcelerometrów | ± 2 g | ± 18 g | ± 2 g |
Wyjście cyfrowe | RS-232 | SPI | RS-232, Ethernet |
Zakres temperatur | -5°C do +45°C | -40°C do +85°C | -5°C do +75°C |
Wymiary z montażem | 57x45x11 | 31.9×23,5×22,9 | „/>100×100 |
Waga | 33 | 16 | „/>100 |
Tabela 1.
Porównanie dostępnych obecnie na rynku miniaturowych inercyjnych jednostek pomiarowych.
Następny blok funkcjonalny mierzy pole magnetyczne Ziemi za pomocą magnetometrów (w schemacie MAG(X), MAG(Y), MAG(Z)). Osie pomiarowe czujników zorientowane są w prawoskrętnym kartezjańskim układzie współrzędnych. Wyjście analogowe z czujników podłączone jest do przetwornika analogowo-cyfrowego i dalej do bloku konfigurowalnych filtrów. Maksymalne wartości możliwe do zmierzenia mieszczą się w zakresie od 1.3 do 81. z rozdzielczością 1/1055 .
Ostatni blok funkcjonalny zawiera termometr mierzący temperaturę w otoczeniu IMU w celu umożliwienia kompensacji temperaturowej wskazań akcelerometrów, żyroskopów i magnetometrów.
Wszystkie bloki funkcjonalne połączone są z jednostką centralną oznaczoną w schemacie uProcessor. W celu przechowywania wymaganych dla algorytmów parametrów została dodana dodatkowa pamięć (oznaczona w schemacie jako eeprom). Jednostka centralna dokonuje filtrowania danych przed ich przekierowaniem na wyjście CAN lub USB lub RS-232. W celu ustalenia parametrów algorytmu filtrującego wymagana jest faza kalibracji.
Czujniki wewnętrzne | akcelerometry, żyroskopy, magnetometry, czujnik temperatury | Zakres pracy żyroskopów | od ± 250 do 2000°/s |
Zakres pracy akcelerometrów | od ± 2 do ± 8 g | Wyjście cyfrowe | CAN, USB lub RS-232 |
Tabela 2.
Charakterystyka wewnętrzna prezentowanej inercyjnej jednostki pomiarowej.
Prezentowany czujnik IMU ma objętość poniżej 2cm3 z obudową i waży 3,13. Taka wielkość czujnika może pozwolić projektantom robotów na przejście od urządzeń o znacznych rozmiarach do konstrukcji w skali mikro. Maksymalne przyspieszenie jakie jest w stanie wytrzymać czujnik to 500 , natomiast napięcie wejściowe wynosi od 3.5 do 8V, a pobór prądu to 35 mA. Istnieją trzy różne typy obudowy, które umożliwiają zamocowanie czujnika w różnych miejscach. Najmniejsza z nich wersja Micro (rys. 4) o wymiarach z mocowaniem 18,6 x 14,7 x 7,3 . Wersja z dodatkowymi otworami montażowymi wersja Micro-Mounting (rys. 5a) ma wymiary 18,6 x 20,7 x 7,3 . W obudowach wersji Micro i Micro-Mounting przewód wyjściowy jest zakończony złączem USB lub RS-TTL w zależności od wersji. Dostępna jest również wersja rozszerzona z otworami montażowymi i wtykiem LEMO osadzonym w obudowie (rys. 5b). Jej wymiary wynoszą 32,0 x 18,0 x 16,5 .
Wymiary fizyczne wszystkich wersji przedstawiono w tab.3.
Kalibrowane orientacje osi są wygrawerowane i pokolorowane na górnej stronie, jak pokazano na Rys. 5. Rozmiar pojedynczego mocowania wynosi 6,15 mm dla wersji Micro-Mounting, oraz 6,50 mm dla wersji Extended LEMO.
Przed zastosowaniem IMU w obiektach fizycznych dokonano porównania najmniejszych dostępnych na rynku czujników w celu weryfikacji możliwości nawigacji autonomicznych pojazdów mobilnych. Badania porównawcze miały na celu sprawdzenie parametrów ustawionych prototypu, przeanalizowanie przyczyn błędów pomiarowych oraz sprawdzenie jak czujniki, na których przeprowadzono testy zachowują się w sytuacjach ekstremalnych. Do testów wykorzystano dwa popularne, komercyjne czujniki miniaturowe: MTiG-28G firmy XSens Technologies oraz Crista IMU firmy Microstrain (rys. 6b).
IMU typ | Dim. X | Dim. Y | Dim. Z | Units | Volume |
Wersja Micro | 18.6 | 14.7 | 7,3 | mm | 1,996 cm3 |
Wersja micro | 18.6 | 20,7 | 7,3 | mm | 2,811 cm3 |
Wersja rozszerzona | 32.0 | 16,5 | 18,0 | mm | 9,504 cm3 |
Parametry wspólne | Min. | Typ | Max. | Jednostki | |
Waga (bez obudowy) | – | 1.13 | – | gram | |
Waga (z obudową) | – | 3.13 | – | gram | |
Temperatura pracy | -40 | – | 80 | °C | |
Temperatura przechowywania | -.60 | – | 100 | °C | |
Maksymalne przyspieszenie | – | 500 | – | g | |
Napięcie wejściowe | 3.5 | 5,0 | 6,0 | V | |
Prąd | 30 | 35 | 40 | mA |
Tabela 3.
Charakterystyka fizyczna czujnika.
W celu przeprowadzenia badań porównawczych zaprojektowano, wykonano i zastosowano platformę kalibracyjną (rys. 6b). Na platformie zamontowano wszystkie testowane IMU, a ich dane surowe skalibrowano do wspólnego układu współrzędnych dla wszystkich czujników za pomocą przedstawionej metody kalibracji. Przeprowadzono kilka testów: porównanie danych surowych, porównanie danych przefiltrowanych, stabilność czasową czujników oraz możliwość kompensacji temperaturowej. Na rys. 7a przedstawiono porównanie odczytów z akcelerometrów prezentowanego czujnika IMU (CZK na wykresie) i czujnika MTiG (MTI na wykresie), a na rys. 7b porównanie żyroskopów. Oba porównania zostały zarejestrowane podczas ruchu.
Daje się zauważyć, że dane wyjściowe z prezentowanego kalibrowanego czujnika i czujnika referencyjnego są prawie takie same. W celu zmierzenia różnic oszacowaliśmy sygnał z danych surowych i oddzieliliśmy go od składowej szumowej. Jako przykład do prezentacji została wybrana tylko oś pomiarowa Y żyroskopu. Wybór ten był możliwy, ponieważ uzyskane wyniki są porównywalne niezależnie od osi i czujnika (magnetometru, akcelerometru czy żyroskopu). W prawej części rys. 8 pokazano, że odchylenie standardowe szumu dla MTi-G28 i naszego czujnika wynosi około 0,04, podczas gdy wynik uzyskany przez IMU Crista wynosi około 0,12. Różnica pomiędzy odchyleniem standardowym MTi-G28 i naszego czujnika wynosi tylko 0.0035, co jest zazwyczaj nie do odróżnienia przez ludzkie oko.
Dodatkowe zestawienie tabelaryczne współczynnika sygnału do szumu przedstawiono w tab. 4.
Ważnym problemem dla inercyjnych jednostek pomiarowych jest stabilność czasowa danych wyjściowych. Przeprowadziliśmy serię testów stabilności o czasie trwania 4h. Przedstawione na rys. 9 wyniki zostały uzyskane po uśrednieniu z pięciu próbek każdego IMU w teście. Można poczynić dwie główne obserwacje. Po pierwsze, że wyniki MTi-G28 i naszych IMU są porównywalne. Różnica uzyskanych wartości średnich wynosi zaledwie 0.00027, a różnica pomiędzy wartościami odchylenia standardowego 0.00226, co jest jeszcze niższą wartością niż podczas testu z ruchem. Drugą obserwacją jest to, że wyniki naszego czujnika i MTi-G28 są ponad 20 razy bliższe rzeczywistej wartości 0.
Crista IMU (S/NKAL) | MTiG (S/ NKAL) | IMU 5 (S/NKAL) | |
Akcelerometry | 20,3 | 38,1 | 43,2 |
Magnetometry | N/A | 719,3 | 767,9 |
Żyroskopy | 13,6 | 206,7 | 254,5 |
Tabela 4.
Porównanie współczynnika sygnału do szumu dla badanych IMU. (Im większa wartość tym lepiej).
Globalna dostępność GPS, stosunkowo wysoka wiarygodność odczytów oraz brak konieczności posiadania dodatkowej infrastruktury to główne powody, dla których większość współczesnych systemów nawigacji inercyjnej wykorzystuje GPS. INS zazwyczaj charakteryzuje się dużą szybkością aktualizacji i małym, ale nie skrępowanym błędem. Błąd GPS jest ograniczony, jednak czas aktualizacji jest wolny, a estymacja położenia nie jest wiarygodna. Ze względu na zamkniętą architekturę większości modułów GPS najpopularniejszym typem metod fuzji jest tzw. wspomaganie niesprzężone lub luźno sprzężone. INS z GPS jest wykorzystywany w systemach bezpieczeństwa pojazdów do estymacji poślizgu bocznego pojazdu. Standardowe zastosowanie obejmuje prowadzenie pojazdu i nawigację. Sygnał GPS wymaga dobrej widoczności satelitów, co często nie jest możliwe w kanionach, zwłaszcza w miejskich kanionach. Systemy GPS/INS są często wykorzystywane do nawigacji quadrocoptera lub naprowadzania pocisków rakietowych.
Opracowaliśmy system nawigacji inercyjnej jako kompletne rozwiązanie nawigacyjne osadzone w pojedynczej płytce PCB. Zawiera on przedstawioną powyżej inercyjną jednostkę pomiarową 10-DOF wraz z modułem GPS (Global Positioning System). W celu skompensowania niskiej dokładności estymacji wysokości przez GPS wbudowano dodatkowy barometr. Opisywany INS pozwala na pomiar kątów w trzech wymiarach, przyspieszeń również w trzech wymiarach, kierunku najsilniejszego sygnału magnesu oraz temperatury otoczenia. Wykorzystuje on technologię MEMS w celu zmniejszenia zarówno rozmiarów jak i wagi czujnika. Płytka drukowana INS ze złączem MCX waży 3,67 grama bez montażu i 8,86 grama ze standardowym montażem.
Dane pomiarowe z czujnika w zależności od wersji mogą być przesyłane przez magistralę USB lub CAN, które są typowymi standardami przemysłowymi przesyłu danych. Elastyczność jest wymagana od nowoczesnych czujników w celu zintegrowania ich z istniejącymi systemami. Z tego samego powodu czujnik posiada elastyczną konfigurację danych wyjściowych. Dane wyjściowe z czujnika mogą być pobierane w trzech wersjach: jako surowe dane z czujnika, jako dane po kalibracji i kompensacji temperaturowej lub jako wyjście filtra przetwarzającego. Dane z czujników mogą być również dostarczane w różnych postaciach do użytkownika. Pierwszą formą jest macierz obrotu, która jest generowana na podstawie danych z urządzenia. Dane mogą być również dostarczane do użytkownika końcowego w postaci kątów Eulera i ich wartości podawanych w stopniach lub radianach. Trzecim rodzajem reprezentacji danych wyjściowych jest wykorzystanie kwaternionów. Współrzędne pozycji wyjściowej z GPS są przesyłane w układzie współrzędnych ECEF (Earth Centered Earth Fixed). Jednostką szacowanej przez GPS prędkości jest m/s. Zastosowany wbudowany wysokościomierz ciśnienia atmosferycznego charakteryzuje się wewnętrzną kompensacją temperatury. Umożliwia on pomiar ciśnienia atmosferycznego w zakresie od 20 do 110 kPa z rozdzielczością 1,5 Pa. Za jego pomocą można oszacować wysokość położenia czujnika z rozdzielczością 30cm. Lokalizacja geograficzna czujnika jest obliczana za pomocą modułu GPS. GPS jest połączony z mikroprocesorem za pomocą szeregowej magistrali komunikacyjnej. W celu poprawy jakości estymacji współrzędnych możliwe jest przekazanie do GPS poprawek różnicowych (DGPS). Wyjście z GPS jest w układzie współrzędnych ECEF (Earth Centered Earth Fixed), a częstotliwość 10 Hz.
Prezentowany czujnik INS ma objętość poniżej 4cm3 z obudową i waży 8,86 . Taka wielkość czujnika może pozwolić projektantom robotów na przejście od urządzeń o znacznych rozmiarach do konstrukcji w skali mikro. Maksymalne przyspieszenie jakie jest w stanie wytrzymać czujnik to 500 , natomiast napięcie wejściowe wynosi od 3,5 do 8V, a pobór prądu to 50 mA. Istnieją dwa różne typy obudowy, które umożliwiają zamocowanie czujnika w różnych miejscach. Najmniejsza z nich wersja Micro (rys. 10) o wymiarach z mocowaniem 32,7 x 14,9 x 8,0 . Wersja ze złączem MCX (rys. 3b) ma wymiary 32,7 x 14,9 x 12,1 . Objętość wersji rozszerzonej jest mniejsza niż 6cm3. Czujnik może pracować w szerokim zakresie temperatur od -40°C do 80°C.
Pomiary fizyczne wszystkich wersji przedstawiono w Tab.5.
INS typ | Dim. X | Dim. Y | Dim. Z | Units | Volume |
Micro version | 32.7 | 14.9 | 8.0 | mm | 3,897 cm3 |
Wersja rozszerzona | 32,7 | 14.9 | 12,1 | mm | 5,895 cm3 |
Parametry wspólne | Min. | Typ | Max. | Jednostki | |
Waga (bez obudowy) | – | 3.67 | – | gram | |
Waga (w/obudowa) | – | 8.86 | – | gram | |
Temperatura pracy | -40 | – | 80 | °C | |
Temperatura przechowywania | -.60 | – | 100 | °C | |
Maksymalne przyspieszenie | – | 500 | – | g | |
Napięcie wejściowe | 3.5 | 5,0 | 6,0 | V | |
Prąd | 40 | 50 | 60 | mA |
Tabela 5.
Charakterystyka fizyczna czujnika.
Kalibrowane orientacje osi są wygrawerowane i pokolorowane na górnej stronie, jak przedstawiono na Rys. 11.
Wprowadzony INS został porównany z najmniejszym IMU o objętości poniżej 2 . Na rys. 12ab zaznaczono osie wymiarów i wielkości. Wymiar X mikro IMU 5 wynosi 18,6 co stanowi około 57% wielkości INS. Wymiar Y wynosi 14.7, co stanowi około 99% rozmiaru INS, a wymiar Z IMU jest mniej więcej równy 91% rozmiaru wersji Micro INS i 60% rozmiaru wersji Extended. Jednakże wersja Extended LEMO IMU ma rozmiar 18, co stanowi 225% wersji micro INS. Porównanie na podstawie objętości pozwala jedynie stwierdzić, że wersja micro INS jest mniej niż dwa razy większa (195% wersji micro IMU).
.