ANALIZA KINEMATYKI MANIPULATORA O PIĘCIU STOPNIACH SWOBODY

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

Równania liniowe. gdzie. Automatyka i Robotyka Algebra -Wykład 8- dr Adam Ćmiel,

Metoda prądów obwodowych

ĆWICZENIE ANALIZA SITOWA I PODSTAWY OCENY GRANULOMETRYCZNEJ SUROWCÓW I PRODUKTÓW

ZESZYTY NAUKOWE NR 11(83) AKADEMII MORSKIEJ W SZCZECINIE. Fuzja danych nawigacyjnych w przestrzeni filtru Kalmana

DOBÓR LINIOWO-ŁAMANEGO ROZDZIAŁU SIŁ HAMUJĄCYCH W SAMOCHODACH DOSTAWCZYCH

Modelowanie sił skrawania występujących przy obróbce gniazd zaworowych

METODY KOMPUTEROWE 11

Sformułowanie zagadnienia. c c. Analiza zagadnienia dla przypadku m = 4 i n = 3. B 2. c A. c A

BILANS ENERGETYCZNY UKŁADÓW NADĄŻNYCH W FOTOWOLTAICE DLA LOKALNYCH WARUNKÓW MIEJSKICH- CZĘŚĆ I 1. WSTĘP

Środek masy i geometryczne momenty bezwładności figur płaskich 1

Raport Przeliczenie punktów osnowy wysokościowej III, IV i V klasy z układu Kronsztadt60 do układu Kronsztadt86 na obszarze powiatu krakowskiego

Adaptacja slajdów do wykładów. Introduction to Robotics (ES159) Advanced Introduction to Robotics (ES259)

( ) Elementy rachunku prawdopodobieństwa. f( x) 1 F (x) f(x) - gęstość rozkładu prawdopodobieństwa X f( x) - dystrybuanta rozkładu.

Wspomaganie obliczeń za pomocą programu MathCad

Część 2 7. METODA MIESZANA 1 7. METODA MIESZANA

MATURA 2014 z WSiP. Zasady oceniania zadań

I. Elementy analizy matematycznej

EKONOMIA MENEDŻERSKA. Wykład 2 Analiza popytu. Optymalna polityka cenowa. 1 ANALIZA POPYTU. OPTYMALNA POLITYKA CENOWA.

METODYKA OCENY WŁAŚCIWOŚCI SYSTEMU IDENTYFIKACJI PARAMETRYCZNEJ OBIEKTU BALISTYCZNEGO

Katedra Chemii Nieorganicznej i Analitycznej Uniwersytet Łódzki ul.tamka 12, Łódź

Równania różniczkowe. y xy (1.1) x y (1.2) z xyz (1.3)


Moment siły (z ang. torque, inna nazwa moment obrotowy)

Wymagania edukacyjne z matematyki FUNKCJE dopuszczającą dostateczną dobrą bardzo dobrą

ω a, ω - prędkości kątowe członów czynnego a i biernego b przy

Matematyczne Podstawy Informatyki

Macierz. Wyznacznik macierzy. Układ równań liniowych

Całkowanie. dx d) x 3 x+ 4 x. + x4 big)dx g) e x 4 3 x +a x b x. dx k) 2x ; x 0. 2x 2 ; x 1. (x 2 +3) 6 j) 6x 2. x 3 +3 dx k) xe x2 dx l) 6 1 x dx

Metoda sił jest sposobem rozwiązywania układów statycznie niewyznaczalnych, czyli układów o nadliczbowych więzach (zewnętrznych i wewnętrznych).

Analiza wariancji klasyfikacja prosta

Ćwiczenie 3. Dobór mikrosilnika prądu stałego do układu pozycjonującego

Równania i nierówności kwadratowe z jedną niewiadomą

Podstawy układów logicznych

4. RACHUNEK WEKTOROWY

Całka oznaczona i całka niewłaściwa Zastosowania rachunku całkowego w geometrii

Zadanie 5. Kratownica statycznie wyznaczalna.

11/22/2014. Jeśli stała c jest równa zero to takie gry nazywamy grami o sumie zerowej.

XIV International PhD Workshop OWD 2012, October Trójkątne Rozszerzanie, nowa metoda wyostrzania na skierowanych liczbach rozmytych

Realizacje zmiennych są niezależne, co sprawia, że ciąg jest ciągiem niezależnych zmiennych losowych,

Temat 1. Afiniczne odwzorowanie płaszczyzny na płaszczyznę. Karol Bator. GGiIŚ, II rok, niestac. grupa 1

Algorytmy graficzne. Filtry wektorowe. Filtracja obrazów kolorowych

Rozwiązanie niektórych zadań treningowych do I kolokwium sem. zimowy, 2018/19

STYLE. TWORZENIE SPISÓW TREŚCI

Przeguby precyzyjne KTR z łożyskowaniem ślizgowym lub igiełkowym

WYMAGANIA EDUKACYJNE NIEZBĘDNE DO UZYSKANIA POSZCZEGÓLNYCH ŚRÓDROCZNYCH I ROCZNYCH OCEN KLASYFIKACYJNYCH Z MATEMATYKI POZIOM PODSTAWOWY KLASA 2

MODELE TEORII GIER. Modelowanie matematyczne. dr inż. Zbigniew Tarapata Wykład nr 5: Modele teorii gier

Rozwiązywanie zadań z dynamicznego ruchu płaskiego część I 9

KSZTAŁTOWANIE ŁUKOWO-KOŁOWEJ LINII ZĘBÓW W UZĘBIENIU CZOŁOWYM NA FREZARCE CNC

1.5. Iloczyn wektorowy. Definicja oraz k. Niech i

Technikum Nr 2 im. gen. Mieczysława Smorawińskiego w Zespole Szkół Ekonomicznych w Kaliszu

Analiza matematyczna i algebra liniowa

Układ elektrohydrauliczny do badania siłowników teleskopowych i tłokowych

CAŁKOWANIE NUMERYCZNE

Zastosowanie multimetrów cyfrowych do pomiaru podstawowych wielkości elektrycznych

TENSOR W ZAPISIE LAGRANGE A I EULERA

Rozwiązania maj 2017r. Zadania zamknięte

Wytrzymałość Materiałów I

( ) Lista 2 / Granica i ciągłość funkcji ( z przykładowymi rozwiązaniami)

Ilość pożywki w gramach 0,

ANALIZA PRACY SYSTEMU ENERGETYCZNO-NAPĘDOWEGO STATKU TYPU OFFSHORE Z WYKORZYSTANIEM METODY DRZEW USZKODZEŃ

CAŁKOWANIE NUMERYCZNE

WYKŁAD 5. Typy macierzy, działania na macierzach, macierz układu równań. Podstawowe wiadomości o macierzach

Logo pole ochronne. 1/2 a. 1/4 a

MATEMATYKA Wykład 4 (Funkcje) przyporządkowany został dokładnie jeden element

Wprowadzenie: Do czego służą wektory?

SYSTEMY UCZĄCE SIĘ WYKŁAD 8. NIEPARAMETRYCZNE METODY APROKSYMACJI FUNKCJI. Dr hab. inż. Grzegorz Dudek Wydział Elektryczny Politechnika Częstochowska

2. Na ich rozwiązanie masz 90 minut. Piętnaście minut przed upływem tego czasu zostaniesz o tym poinformowany przez członka Komisji Konkursowej.

Zadania do rozdziału 7.

Macierz. Wyznacznik macierzy. Układ równań liniowych

IDENTYFIKACJA SYSTEMÓW DYNAMICZNYCH O ZŁOŻONEJ STRUKTURZE NA PRZYKŁADZIE OBIEKTU ENERGETYCZNEGO

3. Rozkład macierzy według wartości szczególnych

WSTĘP DO INFORMATYKI

Dziś: Pełna tabela loterii państwowej z poniedziałkowego ciągnienia

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

Diagnostyka uszkodzeñ wiæzadeæ krzyºowych w badaniu rezonansu magnetycznego

Wymagania edukacyjne na poszczególne oceny z matematyki w klasie II poziom rozszerzony

Autor: Zbigniew Tuzimek Opracowanie wersji elektronicznej: Tomasz Wdowiak

Wyznacznikiem macierzy kwadratowej A stopnia n nazywamy liczbę det A określoną następująco:

KRYTERIA OCENIANIA ODPOWIEDZI Próbna Matura z OPERONEM. Matematyka. Poziom rozszerzony. Listopad Wskazówki do rozwiązania zadania

Wymagania edukacyjne z matematyki

TEORIA WAGNERA UTLENIANIA METALI

POLITECHNIKA GDAŃSKA Wydział Elektrotechniki i Automatyki Katedra Energoelektroniki i Maszyn Elektrycznych M O D E L O W A N I E I S Y M U L A C J A

WPŁYW DOMIESZEK PRZECIWMROZOWYCH I KLASY CEMENTU NA WYTRZYMAŁOŚĆ ZAPRAW CEMENTOWYCH

ELEKTRONIKA CYFROWA. Materiały y pomocnicze do wykład sem.. 1

dr inż. Zbigniew Szklarski

ZASTOSOWANIE RÓWNANIA NASGRO DO OPISU KRZYWYCH PROPAGACYJI PĘKNIĘĆ ZMĘCZENIOWYCH

KRYTERIA OCENIANIA ODPOWIEDZI Próbna Matura z OPERONEM. Matematyka. Poziom rozszerzony. Listopad Wskazówki do rozwiązania zadania

WYMAGANIA I KRYTERIA OCENIANIA Z MATEMATYKI W 3 LETNIM LICEUM OGÓLNOKSZTAŁCĄCYM

Kinematyka manipulatorów robotów

ANALIZA KONSTRUKCJI PRĘ TOWO- TARCZOWYCH METODĄ ELEMENTÓW SKOŃ CZONYCH. 1. Wstę p

T W O R Z Y M Y. 15 godzin w cyklu 3-godzinnym

METODA ELECTRE III W WYBORZE PLATFORMY LMS

2.12. Zadania odwrotne kinematyki

Przekształcenia automatów skończonych

4.6. Gramatyki regularne

MATeMAtyka 3 inf. Przedmiotowy system oceniania wraz z określeniem wymagań edukacyjnych. Zakres podstawowy i rozszerzony. Dorota Ponczek, Karolina Wej

(M2) Dynamika 1. ŚRODEK MASY. T. Środek ciężkości i środek masy

Wymagania edukacyjne z matematyki Klasa IIB. Rok szkolny 2013/2014 Poziom podstawowy

METODA DIAGNOSTYKI SOCJOMETRYCZNEJ JAKO NARZĘDZIE BADAŃ CECH JAKOŚCIOWYCH KIEROWNIKÓW

Transkrypt:

ZESZYTY NUKOWE POLITECHNIKI RZESZOWSKIE 29, Mechnk 86 RUTMech, t. XXXI, z. 86 (4/4), pźdzernk-grudzeń 24, s. 49- Potr GIERLK NLIZ KINEMTYKI MNIPULTOR O PIĘCIU STOPNICH SWOBODY W rtykule przestwono nlzę knemtyk mnpultor o pęcu stopnch swoody n przykłdze ednostk knemtyczne root mnpulcynego Scorot-ER 4pc. Do opsu knemtyk ukłdu zstosowno notcę Denvt-Hrtenerg. Przyęto schemt knemtyk mnpultor podno prmetry opsuące ukłd. Zpsno odpowedne mcerze trnsformc, które zstosowno w dlsze nlze. Wyznczono kon nltyczny mnpultor orz kon geometryczny w cele przeprowdzono nlzę osolwośc. Są to tke konfgurce mnpultor, w których wyznczene rozwązn zdn odwrotnego knemtyk est znczne utrudnone, przy zstosownu klsycznych metod nemoŝlwe. Dltego znomość konfgurc osolwych est nezędn w celu poprwnego plnown generown trektor mnpultor. Zprezentown metodyk est unwersln moŝe yć stosown do nlzy knemtyk mnpultorów o nne strukturze knemtyczne nŝ zprezentown w nnesze prcy. Słow kluczowe: kon, konfgurce osolwe, notc Denvt-Hrtenerg. Wprowdzene nlzę knemtyk mnpultor przeprowdz sę w celu uzyskn opsu włścwośc ruchowych ukłdu, które mogą yć wykorzystne w plnownu trektor ruchu orz e relzc, czyl sterownu [, 2]. nlz knemtyk umoŝlw równeŝ określene chrkterystycznych dl dnego mnpultor tzw. konów, które stosue sę np. do olczen wpływu sł momentów zewnętrznych dzłących n końcówkę mnpultor n sły momenty w przeguch. kony mogą yć teŝ uŝyte do uzyskn nformc o tzw. konfgurcch osolwych, czyl ustwench łńcuch knemtycznego, których nleŝy unkć n etpe plnown trektor, ze względu n neednoznczne rozwązn zdn odwrotnego knemtyk. W rtykule dokonno nlzy knemtyk mnpultor root Scorot-ER 4pc. ednostk knemtyczn root to czteroczłonowy mnpultor o pęcu utor do korespondenc/correspondng uthor: Potr Gerlk, Poltechnk Rzeszowsk, l. Powstńców Wrszwy 8, -99 Rzeszów, tel.: (7) 8684, e-ml: pgerlk@prz.edu.pl

492 P. Gerlk stopnch swoody z moŝlwoścą ednoczesnego wykonywn orotów osttnego członu wokół dwóch prostopdłych os. Rmę mnpultor o trzech stopnch swoody m strukturę knemtyczną ntropomorfczną (stwową) []. N końcu rmen est dołączon tzw. kść o dwóch stopnch swoody. Formlne wygodne est przyąć, Ŝe mnpultor est pęcoczłonowy, ntomst czwrty człon mnpultor m zerową długość msę. 2. Przeksztłcen ednorodne Do opsu knemtyk mnpultor zstosowno notcę Denvt- -Hrtenerg (D-H) [4-6]. N schemce knemtycznym (rys..) przyętym zgodne z notcą, wprowdzono loklne ukłdy odnesen zwązne z kolenym członm określono prmetry knemtyczne chrkteryzuące ukłd. W notc D-H wprowdz sę tzw. mcerz przeksztłcen ednorodnego [4-6] -, któr przeksztłc współrzędne wyrnego punktu z ukłdu -tego do ( ). est on wynkem czterech przeksztłceń podstwowych [6], co zpsno ko: - z, θ z, d x, x, α = Rot Trns Trns Rot = cθ sθ s c c s = θ θ α α = d sα cα cθ sθ cα sθ sα cθ s c c c s s = θ θ α θ α θ () sα cα d gdze: s θ = snθ, c θ = cosθ, s α = snα, c α = cosα, Rot z,θ mcerz rotc o kąt θ wokół os z, Trns z,d mcerz trnslc o d wzdłuŝ os z, Trns x, mcerz trnslc o wzdłuŝ os x, Rot x,α mcerz rotc o kąt α wokół os x. Rotce trnslce są rozumne ko rotce trnslce ukłdu -tego względem ( ). Ognwo -te łńcuch knemtycznego est chrkteryzowne przez cztery prmetry: długość członu, α skręcene członu, d odsunęce przeguu, θ kąt orotu przeguu. Prmetry mnpultor w uęcu notc D-H zestwono w t..

nlz knemtyk mnpultor 49 Rys.. Struktur knemtyczn mnpultor Scorot-ER 4pc Fg.. Knemtc structure of the Scorot-ER 4pc mnpultor Tel. Prmetry knemtyczne mnpultor Scorot-ER 4pc Tle. Knemtcs prmeters of the Scorot-ER 4pc mnpultor Nr ognw α d θ l π/2 d θ 2 l 2 θ 2 l θ 4 π/2 π/2+θ 4 d θ Mcerze przeksztłceń ednorodnych mą nstępuące postce: cosθ snθ l cosθ snθ cosθ l snθ = d (2) cosθ2 snθ2 l2 cosθ2 2 snθ2 cosθ2 l2 snθ 2 = ()

494 P. Gerlk cosθ snθ l cosθ snθ cosθ l snθ 2 = (4) snθ4 cosθ4 4 cosθ4 snθ4 = () cosθ snθ snθ cosθ 4 = (6) d Do wyznczen konu nltycznego geometrycznego potrzen est znomość mcerzy trnsformc ukłdu -tego do ( ) [7]: k - = k- k= T (7) ogóln struktur mcerzy T - to: - - - = R p T gdze: R - R mcerz rotc ukłdu -tego względem ( ), wektor trnslc ukłdu -tego względem ( ). p - (8) R. kon nltyczny W welu spektch rootyk, tkch k modelowne, plnowne ruchu sterowne mnpultorem [2] stosue sę tzw. mcerz konową, nzywną konem (w rootyce ne utoŝsm sę e z wyzncznkem mcerzy konowe, k to m mesce w mtemtyce). W lterturze zdefnowno klk

nlz knemtyk mnpultor 49 rodzów konów [6-8]. W tym rozdzle zostne przedstwony kon nltyczny, ntomst w kolenym kon geometryczny w cele. Do wyznczen konu nltycznego wykorzystue sę tzw. funkcę knemtyk, któr wynk ze zwązku pomędzy współrzędnym konfgurcynym (przeguowym) współrzędnym zdnowym zwąznym z przestrzeną rooczą (zdnową). Współrzędne zdnowe y mogą yć wyrne np. tk, y określły pozycę orentcę końcówk roocze w przestrzen zdnowe w funkc współrzędnych konfgurcynych: m y = k q R (9) gdze: k(q) tzw. funkc knemtyk, q R wektor współrzędnych konfgurcynych, n wymr przestrzen konfgurcyne mnpultor, m wymr przestrzen zdnowe mnpultor. Wyór współrzędnych zdnowych y do reprezentc knemtyk m stotny wpływ n złoŝoność reprezentc knemtyk [7]. ZleŜność pomędzy prędkoścm przeguowym prędkoścm w przestrzen zdnowe est określon z pomocą konu nltycznego, co zpsno nstępuąco: y& = ( q) q&, ( q) n k q = R q m n n () gdze: q& R wektor prędkośc przeguowych, y& R prędkość we współrzędnych zdnowych, (q) mcerz konow reprezentc knemtyk mnpultor we współrzędnych, nzywn konem nltycznym mnpultor. Do wyznczen konu nltycznego zstosowno eden z moŝlwych sposoów, przedstwony m.n. w prcch [6, 7]. kon nltyczny n-członowego mnpultor skłd sę z kolumn, =, 2,, n, czyl: q =...... n () m gdze kolumnę określ sę ko: R p p = - R kol - n - kol w przypdku gdy przegu -ty est orotowy lu (2)

496 P. Gerlk R = - kol () w przypdku gdy przegu -ty est pryzmtyczny. Elementy wzorów (2) () wyzncz sę n podstwe mcerzy trnsformc (8). Symolem R - kol oznczono trzecą kolumnę mcerzy rotc. W przypdku rozwŝnego mnpultor przyęto 6-wymrową przestrzeń zdnową, w które współrzędne y = [y y 2 y y 4 y y 6 ] T opsuą pozycę (trzy perwsze elementy) orentcę (trzy osttne elementy) końcówk roocze względem os ukłdu zowego. Ze względu n specyfczny sposó pomru kątów orotu członów mnpultor root Scorot-ER 4pc przyęto nowy wektor współrzędnych konfgurcynych: q θ q 2 θ 2 q = q = θ2 + θ (4) q4 θ 2 + θ + θ4 q θ Specyfk pomru kątów orotu członu. 4. poleg n tym, Ŝe kąty orotu tych członów ne są odmerzne względem os x członów poprzedzących, lecz względem pozome płszczyzny x y ukłdu zowego. kon nltyczny wyprowdzony z zstosownem zleŝnośc (8) orz ()-() we współrzędnych q m postć: l + l2c2 + lc + dc4 s l2s2c lsc ds4c l + l2c2 + lc + dc4 c l2s2s lss ds4s l2c2 lc dc4 y ( q ) = s c4c x c c4s s4 () gdze: s = snq, c = cosq. kon nltyczny (q) zndue zstosowne w prktycznych plkcch do olczn wpływu sł momentów występuących w końcówce mnpultor, określonych w ukłdze glolnym, n momenty w przeguch. eśl sły momenty są merzone z pomocą czunk umeszczonego w końcówce mnpultor, to są one wyrŝone w loklnym ukłdze czunk. Wówczs, w celu przelczen sł momentów z mesc pomru do przeguów mnpul-

nlz knemtyk mnpultor 497 tor, redukue sę zmerzony wektor sł momentów do ukłdu końcówk wyrŝ sę go w ukłdze glolnym, nstępne stosue sę kon nltyczny. Innym rozwąznem est zstosowne konu geometrycznego w cele. 4. kon geometryczny w cele W celu poprwnego olczen wpływu sł momentów wyrŝonych np. w ukłdze czunk sły umeszczonego w końcówce n sły momenty w przeguch mnpultor moŝn określć kon geometryczny w ukłdze cł (q), zwny krótko konem geometrycznym w cele [7]. MoŜlwy sposó wyznczn konu geometrycznego w cele mnpultor n-członowego przedstwono w prcy [7]. kon tk skłd sę z kolumn, =, 2,, n, czyl: q =...... n (6) gdze kolumnę defnue sę nstępuąco: = R R p nt R- kol nt nt n - kol - - (7) w przypdku gdy przegu -ty est orotowy lu = nt R- kol (8) w przypdku gdy przegu -ty est pryzmtyczny. kon geometryczny w cele wyprowdzony z zstosownem zleŝnośc (8) orz (6)-(8) we współrzędnych q m postć: ( q) l + l2c2 + lc + dc4 s l2c% 42c lc% 4c dc l + l2c2 + lc + dc4 c l2c% 42s lc% 4s ds l2s% 42 ls% 4 = c4c s c4s c s4 gdze: s% = sn( q q ), c% = cos( q q ). (9)

498 P. Gerlk. Konfgurce osolwe W zgdnench plnown trektor ruchu mnpultor stotnym zgdnenem est wyznczene konfgurc osolwych [, 7, 9]. Z prktycznego punktu wdzen występowne tkch konfgurc znczne utrudn rozwązywne zdn odwrotnego knemtyk, gdyŝ koneczne est wówczs stosowne złoŝonych metod mtemtycznych. W celu wyznczen konfgurc osolwych dokonue sę nlzy konu, przy czym nlzuąc kon nltyczny, moŝn wyznczyć konfgurce osolwe mnpultor, ntomst nlzuąc kon geometryczny, moŝn wyznczyć równeŝ osolwośc reprezentc knemtyk [7]. eśl lcz stopn swoody mnpultor est mnesz nŝ wymr przestrzen zdnowe tk est w przypdku rozwŝnego mnpultor, to zgodne z teorą wszystke ego konfgurce są osolwe. Gdyy kon ył mcerzą kwdrtową, wystrczyłoy olczyć ego wyzncznk wyznczyć zór konfgurc osolwych, przyrównuąc wyzncznk konu do zer. Przedstwone kony mnpultor ne są mcerzm kwdrtowym, dltego w celu wyznczen konfgurc osolwych określ sę zestw mnorów stopn. kŝdego konu poszukue sę konfgurc, w których ędą one równe zeru. Zestw mnorów stopn. konu nltycznego to: D l2l l + l2 cosq2 + l cosq + d cosq4 sn q q2 cosq4 l2l l + l2 cosq2 + l cosq + d cosq4 snq sn q q2 snq4 l2l l + l2 cosq2 + l cosq + d cosq4 cosq sn q q2 snq 4 = (2) l2l cos q sn ( q q2 ) cos q 4 l2l sn q sn ( q q2 ) cos q 4 z czego wynk, Ŝe zór konfgurc osolwych est nstępuący: T ( q q2 q q4 q ) R q = S = sn q = cos q = sn q q2 = sn q4 = (2) cos q4 = l + l2 cos q2 + l cos q + d cos q4 = Zestw mnorów stopn. konu geometrycznego w cele to:

nlz knemtyk mnpultor 499 l2l ( l + l2 cosq2 + l cosq + d cosq4 ) sn( q q2 ) snq l2l ( l + l2 cosq2 + l cosq + d cosq4 ) sn ( q q2 ) cosq D = (22) l2l sn( q q2 ) cos q4 cos q l2l sn( q q2 ) cos q4 sn q Wynk z nego zór konfgurc osolwych: ( q q2 q q4 q ) T q = R * S = sn q q2 = cos q4 = sn q = (2) cos q = l + l2 cos q2 + l cos q + d cos q4 = Zer w zestwch mnorów (2) (22) potwerdzą fkt, Ŝe rozptrywny mnpultor formlne zwsze est w konfgurc osolwe. 6. Podsumowne Przeprowdzon nlz knemtyk mnpultor umoŝlw zplnowne trektor we współrzędnych konfgurcynych, któr ędze nstępne relzown przez ukłd sterown root. W tym celu nleŝy rozwązć zdne odwrotne knemtyk przy nrzuconych zmnch pozyc (lu) orentc końcówk roocze mnpultor. Do tego celu moŝn zstosowć równn knemtyk (), z których nleŝy wyznczyć wektor prędkośc przeguowych, nstępne, przez cłkowne, wektor współrzędnych przeguowych. PonewŜ n < m, czyl wymr przestrzen konfgurcyne est mneszy nŝ wymr przestrzen zdnowe, ne est moŝlwe osągnęce przez końcówkę rooczą dowolnego punktu przestrzen zdnowe z dowolną orentcą. Przeprowdzon nlz osolwośc stnow wskzne, k nleŝy plnowć zmny pozyc orentc końcówk roocze, y mnpultor ne osągł konfgurc osolwych. Znomość konów mnpultor est szczególne potrzen w zgdnench sterown ruchem root, z uwzględnenem nterkc z otoczenem. est to sytuc typow m.n. dl róŝnych zdń montŝowych orz w przypdku zrootyzowne orók mechnczne. W tkm przypdku sły momenty nterkc pownny yć merzone przykłdowo przez czunk umeszczony w końcówce roocze, znomość konów pozwl n olczene wpływu sł nterkc n sły momenty w przeguch mnpultor orz umoŝlw poprwne sterowne rootem.

P. Gerlk Ltertur [] Grc L., Tornero.: Trckng Trectores wth Rootc Mnpultor wth Sngulrtes. LNCS, 4729 (27), 9-6. [2] śylsk W., Gerlk P.: Sterowne ruchem ndąŝnym rootów mnpulcynych. OW PRz, Rzeszów 24. [] Penne R., Smet E., Klosewcz P.: short Note on Pont Sngulrtes for Root Mnpultors.. Intell. Root Syst., 62 (2), 2-26. [4] Kozłowsk K., Dutkewcz P., Wrólewsk W.: Modelowne sterowne rootów. Wydwnctwo Nukowe PWN, Wrszw 2. [] Moreck., Knpczyk.: Podstwy rootyk. Teor elementy mnpultorów rootów. WNT, Wrszw 999. [6] Spong M.W., Vdysgr M.: Dynmk sterowne rootów. WNT, Wrszw 997. [7] Tchoń K. n.: Mnpultory rooty molne: modele, plnowne ruchu sterowne. kdemck Ofcyn Wydwncz PL, Wrszw 2. [8] Selg.M.: Geometrc Fundmentls of Rootcs, Sprnger Scence+Busness Med, New York 2. [9] Dulę I.: Metody lgorytmy plnown ruchu rootów molnych mnpulcynych. OW EXIT, Wrszw 2. NLYSIS OF THE KINEMTICS OF THE DOF MNIPULTOR S u m m r y In the pper the knemtcs nlyss of degrees of freedom mnpultor s presented. The nlyss ws relsed for the Scorot-ER 4pc rootc mnpultor. To descre the knemtcs of the mnpultor the Denvt-Hrtenerg notton s used. The knemtcs scheme nd prmeters of the mnpultor s well s pproprte trnsformton mtrces, tht were used n the further nlyss, re gven. The nlytcl con of the mnpultor nd the geometrcl con n the ody re determned nd the nlyss of sngulrtes s relsed. In sngulr mnpultor s confgurtons the soluton of the nverse knemtcs prolem s very dffcult, nd usng clsscl methods mpossle. Therefore, knowledge of the sngulr confgurtons s necessry for the proper plnnng nd genertng the trectory of the mnpultor. The presented methodology s unversl nd cn e used to nlyze the knemtcs of mnpultors wth other knemtc structure tht s not presented n ths pper. Keywords: con, sngulr confgurton, Denvt-Hrtenerg notton DOI:.7862/rm.24. Otrzymno/receved:.6.24 r. Zkceptowno/ccepted: 2..24 r.