Badania elementów i zespołów maszyn laboratorium (MMM4035L) Ćwiczenie 22. Zastosowanie systemu nawigacyjnego w pomiarach geometrii Przygotowanie: Ewelina Świątek-Najwer
Wstęp teoretyczny: Rodzaje systemów nawigacji komputerowej Zadaniem systemu nawigacji komputerowej jest określenie położenia markerów w przestrzeni. Jednym z najbardziej znanych systemów nawigacji jest Global Positioning System, który pozwala ocenić położenie odbiornika posiadanego przez osobę na Ziemi dzięki odbiorowi sygnału z co najmniej 4 satelitów (do określenia 3 współrzędnych i prędkości obiektu). Wśród systemów nawigacji komputerowej możemy wyróżnić: A. nawigację za pomocą mechanicznego pozycjonowania B. nawigację ultradźwiękową C. nawigację elektromagnetyczną D. nawigację optyczną A. Pozycjonowanie mechaniczne System mierzy położenie i orientację dzięki połączeniu mechanicznemu pomiędzy punktem odniesienia a celem pomiarowym. Podczas pomiaru określamy 6 stopni swobody - położenie (trzy współrzędne punktu w przestrzeni) i orientację (trzy kąty opisujące obroty wokół trzech osi układu odniesienia). Enkodery umieszczone na przegubach ramienia mierzą zmiany pozycji i orientacji. Zmiany orientacji mogą być również mierzone za pomocą miniaturowych żyroskopów. Zaletą pozycjonowania mechanicznego jest duża skuteczność, wysoka dokładność i rozdzielczość. Wadą jest nieporęczna obsługa i ograniczona liczba stopni swobody. Rys. 1. Przykłady systemów nawigacyjnych pozycjonowania mechanicznego [4] B. Nawigacja ultradźwiękowa Pomiar położenia i orientacji obiektu za pomocą nawigacji ultradźwiękowej wykonuje się za pomocą jednej z dwóch metod. Pierwsza z nich polega na pomiarze czasu, w którym sygnał emitowany przez nadajnik jest zarejestrowany przez trzy odbiorniki umiejscowione na mierzonym obiekcie. Druga metoda pomiaru polega na ocenie różnicy faz pomiędzy falami ultradźwiękowymi emitowanymi przez nadajnik: na punkcie docelowym (obiekcie) i w pewnym punkcie referencyjnym. Jeżeli Rys. 2. Nawigacja ultradźwiękowa Zebris, Germany [5] Strona 2
różnica faz jest mniejsza niż 360 stopni - czyli mniej niż długość fali pomiędzy kolejnymi ramkami pomiaru, system aktualizuje położenie obiektu. Korzystając z wielu nadajników możliwy jest pomiar położenia obiektu w przestrzeni. Zaletami nawigacji ultradźwiękowej są małe i lekkie czujniki bezprzewodowe, wysoka rozdzielczość pomiaru, niska cena urządzeń. Wadą nawigacji ultradźwiękowej jest praca w ograniczonym półsferycznym obszarze. Pracę systemu ultradźwiękowego zakłócają obiekty odbijające ultradźwięki oraz źródła o wysokiej częstotliwości. Wadą jest również spadek współczynnika odświeżania ze wzrostem odległości od nadajnika. Ponadto, w przypadku metody z pomiarem czasu, wpływ na wyniki pomiaru ma temperatura, wilgotność oraz ciśnienie powietrza, które zmieniają prędkość fali ultradźwiękowej w powietrzu [1]. C. Nawigacja elektromagnetyczna System nawigacji elektromagnetycznej składa się z generatora pola magnetycznego i lokalizowanych cewek. Wyróżniamy dwa typy systemów nawigacji elektromagnetycznej - z generatorem pola stałego i zmiennego. Na pracę systemu z generatorem pola stałego wpływa obecność ferromagnetyków i zewnętrznych pól elektromagnetycznych. Systemy z generatorem pola zmiennego są stabilne wobec zewnętrznych pól magnetycznych, natomiast wywołują powstawanie prądów wirowych w materiałach przewodzących, z czym związane jest powstanie nowych pól elektromagnetycznych zakłócających pomiar. Zaletą systemu nawigacji elektromagnetycznej jest możliwość lokalizacji obiektów bez Rys. 3. Nawigacja elektromagnetyczna Aurora, NDI, Kanada [3] konieczności utrzymywania linii widoczności pomiędzy generatorem pola i lokalizowanymi elementami, a także możliwość zastosowania bezprzewodowych odbiorników o małych rozmiarach i małej masie. Wadą systemu jest jego czułość na obecność zewnętrznych pól elektromagnetycznych generowanych przez urządzenia elektromagnetyczne, zakłócenia pochodzące od materiałów przewodzących i ferromagnetyków. D. Nawigacja optyczna Systemy nawigacji optycznej możemy podzielić na systemy w świetle widzialnym, systemy laserowe i systemy w świetle podczerwonym. Zasada działania systemu nawigacji optycznej polega na przestrzennej rekonstrukcji ocenianego położenia za pomocą algorytmów triangulacji. W przypadku systemów pracujących w świetle widzialnym stosowane są markery z polami o wysokim kontraście, na przykład w postaci białych i czarnych pól, których kontrola geometrii za pomocą kamery pozwala lokalizować element w przestrzeni. Rys. 4. Zasada nawigacji optycznej [2] Strona 3
Rys. 5. System nawigacji optycznej w świetle widzialnym, MicronTracker, Clarontech [6] Popularnymi systemami nawigacji optycznej są systemy nawigacji w zakresie podczerwieni. Istnieją dwa typy nawigowanych elementów, tzw. Rigid Body (tj. ciał sztywnych, czyli o stałych odległościach pomiędzy charakterystycznymi punktami): aktywne i pasywne. Lokalizacja aktywna: Aktywne Rigid Body emituje z diod promieniowanie podczerwone, rejestrowane przez kamerę. Rigid Body dołączone jest do układu sterowania (Tool Interface Unit), który następnie podłączony jest do kamery. Rys. 6. Rigid Body aktywne Rigid Body aktywne składa się z dwóch powierzchni (faces), na których rozmieszczone są po trzy diody emitujące podczerwień. Obie powierzchnie uczestniczą w procedurze trackingu czyli śledzenia przez kamerę lokalizacji w przestrzeni. Rigid Body należy skalibrować, to znaczy określić położenie jego lokalnego układu współrzędnych w odniesieniu do położenia markerów (tj. diod). Plik kalibracyjny zapisywany jest na pamięci EPROM we wtyczce Rigid Body. Lokalizacja pasywna: Kulki umieszczone na pasywnym Rigid Body pokryte są tzw. powierzchnią retrorefleksyjną odbijającą promieniowanie podczerwone emitowane przez kamerę. Odbite promieniowanie jest rejestrowane przez kamerę. Strona 4
Pasywne Rigid Body, różnią się geometrią ramion, czyli rozmieszczeniem kulek. Na tej właśnie podstawie kamera rozpoznaje rodzaj Rigid Body. Plik kalibracyjny pasywnego Rigid Body opisujący położenie lokalnego układu współrzędnych w odniesieniu do położenia markerów pokrytych powierzchnią retrorefleksyjną zapisywany jest na dysku komputera i wczytywany do systemu. Rys. 7. Rigid Body pasywne System Polaris Przykładem systemu nawigacyjnego w podczerwieni jest kamera Polaris firmy NDI. Kamera pozwala lokalizować położenie i orientację diod emitujących podczerwień oraz sfer pokrytych powierzchnią retrorefleksyjną. Wokół kamer CCD wbudowane są diody podczerwone, pozwalające na pracę systemu w trybie pasywnym. Dokładność lokalizacji wynosi 0.25 mm (błąd 3D RMS). Częstotliwość odświeżania wynosi 60Hz. Rys. 8 Obszar pracy systemu Polaris W skład sytemu wchodzą: - Kamera Polaris (rys. 9) - TIU: Tool Interface Unit (rys. 9) - Rigid Bodies (rys. 6,7,9) Strona 5
Rys. 9. System Polaris: kamera, TIU, Rigid Bodies Kamera przekazuje do komputera następujące dane: wektor przesunięcia pomiędzy układem współrzędnych kamery, a układem współrzędnych Rigid Body, kwaternion, który określa macierz rotacji pomiędzy układem współrzędnych kamery, a układem współrzędnych Rigid Body oraz błąd lokalizacji (RMS 3D). Na rys. 10 przedstawiono sytuację, w której kamera jest układem referencyjnym, to znaczy pozycja Rigid Body (B) jest określana w układzie współrzędnych związanym z kamerą. Na rys. 11 przestawiono sytuację, w której układem referencyjnym jest Rigid Body C. Kamera lokalizuje dwa Rigid Bodies. Istnieje możliwość odczytywania współrzędnych ich położenia w układzie współrzędnych związanych z kamerą. Możliwe jest również powiązanie układu współrzędnych z Rigid Body C. W ten sposób określa się współrzędne Rigid Body B względem Rigid Body C. W celu określenie położenia Rigid Body B względem Rigid Body C należy rozwiązać równanie macierzowe postaci: T T A C C B T T C B 1 A C T T A B A B gdzie T A-C określa macierz transformacji dla Rigid Body C względem układu współrzędnych kamery A T A-B określa macierz transformacji dla Rigid Body B względem układu współrzędnych kamery A T C-B określa macierz transformacji dla Rigid Body B względem układu współrzędnych referencji C Strona 6
Rys. 10. Referencja w układzie dwuelementowym (kamera + Rigid Body) Rys. 11. Referencja w układzie trzy elementowym (kamera + 2 Rigid Bodies) Wady i zalety metody Zaletą systemu nawigacji optycznej jest możliwość zastosowania czujników pasywnych, szeroki obszar działania, wysoka rozdzielczość w ograniczonym obszarze pracy. Wadą systemu nawigacji optycznej jest konieczność utrzymania linii widoczności pomiędzy kamerą i kontrolowanym obiektem. Pracę systemu optycznego w zakresie podczerwieni zakłócać mogą inne źródła światła w zakresie podczerwieni (silne reflektory, intensywne światło dzienne). Obiekty odbijające światło również zakłócają pomiar. Zastosowania optycznego systemu nawigacyjnego w przemyśle. Systemy nawigacji optycznej znajdują zastosowanie w badaniach prototypów lub elementów i zespołów maszyn. Umożliwiają one kontrolę geometrii obiektu, jak również ocenę pracy elementów i maszyn w czasie rzeczywistym (częstotliwość odświeżania wynosi 4500 Hz i możliwe jest lokalizowanie do 512 diod jednocześnie). Przykładem systemu jest OPTOTRAK PROseries, firmy NDI, który zapewnia możliwość wykonania następujących badań: - za pomocą nawigowanej sondy pomiarowej Rys. 12. Pomiar z wykorzystaniem nawigowanej sondy pomiarowej [3] Strona 7
- za pomocą nawigowanego skanera laserowego Rys. 13. Pomiar z wykorzystaniem nawigowanego skanera laserowego [3] - z wykorzystaniem ramki referencyjnej zamontowanej na obiekcie Strona 8
Rys. 14. Pomiar z wykorzystaniem ramki referencyjnej [3] - lub z analizy ruchu obiektu. Rys. 15. Analiza deformacji drzwi samochodu oklejonego markerami w postaci diod podczerwonych kontrolowanych za pomocą systemu nawigacji optycznej OPTOTRAK [3] Rys. 16. Wynik testu zamykania drzwi w postaci wykresu położenia punktu drzwi, w którym zamocowano marker (diodę podczerwoną) [3] Strona 9
Rys. 17. Kontrola położenia ramienia robota [3] Nawigacja optyczna pozwala na wykonanie następujących pomiarów geometrii elementów i zespołów maszyn: w zakresie inżynierii odwrotnej (Reverse Engineering): -uzyskiwanie modelu CAD ze skanowania powierzchni w zakresie weryfikacji i kontroli maszyn: - kontrola prototypu w odniesieniu do projektu - Part-to CAD- inspection - kontrola mocowania w zakresie analiz w czasie rzeczywistym: - analiza drgań, - analiza deformacji, - testowanie strukturalne, - testy zamykania drzwi i wyrównania, -weryfikacja pracy robota. Część praktyczna W ramach części praktycznej zajęć należy wykonać pomiar geometrii przestrzennej zadanego obiektu mechanicznego z wykorzystaniem nawigowanego za pomocą systemu Polaris wskaźnika. Rys. 18. Wskaźnik wyposażony w Rigid Body Strona 10
W celu wykonania pomiaru z wykorzystaniem nawigowanego wskaźnika należy zastosować tzw. procedurę pivotingu. Procedura pivotingu polega na określeniu offsetu wskaźnika. W celu określenia położenia końcówki wskaźnika w układzie współrzędnych Rigid Body zamocowanego na wskaźniku, należy wykonać w miarę możliwości pełny obrót utrzymując końcówkę wskaźnika w jednym punkcie będącym centrum rotacji. Algorytm pivotingu określa współrzędne końcówki wskaźnika i dokonuje przesunięcia układu współrzędnych Rigid Body na końcówkę wskaźnika. Ustawienie offsetu należy zachować na czas wszystkich pomiarów. Rys. 19. Pivoting wskaźnika Na podstawie zebranej chmury punktów badanego obiektu należy narysować badany obiekt za pomocą oprogramowania typu CAD. W ramach oceny uzyskanych wyników pomiaru należy wykonać pomiary podstawowych wymiarów obiektu za pomocą suwmiarki. Bibliografia: 1. http://www.hitl.washington.edu/scivw/eve/i.d.1.b.trackingdevices.html 2. http://www.iotracker.com/index.php?q=optical_tracking 3. www.ndigital.com 4. http://www.cse.unr.edu/~wsherman/cs491a/lectures/chapter_4.html 5. http://www.zebris.de/ 6. http://www.clarontech.com/microntracker_technology.php Strona 11