background image

 

 

POLITECHNIKA ŚLĄSKA 

WYDZIAŁ ELEKTRYCZNY 

KATEDRA MECHATRONIKI 

 

Instrukcja do ćwiczenia laboratoryjnego 

Przedmiot: 

Roboty i Manipulatory 

 

Symbol ćwiczenia: 

PN 

 

Tytuł ćwiczenia: 

Robot przemysłowy o napędzie 
pneumatycznym 

background image

ROBOTY I MANIPULATORY – instrukcja do ćwiczenia laboratoryjnego 

 

 

 

 

 

Robot przemysłowy o napędzie pneumatycznym 

Wprowadzenie 

 
Roboty  przemysłowe  z  napędami  pneumatycznymi  charakteryzują  się 

stosunkowo niewielkim udźwigiem (maksymalnie do 20 daN). Napędy pneumatyczne 
robotów  przemysłowych  pracują  na  ogół  w  układzie  otwartym  (bez  sprzężenia 
zwrotnego), a skrajne położenia ramion są nastawione za pomocą ograniczników lub 
zderzaków. 

Pod  względem funkcjonalnym układ napędu  pneumatycznego  ze  sterowaniem 

cyklicznym, można podzielić na następujące człony (bloki),  

 przygotowanie czynnika roboczego (sprężonego powietrza), 
 sterowania przepływem sprężonego powietrza, 

 elementów wykonawczych 
Do  wytwarzania  sprężonego  powietrza  służą  sprężarki  (kompresory). 

Podstawowym kryterium doboru sprężarki jest wydajność, często spotkać się można 
z  dwoma  różnymi  określeniami  wydajności,  a  wiec  z  wydajnością  teoretyczną 
i wydajnością  efektywną.  Z  punktu  widzenia  użytkownika  interesująca  jest  tylko 
wydajność  efektywna  sprężarki,  gdyż  tylko  nią  dysponuje  się  w  celu  pokrycia 
zapotrzebowania przez urządzenia napędowe i sterujące. Wydajność jest podawana 
w m

3

/min lub w m

3

/h.  

Kolejną  rzeczą,  na  którą  należy  zwrócić  uwagę  przy  doborze  sprężarki  jest 

ciśnienie.  Rozróżniamy  ciśnienie  zasilania  i  ciśnienie  robocze.  Ciśnienie  zasilania 
jest dostarczone ze sprężarki do odbiorników,  względnie  jest to ciśnienie  powietrza 
zmagazynowanego  w  zbiorniku  lub  przewodach  zasilających.  Ciśnienie  robocze  to 
niezbędne ciśnienie na poszczególnych stanowiskach roboczych. Zazwyczaj wynosi 
ono  600kPa  (6bar).  Wszystkie  dane  robocze  elementów  są  podawane  najczęściej 
dla tego ciśnienia. Jedną z najważniejszych rzeczy, o jakiej należy pamiętać podczas 
eksploatacji  urządzeń  pneumatycznych,  jest  stałość  ciśnienia.  Zależą  od  niej 
prędkość, siła oraz czas pracy elementów roboczych. 

Sprężone  powietrze  tłoczone  przez  sprężarki  posiada  różnego  rodzaju 

zabrudzenia. Głównie są to drobne zanieczyszczenia mechaniczne (pył, rdza), woda, 
a  także  olej  pochodzący  ze  sprężarki.  Dlatego,  aby  możliwe  było  uzyskanie 
niezawodnego  i  długotrwałego  działania  mechanizmów  pneumatycznych,  sprężone 
powietrze należy odpowiednio przygotować. Przygotowanie powinno polegać na: 

 usunięciu zanieczyszczeń, 

 redukcji ciśnienia do odpowiedniego poziomu, 
 wprowadzenie czynnika smarującego. 
Powietrze oczyszczone powinno się charakteryzować następującymi cechami: 
 braku wody w postaci kropel, 

 zanieczyszczeniami mechanicznymi poniżej 5 μm, 

 niewystępowaniem olejów oraz cieczy w postaci kropel. 
Klasy  jakości  powietrza  określa  międzynarodowa  norma  ISO  8537.1  Poniżej 

przestawiono widok układu przygotowania powietrza (rys. 1), którego zadaniem jest 
oczyszczenie  z  pary  wodnej  sprężonego  powietrza  dostarczonego  ze  sprężarki, 
a następnie ustalenie stałej, zadanej wartości ciśnienia na wylocie zaworu. W skład 
tego układu wchodzą: filtr, regulator, smarownica i wkładka filtracyjna. 

 

background image

ROBOTY I MANIPULATORY – instrukcja do ćwiczenia laboratoryjnego 

 

 

 

 

 

Robot przemysłowy o napędzie pneumatycznym 

 

 

Rys. 1. Układ przygotowania powietrza: a) widok ogólny, b) symbol 

 

Blok  sterowania  przepływem  sprężonego  powietrza  zawiera  urządzenia, 

za pomocą  których,  zgodnie  z  założonym  programem  działania  robota,  otwiera  się 
lub  zamyka  dostęp  sprężonego  powietrza  do  roboczych  przestrzeni  elementów 
wykonawczych.  Elementami  sterowania  przepływem  powietrza  są  rozdzielacze 
pneumatyczne 

(zawory 

rozdzielające) 

sterowane 

elektromagnetycznie. 

W szczególnych  przypadkach  (np.  praca  w  środowisku  agresywnym,  wybuchowym 
bądź  o  wysokim  stopniu  radiacji  itp.)  stosuje  się  rozdzielacze  ze  sterowaniem 
pneumatycznym. 

Można wyróżnić następujące cechy zaworów rozdzielających: 
 liczba  dróg  przepływu  –  liczba  otworów  nie  połączonych  ze  sobą  trwale, 

wykonanych  dla  przepływu  powietrza  przez  zawór.  Drogi  przepływu  są  wzajemnie 
odcinane lub łączone przez element sterujący w zaworze, 

 liczba  położeń  zaworu  –  najczęściej  stosowane  są  zawory  dwu  i  trzy 

położeniowe, 

 rodzaje  sterowania  zaworu  –  wyróżnia  się  sterowanie  ręczne,  mechaniczne, 

elektryczne, pneumatyczne lub w sposób mieszany, 

 odmiany  sterowania  –  sterowanie  bezpośrednie  lub  pośrednie  oraz  zawory 

utrzymujące  położenie  po  zaniku  sygnału  sterującego  (bistabilne)  i powracające  do 
położenia początkowego, po zaniku sygnału sterującego (monostabilne), 

 sposób zasilania – zasilane przewodowo i bezprzewodowo. 
Wszystkie  te  cechy  decydują  o  własnościach  funkcjonalnych  zaworów. 

Na schematach  układów  sterujących  zawory  przedstawione  są  w  sposób 
następujący (rys.2) 

 

background image

ROBOTY I MANIPULATORY – instrukcja do ćwiczenia laboratoryjnego 

 

 

 

 

 

Robot przemysłowy o napędzie pneumatycznym 

 

Rys. 2. Symbole zaworów rozdzielających 

 

Jak  można  zauważyć  na  powyższym  rysunku  liczba  przylegających  do  siebie 

kwadratów,  mówi  o liczbie  położeń zaworu,  natomiast liczba przyłączy  wskazuje  ilu 
drogowy  jest  zawór.  Sposoby  sterowania  zaworu  są  dorysowywane  do  symbolu 
zaworu, prostopadle do kierunku przyłączeń. Poniższy rysunek przedstawia budowę 
zaworu elektropneumatycznego, trójdrogowego, dwupołożeniowego (rys.3). 

 

 

Rys. 3. Budowa zaworu pneumatycznego 

 

Blok  elementów  wykonawczych  napędu  zawiera  siłowniki  pneumatyczne. 

Siłowniki stosowane do napędu robotów i mechanizmów pomocniczych (chwytaków) 
mogą  być  zespołami  typowymi  (produkowanymi  przez  wyspecjalizowane  firmy)  lub 
specjalnymi. Siłowniki pneumatyczne stosowane najczęściej w robotach, ze względu 
na ich rozwiązania konstrukcyjne, można podzielić na: tłoczyskowe (z jednostronnym 
i  dwustronnym  tłoczyskiem)  oraz  beztłoczyskowe,  membranowe,  mieszane 
i wahadłowe. 

konstrukcji 

manipulatora 

kartezjańskiego 

zastosowano 

siłowniki 

pneumatyczne  dwustronnego  działania  (rys.  4).  Siłowniki  tego  rodzaju  są 
powszechnie stosowane w różnego rodzaju pneumatycznych układach napędowych. 
Działanie  tego  siłownika  polega  na  tym,  że  sprężone  powietrze  dopływające 

background image

ROBOTY I MANIPULATORY – instrukcja do ćwiczenia laboratoryjnego 

 

 

 

 

 

Robot przemysłowy o napędzie pneumatycznym 

z elementu  rozdzielającego,  przez  rozdzielacz  kierowane  jest  do  jednej  z  komór 
siłownika.  Działając  na  tłok  powoduje  jego  przemieszczenie.  Powrót  do  pozycji 
wyjściowej  odbywa  się  po  przełączeniu  rozdzielacza.  Powietrze  wpływa  wtedy  do 
drugiej  komory  siłownika,  a  pierwsza,  poprzednio  napełniona,  łączona  jest 
z atmosferą. 

 

 

Rys. 4. Siłownik pneumatyczny dwustronnego działania oraz jego symbol graficzny 

 

1. 

Ręczne sterowanie jednym członem manipulatora 

kartezjańskiego 

 
Poniżej  przedstawiona  została  numeracja  przyłączy  pneumatycznych, 

wyłączników  krańcowych  manipulatora  kartezjańskiego  (Rys.  5),  oraz  schemat 
połączeń  pneumatycznych  i  elektrycznych  jednej  osi,  w  przypadku  sterowania 
ręcznego. 

 
 
 
 

 

 

Rys. 5. Numeracja przyłączy pneumatycznych oraz krańcówek manipulatora 

 

background image

ROBOTY I MANIPULATORY – instrukcja do ćwiczenia laboratoryjnego 

 

 

 

 

 

Robot przemysłowy o napędzie pneumatycznym 

5   1   3

 4      2

14

12

+24V

0 V

P11

P12

 

Rys. 6. Schemat połączeń elektrycznych i pneumatycznych  

 

2. 

Konfiguracja Sterownika PLC 

 
2.1 

Tworzenie nowego projektu 

- uruchamiamy program Totally Integrated Automation

- po uruchomieniu okna jak na rysunku 7 przystępujemy do tworzenia nowego 

projektu 

 

 

 

Rys. 7. Widok głównego okna programu Totally Integrated Automation

 

-  wybieramy  Create  new  project  (rys.7).  Nowy  projekt  tworzymy  (rys  8)  w 

katalogu D:\Studenci-Dokumenty\

nazwa_grupy 

background image

ROBOTY I MANIPULATORY – instrukcja do ćwiczenia laboratoryjnego 

 

 

 

 

 

Robot przemysłowy o napędzie pneumatycznym 

 

 

Rys. 8. Tworzenie nowego projektu. 

 

 

2.2  Konfiguracja warstwy sprzętowej 

- po utworzeniu nowego projektu (rys.9), przystępujemy do konfiguracji 

sterownika, wybierając Configure a device (rys.9) 

 

 

Rys. 9. Okno startowe nowo utworzonego projektu. 

 

background image

ROBOTY I MANIPULATORY – instrukcja do ćwiczenia laboratoryjnego 

 

 

 

 

 

Robot przemysłowy o napędzie pneumatycznym 

- w zakładce Configure a device (rys.10) wybieramy sterownik PLC Simatic S7-

1200 z procesorem CPU 1212C→6ES7 212-1BD30-0XB0. 

 

 

Rys. 10. Okno wyboru CPU. 

 
 

2.3  

Przygotowanie warstwy programowej 

Jednym ze sposobów utworzenia nowego programu (rys 11) jest powrót do 

okna startowego (rys.9) i wybranie Create a PLC program. 

 

 

Rys. 11. Okno nowo utworzonego programu. 

background image

ROBOTY I MANIPULATORY – instrukcja do ćwiczenia laboratoryjnego 

 

 

 

 

 

Robot przemysłowy o napędzie pneumatycznym 

2.4 Zmienne stosowane w programie. 

Zakładka  ‘PLC  tags”  (rys.  12)  zawiera  listę  nazw  zmiennych  stosowanych 

w programie  przy  adresowaniu  pośrednim  (symbolicznym).  W  tabelę  wpisuje  się 
nazwę zmiennej, jej adres, typ oraz rodzaj. 

Rodzaje zmiennych: 
–  imput  „I”  zmienna  wejsciowa  (przykład  I  0.0  –  bit  o  numerze  0,  bajtu  0 

z przedziału zmiennych wejściowych) 

–  output  „Q”  zmienna  wyjściowa  (przykład  Q  0.1  –  bit  o  numerze  1,  bajtu  0 

z przedziału zmiennych wyjściowych) 

– Memory „M” zmienna pamięciowa (przykład M 10.0  – bit o numerze 0, bajtu 

10 z przedziału zmiennych wewnętrznych) 

Przykłady typów zmiennych: 
– BOOL – zmienna bitowa typu boolean (true, false) 
– BYTE – zmienna jednobajtowa (8 bit) 
– WORD – zmienna dwubajtowa (16 bit) 
– DWORD – zmienna czterobajtowa (32 bit) 
– CHAR – zmienna znakowa typu ASCII 
– REAL – zmienna zmiennoprzecinkowa 
 

 

Rys. 12. Przykładowe przypisanie nazw do zmiennych. 

 
 
Zakładka „Program blocks” zawiera wszystkie pliki projektu. Podczas tworzenia 

nowego projektu główny plik projektu tworzy się automatycznie. Plik o rozszerzeniu 
OB1  jest  pierwszym  plikiem  programu  głównego  uruchamianym  przez  system 
operacyjny  sterownika.  Funkcje  oraz  bloki  funkcji  umieszcza  się  odpowiednio 
w plikach  FB  oraz  FC  z  kolejnymi  numerami  (środowisko  automatycznie  nadaje 
kolejne numery) 

Programy  w  sterownikach  SIEMENS  można  pisać  w  trzech  równorzędnych 

językach: 

- STL (Statement List) język tekstowy niskiego poziomu, 
- LAD (Ladder) popularny w PLC język graficzny złożony z włączników, cewek 

itp., 

-  FBD  (Function  Block  Diagram)  język  graficzny  złożony  z  podstawowych 

elementów cyfrowych np. bramek typu AND, OR itp. 

W  tabeli  1  przedstawiono  przykłady  implementacji  prostych  funkcji  we 

wszystkich językach 

 

background image

ROBOTY I MANIPULATORY – instrukcja do ćwiczenia laboratoryjnego 

 

 

 

 

 

Robot przemysłowy o napędzie pneumatycznym 

10 

Funkcja  STL 

LAD 

FBD 

Iloczyn 
AND, 
Adresow
anie 
pośred 
nie

 

A „we1” 
A „we2” 
= „wy5” 

 

 

 

Adresow
anie 
bezpośre
dnie 

AN I 0.0 
A  I 0.1 
A  I 0.2 

A  I 1.0 
A  I 1.1 
O  I 2.0 
=  Q 4.0 

 

 

 

A  "We1" 
A  "We2" 
O(     
A  "We1" 
A  "We3" 
S  "Wy2" 
A(  
O  "We1" 
O  "We3" 
 )      
R  "Wy2" 
A  "Wy2" 
 )      
O  "We4" 
=  "Wy1" 

 

 

Tab. 1. Języki programowania zaimplementowane w sterownikach SIMATIC 

 
 
 
 

Ostatnim etapem pisania programu jest jego kompilacja i wysłanie do 

sterownika (rys. 13)  

 

Rys. 13. Ikony kompilacji (1), download-u do sterownika (2). 

 
 
 

Sterowanie jednym pneumatycznym tłokiem dwustanowym 

 

3.1 Połączenie fizyczne układu elektropneumatycznego. 

 
W  celu  wysterowania  tłoka  należy  zmontować  układ  elektropneumatyczny  jak 

na  rysunku  24.  Część  pneumatyczna  składa  się  z  tłoka  dwustronnego  działania, 
zaworu sterowanego elektrycznie oraz źródła ciśnienia. Część elektryczną stanowią: 

background image

ROBOTY I MANIPULATORY – instrukcja do ćwiczenia laboratoryjnego 

 

 

 

 

 

Robot przemysłowy o napędzie pneumatycznym 

11 

Sterownik  PLC,  przełączniki  sterujące  P1-3,  wyłączniki  krańcowe  S1-2,  cewki 
sterujące pracą zaworu. 

 

 

Rys. 24. Schemat układu elektropneumatycznego. 

 
 

3.2  Algorytm działania 

 
Pracą układy sterują przełączniki: 
- P1 – włącznik (aktywna 1) 
- P2 – przełącznik trybu pracy (0-sterowanie manualne, 1-praca automatyczna) 
-  P3  –  przełącznik  pozycji  przy  pracy  ręcznej  (0-tłok  schowany,  1-tłok 

wyciągnięty) 

 
Pracę układu (w trybie automatycznym) przedstawiają diagramy przedstawione 

na rysunku 25. 

 

a) 

0

1

3

2

P1

P1

P1

O14

P1,P2,S1,S2

P1,P2,

,S2

S1

Error

O12

 

b) 

0

1

5

4

2

3

P1

P1

P1

O14

O14

P1,P2,S1,

,

,

S2 O12 O14

P1,P2,

,

,

,O14

S1 S2 O12

P1,P2,S1,

,

,

S2 O12 O14

Error

O12

O12

P1,P2,

,

,O12,

S1 S2

O14

 

Rys. 25. Diagramy sterowania: 

a) 

dwustanowy 

b) 

czterostanowy 

 
Diagram  a)  przedstawia  schemat  automatycznej  pracy  układu  z  dwoma 

stabilnymi pozycjami. Wyłączenie napięcia na cewce zasilanej następuje po dotarciu 
tłoka  pozycji  końcowej.  Diagram  b)  zawiera  dwie  stabilne  pozycje  (1,  3)  i  dwie 
niestabilne  (2,  4).  W  tym  przypadku  wyłączenie  zasilania  cewki  następuje  już 
w trakcie  ruchu  tłoka,  gdy  obydwie  krańcówki  mają  stan  nieaktywny.  Diagramy 
zawierają  dodatkowy  stan  –  stan  błędu  „Error”,  stan  ten  prezentuje  dowolny  stan 
nieuwzględniony w diagramie, wynikający z błędu w programie, awarii układu, itp.  

 

3.3  Implementacja układu sterowania za pomocą języka LAD 

 

background image

ROBOTY I MANIPULATORY – instrukcja do ćwiczenia laboratoryjnego 

 

 

 

 

 

Robot przemysłowy o napędzie pneumatycznym 

12 

Poniżej  przedstawione  zostały  dwa  przykłady  implementacji  diagramu 

sterowania.  Pierwszy  z  nich  steruje  tylko  pracą  automatyczną,  umożliwia  wybór 
pracy ręczna/automatyczna. 

 

Rys. 26. Implementacja pracy 

automatycznej. 

 

 

 

Rys. 27. Implementacja pełnego układu 

sterowania. 

 

W obydwu przypadkach (rys. 26 oraz rys. 27), gdy aktuator jest wyłączony (P1 

=  „0”)  tłok  jest  chowany.  Zapewniają  to  ostatnie  układy  w  powyższych  programach 
(„Network 3” na rys. 26 oraz „Network 7” na rys. 27). 

Analizując  układ  z  rysunku  26  możemy  zapisać  go  w  postaci  następującego 

układu równań: 

 

)

2

(

Re

)

1

(

1

:

3

2

2

1

1

:

2

1

2

1

1

:

1

T

set

and

T

Set

P

Network

T

S

S

P

Network

T

S

S

P

Network

 

W  wynik  operacji  jest  od  razu  przekazywany  na  odpowiednie  wyjście 

sterownika.  Takie  działanie  jest  możliwe  wtedy,  gdy  w  całym  programie  tylko 
w jednym układzie („Network”) ustalany jest stan konkretnego wyjścia. 

background image

ROBOTY I MANIPULATORY – instrukcja do ćwiczenia laboratoryjnego 

 

 

 

 

 

Robot przemysłowy o napędzie pneumatycznym 

13 

Sterowanie  z  wyborem  trybu  pracy  wymaga  innego  podejścia.  W  tym 

przypadku,  w co  najmniej  dwóch  układach  wynik  operacji  jest  przypisywany  do 
zmiennej  wyjściowej.  Dokonano  tutaj  podziału  sterowania.  Pierwsze  cztery  układy 
(Network  1  -  4)  sterują  pracą  aktuatora  wykorzystując  sygnały  z  czujników  pozycji 
oraz  przełącznika  pozycji  (działającego  podczas  pracy  manualnej).  Wynik  operacji 
nie  jest  wpisywany  bezpośrednio  do  zmiennej  wyjściowej,  lecz  do  zmiennej 
pomocniczej – zmiennej wewnętrznej. Wybór, która zmienna pomocnicza ma zostać 
przypisana do odpowiedniego wyjścia realizują następne dwa układy (Network 5, 6), 
w których operacjom logicznym podlegają zmienne sterujące. 

 

4 Stanowisko laboratoryjne 
 

Stanowisko  laboratoryjne  składa  się  z  robota  pneumatycznego  o  3  stopniach 

swobody oraz podajnika. Ogólny schemat przedstawiony jest na rysunku 28.  

Nr  Wejście 

(czujnik) 

opis 

Nr 

Wyjście 
(aktuator) 

opis 

Pozycja 10 

Krańcowa przy przegub 1 = „0” 

Przegub 1 

 

Pozycja 11 

Krańcowa przy przegub 1 = „1” 

Przegub 2 

 

Pozycja 20 

Krańcowa przy przegub 2 = „0” 

Przegub 3 

 

Pozycja 21 

Krańcowa przy przegub 2 = „1” 

Chwytak 

1 – zamknięty 

Pozycja 30 

Krańcowa przy przegub 3 = „0” 

Przód 

 

Pozycja 31 

Krańcowa przy przegub 3 = „1” 

Popychacz 

Popychacz w podajniku 

Taśmociąg 

Krańcówka na końcu taśmociągu 

 

 

 

Podajnik 

Czujnik podajnika 

 

 

 

Tab. 2. Opis połączeń sygnałów I/O sterownika. 

 
 

 

Rys. 28. Schemat stanowiska laboratoryjnego. 

background image

ROBOTY I MANIPULATORY – instrukcja do ćwiczenia laboratoryjnego 

 

 

 

 

 

Robot przemysłowy o napędzie pneumatycznym 

14 

Wszystkie  czujniki  oraz  elementy  wykonawcze  są  podłączone  do  sterownika 

PLC Simatic S7-1200 firmy Siemens 

Tabela 2 przedstawia opis wejść z czujników i wyjść do aktuatorów. 

 

5 Opis ćwiczenia 

 
Celem  ćwiczenia  jest  zapoznanie  się  z  pneumatycznymi  układami  automatyki 

i robotyki oraz ze sposobami ich sterowania. 

 
a)  zapoznanie się z elementami wykonawczymi oraz sterującymi, 
b)  zapoznanie się z pneumatycznymi metodami sterowania, 
c) 

zapoznanie się z elektro-pneumatycznymi metodami sterowania, 

d)  zaprogramowanie  pneumatycznego  robota  przemysłowego  o  trzech 

stopniach swobody (3 DoF) 

 
 

6 Sprawozdanie z ćwiczenia 

 
Sprawozdanie powinno zawierać: 
- krótki wstęp teoretyczny dotyczący tematu ćwiczenia, 
- opis kolejnych etapów ćwiczenia wraz z rysunkami skonstruowanych układów,  
- podsumowanie i wnioski 
 
 
 
 
Literatura: 
Automation & Control Siemens Summer School – materiały dydaktyczne