REJESTRACJA PARAMETRÓW RUCHU OBIEKTU PRZY UŻYCIU CZUJNIKÓW Z RODZINY MEMS OBJECT MANEUVER REGISTRATION USING MEMS SENSORS

Podobne dokumenty
PROJECT OF FM TUNER WITH GESTURE CONTROL PROJEKT TUNERA FM STEROWANEGO GESTAMI

Cyfrowy rejestrator parametrów lotu dla bezzałogowych statków powietrznych. Autor: Tomasz Gluziński

Zastosowanie procesorów AVR firmy ATMEL w cyfrowych pomiarach częstotliwości

MODEL STANOWISKA DO BADANIA OPTYCZNEJ GŁOWICY ŚLEDZĄCEJ

Parametryzacja przetworników analogowocyfrowych

Komputerowe systemy pomiarowe. Dr Zbigniew Kozioł - wykład Mgr Mariusz Woźny - laboratorium

LABORATORIUM - ELEKTRONIKA Układy mikroprocesorowe cz.2

Laboratorium Komputerowe Systemy Pomiarowe

APPLICATION OF ADUC MICROCONTROLLER MANUFACTURED BY ANALOG DEVICES FOR PRECISION TENSOMETER MEASUREMENT

Generator przebiegów pomiarowych Ex-GPP2

GATHERING DATA SYSTEM FOR CONCRETE S SAMPLE DESTRUCTING RESEARCHES WITH USE OF LABVIEW PACKET

WIZUALIZACJA DANYCH SENSORYCZNYCH Sprawozdanie z wykonanego projektu. Jakub Stanisz

Kod produktu: MP01105

Sensory i systemy pomiarowe Prezentacja Projektu SYNERIFT. Michał Stempkowski Tomasz Tworek AiR semestr letni

IMPLEMENTATION OF THE SPECTRUM ANALYZER ON MICROCONTROLLER WITH ARM7 CORE IMPLEMENTACJA ANALIZATORA WIDMA NA MIKROKONTROLERZE Z RDZENIEM ARM7

Kod produktu: MP01105T

MCAR Robot mobilny z procesorem AVR Atmega32

E-TRONIX Sterownik Uniwersalny SU 1.2

WIZUALIZACJA DANYCH SENSORYCZNYCH MINISTACJA METEOROLOGICZNA

Obługa czujników do robota śledzącego linie. Michał Wendland czerwca 2011

Systemy wbudowane. Paweł Pełczyński

Laboratorium Komputerowe Systemy Pomiarowe

Wykrywacz kłamstw. Grzegorz Puzio, Łukasz Ulanicki 15 czerwca 2008

Wbudowane układy komunikacyjne cz. 1 Wykład 10

Wizualizacja stanu czujników robota mobilnego. Sprawozdanie z wykonania projektu.

Układ pomiarowy CoachLab II

ADuCino 360. Zestaw uruchomieniowy dla mikrokontrolerów ADuCM360/361

Aplikacja dla eksperymentu identyfikacyjnego z wykorzystaniem układu PAIO. Wykonał : Marcin Cichorowski Prowadzenie : dr inż.

Badanie właściwości wysokorozdzielczych przetworników analogowo-cyfrowych w systemie programowalnym FPGA. Autor: Daniel Słowik

Aplikacje Systemów. Nawigacja inercyjna. Gdańsk, 2016

Biomonitoring system kontroli jakości wody

Stanowisko do badania współczynnika tarcia

Ćw. 12. Akwizycja sygnałów w komputerowych systemach pomiarowych ( NI DAQPad-6015 )

Politechnika Gdańska Wydział Elektrotechniki i Automatyki Katedra Inżynierii Systemów Sterowania

Ultradźwiękowy miernik poziomu

projekt przetwornika inteligentnego do pomiaru wysokości i prędkości pionowej BSP podczas fazy lądowania;

SigmaDSP - zestaw uruchomieniowy dla procesora ADAU1701. SigmaDSP - zestaw uruchomieniowy dla procesora ADAU1701.

ТТ TECHNIKA TENSOMETRYCZNA

Sprawozdanie z projektu MARM. Część druga Specyfikacja końcowa. Prowadzący: dr. Mariusz Suchenek. Autor: Dawid Kołcz. Data: r.

WYKORZYSTANIE PLATFORMY FireMonkey W PROCESIE URUCHAMIANIA I TESTOWANIA UKŁADÓW MIKROPROCESOROWYCH

OPBOX ver USB 2.0 Miniaturowy Ultradźwiękowy system akwizycji danych ze

Przetwornik analogowo-cyfrowy

Czujniki podczerwieni do bezkontaktowego pomiaru temperatury. Czujniki stacjonarne.

OKREŚLENIE WPŁYWU WYŁĄCZANIA CYLINDRÓW SILNIKA ZI NA ZMIANY SYGNAŁU WIBROAKUSTYCZNEGO SILNIKA

Rejestratory Sił, Naprężeń.

ТТ TECHNIKA TENSOMETRYCZNA

ТТ TECHNIKA TENSOMETRYCZNA

Laboratoryjny system do badania charakterystyk kątowych czujników anemometrycznych

PROGRAM TESTOWY LCWIN.EXE OPIS DZIAŁANIA I INSTRUKCJA UŻYTKOWNIKA

Wstęp Architektura... 13

STM32Butterfly2. Zestaw uruchomieniowy dla mikrokontrolerów STM32F107

1. Wprowadzenie Programowanie mikrokontrolerów Sprzęt i oprogramowanie... 33

UNO R3 Starter Kit do nauki programowania mikroprocesorów AVR


1. Zasilacz mocy AC/ DC programowany 1 sztuka. 2. Oscyloskop cyfrowy z pomiarem - 2 sztuki 3. Oscyloskop cyfrowy profesjonalny 1 sztuka

PRZETWORNIK ADC w mikrokontrolerach Atmega16-32

ТТ TECHNIKA TENSOMETRYCZNA

ĆWICZENIE 5 WPŁYW KONWEKCJI NA ROZKŁAD TEMPERATURY W POMIESZCZENIU

WPROWADZENIE Mikrosterownik mikrokontrolery

ĆWICZENIE nr 3. Badanie podstawowych parametrów metrologicznych przetworników analogowo-cyfrowych

TES 1601 #02982 TES 1602 #02983

RSD Uniwersalny rejestrator danych Zaprojektowany do pracy w przemyśle

Teltonika FMB920 Instrukcja montażu i konfiguracji

8-KANAŁOWY WZMACNIACZ MOCY Z 10-KANAŁOWYM DSP

Rejestrator sygnałów napięciowych biomedycznych

Programowanie mikrokontrolerów. 8 listopada 2007

Sensoryka i układy pomiarowe łazika marsjańskiego Scorpio IV

- WALKER Czteronożny robot kroczący

1.2. Architektura rdzenia ARM Cortex-M3...16

Zastosowania mikrokontrolerów w przemyśle

Spis treści. Projekt współfinansowany ze środków Unii Europejskiej w ramach Europejskiego Funduszu Społecznego

2. Zawartość dokumentacji. 1. Strona tytułowa. 2. Zawartość dokumentacji. 3. Spis rysunków. 4. Opis instalacji kontroli dostępu. 3.

1. Opis aplikacji. 2. Przeprowadzanie pomiarów. 3. Tworzenie sprawozdania

Cyfrowy wzmacniacz AED dla przetworników tensometrycznych.

o Instalacja środowiska programistycznego (18) o Blink (18) o Zasilanie (21) o Złącza zasilania (22) o Wejścia analogowe (22) o Złącza cyfrowe (22)

2.2 Opis części programowej

ZL15AVR. Zestaw uruchomieniowy dla mikrokontrolerów ATmega32

Projekt MARM. Dokumentacja projektu. Łukasz Wolniak. Stacja pogodowa

Politechnika Gdańska WYDZIAŁ ELEKTRONIKI TELEKOMUNIKACJI I INFORMATYKI. Katedra Metrologii i Optoelektroniki. Metrologia. Ilustracje do wykładu

SPECYFIKACJA TECHNICZNA

Rozproszony system zbierania danych.

Wspomagane komputerowo stanowisko do wyznaczania charakterystyk statycznych czujników przemieszczeń liniowych i kątowych

NOWE MOśLIWOŚCI POMIAROWE ZAKŁADU DYNAMIKI BUDOWLI

Kod produktu: MP01611

Kontroler do gier FPS

oznaczenie sprawy: CRZP/231/009/D/17, ZP/66/WETI/17 Załącznik nr 6 I-III do SIWZ Szczegółowy opis przedmiotu zamówienia dla części I-III

UW-DAL-MAN v2 Dotyczy urządzeń z wersją firmware UW-DAL v5 lub nowszą.

MultiTool instrukcja użytkownika 2010 SFAR

SPOSOBY POMIARU KĄTÓW W PROGRAMIE AutoCAD

Technik elektronik 311[07] moje I Zadanie praktyczne

Pracownia Transmisji Danych, Instytut Fizyki UMK, Toruń. Instrukcja do ćwiczenia nr 10. Transmisja szeregowa sieciami energetycznymi

ZL16AVR. Zestaw uruchomieniowy dla mikrokontrolerów ATmega8/48/88/168

dokument DOK wersja 1.0

W semestrze letnim studenci kierunku Aplikacje Internetu Rzeczy podczas ćwiczeń z programowania CAD/CAM

System akwizycji danych na bazie platformy Arduino

SmartCheck. FAG - linia produktów do diagnostyki drganiowej. ProCheck. DTECTX1 s. SmartCheck. huta / papiernia / kopalnia. łożyska

Rys. 1. Schemat ideowy karty przekaźników. AVT 5250 Karta przekaźników z interfejsem Ethernet

Uproszczony schemat blokowy konwertera analogowo-cyfrowego przedstawiony został na rys.1.

BEZDOTYKOWY CZUJNIK ULTRADŹWIĘKOWY POŁOŻENIA LINIOWEGO

ZAWIERA SUGEROWANE CENY DETALICZNE OBOWIĄZUJĄCE OD

Transkrypt:

Dr hab. inż. Jan PIETRASIEŃSKI, prof. WAT Mgr inż. Kamil DZIĘGIELEWSKI Wojskowa Akademia Techniczna REJESTRACJA PARAMETRÓW RUCHU OBIEKTU PRZY UŻYCIU CZUJNIKÓW Z RODZINY MEMS Streszczenie: W niniejszym referacie zostało zaprezentowane rozwiązanie programowo- sprzętowe systemu, do rejestracji parametrów ruchu obiektu, do budowy którego wykorzystano czujniki MEMS. W artykule zostały zaprezentowane wybrane czujniki, rozwiązanie przetwarzania sygnału przy wykorzystaniu mikroprocesora z rodziny AVR oraz zapis danych pomiarowych na układzie pamięci FLASH. OBJECT MANEUVER REGISTRATION USING MEMS SENSORS Abstract: This paper presents software/hardware solution of object maneuver registration system based on MEMS angular rate and acceleration sensors. Moreover chosen sensors are presented. Acquisition and measurement data recording is explained basing on Atmel AVR microcontroller with use of flash memory card. Słowa kluczowe: rejestracja, parametry ruchu, czujniki Keywords: registration, motion parameters, sensors 1. WPROWADZENIE Określanie parametrów ruchu obiektu jest zagadnieniem znajdującym zastosowanie w wielu dziedzinach. Rejestracja parametrów, takich jak przyspieszenia liniowe i prędkości kątowe, jest często wykorzystywana w celu identyfikacji parametrycznej obiektu. Systemy do pomiaru parametrów ruchu znajdują się w wielu urządzeniach mechatronicznych. Obiektem takim może być zarówno pojazd, robot mobilny, jak i bezzałogowy statek latający (BSL). W motoryzacji czujniki ruchu wykorzystywane są w systemach kontroli trakcji, układach antykradzieżowych, jak również w systemach wykrywających zdarzenia krytyczne (kolizje, wypadki). Obecnie bezzałogowe statki latające używane są w takich branżach, jak [1]: organizacja imprez masowych, budownictwo drogowe, dziennikarstwo, geodezja i kartografia, geologia i geotechnika, media, ochrona i monitoring, służby mundurowe, rolnictwo i leśnictwo, teledetekcja i fotogrametria. Układy określania parametrów ruchu obiektu są niezbędnym elementem w systemach autopilotów BSL. Do zaprojektowania odpowiedniego algorytmu sterowania BSL potrzebne są charakterystyki aerodynamiczne takiego obiektu, co wiąże się z potrzebą ich identyfikacji. 643

W związku z rosnącym zainteresowaniem systemami określania parametrów ruchu został wykonany układ, którego zadaniem była rejestracja zmierzonych parametrów ruchu obiektu. Pomiar parametrów ruchu wykonano poprzez umieszczenie układu mierzącego parametry ruchu na badanym obiekcie. Dane pomiarowe z czujników, czyli wartości przyspieszeń liniowych i prędkości kątowych w trzech osiach, przetwarzane były przez mikrokontroler, a następnie zapisywanie na pamięci typu FLASH. 2. BUDOWA SYSTEMU System można podzielić na następujące części: układ pomiarowy, układ przetwarzania danych, układ akwizycji. Układem przetwarzania danych jest mikrokontroler. Informacje pomiarowe dostarczane są do układu przetwarzania danych z układu pomiarowego oraz zapisywane za pomocą układu akwizycji danych. Schemat ideowy systemu został przedstawiony na rysunku 1. Rys. 1. Schemat blokowy systemu Wykorzystane elementy Jako jednostka obliczeniowa systemu wykorzystany został mikrokontroler z Atmega32 z rodziny mikrokontrolerów AVR firmy Atmel. Poniżej przedstawione zostały podstawowe parametry układu [2]: częstotliwość zegara 8-16 MHz, niskie zużycie energii (1,1 ma przy 1 MHz, 3 V zasilania w temperaturze 25 C), zintegrowany 8-kanałowy, 10-bitowy przetwornik Analogowo- cyfrowy (A/C), wbudowana obsługa interfejsów I 2 C oraz SPI. 644

Do budowy układu pomiarowego wykorzystane zostały czujniki wykonane w technologii MEMS (z ang. Micro Electro-Mechanical Systems). Żyroskopy wykonane w technologii MEMS w porównaniu do żyroskopów światłowodowych, stosowanych w komercyjnych rozwiązaniach, charakteryzują się mniejszym poborem energii, mniejszymi wymiarami oraz niższą ceną [3]. W rozwiązaniach systemów inercyjnych znajdują zastosowanie głównie akcelerometry elektromechaniczne oraz piezoelektryczne. Akcelerometry piezoelektryczne charakteryzują się szerokim pasmem pomiarowym w porównaniu do akcelerometrów elektromechanicznych, małą stabilnością oraz małą odpornością na uszkodzenia mechaniczne. Akcelerometry MEMS charakteryzują się niewielkimi wymiarami (rzędu kilku milimetrów) oraz dużą odpornością na uszkodzenia mechaniczne [4]. Do pomiaru przyspieszeń liniowych wykorzystano akcelerometr Analog Devices ADXL 345. Jest to trójosiowy akcelerometr z wyjściem cyfrowym o rozdzielczości 13 bitów. Komunikacja pomiędzy czujnikiem a mikrokontrolerem może odbywać się zarówno z użyciem interfejsu SPI, jak i I 2 C. Rozdzielczość pomiarowa czujnika zależna jest od wykorzystywanego zakresu pomiarowego (odpowiednio dla zakresów rozdzielczość wynosi: 2g 10 bit, 4g 11 bit, 8g 12 bit, 16g 13 bit). Częstotliwość próbkowania czujnika można zmieniać w zakresie od 6,25 Hz do 3,2 khz [5]. Początkowo do pomiaru prędkości kątowej został wykorzystany jednoosiowy czujnik Analog Devices ADXRS 612. Następnie system został wyposażony w dodatkowy żyroskop dwuosiowy STMicroelectronics LPR 510AL. Zarówno ADXRS 612, jak i LPR 510AL są żyroskopami z wyjściem analogowym. Wybrane parametry żyroskopów przedstawiono w tabeli 1. Tabela 1. Wybrane parametry wykorzystanych żyroskopów [6, 7] Parametr\Żyroskop ADXRS 612 LPR 510 AL Zakres pomiarowy ± 300 /s ± 100 /s, ± 400 /s Czułość 7 mv/ /s 2,5 mv/ /s, 10 mv/ /s Prąd zasilania 0.35 ma 6,8 ma Zasilanie 5 V 3 V Do budowy układu wykorzystano zestaw uruchomieniowy z mikrokontrolerem ATmega32. Zaletą wykorzystania takiego zestawu jest łatwość zmiany konfiguracji połączeń elementów systemu, możliwość bezpośredniego zasilania czujników oraz rozbudowy systemu o nowe elementy. Dodatkową zaletą jest umieszczone gniazdo kart pamięci MMC (z ang. Multi Media Card). Wykorzystane czujniki umieszczone były również na zestawach ewaluacyjnych, co eliminowało konieczność wykonywania dedykowanych układów płytek drukowanych, układów zasilania, co znacznie przyspieszyło proces budowy układu pomiarowego. Dane pomiarowe z czujników zapisywane były na karcie pamięci Flash. Pamięć FLASH cechuje niskie zużycie energii oraz duża wytrzymałość na uszkodzenia mechaniczne. Zastosowanie karty pamięci umożliwia również szybkie przeniesienie danych pomiarowych do pamięci komputera w celu dalszej analizy wyników pomiarów. Pomiar parametrów ruchu 645

Akwizycja próbek sygnału z żyroskopów została zrealizowana przy wykorzystaniu wewnętrznego przetwornika A/C mikrokontrolera. Konfiguracja parametrów przetwornika, takich jak wybór napięcia zasilania, sposób zapisu danych pomiarowych, wybór kanału przetwornika, odbywa się poprzez zapis odpowiednich wartości do rejestru ADMUX mikrokontrolera. Jako napięcie odniesienia wykorzystano stabilizowane źródło napięcia zestawu ewaluacyjnego. Sterowanie pracą przetwornika (uruchomienie, wybór częstotliwości próbkowania) odbywa się poprzez ustawienie odpowiednich wartości w rejestrze ADSCRA. Dane pomiarowe (10 bitów) zapisywane są w dwóch rejestrach mikrokontrolera. Odczytanie próbek z pamięci podręcznej akcelerometru odbywało się poprzez łącze cyfrowe pracujące w interfejsie szeregowym I 2 C. Obsługa tego interfejsu wspomagana jest przez mikrokontroler (w nomenklaturze firmy Atmel interfejs ten określany jest jako TWI z ang. Two Wire Interface). Zaletą wykorzystania interfejsu I 2 C jest ograniczenie ilości połączeń (do transmisji danych wymagane są dwa przewody). Możliwa prędkość transmisji w tym interfejsie wynosi 400 kbps [2], co umożliwia odczyt danych pomiarowych z częstotliwością 800 Hz [5]. Wymiana danych pomiędzy mikrokontrolerem a akcelerometrem opierała się na zapisie lub odczycie wartości rejestru TWDR mikrokontrolera. W zależności od wartości rejestru TWCR dane z rejestru TWDR były wysyłane do akcelerometru lub dane z akcelerometru były zapisywane do TWDR. Konfiguracja parametrów transmisji, ustawień czujnika oraz dostęp do próbek pomiarowych polegały na zapisie lub odczycie odpowiednich rejestrów danych akcelerometru. Należy zwrócić uwagę na sposób odczytu danych pomiarowych. W użytym akcelerometrze dane z jednego pomiaru zapisywane są w sześciu ośmiobitowych rejestrach. Zapis oraz prezentacja danych pomiarowych Dane pomiarowe zapisywane były przez mikrokontroler na karcie pamięci MMC, w nowo utworzonym pliku. W poszczególnych kolumnach zapisywane były kolejno próbki z odpowiednich czujników. Utworzenie pliku na karcie pamięci, który można odczytać w komputerze z systemem operacyjnym Windows, wymagało zapisu danych na karcie pamięci w formacie FAT (z ang. File Allocation Table). Do zapisu danych w systemie FAT 32 została użyta biblioteka ze strony [8]. Biblioteka ta służy do zarządzania danymi na karcie pamięci z użyciem mikrokontrolera z rodziny AVR. Zapis i odczyt danych na karcie pamięci z użyciem biblioteki [8] odbywał się w oparciu o komendy wysyłane z komputera do mikrokontrolera za pośrednictwem portu RS 232. W związku z tym wprowadzono modyfikacje do biblioteki w celu umożliwienia bezpośredniego zapisu danych pomiarowych na karcie pamięci bez użycia komputera. Opracowano program komputerowy w środowisku C++ Builder do akwizycji i prezentacji danych pomiarowych z układu pomiarowego na ekranie komputera PC z systemem operacyjnym Windows. Na rysunku 2 został przedstawiony graficzny interfejs wspomnianego oprogramowania. 646

Rys. 2. Interfejs graficzny programu do prezentacji danych pomiarowych w trybie online W celu weryfikacji działania systemu wykonane zostały pomiary polegające na umieszczeniu urządzenia na motocyklu. Układ pomiarowy został zamontowany w schowku pod siedzeniem kierowcy. Na rysunkach 3 i 4 zostały przedstawione odpowiednio wykresy przyspieszeń liniowych oraz prędkości kątowych dla przyspieszenia i hamowania. 5 4 przyspieszenie[g] 3 2 1 0-1 -2-3 0 10 20 30 40 50 t [s] y x z Rys. 3. Wykresy przyspieszeń liniowych podczas przyspieszenia i hamowania motocykla 647

60 40 prędkość kątowa[ /s] 20 0-20 0 10 20 30 40 50 giro x giro y giro z -40-60 t [s] Rys. 4. Wykresy prędkości kątowych podczas przyspieszenia i hamowania motocykla Porównując wyniki pomiarów opublikowanych w pracy [9] z wynikami pomiarów zaprezentowanymi na rysunkach 3 oraz 4, można stwierdzić poprawność działania opracowanego systemu. 3. PODSUMOWANIE Różnorodność czujników ruchu obecnych na runku stwarza szerokie możliwości ich wykorzystania. Czujniki MEMS sprawdzają się w zastosowaniach mobilnych do pomiaru parametrów ruchu obiektów, takich jak pojazdy drogowe czy BSL. Dostępność i wybór mikrokontrolerów umożliwia dobór optymalnego urządzania do przetwarzania i akwizycji danych pomiarowych w opisywanym systemie. Niskie zużycie energii, wymiary oraz masa przemawiają za użyciem opisanych czujników do budowy taniego systemu wykorzystywanego w wielu rozwiązaniach (identyfikacja parametrów aerodynamicznych BSL, badanie charakterystyk pojazdów). LITERATURA [1] http://www.robokopter.pl. [2] Dokumentacja techniczna ATmega32 firmy Atmel, USA: Atmel, 2009. [3] Tanenhaus M.: Miniature UMU/INS with Optimally Fused Low Drift MEMS Gyro and Accelerometers for Applications in GPS-denied Environments, Position Location and Navigation Symposium (PLANS), 2012. [4] Dong Y., Zwahlen P., Nguyen A.M., Rudolf F., Stauffer J.M., High Performance Inertial Navigation Grade Sigma- Delta MEMS Accelerometer, Mechatronics and Automation, 2009. [5] Dokumentacja techniczna ADXL 345 firmy Analog Devices, USA: Analog Devices, 2013. 648

[6] Dokumentacja techniczna ADXRS 612 firmy Analog Devices, USA: Analog Devices, 2007. [7] Dokumentacja techniczna LPR510AL firmy STMicroelectronics, USA: STMicroelectronics, 2009. [8] http://http://www.dharmanitech.com/ [9] Pietrasieński J., Rodzik D., Bużantowicz W., Miernik J., Paramuszczak K., Analiza możliwości detekcji zdarzeń krytycznych z udziałem motocykla. Część I. Wykorzystanie drgań i wibracji motocykla, WAT, Warszawa, 2012. 649

650