Documente Academic
Documente Profesional
Documente Cultură
Coordonator științific,
Ș.l. dr. ing. Cornel-Camil SUCIU
Candidat,
Ștefan UNGUREAN
SUCEAVA
Iulie, 2020
1
DEPARTAMENTUL MECANICĂ ŞI TEHNOLOGII
Programul de studii Mecatronică
PROIECT DE DIPLOMĂ
Coordonator științific,
Ș.l. dr. ing. Cornel-Camil SUCIU
2
FIŞA DE APRECIERE
A PROIECTULUI DE DIPLOMĂ
Coordonator științific,
Ș.l. dr. ing. Cornel-Camil SUCIU
Candidat,
UNGUREAN Ștefan
3
4
PLAN TEMATIC
PENTRU PROIECTUL DE DIPLOMĂ
Coordonator științific,
Ș.l. dr. ing. Cornel-Camil SUCIU
Candidat,
UNGUREAN Ștefan
NOTĂ: Proiectele de diplomă vor fi redactate pe calculator. Proiectul se poate redacta și într-o limbă de circulație
internațională.
Prezentarea lucrării în fața Comisiei de examinare se va face în Power Point.
Se va preda OBLIGATORIU Secretarului Comisiei cu 2 zile înainte de susținere un CD care va conține
următoarele elemente: titlul și cuprinsul proiectului de diplomă, rezumatul proiectului de diplomă (în limba română
și o limbă de circulație internațională engleză sau franceză) și prezentarea proiectului de diplomă în Power Point.
5
6
REZUMAT
7
ABSTRACT
9
CUPRINS
REZUMAT.......................................................................................................................................... - 7 -
ABSTRACT....................................................................................................................................... - 9 -
CUPRINS......................................................................................................................................... - 11 -
INTRODUCERE............................................................................................................................... - 15 -
11
IV.1. PREZENTARE GENERALĂ...........................................................................................- 49 -
IV.1.1. Schema bloc.......................................................................................................... - 50 -
IV.1.2. Schema electrică.................................................................................................... - 51 -
IV.2. PREZENTAREA COMPONENTELOR ELECTRONICE FOLOSITE..............................- 52 -
IV.2.1. Placa de dezvoltare Arduino Mega........................................................................- 52 -
IV.2.2. Senzor ultrasonic HC 005......................................................................................- 53 -
IV.2.3. Senzor de culoare TCS 230...................................................................................- 54 -
CONCLUZII...................................................................................................................................... - 62 -
BIBLIOGRAFIE............................................................................................................................... - 63 -
ANEXE............................................................................................................................................. - 64 -
12
LISTĂ DE NOTAȚII ȘI SIMBOLURI
14
INTRODUCERE
15
În capitolul patru se relatează rolul sistemului de comandă și logica de
funcționare a instalației. Se parcurge schema bloc menționând fazele prin care trece
sistemul, determinate de către senzori. Se descrie modul de funcționare acestora
precum și rolul microcontrolerului. Se analizează schema electrică menționând
diferitele componente hardware, precum și necesitatea prezenței acestora în
instalație.
Prezentarea elementelor sistemului este urmată, în capitolul cinci, de
descrierea succesiunii fazelor prin care trece sistemul pentru a implementa aplicaţia
propusă la începutul proiectului.
Lucrarea se încheie cu concluziile proprii în legătură cu tema, urmate de o
serie de referințe bibliografice și anexe, în care se regăsesc desene tehnice de
execuție precum și codul utilizat pentru controlul echipamentului.
16
I. STADIUL ACTUAL PRIVIND ROBOȚII PARALELI
Așa cum se arată în [ CITATION ROT16 \l 1048 ]1, un robot paralel este un
mecanism care manipulează efectorul final folosind lanțuri cinematice controlate de
calculator. Cazul cel mai cunoscut și de la care a pornit acest sistem de manipulator
paralel este compus din 6 actuatoare liniare care susțin o bază mobilă. De
asemenea, aceste manipulatoare pot fi alcătuite din servomotoare atașate atât de
bază cat și de platforma mobilă, fiind articulate sferic pentru a putea efectua
mișcările. Spre deosebire de un manipulator normal, acesta se diferențiază printr-un
lanț paralel, în care efectorul final este conectat la bază prin intermediul a 3-6 legături
care lucrează în paralel. Acest termen de paralel, poate fi luat în considerare doar
din punct de vedere informativ și nu geometric. Legăturile ce compun acest
ansamblu acționează împreună, dar paralelismul lor nu poate fi unul absolut. Așadar,
termenul de paralel face referire la faptul că poziția punctului final al fiecărei legături
este independentă de poziția celorlalte legături [ CITATION wik16 \l 1048 ]2.
Un manipulator paralel se diferențiază de celelalte categorii, printr-un gabarit
redus, masă redusă și un mecanism simplu ce oferă rigiditate in cazul mișcărilor
bruște. Acest tip de manipulator face ca fiecare sistem de acționare să se deplaseze
cu același grad de libertate. Totuși la robotul de tip paralel, flexibilitatea articulației
este afectată de prezența celorlalte componente ale lanțului. Rigiditatea sa sporită se
datorează buclei închise pe care o alcătuiește sistemul, ceea ce face ca
manipulatorul paralel sa fie cu mult mai rigid, spre deosebire de manipulatoarele
serie, care din cauza componentelor numeroase devin progresiv mai puțin rigide,
[ CITATION ROT16 \l 1048 ]1.
Având rădăcini tocmai din anul 1931 datorită cercetătorului I.A. Bonev care a
gândit acest sistem pentru industria divertismentului,[ CITATION ROT16 \l 1048 ]1,
[ CITATION Bon03 \l 1048 ]3, urmând apoi după zece ani Wiliard L. Pollard care
implementa acest sistem într-o vopsitorie, [ CITATION Wil42 \l 1048 ]4. Mai târziu, un
inginer de la compania auto Dunlop Rubber Co. a implementat idea in domeniul auto
17
unde, acesta a construit un sistem de determinare a proprietăților anvelopelor sub
sarcini combinate, [ CITATION Eri62 \l 1048 ]5.
Această cercetare nu s-a oprit aici, deoarece Eric Gough, în 1965 a format o
platformă cu structură de hexapod unde placa mobilă era folosită în simularea
aparatelor de zbor,[ CITATION ROT16 \l 1048 ]1.
La începutul anilor `80 când profesorul Reymond Clavel (profesor la EPFL-Ecole
Polytechnique Federale de Lausanne) a venit cu idea de a folosi paralelogramele pentru
a construi un robot paralel cu trei grade de libertate, două translații și o rotație, care la
începutul secolului va fi una dintre cele mai reușite modele de robot paralel. Așa încât în
anul 1999 primește Premiul Robotul de Aur, fiind sponsorizat de ABB Flexible
Automation, pentru munca depusă în acest proiect. Scopul pentru care profesorul a
realizat acest proiect era necesitatea de a manipula obiecte de mici dimensiuni, cu o
viteză mare fiind de mare efect în industria acelor ani, [ CITATION ROT16 \l 1048 ]1.
Figura I.1 Primul hexapod octaedric – platforma originală Gough construită în 1954, [ CITATION
ROT16 \l 1048 ]1
18
imaginilor video. În principiu, folosind o cameră video prin intermediul căreia sunt
comandate servomotoarele, se asigură operații de asamblare pentru piese de mici
dimensiuni, sortare și manipulare a acestora.
19
Figura I.3 Robotul Delta construit de FANUC, [ CITATION FAN17 \l 1048 ]7
http://www.fanuc.eu/ru/en/robots/robot-filter-page/m1-series accesat în 23.06.2017
20
II. SOLUȚIE CONSTRUCTIVĂ
21
Pentru început, ideea a fost realizarea unei stații de sortare în funcție de
culoare, de mare viteză și care să permită mutarea pieselor de diferite culori într-o
zonă de unde vor fi preluate pentru a fi prelucrate, împachetate, aranjate.
S-a realizat modelul 3D ilustrat în Figura II .4, unde este prezentat modelul
conceput pentru un robot paralel cu trei grade de libertate. Acesta este format dintr-o
bază fixă și una mobilă care sunt dispuse paralel. Legătura creată între cele două
baze este realizată prin intermediul a trei brațe principale articulate, care pun
sistemul în mișcare și care unesc cele două plăci, formând o structură rigidă de tip
paralelogram. Sistemul de punere in mișcare al acestui manipulator este alcătuit din
trei servomecanisme, de care sunt atașate rigid cele trei brațe mobile. Pentru a oferi
întregului ansamblu cele trei grade de libertate necesare realizării operațiilor
propuse, s-au folosit articulații sferice. Întregul ansamblu este atașat rigid de un batiu
solid, care permite stabilitatea optimă a întregului echipament. Acesta din urmă,
susține atât manipulatorul cât și banda transportoare a aplicației. De asemenea
sistemul este prevăzut cu o serie de senzori, fixați în diferite poziții cheie, aceștia
asigurând fluxul de informații, necesar la implementarea aplicației propuse.
Principalele componente ale echipamentului proiectat sunt numerotate în Figura II .5
şi se regăsesc enumerate în Tabelul II -1.
22
Tabelul II-1 Părțile componente ale ansamblului
Poziţia Denumirea
1 Senzor de culoare
2 Placă de depozitare piese
3 Motor cu reductor
4 Batiu
5 Leduri colorate
6 Role cu rulmenți
7 Placă din PVC
8 Braț principal
9 Flanșă
10 Servomotor
11 Profil U
12 Tijă de aluminiu
13 Gripper
14 Senzor ultrasonic
15 Gripper
16 Placă mobilă
17 Articulație sferică
18 Sistem de reglare a benzii
19 Material elastic
Componentele care alcătuiesc acest ansamblu au fost alese astfel încât ele să
poată fi tehnologic prelucrate.
După cum se poate vedea prezentat în Figura II .5 avem o bandă
transportoare alcătuită din materialul elastic 13, folosită pentru susținerea și
deplasarea pieselor. Banda elastică este înfășurată pe role cu rulmenți, având
diametrul de 47mm, notate 6 în Figura I .1. Rola principală, adică cea de antrenare a
sistemului este atașată de axul unui motor cu reductor 3 fixat rigid pe batiul 4. Având
ca scop deplasarea pieselor, banda transportoare are atașat un senzor ultrasonic 14
pentru detectarea prezenței acestora. Mai precis, prin deplasarea pieselor pe bandă,
acestea vor ajunge la un punct definit al cursei iar, datorită semnalului primit de la
senzorul 14, sistemul de comandă va sista deplasarea benzii transportoare
întrerupând alimentarea cu energie electrică a motorului 3, pentru a evita căderea
pieselor în exteriorul ansamblului. Batiul 4 este confecționat din țeavă pătrată de oțel
cu dimensiuni alese în ordinea solicitărilor. Acestea susțin rigid placa din PVC 7,
necesară susținerii manipulatorului de tip paralelogram. Manipulatorul preia piesele
de pe banda transportoare în momentul detectării prezenței acesteia de către senzor.
Consecutiv piesa va fi preluată, ca apoi să fie poziționată timp de câteva secunde în
raza de acțiune a unui senzor de detectare a culorii 1. Detectarea acesteia permite
23
luarea deciziei de către manipulatorului cu privire la următoarea fază prin care va
trece sistemul și deci poziționarea piesei în locul ales, timp în care va fi solicitată
aprinderea ledurilor 5 îndeplinită de sistemul de comandă. Fiind rigid atașat pe placa
din PVC 7, manipulatorul proiectat, este acționat de trei servomotoare 8 care sunt
fixate printr-un sistem de prindere confecționat din profil U de aluminiu 11.. Pentru
punerea în mișcare a brațului 4 sunt prevăzute flanșele 9 care sunt atașate de axul
servomotoarelor. Brațul principal 8 este confecționat din material plastic, prin
imprimare 3D și are ca scop susținerea articulațiilor sferice 17 prevăzute cu filet
exterior la capătul extrem. În vederea prinderii articulațiilor de tijele 12 s-a optat
pentru practicarea unor filete interioare pe ambele capete ale tijelor, ceea ce va
permite montarea articulațiilor pe capetele tijei. Acest ansamblu are ca rol dirijarea
plăcii mobile 16. De placa mobilă se atașează gripperul 13 care are rolul de prindere
a pieselor și mutarea acestora de pe bandă, după detectarea acestora de către
senzorul 14, în poziţia corespunzătoare.
12Equation Section 2
25
Forțele ce apar în ramurile benzii transportoare se calculează cu relaţiile:
P1 Sg 0,051 N
, 222\* MERGEFORMAT (.)
P2 P1 Rez12 0,038 N , 323\* MERGEFORMAT (.)
Sii Sg e 0,014 N
. 626\* MERGEFORMAT (.)
Astfel, forța în ramura ce se înfășoară pe tamburul de acționare va fi:
e K c Re z12 Re z34
Sii 0,051 N
e K c . 727\* MERGEFORMAT
(.)
Forța în ramura ce se desfășoară de pe tamburul de antrenare:
K c Re z12 Re z34
Sii 0,014 N
e K c .828\* MERGEFORMAT (.)
Unde :
Re z12 2 N – Forța în bandă pe tronsonul 1;
unde:
L1 1,2 B – lățimea rolelor, în care B 0,01m reprezintă lățimea benzii.
unde,
Gd 2,941 N – greutatea benzii;
Ag
- accelerația gravitațională.
Forța necesară învingerii inerției reazemului cu role:
3 Grola v
Fnîl 0,00525 N
4 Ag td
15215\* MERGEFORMAT (.)
unde
td 3s este timpul necesar demarării; Grola 2,94 N - greutatea rolei, iar
m
v 0,07
s reprezintă viteza de deplasare.
Sarcina dinamică totală ce trebuie învinsă la demaraj:
Sdim Fînl Fnî 1,306 N 16216\* MERGEFORMAT (.)
Momentul:
27
1
Mom D Smax 1 Ag 2,13 N m
2 , 18218\*
MERGEFORMAT (.)
28
II.3.3. Structura benzii transportoare
II.3.4. Batiul
30
Tabelul II-3 Părțile componente ale batiului
Poziţia Denumirea
1 Țeavă pătrată 15x15mm
2 Leduri
3 Platformă de depozitare cu panou de comandă
4 Suport de prindere panou de comandă
5 Țeavă pătrată 25x25mm
6 Picior de susținere
7 Placa fixă PVC
8 Flanșă prindere placă fixă
9 Urechi de prindere a benzii transportoare
31
II.3.5. Calculul de rezistență a batiului
32
Calculul de rezistență a batiului prin metode analitice
Pentru verificarea rezultatelor obţinute prin analiza cu elemente finite, s-a
efectuat un calcul de rezistenţă al batiului, folosind metode analitice de calcul. S-a
determinat deplasarea, înclinarea și săgeata capătului liber al barei, așa cum este
a3
descris în continuare. Aceasta fiind de secțiune pătrată din oțel cu Iz= , și știind ca
6
modulul lui Young pentru oțel laminat este de 210GPa vom avea:
203 Kg
EIz 210 2,8 1011 2
6 s 20220\* MERGEFORMAT
(.)
F 25cm
A C
x
y
50cm M ( x )=−Fx
M ( y )=−1 y
m ( x ) =0
m ( y )=−1 y
B
B
1
20 50
A
M x m
x dx 0 M y m y dy
EIz 0 21221\*
MERGEFORMAT (.)
Înlocuind în ecuaţia Error: Reference source not found valorile rezultate din
analiza elementelor ilustrate în Figura II .11 şi Figura II .12, se obţine că:
1
20 50
A Fx 0dx Fl y dy
EIz 0
0
, 22222\*
MERGEFORMAT (.)
adică:
33
50
1 2Fl 3
A
EIz 0
ydy
EIz
1,429 106 N
23223\* MERGEFORMAT
(.)
A
1 C
x y
m ( x ) =−1 x
m ( x ) =−1l
B
B
Figura II.13 Figura II.14
1
20 50
vA M x m x dx M y m y dy
EIz 0 0
1
20 50
Fx 1x dx Fl 1l dy
EIz 0 0
1 1 Fl 3 3
20 50
7Fl 3
EIz 0 0
Fx 2
dx Fl 2
dy 2Fl
EIz 3 3EIz
1,667 10 6 N 24224\*
MERGEFORMAT (.)
25cm
C
A
x y
m ( x ) =−1
50c m ( x ) =−1
m
B
B
Figura II.15 Figura II.16
34
1
20 50
A M x m x dx M y m y dy
EIz 0 0
1
20 50
Fx 1 dx Fl 1 dy
EIz 0 0
1 Fl 2 5Fl 2
2Fl 2 1,786 10 6 N
EIz 3 2EIz 25225\*
MERGEFORMAT (.)
II.3.6. Manipulatorul
35
paralelism bine definit între placa fixă și cea mobilă a fost un factor influent la
dimensionarea diferitelor componente. În ceea ce privește zona de lucru, raportat la
conținutul temei, s-a stabilit ca manipulatorul să poată să desfășoare deplasări de
maxim 180mm pe axa x, 180mm pe axa y și 250mm pe axa z, pentru a permite
manipulatorului atât prinderea piesei de pe banda transportoare cât și poziționarea
acesteia pe platforma de depozitare
Placa fixă din PVC 13 susține profilul U care are rol de prindere a
servomotoarelor 11. Acesta prin intermediul unor șuruburi vor prinde corpul
servomotorului fixându-l pe placa fixă. Servomotorul este de construcție specială
având pe o parte cu sistem de susținere format dintr-un reazem cilindric, iar de
cealaltă axul ce antrenează brațul. Tabelul II -3
Această construcție permite distribuția cuplului motor generat și alinierea celor
două capete ale brațului 9, astfel formând primul grad de libertate a manipulatorului. Pe
brațul 9, pentru fixarea acestuia se vor atașa flanșe de aluminiu 10, poziționate pe ambele
36
părți ale acestuia. Tot pe brațul 9 în partea exterioară se află șurubul de prindere 8, care
ajută la fixarea articulațiilor sferice 7 acestea permițând împreună cu brațul 9 cele trei
grade de libertate ale ansamblului. Aceste articulații sferice sunt concepute cu o parte
filetată care permite prinderea celor șase tije 6, prin sistemul demontabil șurub-piuliță.
Tijele au la fiecare capăt câte o articulație sferică, iar in partea de jos sunt atașate de
placa mobilă 2 prin intermediul șurubului de fixare 1. Pentru a putea executa tema
propusă, în vederea prinderii pieselor s-a folosit un sistem de prehensiune
electromecanic. Gripperul 3, cu două bacuri (fălci de prindere) 4. Acesta formează un
sistem bilateral, ce implică existența a cel puțin două forțe, ce trebuie să acționeze în
sensuri opuse. Gripperul este pus în mişcare de către un servomotor. Avantajul acestui
sistem este precizia de apucare, forță de prindere relativ mare și tenacitatea de a apuca
piese de diferite forme care pot conține inclusiv găuri.
38
III.CONSTRUCȚIA ȘI ASAMBLAREA SISTEMULUI
III.1.1. Batiul
Batiul este confecționat din mai multe segmente de țeavă pătrată de dimensiuni
diferite, acestea fiind sudate între ele, formând astfel cadrul de care se vor prinde
diferitele componente.
39
Dimensiunile barelor au fost alese conform proiectării, ținând cont de gabaritul
și robustețea subansamblelor, prezentată în partea de proiectare, descrisă în cap. II.
40
Construcția acestor role s-a realizat conform dimensiunilor prezentate în
capitolul anterior. Acestea se sprijină pe un ax care trece prin doi rulmenți radiali cu
bile, încastrați prin presare în rola de poliamidă. Ghidarea și întinderea benzii elastice
este posibilă printr-un mecanism șurub piuliță prevăzut cu un arc de auto-centrare.
III.1.3. Manipulatorul
Manipulatorul este compus din șase tije din aluminiu, care au fost filetate la
capete, pe o porțiune de 10mm pentru a permite atașarea articulațiilor sferice. Brațul
principal este atașat de flanșa servomotorului, care se așează pe placa fixă din PVC
prin intermediul a patru șuruburi M3, aşa cum se poate observa în Figura III .24.
Cele trei braţe principale ale robotului paralel şi baza mobilă acestuia au fost
fabricate prin imprimare 3D, pornind de la modelele tridimensionale ale acestor piese
reprezentate în Figura III .25. Imagini ale celor două componente, realizate practic
prin acest procedeu de fabricaţie (imprimare 3D), se regăsesc în Figura III .24 şi
respectiv Figura III .27. Caracteristicile dimensionale rezultate în urma proiectării
sunt cele rezultate din desenele de execuţie, regăsite în Anexa 1 la prezenta lucrare.
41
Figura III.25 Model 3D pentru braţul principal (dreapta) şi baza mobilă (stânga)
La capătul inferior placa mobilă cuplează cele șase tije prin intermediul
aceluiași tip de bară filetată M3. În final de placa mobilă este prins gripperul.
42
Determinarea experimentală a zonei de lucru a manipulatorului
Experimental, după asamblarea manipulatorului, s-a putut stabili spațiul de
lucru real. Aceasta este dat de volumul spațiului pe care îl determină deplasarea
efectorului final în toate pozițiile limită. În cazul de față efectorul final acoperă un
volum neuniform așa cum este reprezentat în figura 3.6. Baza spațiului de lucru
descrie o zonă circulară cu diametrul de 190 mm, pozițiile extreme ale gripperului
descriind forma ilustrată în Figura III .28. Dimensiunile determinate experimental
pentru spațiul de lucru al manipulatorului permit desfășurarea fără impedimente a
aplicației propuse.
43
III.2. CARACTERISTICILE COMPONENTELOR FOLOSITE ÎN
I.1.
I.2.
REALIZAREA PRACTICĂ
44
Figura III.30 Reprezentarea constrângerilor impuse brațului principal
Deoarece: M =Fm × rm
unde:M – momentul;
Fm – forța cu care se acționează asupra brațului;
rm – brațul forței.
Deci: M =16,6 × 0,112=1,8592 N × m,
Va fi deci necesară utilizarea unui motor care să dezvolte un cuplu motor de
peste 18 Kg ×cm.
Conform specificațiilor tehnice, ilustrate în Tabelul III -5, motorul folosit poate
dezvolta max=35 Kg x cm:
45
Servomotorul ales este unul cu pinion metalic ataşat pe arbore. Motorul este
de construcție specială, acesta înglobând un reazem cilindric pe o laterală, pe
cealaltă fiind poziţionat arborele de antrenare. Pe reazem și pe axul de antrenare se
atașează două flanșe care susțin brațul principal. Pentru fixare , pe placa fixă din
PVC este prevăzut cu un sistem de prindere cu profil U, Figura III .32, care este
prinsă de servomotor prin intermediul șuruburilor din imagine.
Figur
a III.33 Articulațiile sferice, modul de prindere
46
Figura III.34 Distanțierele, arcul de tracțiune, piuliță hexagonală cu cap înfundat
Din faza de proiectare, s-a dedus prin calcule organologice că pentru punerea
în mișcare a benzii transportoare este necesar un motor care să dezvolte 4W putere
care va fi suficient învingerii forțelor ce apar în antrenarea rolelor. Astfel s-a ales
motorul din Figura III .35. Experimental s-a constatat că în sarcină acesta consumă
un curent de 0.5 A, aşa cum se observă în Figura III .36. Motorul ales poate dezvolta
o putere 12 W, alimentat în curent alternativ 24V 50Hz.
47
III.2.4. Gripperul
48
IV. ECHIPAMENTE ELECTRONICE DE COMANDĂ ȘI
CONTROL
49
IV.1.1. Schema bloc
1. Senzor ultrasonic care trimite semnalul ultrasonic timp de 10µs, pentru ca apoi
să aștepte întoarcerea undei sonore, astfel calculând distanța până la obstacol.
Acesta este alimentat la tensiunea de 5V, direct de pe placa de dezvoltare
Arduino.
2. Senzor de culoare care înștiințează microcontrolerul determinând intensitatea
lumini a fiecărei culori . Acesta este alimentat de pe placa Arduino.
51
Acesta emite un semnal de ieșire pe pinul 7 care activează releul motorului
de AC astfel alimentând cu energie electrică motorul, care funcționează la o
frecvență de 50Hz 24V AC. Lucru care se întâmplă la primirea unui semnal de la
senzorul de proximitate prin pinul 44, care măsoară în permanență 10 cm. Daca
distanța este mai mică de 10 cm acesta dezactivează releul cu comanda primită
de pe pinul 42, și astfel oprirea motorului. În această fază obstacolul este în locul
de preluare de către manipulator.
În circa două secunde după primirea semnalului de la senzor pe intrarea
42, microcontrolerul comandă cele 4 servomotoare care compun manipulatorul,
pe ieșirile 2, 3, 4, 5. Pinul 5 fiind comanda pentru servomotorul gripperului.
Manipulatorul deplasează piesa în dreptul senzorului de culoare care va genera la
ieșire un semnal dreptunghiular în funcție de culoare. Acesta va trimite în funcție
de culoare date microcontrolerului pe pini, 8, 9, 10, 11, 12. După detectare
oricărei culori microcontrolerul va trimite semnal servomotoarelor manipulatorului
astfel că acesta va pune piesa în locul stabilit în program. În momentul sesizării
culorii și trimiterea semnalului de ieșire către mediul de dezvoltare, ledul de pe
panoul de monitorizare se va aprinde acționat de ieșirea 50 pentru ledul albastru,
48 pentru ledul roșu și 46 pentru ledul verde. După terminarea procesului bucla se
reia formând un ciclu continuu.
Circuitul dezvoltare Arduino Mega este, „creierul” acestei aplicații, fiind bazat
pe un microcontroler care folosește ca suport limbajele de programare ca C și C++.
Având 54 de pini de ieșire/intrare, digitali și analogici ne oferă suportul necesar în
desfășurarea proiectului. Acest mediu de dezvoltare face posibilă conexiune între
senzori și partea motoare.
52
Figura IV.41 Arduino Mega [ CITATION ROB17 \l 1048 ]9
https://www.robofun.ro/arduino_mega2560 accesat 23.06.2017
Figura IV.42 Modul de funcționare a senzorului ultrasonic , [ CITATION 1706 \l 1048 ]10
http://www.themakersworkbench.com/tutorial/using-ultrasonic-distance-sensor-illuminate-
neopixels accesat 23.06.2017
53
Raportat la aplicație acesta are rolul de a observa obstacolul, oprind
alimentarea motorului ce acționează banda transportoare. Pentru a realiza aceasta,
s-a implementat un cod care să permită acest lucru.
Definirea pinilor de intrare /ieșire unde se vor trimite date, în acest caz pe
pinul 42 și 44.
int trigPin = 42;
int echoPin = 44;
Pentru început acesta va măsura distanța de la senzor la obstacol.
int calculeaza_distanta()
{
long duration;
pinMode(trigPin, OUTPUT); unda emisă
Se emite o undă
digitalWrite(trigPin, LOW);
delayMicroseconds(2);
digitalWrite(trigPin, HIGH);
delayMicroseconds(10);
digitalWrite(trigPin, LOW);
pinMode(echoPin, INPUT); unda recepționată
Se cronometrează timpul în care unda sonoră se întoarce la
modulul de recepție după ce a fost trimisă.
duration = pulseIn(echoPin, HIGH);
Se stabilește ca distanța măsurată să fie în centimetri, și
cunoscând viteza de propagare a undei se calculează distanța.
cm = duration/29/2;
Pentru a putea vizualiza ce distanță avem pe serial monitor s-a
implementat:
Serial.print(cm);
Serial.print("cm");
Serial.println();
}
54
Figura IV.43 Senzor de culoare TCS 230 [ CITATION htt68 \l 1048 ]11
https://www.optimusdigital.ro/senzori-senzori-optici/111-modul-senzor-de-culoare-tcs230.html
accesat 23.06.2017
contor = 0;
rosu_final = 0;
verde_final = 0;
albastru_final = 0;
if(vect[0] < vect[1] && vect[0] < vect[2] ) return 'R';
else if(vect[1] < vect[0] && vect[1] < vect[2] ) return 'V';
else if(vect[2] < vect[0] && vect[2] < vect[1]) return 'A';
else return 'N';
}
În această parte a codului se execută citirea propriu-zisă pentru a fi
interpretată mai sus.
void culoare_cub() {
digitalWrite(S2,LOW);
digitalWrite(S3,LOW);
Citirea frecventei de ieșire
frequency = pulseIn(sensorOut, LOW);
rosu = frequency - rosu_calibrare;
Serial.print(rosu); Serial.print(" ");
delay(100);
digitalWrite(S2,HIGH);
digitalWrite(S3,HIGH);
frequency = pulseIn(sensorOut, LOW);
verde = frequency - verde_calibrare;
Serial.print(verde); Serial.print(" ");
delay(100);
digitalWrite(S2,LOW);
digitalWrite(S3,HIGH);
frequency = pulseIn(sensorOut, LOW);
albastru = frequency - albastru_calibrare;
Serial.print(albastru); Serial.print(" ");
delay(100);
}
Aici, calibrarea senzorului se face în funcție de lumina din mediul în care se
află. În cazul în care e întuneric se va calibra pentru această stare, iar dacă aprindem
lumina va trebui recalibrat.
void calibrare_senzor_culoare()
{
digitalWrite(50, HIGH);
56
digitalWrite(48, HIGH);
digitalWrite(46, HIGH);
while(contor <= 20)
{
functie();
contor++;
}
rosu_calibrare = rosu_calibrare/20;
verde_calibrare = verde_calibrare/20;
albastru_calibrare = albastru_calibrare/20;
contor = 0;
delay(2000);
digitalWrite(50, LOW); digitalWrite(48, LOW); digitalWrite(46,
LOW);
}
void functie()
{
Setarea senzorului pentru a citi rosu
digitalWrite(S2,LOW);
digitalWrite(S3,LOW);
delay(100);
}
57
V. DESCRIEREA APLICAŢIEI DE SORTARE ŞI
MANIPULARE
58
Figura V.45 Faza 2
A doua fază, Figura V .45, este cea în care gripperul preia piesa pentru ca
apoi să o deplaseze în faza 3, aşa cum este ilustrat în Figura V .46, adică în raza de
acțiune a senzorului de culoare, unde acesta va citi culoarea piesei. Senzorul va
trimite datele către sistemul de comandă făcând trecerea sistemului în faza 4, unde
manipulatorul se retrage în poziția de așteptare. Acesta va primi semnal de la
sistemul de comandă după ce senzorul ultrasonic va detecta următoarea piesă. În
continuare ciclul se reia până la epuizarea pieselor.
59
Figura V.47 Faza 4
61
senzorului de culoare. Același traseu va fi folosit pentru toate cele trei piese.
Celelalte trei trasee sunt determinate pentru fiecare piesă în parte. Astfel, dacă
senzorul de culoare va citii culoarea roșu, manipulatorul va parcurge traseul
corespunzător culorii roşu și va depune piesa în poziţia predefinită.
62
CONCLUZII
63
BIBLIOGRAFIE
x
1 ROTARU A. ISTORIA ROBOŢILOR PARALELI. STUDII ŞI COMUNICĂRI / DIS.
2016 375-386.
2 wikipedia. Parallel manipulator. [Internet]. 2016 [cited 2017 Jun 27]. Available
from: https://en.wikipedia.org/wiki/Parallel_manipulator.
3 Bonev IA. The true origins of parallel robots. [Internet]. 2003 [cited 2017 Jun 26].
Available from: http://www.parallemic.org/Reviews/Review007.html.
4 Pollard WLV, inventor. Position controlling apparatus. 1942 Jun 16. US Patent
No. 2,286,571.
5 Eric V. Gough SGW. Universal tyre test machine. In: Proceedings of the FISITA
Ninth International Technical Congress; 1962. p. p. 117–137.
6 Clavel R, inventor. Device for movement and displacing of an element in space.
1990 Dec 11. Us Patent No. 4,976,582.
7 FANUC. www.fanuc.eu. [Internet]. [cited 2017 Jun 23]. Available from:
http://www.fanuc.eu/ru/en/robots/robot-filter-page/m1-series.
8 www.aliexpress.com. [Internet]. Available from:
https://www.aliexpress.com/item/5x-HV-high-torque-Robot-servo-35kg-RDS3135-
Metal-gear-Coreless-motor-digital-servo-arduino-servo/32776672283.html?
spm=2114.40010508.4.19.6deoZQ.
9 ROBOFUN. [Internet]. [cited 2017 Jun 23]. Available from:
https://www.robofun.ro/arduino_mega2560.
10 [Internet]. [cited 2017 Jun 23]. Available from:
http://www.themakersworkbench.com/tutorial/using-ultrasonic-distance-sensor-
illuminate-neopixels.
11 [Internet]. Available from: https://www.optimusdigital.ro/senzori-senzori-optici/111-
modul-senzor-de-culoare-tcs230.html.
12 Optimus Digital. [Internet]. [cited 2017 Jun 26]. Available from:
https://www.optimusdigital.ro/senzori-senzori-optici/111-modul-senzor-de-culoare-
tcs230.html.
13 [Internet]. Available from: http://robottini.altervista.org/delta-robot-with-arduino.
14 Intelligent Robotics and Autonomous Agents series.; 2004.
15 AGV. [Internet]. Available from: www.silledrobots.com/products/agv.
16 Popescu D. Senzori pentru roboti. Editura Electra(ICPE); 2004.
17 „Wheeled Modular Mobile Robots”,. In: Intemdonal Conhnnu on Robotics L
Automation, ; 2004; New Orleans.LA.
65
18 [Internet]. Available from: http://cyberneticzoo.com/tag/elsie/page/3/.
19 [Internet]. Available from: http://cyberneticzoo.com/tag/elsie/page/3/.
20 [Internet]. Available from: http://urtechfriend-
paperpresentations5.blogspot.ro/p/mems-micro-electro-mechanical-system.html.
21 [Internet]. Available from: http://www.swisslog.com/en/Products/HCS/Automated-
Material-Transport/RoboCourier-Autonomous-Mobile-Robot.
22 [Internet]. Available from: http://science.howstuffworks.com/robot4.htm.
23 [Internet]. Available from: http://www.tinynews.be/24/irobot-980/.
24 [Internet]. Available from: http://blogs.discovermagazine.com/lovesick-
cyborg/2016/03/18/2216/#.V3QcRriLTIU.
25 wikipdia. [Internet]. Available from:
https://en.wikipedia.org/wiki/Automated_guided_vehicle.
26 [Internet]. Available from:
http://www.popularmechanics.com/technology/robots/g1867/5-farm-robots-ag-
industry/.
27 [Internet]. Available from: http://itradar.ro/onu-dezbate-deca-robotii-ar-trebui-sa-
aiba-permisiunea-de-a-impusca-mortal-8298/.
28 [Internet]. Available from: http://www.voanews.com/content/estonian-turtle-robot-
searches-for-shipwrecks-and-treasure/3094819.html.
29 [Internet]. Available from: http://www.shopniac.ro/?s=robot+aspirator.
30 [Internet]. Available from: http://www.dozait.ro/cum-sa-ai-o-casa-smart-pasul-6-
curtea-din-spate/.
x
66
ANEXE
67