ANALIZA KINEMATYCZNA MANIPULATORÓW ROBOTÓW METODĄ MACIERZOWĄ

Slides:



Advertisements
Podobne prezentacje
Na szczycie równi umieszczano obręcz, kulę i walec o tych samych promieniach i masach. Po puszczeniu ich razem staczają się one bez poślizgu. Które z tych.
Advertisements

Wykład 4 2. Przykłady ruchu 1.5 Prędkość i przyśpieszenie c.d.
Wykład Ruch po okręgu Ruch harmoniczny
Dynamika bryły sztywnej
Teoria maszyn i części maszyn
Teoria maszyn i części maszyn
Kinematyka Definicje podstawowe Wielkości pochodne
Ruch i jego parametry Mechanika – prawa ruchu ciał
Kinematyka punktu materialnego
Temat: Ruch jednostajny
Metody numeryczne wykład no 2.
Metody Numeryczne Wykład no 3.
Ruch i jego parametry Mechanika – prawa ruchu ciał
KINEMATYKA Kinematyka zajmuje się związkami między położeniem, prędkością i przyspieszeniem badanej cząstki – nie obchodzi nas, skąd bierze się przyspieszenie.
Wykład 16 Ruch względny Bąki. – Precesja swobodna i wymuszona
Wielkości skalarne i wektorowe
Napory na ściany proste i zakrzywione
RÓWNOWAGA WZGLĘDNA PŁYNU
Metody numeryczne Wykład no 2.
KINEMATYKA MANIPULATORÓW I ROBOTÓW
MECHANIKA NIEBA WYKŁAD r.
Wykład 11. Podstawy teoretyczne odwzorowań konforemnych
Kinematyka SW Sylwester Wacke
Wektory SW Department of Physics, Opole University of Technology.
Kinematyka prosta.
MECHANIKA 2 Wykład Nr 11 Praca, moc, energia.
Ruch złożony i ruch względny
Wykład 2. Pojęcie regularnego odwzorowania powierzchni w powierzchnię i odwzorowania kartograficznego Wykład 2. Pojęcie regularnego odwzorowania powierzchni.
MECHANIKA NIEBA WYKŁAD r.
Bez rysunków INFORMATYKA Plan wykładu ELEMENTY MECHANIKI KLASYCZNEJ
Sterowanie – metody alokacji biegunów II
MECHANIKA I WYTRZYMAŁOŚĆ MATERIAŁÓW
WPROWADZENIE DO KINEMATYKI MANIPULATORÓW ROBOTÓW
Zasady przywiązywania układów współrzędnych do członów.
ANALIZA DYNAMICZNA MANIPULATORÓW JAKO MECHANIZMÓW PRZESTRZENNYCH
Przekształcenia liniowe
MECHANIKA 2 Wykład Nr 10 MOMENT BEZWŁADNOŚCI.
Dynamika układu punktów materialnych
RUCH PŁASKI BRYŁY MATERIALNEJ
Elementy geometrii analitycznej w przestrzeni R3
Projektowanie Inżynierskie
dr hab. inż. Monika Lewandowska
Treści multimedialne - kodowanie, przetwarzanie, prezentacja Odtwarzanie treści multimedialnych Andrzej Majkowski informatyka +
RUCH KULISTY I RUCH OGÓLNY BRYŁY
Rozwiązywanie układów równań liniowych różnymi metodami
Grafika i komunikacja człowieka z komputerem
Metody matematyczne w Inżynierii Chemicznej
Projektowanie Inżynierskie
Wyznaczniki, równania liniowe, przestrzenie liniowe Algebra 1
Grafika i komunikacja człowieka z komputerem
PLAN WYKŁADÓW Podstawy kinematyki Ruch postępowy i obrotowy bryły
Kinematyka zajmuje się ilościowym badaniem ruchu ciał z pominięciem czynników fizycznych wywołujących ten ruch. W mechanice technicznej rozważa się zagadnienia.
Grafika i komunikacja człowieka z komputerem
MECHANIKA 2 Wykład Nr 12 Zasady pracy i energii.
Dynamika ruchu płaskiego
MECHANIKA NIEBA WYKŁAD r. E r Zagadnienie dwóch ciał I prawo Keplera Potencjał efektywny Potencjał efektywny w łatwy sposób tłumaczy kształty.
WYKŁAD 5 OPTYKA FALOWA OSCYLACJE I FALE
Ruch jednowymiarowy Ruch - zmiana położenia jednych ciał względem innych, które nazywamy układem odniesienia. Uwaga: to samo ciało może poruszać się względem.
Wykład Rozwinięcie potencjału znanego rozkładu ładunków na szereg momentów multipolowych w układzie sferycznym Rozwinięcia tego można dokonać stosując.
Dynamika ruchu obrotowego
Ruch – jedno w najczęściej obserwowanych zjawisk fizycznych
Projektowanie Inżynierskie
Dynamika bryły sztywnej
Prowadzący: dr Krzysztof Polko
POTENCJALNY OPŁYW WALCA
6. Ruch obrotowy W czystym ruchu obrotowym każdy punkt ciała sztywnego porusza się po okręgu, którego środek leży na osi obrotu (ruch wzdłuż linii prostej.
Metody matematyczne w Inżynierii Chemicznej
Ruch złożony i ruch względny Prowadzący: dr Krzysztof Polko
Symulacje komputerowe
2. Ruch 2.1. Położenie i tor Ruch lub spoczynek to pojęcia względne.
Zapis prezentacji:

ANALIZA KINEMATYCZNA MANIPULATORÓW ROBOTÓW METODĄ MACIERZOWĄ

Jeśli dane są: - współrzędne wxi , wyi , wzi wektora w związane z ogniwem i - współrzędne px , py , pz początku układu i związane z ogniwem j oraz kosinusy kierunkowe osi układu i względem osi układu j

to zależność pomiędzy współrzędnymi w układzie i oraz j można zapisać jako

{ lub w formie symbolicznej gdzie: - macierz przekształcenia współrzędnych wektora z układu i do układu j Wyznacznik macierzy { 1, gdy obydwa układy są prawoskrętne -1, gdy jeden jest prawo- a drugi lewoskrętny

Macierz Tij przekształcenia złożonego z przesunięcia i obrotu można przedstawić w postaci iloczynu macierzy: - obrotu (rotacji) - przesunięcia (translacji) czyli gdzie:

Zastosowanie do opisu przekształceń w kinematyce i dynamice manipulatorów robotów macierzy 4x4 jest bardzo wygodne ponieważ umożliwia w zwartej formie zapisać zarówno obrót jak i przesunięcie oraz ułatwia mnożenie odpowiednich macierzy przy użyciu komputerów osobistych bez konieczności sprawdzania osobliwości.

Z dziewięciu zmiennych wyrazów macierzy - obrotu (rotacji) tylko trzy są niezależne, natomiast pozostałe sześć muszą spełniać równania

przy czy kwadraty kosinusów kierunkowych (trzy pierwsze równania) są równe odpowiednim kwadratom współrzędnych wersorów osi, których długość jest równa 1; pozostałe trzy równania wynikają z warunków prostopadłości wersorów osi układu współrzędnych.

współrzędnych przypadku przekształceń odwrotnych to znaczy przy przejściu z układu j do układu i stosuje się macierze odwrotne, czyli przy czym gdzie: E jest macierzą jednostkową, czyli

Hartenberga i Denavita W celu uproszczenia analizy przestrzennego łańcucha kinematycznego wprowadza się specjalne usytuowanie układów współrzędnych poszczególnych członów tak, aby liczba parametrów wchodzących do macierzy przekształceń była minimalna, a postać tej macierzy była jednakowa tak w przypadku pary obrotowej, jak i pary przesuwnej. W dalszym ciągu przedstawiono najczęściej stosowany sposób usytuowania wzajemnego układów współrzędnych członów połączonych parami obrotowymi i przesuwnymi, który jest znany jako zapis Hartenberga i Denavita

Na rysunku przedstawiono dwa układy współrzędnych związanych z członami i – 1 oraz i,

Figure 4-8 The variables in a link using the notation of Paul [9] Figure 4-8 The variables in a link using the notation of Paul [9]. The rules used to define the notation are: (1) Axis zn-1 defines the position of the axis of rotation for joint Jn, zn, for joint Jn+1, and so forth. (2) Axis xn-1 is selected to be an extension for the common perpendicular line of length an-1 between consecutive joints zn-2 and zn-1. (3) The axis yn-1 – is selected to provide a right-hand coordinate system with the other axes. (4) Axis xn is an extension of the common perpendicular line of Iength an. Rys 4-8. Zapis zmiennych z użyciem notacji Paul’a [7]. Według zasad: (1) Oś zn-1 opisuje położenie osi rotacji dla ogniwa Jn, zaś oś zn dla ogniwa Jn+1 itd. (2) Oś xn-1 jest przedłużeniem linii znajdującej się pomiędzy osią zn-2 i zn-1 i prostopadłą do nich o długości an-1. (3) Oś yn-1 zapewnia prawoskrętny układ współrzędnych. (4) Oś xn jest przedłużeniem linii prostopadłej do osi zn-1 o długości an.

Usytuowanie układów współrzędnych

Usytuowanie układów współrzędnych

xi-1 zi-1 yi-1 i-1 przy czym oś leży na wspólnej prostopadłej do osi par obrotowych członu i-1, oś zi-1 leży na osi pary obrotowej łączącej człony i-1 z i oś yi-1 nie pokazana na rysunku stanowi uzupełnienie prawoskrętnego układu współrzędnych i-1

i xi i zi Układ współrzędnych jest związany z członem w podobny sposób, to znaczy oś xi leży na wspólnej prostopadłej do osi par obrotowych członu i oś zi leży na osi pary obrotowej łączącej człon i z członem i + 1

Zaletą takiego usytuowania układów współrzędnych jest to, że tylko cztery parametry określają względne położenie dwóch sąsiednich układów, przy czym dwa z nich to znaczy li oraz αi są zawsze stałe, jeden z pozostałych jest zmienny w zależności od typu pary kinematycznej - w przypadku pary obrotowej zmienny jest kąt θi - w przypadku pary przesuwnej zmienne jest przesunięcie λi

i jeszcze jednego obrotu Dwa sąsiednie układy współrzędnych i oraz i-1 mogą być przekształcone jeden w drugi za pomocą obrotu dwóch przesunięć i jeszcze jednego obrotu w następującej kolejności a) obrót wokół osi zi-1 o kąt θi tak, aż oś xi-1 stanie się równoległa do osi xi

b) przesunięcie wzdłuż osi zi-1 o wielkość λi tak, aby oś xi-1 pokryła się z osią xi c) przesunięcie wzdłuż osi xi o wielkość li tak, aby początki obu układów pokryły się d) obrót wokół osi xi o kąt αi tak aż wszystkie osie będą pokrywać się

Ti,i-1 Ai Każdemu z tych elementarnych ruchów odpowiada macierz Przekształcenia, którą tutaj oznaczono przez Ai przy czym

Macierz Ai opisująca przekształcenia z układu i do układu i-1 będzie równa iloczynowi wyżej wymienionych macierzy ruchów elementarnych, czyli Zatem, po wykonaniu mnożeń macierzy zaczynając od prawej strony otrzymuje się

gdzie: li , αi - odległość i kąt pomiędzy osiami par obrotowych ogniwa i, λi , θi , - odległość i kąt obrotu pomiędzy ogniwami i-1 oraz i

Przypadku pary obrotowej kąt θi jest zmienny, a odległość λi jest stała; w przypadku pary przesuwnej zmienna jest długość λi a stały kąt θi Macierz przekształcenia odwrotnego, to znaczy układu współrzędnych członu i-1 do układu członu i otrzymuje się jako rozwiązanie równania macierzowego gdzie: E – macierz jednostkowa

stąd W przypadku otwartego łańcucha kinematycznego wprowadza się macierz położenia i orientacji układu związanego z członem n względem układu związanego z członem i jako iloczyn macierzy kolejnych przekształceń

przy czym W przypadku zamkniętego łańcucha kinematycznego, zbudowanego z n członów wprowadza się równanie zamknięcia w postaci Mnożąc z lewej strony powyższe równanie przez macierze odwrotne otrzymuje się równanie zamknięcia łańcucha kinematycznego w bardziej wygodnej postaci

………………….…………………… W przypadku, gdy dany jest wektor

opisujący położenie dowolnego punktu Pi należącego do członu i w układzie współrzędnych związanym z tym członem oraz dane są macierze kolejnych przekształceń, wtedy z równań oraz

można wyznaczyć wektor opisujący położenie punktu Pi w układzie podstawy przy czym mnożenia macierzy trzeba zaczynać od prawej strony (!!!) Kolejność obliczeń jest zatem następująca

………….……………… (wzory na r)

Wektory prędkości i przyspieszenia punktu Pi otrzymuje się jako pierwszą i drugą pochodną względem czasu wektora A zatem

Różniczkując kolejno dwie ostatnie zależności przy założeniu, że otrzymuje się algorytm wyznaczania prędkości jako ……………………………………………

(wzory na v) oraz algorytm wyznaczania przyśpieszenia jako ………………………………………………….

Aj (wzory na a) Pochodne względem czasu macierzy oblicza się według następujących wzorów (wzory na A)

przy czym w przypadku pary obrotowej

natomiast w przypadku pary przesuwnej

Podstawiając (wzory na A) do (wzorów na v) i (wzorów na a) przy uwzględnieniu (wzorów na r) otrzymuje się …………………….…………………… (wzory na v)1

oraz …………………………………….. (wzory na a)1

PRZYKŁAD Gdy i = 2 wtedy (wzory na r) przyjmą postać natomiast (wzory na v)1 są następujące

natomiast ( wzory na a)1 przyjmą formę Wektory prędkości kątowej i przyspieszenia kątowego członów można wyznaczyć z następujących równań:

(wzór na prędkość kątową członów) ………………………………………

(wzór na przyśpieszenia kątowe członów)

gdzie: