MODEL MANIPULATORA O DWÓCH STOPNIACH SWOBODY



Podobne dokumenty
Roboty manipulacyjne i mobilne. Roboty przemysłowe zadania i elementy

Proste układy wykonawcze

Laboratorium z Napęd Robotów

MODEL MANIPULATORA O STRUKTURZE SZEREGOWEJ W PROGRAMACH CATIA I MATLAB MODEL OF SERIAL MANIPULATOR IN CATIA AND MATLAB

PRACA PRZEJŚCIOWA SYMULACYJNA. Zadania projektowe

Politechnika Poznańska Instytut Technologii Mechanicznej. Laboratorium MASZYN I URZĄDZEŃ TECHNOLOGICZNYCH. Nr 2

(12) OPIS PATENTOWY (19) PL (11) (13) B1

P O L I T E C H N I K A Ł Ó D Z K A INSTYTUT ELEKTROENERGETYKI ZAKŁAD ELEKTROWNI LABORATORIUM POMIARÓW I AUTOMATYKI W ELEKTROWNIACH

Roboty przemysłowe. Cz. II

Struktura manipulatorów

StrK Sterownik bipolarnego silnika krokowego

Materiały pomocnicze do ćwiczeń laboratoryjnych

Sterowanie, uczenie i symulacja robotów przemysłowych Kawasaki

Napędy urządzeń mechatronicznych - projektowanie. Ćwiczenie 3 Dobór silnika skokowego do pracy w obszarze rozruchowym

Mechanika Robotów. Wojciech Lisowski. 5 Planowanie trajektorii ruchu efektora w przestrzeni roboczej

PRACA DYPLOMOWA MAGISTERSKA

Manipulatory i roboty mobilne AR S1 semestr 5

ANALIZA KINEMATYKI MANIPULATORÓW NA PRZYKŁADZIE ROBOTA LINIOWEGO O CZTERECH STOPNIACH SWOBODY

1 Zasady bezpieczeństwa

AP3.8.4 Adapter portu LPT

Notacja Denavita-Hartenberga

Prototypowanie sterownika dla robota 2DOF

IRB PODSUMOWANIE:

PRZEWODNIK PO PRZEDMIOCIE

PL B1. PRZEMYSŁOWY INSTYTUT AUTOMATYKI I POMIARÓW PIAP, Warszawa, PL BUP 13/09. RAFAŁ CZUPRYNIAK, Warszawa, PL

1. STRUKTURA MECHANIZMÓW 1.1. POJĘCIA PODSTAWOWE

Badanie napędu z silnikiem bezszczotkowym prądu stałego

Podstawy robotyki wykład III. Kinematyka manipulatora

W TECHNOLOGII DRUKU 3D

ZROBOTYZOWANE STANOWISKO DO PALETYZACJI

PL B1. Manipulator równoległy trójramienny o zamkniętym łańcuchu kinematycznym typu Delta, o trzech stopniach swobody

Instrukcja obsługi AP3.8.4 Adapter portu LPT

PRZEKŁADNIE ZĘBATE. Przekł. o osiach stałych. Przekładnie obiegowe. Planetarne: W=1 Różnicowe i sumujące: W>1

Młody inżynier robotyki

Rys. 1. Krzywe mocy i momentu: a) w obcowzbudnym silniku prądu stałego, b) w odwzbudzanym silniku synchronicznym z magnesem trwałym

Wyznaczanie sił w przegubach maszyny o kinematyce równoległej w trakcie pracy, z wykorzystaniem metod numerycznych

Rotor RAS

Napędy elektromechaniczne urządzeń precyzyjnych - projektowanie. Ćwiczenie 3 Dobór mikrosilnika prądu stałego do układu pozycjonującego

Zastosowanie silników krokowych jako napęd robota mobilnego

Obrotniki i. pozycjonery przeznaczone do spawania ręcznego i zautomatyzowanego.

PL B1. PRZEDSIĘBIORSTWO HAK SPÓŁKA Z OGRANICZONĄ ODPOWIEDZIALNOŚCIĄ, Wrocław, PL BUP 20/14. JACEK RADOMSKI, Wrocław, PL

Systemy Wbudowane. Arduino dołączanie urządzeń Wersja Arduino więcej portów I/O. Układy serii 74. Układy serii 74xx a seria 40xx

PL B1. POLITECHNIKA WARSZAWSKA, Warszawa, PL BUP 12/14. ANTONI SZUMANOWSKI, Warszawa, PL PAWEŁ KRAWCZYK, Ciechanów, PL

ROBOTYKA. Odwrotne zadanie kinematyki - projekt.

Projektowanie systemów zrobotyzowanych

POLITECHNIKA POZNAŃSKA Wydział Maszyn Roboczych i Transportu

Cel ćwiczenia. Przetwornik elektromagnetyczny. Silniki krokowe. Układ sterowania napędu mechatronicznego z silnikiem krokowym.

AUTONOMOUS GUARDIAN ROBOT AUTONOMICZNY ROBOT WARTOWNIK

Kinematyka robotów mobilnych

ZESZYTY NAUKOWE POLITECHNIKI ŚLĄSKIEJ 2014 Seria: TRANSPORT z. 82 Nr kol. 1903

Układ ENI-EBUS/URSUS stanowi kompletny zespół urządzeń napędu i sterowania przeznaczony do autobusu EKOVOLT produkcji firmy URSUS..

Kinematyka manipulatora równoległego typu DELTA 106 Kinematyka manipulatora równoległego hexapod 110 Kinematyka robotów mobilnych 113

RZECZPOSPOLITA OPIS PATENTOWY POLSKA

SPOSOBY POMIARU KĄTÓW W PROGRAMIE AutoCAD

PL B1. Akademia Górniczo-Hutnicza im. Stanisława Staszica,Kraków,PL BUP 21/05. Bogdan Sapiński,Kraków,PL Sławomir Bydoń,Kraków,PL

2.9. Kinematyka typowych struktur manipulatorów

Szybkie prototypowanie w projektowaniu mechatronicznym

Napędy urządzeń mechatronicznych - projektowanie. Ćwiczenie 1 Dobór mikrosilnika prądu stałego z przekładnią do pracy w warunkach ustalonych

WPW-1 ma 2 wejścia sygnalizacyjne służące do doprowadzenia informacji o stanie wyłącznika.

Analogowy sterownik silnika krokowego oparty na układzie avt 1314

PROGRAMOWANIE DYNAMICZNE W ROZMYTYM OTOCZENIU DO STEROWANIA STATKIEM

OSIE ELEKTRYCZNE SERII SHAK GANTRY

Roboty przemysłowe. Wprowadzenie

UKŁAD AUTOMATYCZNEJ REGULACJI SILNIKA SZEREGOWEGO PRĄDU STAŁEGO KONFIGUROWANY GRAFICZNIE

Rok akademicki: 2013/2014 Kod: RAR s Punkty ECTS: 5. Poziom studiów: Studia I stopnia Forma i tryb studiów: -

Laboratorium Elektroniki w Budowie Maszyn

Rozszerzony konspekt preskryptu do przedmiotu Podstawy Robotyki

Praca dyplomowa inżynierska

2. Dane znamionowe badanego silnika.

I. KARTA PRZEDMIOTU CEL PRZEDMIOTU

TEORIA MECHANIZMÓW I MANIPULATORÓW

WZORU UŻYTKOWEGO q Y1 UlJ Numer zgłoszenia: s~\ t f i7.

Tadeusz SZKODNY. POLITECHNIKA ŚLĄSKA ZESZYTY NAUKOWE Nr 1647 MODELOWANIE I SYMULACJA RUCHU MANIPULATORÓW ROBOTÓW PRZEMYSŁOWYCH

1. Kiść. 1. Kiść 5. Podstawa 2. Przedramię 6. Przewody łączeniowe 3. Ramię 7. Szafa sterownicza 4. Kolumna obrotowa

Sterowanie napędów maszyn i robotów

PRZEWODNIK PO PRZEDMIOCIE

WZORU UŻYTKOWEGO (,9,PL <1» 63238

Sterowanie Napędów Maszyn i Robotów

ANALIZA KINEMATYCZNA PALCÓW RĘKI

Ćwiczenie EA5 Silnik 2-fazowy indukcyjny wykonawczy

PL B1. POLITECHNIKA WARSZAWSKA, Warszawa, PL

Sprzężenie mikrokontrolera (nie tylko X51) ze światem zewnętrznym cd...

Jakobiany. Kinematykę we współrzędnych możemy potraktować jako operator przekształcający funkcje czasu

PL B1. POLITECHNIKA LUBELSKA, Lublin, PL UNIWERSYTET PRZYRODNICZY W LUBLINIE, Lublin, PL BUP 15/16

EUROELEKTRA Ogólnopolska Olimpiada Wiedzy Elektrycznej i Elektronicznej Rok szkolny 2015/2016. Zadania z elektrotechniki na zawody I stopnia

Laboratorium Maszyny CNC. Nr 3

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

Rotor RAU

Zadania kinematyki mechanizmów

Programowanie i uruchamianie serwo-kontrolera w napędowym układzie wykonawczym z silnikiem skokowym. Przebieg ćwiczenia

Koła stożkowe o zębach skośnych i krzywoliniowych oraz odpowiadające im zastępcze koła walcowe wytrzymałościowo równoważne

PRZEWODNIK PO PRZEDMIOCIE

Projekt konstrukcyjny i wykonanie prototypu mechanizmu Jansena. The construction project and making the prototype of the Jansen mechanism

II. Redukcja układów sił. A. Układy płaskie. II.A.1. Wyznaczyć siłę równoważną (wypadkową) podanemu układowi sił zdefiniowanychw trzy różne sposoby.

Napędy urządzeń mechatronicznych

PL B1. Zespół napędowy pojazdu mechanicznego, zwłaszcza dla pojazdu przeznaczonego do użytkowania w ruchu miejskim

Politechnika Warszawska Wydział Samochodów i Maszyn Roboczych Instytut Podstaw Budowy Maszyn Zakład Mechaniki

Silniki prądu stałego z komutacją bezstykową (elektroniczną)

Ćwiczenie 2a. Pomiar napięcia z izolacją galwaniczną Doświadczalne badania charakterystyk układów pomiarowych CZUJNIKI POMIAROWE I ELEMENTY WYKONAWCZE

2.2 Opis części programowej

Transkrypt:

Adam Labuda Janusz Pomirski Andrzej Rak Akademia Morska w Gdyni MODEL MANIPULATORA O DWÓCH STOPNIACH SWOBODY W artykule opisano konstrukcję modelu manipulatora o dwóch przegubach obrotowych. Obie osie przegubów umieszczone są pionowo, przez co kinematyka prosta i odwrotna manipulatora jest zgodna z kinematyką popularnych manipulatorów typu SCARA. Model będzie miał zastosowanie dydaktyczne. 1. WSTĘP Jedną z najbardziej rozpowszechnionych w praktyce konfiguracji robota przemysłowego jest konfiguracja typu SCARA mająca dwie pionowo umieszczone osie obrotowe. W artykule opisano konstrukcję modelu manipulatora SCARA. Do poruszania ramionami modelu robota wykorzystano silniki krokowe. Na końcu drugiego ramienia robota umieszczono efektor w postaci pisaka, który może być podnoszony i opuszczany na powierzchnię podstawy robota.. MECHANIZM MANIPULATORA Rysunek 1 przedstawia koncepcję zbudowanego manipulatora o dwóch stopniach swobody []. Rys. 1. Konstrukcja manipulatora Ramiona robota wykonano z płyty pleksiglasowej o grubości 5 mm. W celu zwiększenia sztywności konstrukcji pod silnikiem umieszczono dodat-

5 ZESZYTY NAUKOWE AKADEMII MORSKIEJ W GDYNI, nr 6, grudzień 009 kowy punkt podparcia w postaci rolki dociskowej. Podtrzymuje on ciężar silnika i efektora. Do napędu obu ramion zostały wykorzystane silniki krokowe. Pierwszy silnik porusza całym robotem za pomocą przekładni zębatej :1. Przekładnia ma za zadanie zwiększenie precyzji sterowania ramieniem A oraz zwiększenie momentu obrotowego, ponieważ moment obrotowy uzyskiwany z dostępnych silników krokowych był zbyt mały. Przekładnię zbudowano z dwóch kół zębatych: o liczbie zębów 75 dla zębatki umieszczonej na wale silnika i 150 dla zębatki przymocowanej do ramienia A. Ruch ramienia napędowego silnikiem 1 został ograniczony w zakresie 115, aby nie doprowadzić do kolizji ramienia z silnikiem i przekładnią. Silnik porusza ramieniem B w zakresie 135 od pozycji zerowej. Tutaj ograniczenie wprowadzono po to, aby uniknąć uszkodzenia rysika, które mogłoby nastąpić w momencie uderzenia pisaka w ramię A robota. Ograniczenia ruchu obu ramion mają charakter programowy. Efektorem manipulatora jest rysik, który może być podnoszony i opuszczany na powierzchnię podstawy (rys. ). Do sterowania rysikiem wykorzystano elektromagnes. W stanie spoczynkowym rysik podtrzymywany jest przez sprężynkę. Po podaniu napięcia na cewkę elektromagnesu kotwa wędruje w dół, przyciskając pisak do podłoża robota. Rys.. Efektor wraz z systemem podnoszenia i opuszczania 3. UKŁADY ELEKTRYCZNE MANIPULATORA Do napędu manipulatora dydaktycznego wykorzystano dwa silniki krokowe: SHINANO KENSHI STH-55D115-0 o masie około 0,45 kg, prądzie znamionowym 1,1 A i rozdzielczości 1,8 /krok. Na rysunku 3 przedstawiono schemat elektryczny sterowników silników krokowych. Sterownik silnika krokowego umożliwia unipolarne sterowanie dwoma silnikami krokowymi w trybie pracy pełnokrokowej i półkrokowej. Wejściowe sygnałów sterujące są doprowadzone ze

A. Labuda, J. Pomirski, A. Rak, Model manipulatora o dwóch stopniach swobody 53 Rys. 3. Schemat elektryczny sterownika; 1 separacja sygnałów sterujących silników (LTV847), stopień wyjściowy silników krokowych (ULN803A), 3 złącza silnika 1, 4 złącza silnika, 5 separacja sygnałów sterujących efektora, 6 stopień wyjściowy efektora (ULN803A), 7 złącza efektora, 8 złącza czujników zerowania, 9 zasilanie

54 ZESZYTY NAUKOWE AKADEMII MORSKIEJ W GDYNI, nr 6, grudzień 009 złącza LPT komputera poprzez gniazdo DB-5. Komputer odseparowany jest galwanicznie od silników krokowych przez transoptory LTV847. W stopniu wyjściowym sterowników zastosowano układy ULN803A, które mają wystarczającą wydajność prądową do zasilania uzwojeń silników krokowych. W manipulatorze zainstalowano dwa styczniki, które są wykorzystywane do funkcji zerowania. Uaktywniając procedurę zerowania, silniki krokowe zaczynają obracać się w zadaną stronę. Każdy z nich obraca się do momentu, kiedy umieszczony w ramieniu stycznik zostanie załączony. Pozycja ta wyznacza pozycję zerową manipulatora. 4. KINEMATYKA PROSTA I ODWROTNA MANIPULATORA [1, ] Na rysunku 4 zdefiniowano podstawowe parametry geometryczne manipulatora (L 1, L długości ramion manipulatora) i jego chwilowe położenie ( 1, kąty ugięcia obu przegubów). Y (x, y ) L y x (x 1, y 1) L 1 0 1 X Rys. 4. Kinematyka manipulatora Zadanie kinematyki prostej polega na wyznaczeniu położenia końca manipulatora (x, y ) dla przyjętych wartości zmiennych przegubowych 1,. Współrzędne (x, y ) mogą być obliczone na podstawie zależności trygonometrycznych: x L1cos 1 Lcos 1, (1) L1sin 1 Lsin 1 y. () Zadanie kinematyki odwrotnej polega na wyznaczeniu zmiennych przegubowych (kątów 1, ), dla których koniec manipulatora znajdzie się we wskazanym położeniu (x, y ). Dla wykonanego manipulatora kinematyka odwrotna ma rozwiązanie dokładne wyrażone w postaci formuł analitycznych:

A. Labuda, J. Pomirski, A. Rak, Model manipulatora o dwóch stopniach swobody 55 1 1 x y L L arccos, (3) L L y L sin 1 arctg arcsin. (4) x x y Równania 3 i 4 mają rozwiązania tylko wtedy, gdy: oraz x y L1 L L1 L L (5) sin x y. (6) Równania 3 i 4 mają w większości wypadków dwa rozwiązania. W przypadku układów sterowania wybiera się to rozwiązanie, które w mniejszym stopniu różni się od dotychczasowego położenia manipulatora. 5. STEROWANIE Do sterowania manipulatorem opracowano program komputerowy. Rysunek 5 przedstawia schemat blokowy działania programu sterującego. Program ten został napisany w środowisku Borland Delphi. Rys. 5. Algorytm i ekran główny dydaktycznego programu sterującego

56 ZESZYTY NAUKOWE AKADEMII MORSKIEJ W GDYNI, nr 6, grudzień 009 Ze względu na zastosowania dydaktyczne ruch manipulatora jest opisywany w tekstowym pliku dyskowym (pliku wykonawczym). W pliku tym w kolejnych liniach zapisywane są wartości zmiennych przegubowych, które powinien osiągnąć manipulator w poszczególnych krokach wykonywania programu. Plik wykonawczy może być przygotowany przez studentów w dowolnym edytorze tekstowym na podstawie własnych obliczeń, wygenerowany z programów obliczeniowych typu Matlab, a także wygenerowany w programie sterującym po wywołaniu modułów obliczeń kinematyki prostej i odwrotnej. 6. PODSUMOWANIE Na rysunku 6 przedstawiono zdjęcie całej konstrukcji manipulatora. Rzeczywista trajektoria końcówki roboczej może być zarejestrowana na papierze po opuszczeniu pisaka umocowanego na końcu manipulatora. Dla tego manipulatora zadanie kinematyki odwrotnej ma dokładne rozwiązanie analityczne w postaci formuły matematycznej, dlatego analiza tego przypadku jest przydatna do celów dydaktycznych. W czasie ruchu możliwe jest obserwowanie w skali makroskopowej niedokładności ruchu końcówki roboczej, a także trajektorii efektora pomiędzy dwoma punktami przy zastosowaniu aproksymacji liniowej w przestrzeni układu bazowego i przestrzeni zmiennych złączowych. Rys. 6. Manipulator o dwóch stopniach swobody

A. Labuda, J. Pomirski, A. Rak, Model manipulatora o dwóch stopniach swobody 57 LITERATURA 1. Gawrysiak M., Robot jako system komputerowy, notatki do wykładu w postaci elektronicznej (pdf), Politechnika Białostocka 006.. Labuda A., Budowa dydaktycznego modelu manipulatora o dwóch stopniach swobody, praca dyplomowa inżynierska, Wydział Elektryczny, Akademia Morska w Gdyni, Gdynia 009. DOF ROBOTIC ARM MODEL Summary The paper describes design of the didactic robot arm with degrees of freedom. Both joints axes are of rotation type with the vertical axes, so the forward and inverse kinematics of the arm have analytical solutions, similar to the kinematics of a SCARA robot. Effector of the arm enables registration of the trajectory on paper sheet.