MANIPULATORY (ROBOTY) Robotyka jest nauką o inteligentnym wykorzystaniu percepcji do działania.

48
MANIPULATORY (ROBOTY) Robotyka jest nauką o inteligentnym wykorzystaniu percepcji do działania. Obiektami robotyki są układy zdolne do samoczynnego i samodzielnego działania w zmieniającym się otoczeniu, zwane robotami autonomicznymi lub inteligentnymi. W zależności od przeznaczenia, roboty inteligentne należą do klasy robotów przemysłowych lub usługowych . Z samej natury robotyki wynika, że jednym z jej podstawowych narzędzi jest informatyka, ze szczególnym uwzględnieniem programowania numerycznego i symbolicznego, sztucznej inteligencji i inteligencji obliczeniowej, cyfrowego przetwarzania sygnałów, mikrokontrolerów oraz lokalnych sieci komputerowych i rozproszonych układów przetwarzania danych i sterowania.

description

MANIPULATORY (ROBOTY) Robotyka jest nauką o inteligentnym wykorzystaniu percepcji do działania. - PowerPoint PPT Presentation

Transcript of MANIPULATORY (ROBOTY) Robotyka jest nauką o inteligentnym wykorzystaniu percepcji do działania.

Page 1: MANIPULATORY (ROBOTY) Robotyka jest nauką o inteligentnym wykorzystaniu percepcji do działania.

MANIPULATORY (ROBOTY)Robotyka jest nauką o inteligentnym wykorzystaniu percepcji do działania. Obiektami robotyki są układy zdolne do samoczynnego i samodzielnego działania w zmieniającym się otoczeniu, zwane robotami autonomicznymi lub inteligentnymi. W zależności od przeznaczenia, roboty inteligentne należą do klasy robotów przemysłowych lub usługowych . Z samej natury robotyki wynika, że jednym z jej podstawowych narzędzi jest informatyka, ze szczególnym uwzględnieniem programowania numerycznego i symbolicznego, sztucznej inteligencji i inteligencji obliczeniowej, cyfrowego przetwarzania sygnałów, mikrokontrolerów oraz lokalnych sieci komputerowych i rozproszonych układów przetwarzania danych i sterowania.

Page 2: MANIPULATORY (ROBOTY) Robotyka jest nauką o inteligentnym wykorzystaniu percepcji do działania.

Automatyzacja wielu operacji technologicznych (np. podawanie detali do obróbki, montaż, pakowanie, sortowanie, rozpoznawanie cech fizycznych, itp.) wymaga stosowania urządzeń automatyki umożliwiających wykonywanie ruchów roboczych o precyzyjnie ustalonych parametrach, takich, jak: prędkość, przyspieszenie, przemieszczenie, trajektoria, położenie początkowe i końcowe ruchu. W operacjach tego typu wykorzystywane są manipulatory. Z punktu widzenia organizacji procesu tech nologicznego manipulowanie (ang. HANDLING) stanowi część funkcji przepływu materiałów (rysunek 1.)

PRZEP£YWMATERIA£ÓW

TRANSPORT MAGAZYNOWANIE MANIPULOWANIE

Rys.1. Operacja manipulowania jako element procesu technologicznego

Page 3: MANIPULATORY (ROBOTY) Robotyka jest nauką o inteligentnym wykorzystaniu percepcji do działania.

Manipulator sterowany jest przez urządzenie cyfrowe, którym może być PLC, wyspecjalizowany sterownik lub komputer. Stanowisko laboratoryjne wyposażone jest w elektropneumatyczny manipulator pozycjonujący sterowany przez komputer. W skład stanowiska wchodzą trzy grupy elementów (rysunek 4.): -urządzenie sterujące,-urządzenia transmisyjno - sprzęgające, -zespół manipulatora

URZ¥DZENIE

STERUJ¥CE

URZ¥DZENIA

TRANSMISYJNO

- SPRZÊGAJ¥CE

MANIPULATOR

Urządzeniem sterującym jest komputer osobisty klasy IBM PC (typu IBM PS/2). Komputer wraz z oprogramowaniem spełnia następujące funkcje:1. Umożliwia realizację programu sterującego urządzeniami wykonawczymi. 2. Umożliwia wpisanie programu sterującego, jego modyfikację oraz uruchomienie (tzn. sprawdzenie poprawności i ewentualne poprawienie).

URZĄDZANIE STERUJĄCE

urządzenia transmisyjno -

sprzęgające

Page 4: MANIPULATORY (ROBOTY) Robotyka jest nauką o inteligentnym wykorzystaniu percepcji do działania.

1 2 3 4 5

6

7

8

9

10

13

111213

14

15

16

17

18

Rys.3Manipulator (robot dydaktyczny)

Page 5: MANIPULATORY (ROBOTY) Robotyka jest nauką o inteligentnym wykorzystaniu percepcji do działania.

Urządzeniem wykonawczym jest manipulator pozycjonujący o 3 stopniach swobody: umożliwia przemieszczanie głowicy roboczej ruchem prostoliniowym poziomym, prostoliniowym pionowym i ruchem obrotowym wokół osi pionowej (rysunek 3.). Układ kinematyczny manipulatora stanowią dwie sprzężone prostopadle osie - pionowa (1) i pozioma (8), zamocowane na stole obrotowym (10). Na jednym z końców osi poziomej znajduje się chwytak pneumatyczny (15) sterowany przy pomocy rozdzielacza elektropneumatycznego. Jednostką napędową każdej osi jest silnik skokowy (2), (6), obracający śrubę posuwu (3), (7), która przesuwa wózek suportowy. Jednostką napędową stołu obrotowego jest silnik prądu stałego (9), z przekładnią zębatą. Na każdej prowadnicy zamontowany jest czujnik położenia (4), (5), wykorzystywany przy określaniu położenia ramienia manipulatora. W stole obrotowym zamontowane są dwa czujniki położenia (12) umożliwiające pozycjonowanie kątowe stołu. Na chwytaku zamocowane są dwa czujniki położenia (16), (17), z których jeden umożliwia detekcję stanu "chwytak trzyma", a drugi - stanu przeciwnego.

Page 6: MANIPULATORY (ROBOTY) Robotyka jest nauką o inteligentnym wykorzystaniu percepcji do działania.

Elementy transmisyjno - sprzęgające zapewniają komunikację między komputerem a elementami manipulatora, tzn. transmisję sygnałów sterujących z komputera do urządzeń wykonaw czych, oraz sygnałów informujących o stanie, w jakim znajduje się manipulator z czujników do komputera. W skład grupy elementów transmisyjno - sprzęgających wchodzą (rysunek 4.): - napięciowy interfejs szeregowy RS232 (karta wewnątrz komputera), - prądowy interfejs szeregowy D.AS-DIAG/RS232-1,

Page 7: MANIPULATORY (ROBOTY) Robotyka jest nauką o inteligentnym wykorzystaniu percepcji do działania.

STEROWNIK

SILNIKÓW

SKOKOWYCH

D.ER-REA

-POSIT-STEP-2

MODU£

WEJή/WYJή

CYFROWYCH

D.ER-REA-88-S

INTERFEJS

RS 232

PR¥DOWY

INTERFEJS

RS 232

NAPIÊCIOWY

Page 8: MANIPULATORY (ROBOTY) Robotyka jest nauką o inteligentnym wykorzystaniu percepcji do działania.

P1 P2

c1 c2

24V

0V

0V 0Vwejœcielogiczne

wejœcielogiczne

Sterowanie silnikiem prądu stałego do obrotu w osi pionowej manipulatora

Page 9: MANIPULATORY (ROBOTY) Robotyka jest nauką o inteligentnym wykorzystaniu percepcji do działania.

czas czas

czas

czas

czas

czas

CLK1 CLK2

DIR DIR

1

0

1

0

1

0

1

0

a) b)

Porównanie pracy silnika przy dwóch różnych częstotliwościach sygnału CLK. . a) silnik sterowany sygnałem CLK1, b) silnik sterowany sygnałem CLK2.Częstotliwość fCLK1=2*fCLK2

Page 10: MANIPULATORY (ROBOTY) Robotyka jest nauką o inteligentnym wykorzystaniu percepcji do działania.

FR

czas

R

-S+S

prêdkoœæk¹towa

Znaczenie parametrów FR, R, S określających ruch silnika skokowego. Tą samą drogę (kąt obrotu) silnik skokowy może przebyć z różnymi prędkościami i w różnym czasie, w zależności od wartości parametrów FR, R, S (rysunek 12.).Przy sterowaniu silnikiem skokowym należy wziąć pod uwagę ograniczenia, jakim podlegają war tości parametrów FR, R, S, które nie powinny przekroczyć pewnych wartości granicznych zależnych od momentu siły obciążającej silnik.

Prędkość kątowa

Page 11: MANIPULATORY (ROBOTY) Robotyka jest nauką o inteligentnym wykorzystaniu percepcji do działania.

Ramię manipulatora (1 i 8 na rysunku 3.) napędzane jest przez silnik skokowy. Ruch wzdłuż każdej z osi określony jest więc przez parametry ruchu silnika skokowego FR, R, S. Zmiana położenia ramienia wywoływana jest przez rozkazy języka CCS sterujące silnikiem skokowym. W celu określenia położenia ramienia wprowadzona jest oś układu współrzędnych OX (rysunek 13.). Kierunek osi OX jest zgodny z kierunkiem ramienia (1). Punkt zerowy osi jest wyznaczony przez magnes trwały (3) zamontowany na wózku suportowym (2). Położenie ramienia w punkcie zerowym jest wykrywane przez magnetyczny czujnik obecności (4) zamontowany na ramieniu. Od tego punktu odmierzane są współrzędne podawane w programie sterującym. Przemieszczanie ramienia możliwe jest tylko w obszarze dodatnich współrzędnych. Jednostką położenia na osi OX jest przesunięcie ramienia spowodowane jednym krokiem silnika skokowego. Długość ramienia mierzona w tych jednostkach wynosi 16000. Moduł wejść/wyjść cyfrowych.Moduł wejść/wyjść cyfrowych (rysunek 14.) umożliwia wprowadzenie do komputera (odczytanie) nie więcej niż 8 i wyprowadzenie z komputera (zapis) nie więcej niż 8 sygnałów logicznych (dwustanowych sygnałów napięciowych). Sygnały wyprowadzane są przez złącze wyjściowe (6) do odbiorników sygnałów, a wprowadzane przez złącze wejściowe (1) z nadajników sygnałów. 8 sygnałów wejściowych stanowi słowo wejściowe, a 8 sygnałów wyjściowych stanowi słowo wyjściowe modułu. Stan logiczny poszczególnych wejść i wyjść można obserwować na wskaźnikach diodowych (7), (8). Dołączanie przewodów sygnałowych do modułu jest ułatwione dzięki zastosowaniu puszki przyłączeniowej. Uporządkowanie sygnałów (numerowanych od 1 do 8) w polu wejściowym i wyjściowym puszki przyłączeniowej jest takie samo, jak uporządkowanie tych sygnałów (numerowanych od 0 do 7) w edytorze programu systemu CCS.

Page 12: MANIPULATORY (ROBOTY) Robotyka jest nauką o inteligentnym wykorzystaniu percepcji do działania.

1

2

3

4

5

6

7

910

11

12

8

13

modu³

wejϾ/wyjϾ

cyfrowych

puszka

przy³¹czeniowa

Moduł wejść/wyjść cyfrowych D.ER-REA-88-S z puszką przyłączeniową

Page 13: MANIPULATORY (ROBOTY) Robotyka jest nauką o inteligentnym wykorzystaniu percepcji do działania.

1

2

3

4 5 6 7

88

9

10

11

1213

14

0V 24V 0V 24V

Moduł sterowania silnikami skokowymi.

Page 14: MANIPULATORY (ROBOTY) Robotyka jest nauką o inteligentnym wykorzystaniu percepcji do działania.

oś 1nr diody

oś 2 nr diody

stan diody

stansterownika

0 4 01

ruchbrak ruchu

1 5 01

oś w położeniu odniesieniaoś poza położeniem odniesienia

2 6 01

nie używany

3 7 01

nie używany

Tabela stanów wskaźników świetlnych pokazujących stan wejść modułu sterowania silnikami skokowymi D.ER.-REA-STEP-POSIT-2.

a) b)

. Elementy ustalania konfiguracji modułu. a) przełącznik adresów, b) zespół przełączników konfiguracyjnych.

Page 15: MANIPULATORY (ROBOTY) Robotyka jest nauką o inteligentnym wykorzystaniu percepcji do działania.

5

1 2

3 3 34 4

4

. Łączenie modułów z komputerem. 1 ‑ komputer, 2 ‑ przetwornik napięciowego sygnału transmisji szeregowej na sygnał prądowy, 3 ‑ moduły, 4 ‑ kable łączące, 5 ‑ terminator.

Page 16: MANIPULATORY (ROBOTY) Robotyka jest nauką o inteligentnym wykorzystaniu percepcji do działania.

SPOSOBY PROGRAMOWANIA MANIPULATORA

Za pomocą języka CCS.

Za pomocą języka STL.

Za pomocą specjalnych procedur języka Pascal.

Page 17: MANIPULATORY (ROBOTY) Robotyka jest nauką o inteligentnym wykorzystaniu percepcji do działania.

Opis języka CCS.Język programowania CCS (Computer Control Software) służy do tworzenia programów steru jących urządzeniami wykonawczymi połączonymi z komputerem za pomocą interfejsów D.ER-REA-POSIT-STEP-2 oraz D.ER-REA-88-S (możliwe jest też oprogramowanie modułów wejść/wyjść analogowych i wejść analogowych/wyjść cyfrowych, które jednak nie są używane do sterowania manipulatorem i w związku z tym nie będą opisywane). Większość rozkazów tego języka jest wykonywana warunkowo. Język umożliwia wykonywanie następujących operacji:•odczyt wartości sygnałów logicznych doprowadzonych do modułu wejść/wyjść cyfrowych, •nadanie wartości wyjściowym sygnałom logicznym modułu wejść/wyjść cyfrowych,•nadawanie wartości zmiennym logicznym (flagom),•budowanie wyrażeń sumy i alternatywy logicznej, których argumentami są wartości sygnałów wejściowych modułów wejść/wyjść cyfrowych i wartości zmiennych logicznych,•wykorzystanie liczników zdarzeń logicznych,•wykorzystanie funkcji czasowych (opóźnienia i pętle czasowe),•sterowanie silnikami skokowymi (prędkością, przyspieszeniem i położeniem każdego z ramion manipulatora),•odtworzenie (w formie wywołania podprogramu) sekwencji ruchów manipulatora zapamiętanych w trybie "ręcznego sterowania",•wykorzystanie skoków programowych.

Page 18: MANIPULATORY (ROBOTY) Robotyka jest nauką o inteligentnym wykorzystaniu percepcji do działania.

Program napisany w języku CCS składa się z kroków. Ilość kroków w programie nie może być większa niż 500. Zapis każdego kroku zawiera kolejno: numer kroku, warunek wykonania rozkazu, rozkaz, argumenty rozkazu i ewentualnie warunki czasowe. Program może zawierać również linie komentarza, wprowadzane najczęściej w celu objaśnienia przebiegu programu. Każda linia komenta rza powinna rozpoczynać się znakiem * i może mieć dowolną zawartość. Ilość linii komentarza i ich położenie w programie są dowolne.

POLE EDYTORA

linia komunikatów o błędach

numer

krokuwarunek wejściowy rozkaz opis wyjścia warunek

czasowy

ramka bieżących informacjinagłówek edytora programulinia menu systemowego

kolumna 1 kolumna 2 kolumna 3 kolumna 4 kolumna 5 kolumna 6 kolumna 7

Page 19: MANIPULATORY (ROBOTY) Robotyka jest nauką o inteligentnym wykorzystaniu percepcji do działania.

Symbol Znaczenie symbolu

0 Odpowiednie wejście logiczne powinno być w stanie logicznym "0"

1 Odpowiednie wejście powinno być w stanie logicznym "1"

X Odpowiednie wejście może przyjmować dowolny stan logiczny

STEPNo.

MODULE/FLAG

INPUT01234567

COMMAND MODULE/FLAG

OUTPUT01234567

TIME

010 01 101XXXXX 00 0XXXXXXX

PRZYKŁAD 1

STEPNo.

MODULE/FLAG

INPUT01234567

COMMAND MODULE/FLAG

OUTPUT01234567

TIME

012 REF 01 A3013 D+ 01 A1014 FR10 01 A1015 R100 01 A1016 S5 01 A1017 G6000 01 A1018 D- 01 A1019 G1000 01 A1020 G2000 01 A1021 G2000 01 A1

PRZYKŁAD 2

Page 20: MANIPULATORY (ROBOTY) Robotyka jest nauką o inteligentnym wykorzystaniu percepcji do działania.

Programowanie robota za pomocą języka STL.

(napęd stepper motors- silniki krokowe)

Page 21: MANIPULATORY (ROBOTY) Robotyka jest nauką o inteligentnym wykorzystaniu percepcji do działania.

0004 "" * * * * * * * * * * * * "PROGRAM 3 : MANIPULATOR * * * *0005 "" * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * *0006 STEP 1 (1) "*********DEKLARACJA STALYCH*********0007 THEN CFM 0 "ZEROWANIE WSZYSTKICH *0008 WITH V0 "FLAG,REJESTROW,TIMEROW,LICZNIKOW *0009 LOAD V5000010 TO TP2 'czas zalaczenia tasmociagu11 LOAD V300012 TO TP4 'czas migotania lampki alarmowej

0013 STEP 1.1 (2) "***OPERACJE RESETUJACE UKLAD0014 THEN RESET led1 'lampka przycisku start0015 RESET led2 'lampka pozycjonowania wyjsciowego0016 RESET sp1 'ssanie ON 4Y30017 SET sp0 'ssanie OF 4Y4======================================================0018 STEP 2 (3)0019 THEN LOAD V10 "predkosc poczatkowa0020 TO R0 "os 10021 TO R3 "os 2=====================================================0022 STEP 2.1 (4)0023 THEN LOAD V80 "predkosc koncowa0024 TO R1 "os 10025 TO R4 "os 2======================================================0026 STEP 2.3 (5)0027 THEN LOAD V100 "przyspieszenie0028 TO R2 "os10029 TO R5 "os2

Page 22: MANIPULATORY (ROBOTY) Robotyka jest nauką o inteligentnym wykorzystaniu percepcji do działania.

0040 STEP 20 (7) "***INICJALIZACJA STEROWNIKA SILNIKOW0041 IF F13.0 'BAP beendet bzw. Motion complete0042 THEN CFM 20043 WITH 'cmp0:1'0044 WITH V00045 WITH V10046 WITH V00047 WITH V0===============================================================0048 STEP 30 (8) "***WYWOLANIE RUCHU REFERENCYJNEGO0049 IF F13.0 'BAP beendet bzw. Motion complete0050 THEN CFM 20051 WITH 'cmp0:1'0052 WITH V00053 WITH V230054 WITH V00055 WITH V0

0070 STEP 53 (12) "***NAJAZD NA PUNKT POBRANIA0071 IF _cz 'element gotowy do pobrania 3B80072 AND F13.0 'BAP beendet bzw. Motion complete0073 THEN CFM 20074 WITH 'cmp0:1'0075 WITH V00076 WITH V30077 WITH V220078 WITH V220079 RESET st 'silnik tasmociagu 2M10080 OTHRW JMP TO 200 (22)

Page 23: MANIPULATORY (ROBOTY) Robotyka jest nauką o inteligentnym wykorzystaniu percepcji do działania.

Programowanie robota w języku PASCAL

Page 24: MANIPULATORY (ROBOTY) Robotyka jest nauką o inteligentnym wykorzystaniu percepcji do działania.

Instrukcja programowania robota w języku PASCALSterowniki silników skokowych i moduły we/wy cyfrowych podłączamy do portu szeregowego np. COM2 poprzez konwerter D.AS-DIAG / RS232-1.Przed uruchomieniem programu w Pascalu należy ustawić parametry transmisji przez port szeregowy za pomocą komendy dosowej mode , np.:

mode com2: baud24 parity=M data=7 stop=1Ustawione w ten sposób parametry muszą być zgodne z parametrami ustawionymi za pomocą przełączników na płycie czołowej sterownika (w podanym przykładzie wszystkie przełączniki muszą być w pozycji OFF).Do sterowania robotem został napisany program w języku Pascal. Jego kod znajduje się w kilku plikach : proc1.pas, procpom.pas, rozkazy.pas, ruchy.pas, stałe.pas, typy.pas. Głównym plikiem jest proc1.pas, w którym można wprowadzać pożądaną sekwencję działań robota. Pozostałych plików nie należy modyfikować. W oznaczonym obszarze pliku proc1.pas najpierw należy wywołać procedurę :assign(zmienna_plikowa,’COM2’); - przypisanie zmiennej zmienna_plikowa typu text do portu szeregowego, do którego jest podłączony sterownik.

Page 25: MANIPULATORY (ROBOTY) Robotyka jest nauką o inteligentnym wykorzystaniu percepcji do działania.

Komunikacja odbywa się poprzez wysyłanie i odbieranie znaków kodu ASCII. W omawianym programie napisano procedury ułatwiające tworzenie odpowiednich sekwencji znaków, a następnie wysyłanie ich i odbieranie. Przed wysłaniem jakiejkolwiek sekwencji znaków należy otworzyć zmienna plikową do zapisu :rewrite(zmienna_plikowa);Robot wykonuje ruch do punktu referencyjnego po wywołaniu procedury :PunktReferencyjny;Moment zakończenia ruchu referencyjnego nie jest wykrywany automatycznie. Stan obu silników skokowych można wykrywać za pomocą procedury :odczytaj(md,os); md - określa numer modułuos - określa oś, której stan sprawdzamyPo wywołaniu tej procedury w zmiennej status zostaną przypisane dwie cyfry heksadecymalne. Przy czym 7F - oznacza, że ruch trwa,FF - oznacza, że ruch zakończył się. Zmienna statusu jest typu string[2].

Page 26: MANIPULATORY (ROBOTY) Robotyka jest nauką o inteligentnym wykorzystaniu percepcji do działania.

Ruch robota na osiach napędzanych silnikami skokowymi realizuje się za pomocą wywołania procedury :ruchodczyt(md,os,odl);md - modułos - numer osiodl - odległość typu integerW tej procedurze jest już sprawdzane zakończenie ruchu. Przejście do wykonywania kolejnego rozkazu w programie odbywa się dopiero po zakończeniu ruchu.Sprawdzanie stanu wejść cyfrowych modułu nr 0 odbywa się za pomocą wywołania procedury :odczytIO;Po jej wykonaniu, zmiennej status zostana przypisane dwie cyfry heksadecymalne odpowiadające stanowi dwu czwórek wejść cyfrowych.Zapisanie wyjść cyfrowych odbywa się za pomocą procedury :zapisIO(‘XX’);X - cyfra heksadecymalna 0,1,..,9,A,B,C,D,E,F.

Page 27: MANIPULATORY (ROBOTY) Robotyka jest nauką o inteligentnym wykorzystaniu percepcji do działania.

Programowanie silników krokowych robota bezpośrednio z PLC

Page 28: MANIPULATORY (ROBOTY) Robotyka jest nauką o inteligentnym wykorzystaniu percepcji do działania.

Prosty układ sterowania silnikiem krokowym na PLC -S7; użyto hardwerowego układu SAA 1027, który z dwóch sygnałów -sygnału taktu i sygnału kierunku- generuje odpowiednie przebiegi 4 faz )

Page 29: MANIPULATORY (ROBOTY) Robotyka jest nauką o inteligentnym wykorzystaniu percepcji do działania.
Page 30: MANIPULATORY (ROBOTY) Robotyka jest nauką o inteligentnym wykorzystaniu percepcji do działania.

Zalety i wady silników krokowych.

Zalety:• Kąt obrotu silnika jest proporcjonalny do ilości impulsów wejściowych,• Silnik pracuje z pełnym momentem w stanie spoczynku (o ile uzwojenia są zasilane),• Precyzyjne pozycjonowanie i powtarzalność ruchu - dobre silniki krokowe mają dokładność

ok. 3 - 5% kroku i błąd ten nie kumuluje się z kroku na krok,• Możliwość bardzo szybkiego rozbiegu, hamowania i zmiany kierunku,• Niezawodne - ze względu na brak szczotek. żywotność silnika zależy zatem tylko od

żywotności łożysk,• Zależność obrotów silnika od dyskretnych impulsów umożliwia sterowanie w pętli otwartej,

przez co silnik krokowy jest łatwiejszy i tańszy w sterowaniu,• Możliwość osiągnięcia bardzo niskich prędkości synchronicznych obrotów z obciążeniem

umocowanym bezpośrednio na osi.,• Szeroki zakres prędkości obrotowych uzyskiwany dzięki temu, że prędkość jest

proporcjonalna do częstotliwości impulsów wejściowych,• Jedną z najbardziej znaczących zalet silnika krokowego jest możliwość dokładnego

sterowania w pętli otwartej. Praca w pętli otwartej oznacza, że nie potrzeba sprzężenia zwrotnego - informacji o położeniu. Takie sterowanie eliminuje potrzebę stosowania kosztownych urządzeń sprzężenia zwrotnego, takich jak enkodery optoelektroniczne. Pozycje znajduje się zliczając impulsy wejściowej.

Wady:Rezonanse mechaniczne pojawiające się przy niewłaściwym

sterowaniu,Trudności przy pracy z bardzo dużymi prędkościami

Page 31: MANIPULATORY (ROBOTY) Robotyka jest nauką o inteligentnym wykorzystaniu percepcji do działania.

Ruchy dwustawne- pneumatyczny napęd beztłoczyskowy

Page 32: MANIPULATORY (ROBOTY) Robotyka jest nauką o inteligentnym wykorzystaniu percepcji do działania.

Programowanie PLC w przypadku zadań sekwencyjnychPrzykładowy projekt układu sterowania procesem objętościowego dozowania materiału sypkiego

(np. sorbentu siarki w kotle)

Ze zbiornika ma być pobierana stała objętość ziarna w sposób cykliczny. Objętość dozowanego ziarna ustalana jest przez dwie zasuwy napędzane siłownikami A i B. Po zamknięciu zasuwy dolnej (tłoczysko siłownika B - wysunięte) i przy otwartej zasuwie górnej (tłoczysko siłownika A – wycofane) następuje wypełnienie przestrzeni dozowniczej (rys.

a). Wysuw tłoczyska siłownika A (rys. b) odcina określoną objętość ziarna. Odmierzona objętość ziarna opuszcza silos po otwarciu zasuwy dolnej (rys. c). Czas otwarcia zasuwy górnej jest także zadawany. Zaprojektować układ

automatycznego sterowania spełniający ww. wymagania

Page 33: MANIPULATORY (ROBOTY) Robotyka jest nauką o inteligentnym wykorzystaniu percepcji do działania.
Page 34: MANIPULATORY (ROBOTY) Robotyka jest nauką o inteligentnym wykorzystaniu percepcji do działania.

Programowanie PLC w przypadku zadań sekwencyjnych

(Widok zadania : samotok)

Page 35: MANIPULATORY (ROBOTY) Robotyka jest nauką o inteligentnym wykorzystaniu percepcji do działania.

Zadanie :

Przy pomocy zestawu elementów elektro-pneumatycznych i sterownika zrealizować cyklogram przedstawiony na poniższym rysunku . Zadanie zrealizować w języku drabinkowym. Cyklogram dotyczy współdziałania 2

siłowników obsługujących fragment samotoku – kiedy „paczka” trafia na siłownik A, ten podnosi ja do góry i przytrzymuje tak długo aż siłownik B przesunie paczkę na kolejny fragment samotoku.

Page 36: MANIPULATORY (ROBOTY) Robotyka jest nauką o inteligentnym wykorzystaniu percepcji do działania.
Page 37: MANIPULATORY (ROBOTY) Robotyka jest nauką o inteligentnym wykorzystaniu percepcji do działania.
Page 38: MANIPULATORY (ROBOTY) Robotyka jest nauką o inteligentnym wykorzystaniu percepcji do działania.
Page 39: MANIPULATORY (ROBOTY) Robotyka jest nauką o inteligentnym wykorzystaniu percepcji do działania.

Lista alokacji zmiennych sterownika SIMATIC S7 200 :

Czujnik paczki - I0.0

Kr_A0 - I0.1 (siłownik A cofnięty)

Kr_A1 - I0.2 (siłownik A wysunięty)

Kr_B0 - I0.4 (siłownik B -cofnięty)

Kr_B1 - I0.5 (siłownik B wysunięty)

Wyjścia:

cewka rozdzielacza siłownika A - Q0.4 cewka rozdzielacza siłownika B - Q0.5Znaczniki stanu cyklogramu:M0.0, M0.1 M0.2, M0.3 Lamki stanu:Q0.0, Q0.1 Q0.2, Q0.3 odpowiednioProgram – Ladder poniżej:

Page 40: MANIPULATORY (ROBOTY) Robotyka jest nauką o inteligentnym wykorzystaniu percepcji do działania.
Page 41: MANIPULATORY (ROBOTY) Robotyka jest nauką o inteligentnym wykorzystaniu percepcji do działania.
Page 42: MANIPULATORY (ROBOTY) Robotyka jest nauką o inteligentnym wykorzystaniu percepcji do działania.

Zadanie 2. Przy pomocy zestawu elementów elektro-pneumatycznych i sterownika FESTO 101 ( lub S7) zrealizować cyklogram przedstawiony na poniższym rysunku. Zadanie zrealizować w języku STLZadanie nawiązuje do monostabilnych przycisków spełniających jednocześnie funkcje włącznika i wyłącznika – pierwsze naciśnięcie dale nam na wyjściu jedynkę logiczną, drugie ja kasuje. Takie rozwiązanie, stosowane m.in. w klawiaturach do komputerów klasy PC (CAPS LOCK, SCROLL LOCK i NUM LOCK) ma zastosowanie, np., gdy mamy ograniczoną liczbę wejść do sterownika (albo ograniczona liczbę przycisków), a musimy zapewnić ręczne załączanie i wyłączanie jakiś urządzeń.

Page 43: MANIPULATORY (ROBOTY) Robotyka jest nauką o inteligentnym wykorzystaniu percepcji do działania.
Page 44: MANIPULATORY (ROBOTY) Robotyka jest nauką o inteligentnym wykorzystaniu percepcji do działania.

0001 STEP 10 (1) 0002 THEN SET ff 'flaga 1 ====================================================================== 0003 STEP 20 (2) 0004 IF ff 'flaga 1 0005 AND N x1 'start 0006 THEN RESET ff 'flaga 1 ====================================================================== 0007 STEP 30 (3) 0008 IF N ff 'flaga 1 0009 AND x1 'start 0010 THEN SET ff 'flaga 1 ====================================================================== 0011 STEP 40 (4) 0012 THEN LOAD N y1 'silownik A 0013 TO y1 'silownik A ====================================================================== 0014 STEP 50 (5) 0015 THEN JMP TO 10 (1)

Page 45: MANIPULATORY (ROBOTY) Robotyka jest nauką o inteligentnym wykorzystaniu percepcji do działania.

A

M B

M W

M Z

M pow

M S

p

n

N

H

p c

Blok energetyczny jako wielowymiarowy obiekt regulacji.

Page 46: MANIPULATORY (ROBOTY) Robotyka jest nauką o inteligentnym wykorzystaniu percepcji do działania.

Model bloku MIMO 2x2

Blok energetyczny stanowi obiekt regulacji o wielu wejściach i wyjściach. Główne wielkości regulowane umieszczone są na rys.1. Linią ciągłą zaznaczono oddziaływania w torach głównych, ale oprócz nich występują jeszcze oddziaływania skrośne, powodujące sprzężenie obwodów regulacji między sobą (linie przerywane).

Blok energetyczny jako wielowymiarowy obiekt regulacji.

A – położenie zaworu turbiny, M B - strumień paliwa,

MW - strumień wody do schładzaczy pary,

MZ - strumień wody zasilającej,

MPow - strumień powietrza do kotła,

MS - strumieńspalin z kotła,

N - moc bloku,

n - prędkość obrotowa turbozespołu,

p – ciśnienie pary, t - temperatura pary,

h - poziom wody w walczaku,

- nadmiar powietrza charakteryzujący proces spalania,

pc - podciśnienie w komorze paleniskowej.

Page 47: MANIPULATORY (ROBOTY) Robotyka jest nauką o inteligentnym wykorzystaniu percepcji do działania.

T r a n s m i t a n c j a

G sM s

L s T

ns

L

p Ln( )

( )

( )

*

*

1

1

( 2 )

o z n a c z a d e f i n i c y j ną i n e r c ję c i e p l n ą s t r u m i e n i a p a r y , a t r a n s m i t a n c j a

G sM s

p s

T s

T sS

L

g

p

( )( )

( )

*

*

1

( 3 )

a k u m u l a c ję p a r y w k o t l e .

Page 48: MANIPULATORY (ROBOTY) Robotyka jest nauką o inteligentnym wykorzystaniu percepcji do działania.

M M p L ( , )Model bloku energetycznego

)()(

)()(

)(

)()()( *

*

**

*

*

** sp

sp

sMsL

sL

sM

M

sMsM

Lp

l u b w s k r ó c i e

M M M G s L s G s p sp L L S* * * * *( ) ( ) ( ) ( ) ( 1 )

strumień pary M ciśnienie pary p strumień paliwa L położenie zaworu turbiny A

pz

L

p

M

Rp A