Documente Academic
Documente Profesional
Documente Cultură
Capitolul 1.
Japonezii au meritul de a fi definit sensul acestor mişcări, brevetând în anul 1972 termenul de
mecatronică. Termenul a fost utilizat pentru a defini fuziunea tehnologică: mecanică - electronică
- informatică.
Electronica, alături de informatică, este unul dintre domeniile cele mai dinamice din robotică.
Dezvoltarea electronicii s-a făcut cu paşi rapizi, începând din dublat numărul de componente pe o
placă de siciliu, ajungând azi la zeci de milioane de tranzistori. În contextul acestei dezvoltări
spectaculoase se înscrie şi domeniul microcontrolerelor.
Prin maşină se înţelege un obiect manufacturat care interacţionează cu mediul său. Prin această
interacţiune fie că ia din mediu energia necesară şi o converteşte în energie mecanică şi căldură
disipată, fie manipulează informaţii.Exista maşini simple, conduse de către un operator uman,
maşini programate să se comporte într-un anumit fel, mai avansate decât primele şi maşini cu
proprietăţi senzoriale, cu capacitatea de planificare, recunoaştere a formelor, navigare, învăţare,
numite maşini inteligente.Maşinile inteligente pot opera individual sau conectate în cadrul unor
sisteme.In acest ultim caz performanţele globale ale acestor sisteme sunt mai bune decât suma
performanţelor maşinilor componente. De asemenea, maşinile inteligente operează autonom, fără
un control total al operatorului uman dar cu posibilitatea de a colabora cu acesta, operează în
medii nestructurate, ce pot fi periculoase sau lipsite de confort.
Dintre tipurile de structuri, pentru maşinile inteligente, cea mai adecvată arhitectură este cea de
tip reţea, prezentată în fig. 1.
1
Studiul privind proiectarea unui robot mobil cu senile
Subsistemul de percepţie care are rolul de a colecta, stoca, procesa şi distribui informaţii despre
starea actuală a maşinii şi a mediului în care operează.
Componentele fizice din structura acestor subsisteme sunt: senzorii şi traductorii, actuatorii,
microprocesoarele, reţelele de comunicaţii, dispozitivele de intrare/ieşire, efectorii finali, sursele
de energie.
2
Studiul privind proiectarea unui robot mobil cu senile
Robotul industrial trebuie înţeles ca un sistem ierarhic care asigură realizarea repetitivă a unei
sarcini programate.Robotul industrial din prima generaţie,este întâlnit din ce în ce mai frecvent în
aplicaţiile industriale actuale. Toată informaţia, despre mediul de lucru şi acţiunile robotului sunt
predeterminate, descris de operatorul uman în faza de programare. În regim automat robotul le
execută fără să ia in calcul mediul exterior, folosind numai informaţiile despre starea sa internă
cum ar fi poziţia şi viteza elementelor sale în mişcare. Un astfel de robot, este format din
structura mecanică de manipulare, motoarele (electrice, pneumatice sau hidraulice) de acţionare,
traductoare de poziţie şi viteză pentru fiecare grad de libertate şi structura de calcul care asigură
programarea şi comanda sa. Funcţionarea robotului este "în buclă deschisă" faţă de mediul de
lucru (robot fără senzori), ce nu percepe modificările din mediul de lucru. Următoarele nivele
ierarhice ale robotului se realizează prin adăugarea unor sisteme din ce în ce mai complexe, cum
sunt: sistemul senzorial, mecanisme evoluate de comunicare om – robot (terminale grafice şi
universale, comunicări prin voce etc.) şi sisteme complexe de programe care asigură prelucrarea
robotului în limbaje de nivel înalt,planificarea automată a funcţiilor robotului etc. Funcţionarea
acestor roboţi este in "buclă închisă" faţă de mediul de lucru, ei pot să îndeplinească sarcini care
nu au fost cunoscute şi descrise total in prealabil şi se pot adapta la modificările mediului de
lucru.Aceşti roboţi cu caracteristici noi se denumesc "roboţi evoluaţi", "adaptivi", "inteligenţi",
"de generaţiile doi sau trei" etc.
Conducerea unei celule de atomatizare flexibilă, corespunzătoare postului clasic de lucru, este
realizată de unul sau mai multe calculatoare, rolul omului reducându-se la programare şi
supervizare. Flexibilitatea se referă la capacitatea uneia şi aceleaşi linii (grupe de utilaje)
tehnologice de a executa – cu un efort şi timp minim de pregătire a lor – o gamă variată de piese
şi operaţii, făcând astfel rentabilă automatizarea fabricaţiei în serii mici, precum şi creşterea
productivităţii în procesele de fabricaţie cu specific de construcţii de maşini. Flexibilitatea este
conferită de utilizarea calculatoarelor ce comandă roboţii şi utilajele tehnologice, calculatoare ce
îşi pot foarte uşor adapta sau modifica programul de lucru. Unirea automatizării flexibile cu
proiectarea, pregătirea tehnologică şi producţia asistată de calculator creează sisteme flexibile
integrate de producţie deschizând calea spre realizarea liniilor şi secţiilor de producţie complet
automatizate.În aceste structuri noi de producţie, operatorii umani, de înaltă calificare, stabilesc
cantitatea şi calitatea produselor executate, supraveghează, cu ajutorul calculatoarelor,
funcţionarea şi întreţinerea întregului sistem, reprogramează roboţii şi calculatoarele etc. În
celulele de automatizare flexibilă, lucrează în cooperare maşini unelte, roboţi evoluaţi de
manipulare, transport şi de inspecţie (control de calitate) cu caracteristici adaptive şi inteligente,
realizând sisteme flexibile de fabricaţie. Aceste sisteme se caracterizează prin: grad înalt de
flexibilitate, timp scurt de adaptare la noi cerinţe de producţie, realizarea unor sarcini coplexe cu
3
Studiul privind proiectarea unui robot mobil cu senile
Domeniile de aplicare ale tehnicii roboţilor se lărgesc mereu, ei putând fi utilizaţi în industrie,
transporturi, agricultură, sfera serviciilor, în cunoaşterea oceanului şi a spaţiului cosmic, în
cercetarea ştiinţifică etc.
Pentru a sugera aplicaţii concrete în aceste subdomeni, sunt precizate mai departe direcţiile care
pot fi avute în vedere.In medicină: sisteme robotizate pentru diagnoza prin ecografie, sisteme
robotizate pentru intervenţii neurochirurgicale; telemanipulatoare pentru chirurgie laporoscopică
etc.
În construcţii: vehicul ghidat automat pentru asfaltarea şoselelor, sistem robotizat pentru stropirea
betonului în construcţia tunelurilor; robot mobil pentru cofraje glisante; excavatoare autonome,
sistem robotizat pentru compactarea şi nivelarea suprafeţelor turnate din beton; sistem robotizat
pentru inspectarea faţadelor clădirilor; sistem robotizat pentru montarea/demontarea schelelor
metalice etc.
În general roboţii constituie o clasă de sisteme tehnice care imită sau substituie funcţii motrice
sau intelectuale umane. Aceastea se realizează prin asocierea diferitelor tipuri de sisteme de
manipulare sau locomotoare, determinând caracterul antropomorfic al robotului, cu diferite tipuri
de echipamente de calcul sau logice, care determină funcţiile intelectuale ale acestuia. Roboţii îşi
desfăşoară activitatea într-un mediu concret, ale cărui caracteristici pot rămâne constante sau sunt
variabile în timp.
4
Studiul privind proiectarea unui robot mobil cu senile
Din punct de vedere al relaţiei om – robot în timpul desfăşurării lucrului roboţilor, aceştia se
împart în trei mari categorii:
• Roboţi automaţi
• Roboti biotehnici
• Roboţi interactivi
Roboţii automaţi realizează funcţiile lor fără participarea directă a omului în procesul de
comandă. Având în vedere adaptabilitatea lor la condiţiile mediului în care îşi realizează
funcţiile.Roboţii automaţi se împart în trei generaţii:
1. Generaţia I, care se caracterizează prin program fix de funcţionare, ei fiind capabili să repete
în mod strict operaţiile specificate în program, sub condiţia invariabilităţii mediului în care
lucrează, fără perturbaţii externe.
2. Generaţia a ll-a cuprinde roboţii adaptivi, capabili să lucreze în condiţii de mediu variabile
sau parţial necunoscute iniţial. Capacitatea de adaptare a robotului la acţiunea perturbaţiilor date
de schimbările de mediu este determinată de senzorii ce dotează aceşti roboţi, de la care se obţin
informaţii asupra schimbării condiţiilor externe.
Roboţii biotehnici sunt roboţii la care există o permanentă participare a operatorului uman.Sunt
împărţiţi în trei subgrupe:
• Roboţi semiautomaţi
În cazul roboţilor comandaţi pas cu pas, prin acţionare de către operatorul uman a unui buton sau
manetă, e pus în funcţiune unul din gradele de mişcare ale robotului. Roboţii master-slave sunt
constituiţi din două lanţuri cinematice deschise, prin lanţ (master) având mişcarea comandată de
operatorul uman, iar al doilea (slave) copiind la scară această mişcare şi efectuând operaţiile de
manipulare pentru care este destinat robotul.
5
Studiul privind proiectarea unui robot mobil cu senile
Roboţii interactivi se caracterizează prin faptul că operatorul uman are numai o participare
periodică în procesul de comandă, în restul timpului robotul fiind comandat de calculatorul
electronic.
Funcţiile de lucru ale robotului industrial sunt deplasarea şi orientarea obiectului într-un spaţiu şi
funcţia locomotoare (deplasarea robotului în afara zonei de lucru).
Aceste funcţii sunt realizate de sistemul mecanic SM (fig.1.2.) al robotului, suportul 2, care poate
fi fix sau deplasabil pe ghidajele 1 (uneori pe roţi, la roboţii folosiţi pentru operaţia de stivuire,
depozitare etc.) realizându-se astfel funcţia locomotoare.
Funcţia de mişcare a robotului se obţine prin subansamblele 3, 4, 5 şi 6 (fig. 1.2.), care realizează
mişcări de translaţie T şi de rotaţie R după axele de coordonate, determinând prin aceasta
deplasarea obiectului manipulat într-o poziţie oarecare în spaţiu. Funcţia de apucare – eliberare a
robotului este realizată de mâna 6 cu ajutorul degetelor 7 ce execută mişcarea 8. Obiectul
manipulat de mâna 6 poate fi o piesă, o sculă, un pistol de vopsit, un cap de sudare, o şurubelniţă
etc. Pentru a realiza funcţia de mişcare se constituie un plan cinematic deschis, ca în fig. 1.2, sau
uneori parţial închis. Această funcţie se execută în două faze distincte: deplasarea obiectului
manipulant şi orientarea acestuia, faze ce se pot defini cu ajutorul noţiunilor de punct
caracteristic, dreaptă caracteristică şi dreaptă auxiliară. Punctul caracteristic este un punct
6
Studiul privind proiectarea unui robot mobil cu senile
oarecare al obiectului manipulant, dreapta caracteristică este o dreaptă ce trece prin acest punct
iar dreapta auxiliară este o dreaptă perpendiculară în punctul caracteristic. În prima fază, se
realizează deplasarea punctului caracteristic dintr-o poziţie în alta, pe o anumită traiectorie.
Mecanismul ce realizează această fază se numește generator de traiectorie. Orientarea dreptei
caracteristice şi a celei auxiliare în poziţii corespunzătoare poziţiei finale impuse a obiectului
manipulant se realizează prin mecanismul de orientare al robotului.
Deplasarea obiectului manipulant înseamnă modificarea celor trei coordonate ale punctului
caracteristic.Sunt necesare pentru acesta trei grade de mişcare, de exemplu translaţie Ts şi Tz,
rotaţia Rz.
Pentru orientarea deplină a obiectului manipulant sunt necesare, de asemenea, trei grade de
mişcare (trei rotaţii, de exemplu mişcarea RR). Aşa cum rezultă de mai sus, în construcţia
mecanismelor roboţilor industriali intră cuple de clasa 5-a (de rotaţie şi de translaţie).
Modificarea poziţiei relative unghiulare sau liniare a elementelor ce compun aceste cuple se
realizează prin elemente de acţionare electromecanice, hidraulice sau pneumatice a acestor
componente (în fig. 1.2., elementele de acţionare se considerară înglobate în subansamblele 2 –
6).
Comanda mişcărilor unui robot se poate realiza pe calea manuală, prin panoul PC (fig. 1.2.) sau
automat cu ajutorul echipamentului de comandă. Indroducerea programului de funcţionare în
memoria echipamentului se poate face manual, cu panoul PC sau cu ajutorul unui dispozitiv
special de programare. Pentru a sincroniza fazele ciclului de lucru ale robotului cu cele ale
procesului tehnologic, echipamentul de comandă trebuie să emită semnale de comandă şi pentru
utilajele pe care se execută procesul tehnologic şi invers.
Calculatorul ce controlează robotul are un rol deosebit de important. El are în memoria sa:
• un model al robotului fizic care înglobează relaţiile între semnalele de excitare ale sistemului de
acţionare şi deplasările robotului ca răspuns la aceste semnale.
7
Studiul privind proiectarea unui robot mobil cu senile
Spaţiul de lucru al unui robot industrial reprezintă volumul ce cuprinde totalitatea poziţiilor pe
care le poate ocupa punctul caracteristic sau, altfel spus, este volumul cuprins între suprafeţele
care înconjoară toate poziţiile posibile ale dispozitivului de apucare. În cadrul acestui spaţiu sunt
realizate traiectoriile şi poziţiile obiectului manipulat de robot.Forma spaţiului de lucru este
determinată de cele trei grade de bază ale mecanismului generator de traiectorie care pot fi
translaţii sau rotaţii după cele trei axe de coordonate. În funcţie de modul cum sunt combinate
aceste trei grade de mişcare în cadrul schemei cinematice de bază a robotului obţinem:
Coordonatele care determină poziţia punctului caracteristic în spaţiile de lucru cartezian, cilindric
şi sferic rezultă din figura 1.3.In spaţiul de lucru cartezian (dreptunghic), coordonatele sunt x, y,
z, în spaţiul de lucru cilindric coordonatele sunt r, cp, z iar în spaţiul de lucru sferic poziţia
punctului este determinată de parametrii p, φ, θ. Din aceasta rezultă tipul mişcărilor ce trebuie
realizate de mecanismul generator de traiectorie, pentru realizarea lor fiind necesare trei cuple
cinematice inferioare de translaţie T sau de rotaţie R.
Schema robotului ce lucrează în coordonate carteziene şi spaţiul său de lucru sunt prezentate în
fig. 1.4.Spaţiul de lucru în acest caz este un paralelipiped dreptunghic având dimensiunile a, b, h,
acestea constituind mărimea curselor mişcărilor de translaţie după cele trei axe, Tx, Ty, Tz. Ca
8
Studiul privind proiectarea unui robot mobil cu senile
urmare, mecanismul generator de traiectorie pentru acest tip de robot se realizează cu trei cuple
de translaţie.
Roboţii ce lucrează în coordonatele cilindrice conţin două cuple cinematice de translaţie, având
mişcările Tx, Tz şi o cuplă de rotaţie având mişcarea Rz cursele acestor mişcări fiind b, h
respectiv unghiul cp (fig. 1.5). Roboţii care lucrează în coordonate sferice (fig. 1.6.) se realizează
cu o cuplă cinematică de translaţie pentru realizarea parametrului p şi două cuple cinematice de
rotaţie pentru realizarea parametrilor φ şi θ.
9
Studiul privind proiectarea unui robot mobil cu senile
Se consideră un corp solid nedeformabil situat în spaţiul tridimensional. Din mecanica teoretică
se ştie că acest corp posedă şase grade de libertate: trei care îi permit să se deplaseze şi trei care îi
permit să se orienteze. Considerând triedrul ortogonal cu originea în centrul de greutate al
solidului, cele şase grade de libertate se pot exprima în astfel:
- prin trei translaţii urmărind cele trei axe ale triedrului (T1, T2, T3); ele asigură deplasarea
solidului în spaţiul de referinţă;
- prin trei rotaţii (Rl, R2, R3) în jurul celor trei axe ale triedrului; aceste trei rotaţii asigură
orientarea solidului în spaţiul de referinţă, fig. 1.7.
11
Studiul privind proiectarea unui robot mobil cu senile
Când între două corpuri solide se stabilesc legături, atunci fiecare dintre ele pierde, în raport cu
celălalt, o parte din gradele de libertate. Aceasta înseamnă că o parte din mişcările de translaţie
sau de rotaţie pe care un corp le va efectua faţă de celălalt, devin imposibile. Solidul va avea în
această situaţie mai puţin de şase grade de libertate.
Prin definiţie, numărul gradelor de libertate ale unui robot este egal cu numărul gradelor de
libertate ale organului terminal. El este în funcţie de numărul de segmente ce alcătuiesc structura
mecanică şi de numărul, natura şi dispunerea legăturilor dintre ele.
Noţiunea de grad de libertate, care la prima vedere pare simplă, poate deveni pretenţioasă în
utilizare. De aceea trebuie făcute câteva precizări:
1. modul de obţinere a gradelor de libertate (translaţie, rotaţie) poate să fie diferit pentru acelaşi
rezultat final (poziţia şi orientarea dorită a organului terminal); aceasta va determina existenţa
unor roboţi cu structuri diferite, dar care fac acelaşi lucru;
2. numărul gradelor de libertate este comandat şi de lucrarea pe care trebuie să o execute robotul,
ţinând cont de următoarele observaţii:
- din raţiuni tehnice, specifice locului de muncă, organul terminal se poate apropia greu de zona
de lucru şi atunci robotul poate fi purtat de un batiu mobil, mobilitatea acestuia din urmă nu se
constituie ca grad de libertate.
12
Studiul privind proiectarea unui robot mobil cu senile
- în alte cazuri robotul va trebui să-şi strecoare braţul prin ferestre de dimensiuni mici, sau să-şi
plaseze braţul în spatele unui panou şi atunci braţul trebuie să aibă mai multe articulaţii; aceasta
nu se constituie ca grad de libertate, ci reprezintă o creştere a gradelor de mobilitate.
Un robot are nevoie de 6 grade de libertate pentru a manipula orice obiect din mediul său de
lucru, acesta fiind un caz general, deoarece de foarte multe ori roboţii posedă mai puţin de 6
grade de libertate.
În concluzie, un robot industrial nu are mai mult de 6 grade de libertate, dar poate să aibă mai
multe grade de mobilitate.
Structura unui robot industrial este un ansamblu de corpuri, teoretic rigide, legate prin cuple
cinematice. O cuplă care intervine între două corpuri creează o serie de restricţii în ceea ce
priveşte mişcarea relativă a acestora. Majoritatea legăturilor dintre rigide ale unui robot industrial
sunt de clasă 5 (au un singur grad de libertate) aceastea fiind cuple de rotaţie (rotoide) şi cuple de
translaţie.
Corpurile Ci şi legăturile Li care constituie robotul, pot fi dispuse sub forma unui lanţ cinematic
în raport cu un corp de referinţă C0 – fix sau mobil, denumit batiu. Mai frecvent, se întâlnesc
următoarele structuri:
- structură simplă, care un corp oarecare al lanţului cinematic, diferit de C0 şi organul terminal
(OT), posedă un corp precedent şi un corp ascendent (fig. l.8.);
- structură paralelă, la care există mai multe corpuri C0 distincte între care un corp oarecare
diferit de organul terminal (OT) posedă mai multe corpuri succedente şi mai multe corpuri
succesoare (fig. 1.11.)
Lanţul cinematic cel mai simplu este evident cel cu structură simplă, pentru aceasta indicile de
mobilitate N fiind obţinut un număr minim de legături (cuple).
13
Studiul privind proiectarea unui robot mobil cu senile
Structura simpla are o flexibilitate mare şi un bun comportament dinamic, în schimb rigiditatea
este redusă pentru lungimi mari sau număr mare de cuple ceea ce va implica o precizie mică a
poziţionării OT. Structura aborescentă posedă mai multe organe terminale ce se pretează pentru
operaţii de asamblare în rest având proprietăţi asemănătoare structurii simple. La structurile
complexe apar aşa numitele "bucle mecanice", avantajul principal fiind o bună rigiditate
favorabilă pentru o precizie ridicată, dar datorită inerţiei ridicate rapiditatea de răspuns dinamic
este diminuată. Structurile paralele prezintă cea mai mare rigiditate, mai multe lanţuri cinematice
14
Studiul privind proiectarea unui robot mobil cu senile
independente modificând poziţia şi orientarea unei platforme sau a unui organ terminal,
dezavantajele fiind aceleaşi cu cele ale structurilor complexe.
Exceptând roboţii mobili, batiul C0, raportat la un reper ortonormat Rn (Oo, Xo, Yo, ZQ) este
fixat în timp ce corpurile C1, C2, Cn sunt mobile.O legătură de clasă c între două corpuri creează
o restricţie de c parametrii.
Rezultat după montaj, reprezentând numărul maxim de parametri liberi pe care îi determină
geometria sa.
- structura TT, caracterizată prin faptul că este constituită dintr-un lanţ cinematic deschis,
alcătuit din trei cuple cinematice de translaţie. Ponderea acestei structuri reprezintă 14% din
totalul roboţilor industriali. Pentru exprimarea poziţionării este recomandată utilizarea
coordonatelor carteziene, spaţiul de lucru fiind paralelipipedic. Structura prezintă o bună
rigiditate şi o capacitate de încărcare de ordinul zecilor de daN. Inerţia şi cuplurile gravitaţionale
măsurate la nivelul fiecărei legături variază puţin de la o configuraţie la alta, facilitând alegerea
acţionărilor. Vitezele obţinute la OT sunt medii, iar deformaţiile elastice sunt importante pentru
lungimi mari.
- structura RTT, se caracterizează prin faptul că este constituită dintr-un lanţ cinematic deschis,
alcătuit, plecând de la bază, dintr-o cuplă cinematică de rotaţie şi două cuple cinematice
translaţie. Ponderea acestei structuri este de aproximativ 47% din totalul roboţilor industriali.
Pentru exprimarea poziţionării este recomandată utilizarea coordonatelor cilindrice, spaţiul de
lucru fiind cilindric. Structura permite obţinerea simultană a unei bune rigidităţi şi repetabilităţi şi
a unei capacităţi de încărcare de câteva zeci de daN.
- structura RTR sau RRT sau TRR.Lanţul cinematic deschis al structurii de bază are două
cuple de rotaţie şi una de translaţie. Ponderea acestei structuri este de aproximativ 1% din totalul
roboţilor industriali şi lucrează în coordonate toroidale. Structura, denumită şi SCARA (Selective
Compliance Assambly Robot Arm), are o mare rigiditate mecanică într-un plan ce trece prin axa
primei cuple şi printr-un punct al OT, dar este foarte flexibilă într-un plan perpendicular pe
acesta.
- structura RRR.Lanţul cinematic deschis al structurii de bază are trei cuple de rotaţie. Ponderea
acestei structuri de aproximativ 25% din totalul roboţilor industriali şi lucrează în coordonate
sferice.
15
Studiul privind proiectarea unui robot mobil cu senile
Principalul avantaj al acestei structuri este spaţiul de lucru foarte mare în poziţie menţinând un
gabarit redus al roboţilor industriali.
Varietatea extrem de mare a roboţilor industriali (universali, speciali sau specializaţi) concepuţi
actualmente pe plan mondial, din diverse considerente, în special de ordin tehnologic, a impus
tendinţa de realizare a acestora din module tipizate, acesta reprezentând, aşa cum s-a arătat mai
înainte, subansambluri care îndeplinesc diverse funcţiuni în cadrul structurii mecanice.
4. module de prindere
În practica construcţiei roboţilor industriali pot fi concepute module cu mai multe funcţiuni: de
ghidare, orientare şi prindere, denumite module polifuncţionale.
CAPITOLUL 2
Aplicaţiile industriale şi tehnice ale roboţilor mobili câştigă în mod constant importanţă, în
special din cauze de siguranţă (execuţia sigură şi neîntreruptă a sarcinilor monotone ca de
exemplu supravegherea), accesibilitatea (inspectarea locurilor care sunt inaccesibile oamenilor,
exemplu: spaţii înguste, medii cu grad sporit de risc, sau locuri îndepărtate) sau cost (sistemele de
16
Studiul privind proiectarea unui robot mobil cu senile
transportare s-au bazat pe faptul că roboţii autonomi mobile pot să fie mai ieftini decât alte
sisteme de transport). Roboţii mobili sunt deja folosiţi în mare măsură având sarcini pentru
supraveghere, inspecţie şi transport.
Un rol important în cadrul atelierelor flexibile de producţie îl joacă roboţii mobili, care asigură
deplasarea produselor între magazii, spaţii de avertizare, celule de automatizare flexibile. La
aceşti roboţi, funcţia de acţiune se manifestă prin deplasarea robotului în mediul de lucru, cea de
percepţie – prin construirea unui hărţi al terenului, iar cea de decizie – prin generarea şi execuţia
traseului de mişcare, cu ocolirea obstacolelor şi minimizarea postului deplasării.
La roboţii mobili apar probleme specifice, cum ar fi evitarea impactului cu obiecte staţionare sau
în mişcare, determinarea poziţiei şi a orientării robotului în teren, planificarea traiectoriei optime
de mişcare.
Navigaţia este posibilă şi fără determinarea poziţiei şi orientării robotului faţă de un sistem de
coordonare fix, doar această informaţie este utilă pentru sistemul de comandă al mişcării. Datorită
periodicităţii cu care se explorează mediul înconjurător şi al întârzierilor introduse de prelucrarea
informaţiei senzoriale, nici nu se poate calcula precis şi conţine poziţia şi orientarea robotului în
teren. Între punctele din teren determinate, poziţia şi orientarea robotului se interpolează.
17
Studiul privind proiectarea unui robot mobil cu senile
Planificarea traiectoriei se poate face cu ajutorul modelului terenului, sau în cazuri mai simple
fără acestea. Lipsa modelului terenului implică însă posibilitatea determinării direcţiei în care se
află ţinta, existenţa unui sistem de protecţie pentru evitarea coliziunii cu obstacolele şi
posibilitatea determinării poziţiei robotului în teren.
Dacă funcţia de percepţie construieşte un model al terenului, atunci peste ea se proiectează o grilă
de control paralelă cu axele sistemului de referinţă fix în care se deplasează robotul. În acest fel,
pe hartă apar sectoare care sunt numerotate începând cu acela care conţine sistemul de referinţă
fix. În funcţie de informaţia furnizată de sistemul de vedere şi senzorii de măsurare al distanţei,
fiecare sector de pe hartă se defineşte ca traversabil, netraversabil (conţine obstacole), sau
necunoscut.
Se identifică, de asemenea, numărul sectoarelor în care se află robotul si ţinta traiectoriei. Între
aceste două sectoare trebuie găsită o traiectorie care să treacă numai prin sectoarele traversabile şi
să minimizeze postul deplasării (exemplu: minimizarea energiei consumabile).
Roboţii care îşi planifică singuri traiectoria de mişcare sunt dotaţi cu funcţia de decizie şi încadrat
în clasa roboţilor evoluaţi inteligenţi.
Desigur, există roboţi la care traiectoria nu se planifică, este fixă şi marcată pe teren. În acest caz,
ei trebuie să evite obstacolele interpuse accidental pe traiectoria marcată şi să prelucreze
informaţia de navigaţie, realizând astfel urmărirea traiectoriei fixate. Aceşti roboţi mobili nu sunt
inteligenţi, dar sunt deosebiţi de utili pentru asigurarea transportului în atelierele flexibile de
producţie.
Există o mare varietate de roboţi mobili (de transport), ei clasificându-se în trei grupe mari, aşa
cum se observă pe reprezentarea din fig. 2.1. şi anume:
- roboţi mobili cu deplasare pe o bază situată pe sol sau cu deplasare directă pe sol
18
Studiul privind proiectarea unui robot mobil cu senile
Roboţii cu deplasare la sol se pot deplasa pe ghidaje sau se amplasează pe cărucioare automate
prevăzute cu roţi, cu deplasare pe o traiectorie materializată prin şină sau direct pe sol, caz în care
traiectoria este materializată de un fir inductiv sau de o bandă luminiscentă. Acestea din urmă
sunt mijloace de transport şi manipulare cu un înalt grad de flexibilitate, putându-se deplasa pe
cele mai variate traiectorii.
19
Studiul privind proiectarea unui robot mobil cu senile
Pentru deplasări pe distanţe mai mici, roboţii mobili la sol se pot deplasa pe ghidaje executate pe
baza robotului.
Pentru deplasări pe distanţe mari, se utilizează cărucioarele automate dotate cu roboţi care
îndeplinesc operaţiile de transfer ale materialelor transportate de cărucior între acesta şi postul de
lucru din sistemul tehnologic, acestea sunt numite robocare. Robocarele se pot deplasa pe şine,
fiind dotate cu un sistem de roţi metalice sau se pot deplasa liberi, pe pneuri, fiind ghidate pe fir
inductiv sau fotoelectric. Acţionarea (propulsia) acestor robocare se realizează cu motoare
electrice de curent continuu, alimentate în mod normal, de la baterii de acumulatoare încărcate pe
robocar. Tot pe acestea se mai găsesc:
- bara de protecţie împotriva şocurilor, care sunt prevăzute şi cu mijloace sau senzori de
proximitate pentru comanda întreruperii acţionării în momentul coliziunii;
- panouri hidraulice, în cazul când acţionarea robotului îmbarcat pe robocar este hidraulică sau
când platforma ridicătoare este acţionată hidraulic;
20
Studiul privind proiectarea unui robot mobil cu senile
Deplasarea verticală sau înclinată este ghidată în mod corespunzător de ghidaje, magneţi etc.
Modulul de comandă se amplasează de regulă, la sol, dar poate fi şi îmbarcat.
21
Studiul privind proiectarea unui robot mobil cu senile
22
Studiul privind proiectarea unui robot mobil cu senile
Roboţii cu deplasare pe căi suspendate pot fi de tipul cu deplasare "pe portal" şi cu deplasare "pe
punte". Aceşti roboţi au o largă utilizare în următoarele aplicaţii:
- în sistemele flexibile de fabricaţie prin aşchiere pentru alimentarea cu piese şi scule a maşinilor
- unelte care constituie posturile de lucru ale sistemului, aceasta în special când se prelucrează
piese de revoluţie
Diferitele variante ale roboţilor cu deplasare "pe portal" şi "pe punte" se deosebesc între ele prin
numărul de braţe (unul sau două), prin numărul gradelor de libertate ale dispozitivului de apucare
(1, sau 3 grade de libertate), prin existenţa sau lipsa dispozitivelor pentru schimbarea automată a
apucătorului, prin mărimea curselor după diferitele grade de mişcare ale robotului.
În cazul când un robot industrial pe portal este utilizat pentru alimentarea cu piese sau scule a
maşinilor – unelte în sistemele flexibile robotizate, acestea se realizează în mod normal cu două
braţe.
Ambele braţe ale robotului sunt amplasate pe acelaşi cărucior, unul dintre ele preluând
semifabricatul care trebuie dus pe maşină, iar celălalt va prelua piesa prelucrată de pe maşina
respecţivă. Cele două braţe ale robotului pot fi amplasate în acelaşi plan sau pot forma între ele
un unghi ascuţit.
Roboţii mobili cu deplasare pe punte se deosebesc cu cei cu deplasare pe portal prin faptul că
sunt amplasaţi pe un cărucior care, la rândul său, se amplasează pe o punte.
23
Studiul privind proiectarea unui robot mobil cu senile
Singurele lucruri vizate au fost cercetarea şi executarea de traiectorii pentru vehicule, având
obiceiul de a caracteriza roboţii mobili prin trei funcţii care sunt:
- funcţia de locomoţie
- funcţia de localizare
24
Studiul privind proiectarea unui robot mobil cu senile
În componenţa elementelor mobile ale roboţilor pot intra mecanisme de naturi diferite: mecanice,
hidraulice, pneumatice, electrice combinate sau nu între ele.
Precizia de poziţionare, siguranţa în funcţionare, uşurinţa exploatării şi întreţinerii sunt cerinţe ale
roboţilor industriali şi de cei de tipul constructivi şi de precizia de execuţie al fiecărui mecanism
component.
- elemente mecanice ale căror dimensiuni sunt determinate de condiţiile de rezistenţă, se execută
din materiale cu proprietăţi înalte de rezistenţă, în special din oţel îmbunătăţit sau călit din fontă
de înaltă rezistenţă (roţi dinţate, arbori);
- elemente mecanice ale căror dimemsiuni sunt determinate de condiţii de rigiditate se execută
din materiale cu un modul de elasticitate ridicat, cum ar fi o oţelul netratat termic şi fonta;
- elemente mecanice supuse eforturilor unitare de contact se execută: în cazul unor eforturi
unitare de contact, mari, din oţel călit la durităţi ridicate (roţi dinţate puternic solicitate); la
eforturi unitare de contact medii şi mici, din oţel îmbunătăţit netratat termic, din fontă şi materiale
nemetalice; în cazul condiţiei de alunecare (lagăre de alunecare, angrenaje melcate, frână) se
execută o piesă dintr-un material antifricţiune sau de fricţiune, iar cealaltă din oţel îmbunătăţit sau
nu tratat termic din fontă, etc, astfel încât suprafaţa de contact să fie dură.
25
Studiul privind proiectarea unui robot mobil cu senile
La alegerea materialului oricărui element mecanic, în afară de factorii mai sus amintit, concură şi
factorii economici care urmăreşte reducerea greutăţii acestora, tehnologie cât mai uşoară cu
durabilitate în utilizare, folosind în acest scop materialele corespunzătoare.
Materialele utilizate frecvent în costrucţia elementelor mecanice specifice roboţilor sunt fontele,
oţelurile şi într-o măsură mai mică aliajele neferoase şi masele plastice.
Fontele sunt, prin excelenţă, folosite la confecţionarea batiurilor sistemelor roboţilor, datorită
faptului că aceste elemente, având forme complicate, se presează mai uşor a fi obţinută prin
turnare, ca şi faptului foarte important, că fonta are proprietăţi de amortizare a vibraţiilor. Fonta
cea mai folosită la confecţionarea elementelor mecanice este fonta cenuşie.
Cele mai utilizate oţeluri în construcţia elementelor mecanice ale roboţilor sunt: oţelurile –
carbon obişnuite, oţelurile – carbon de calitate şi oţelurile aliate.
Elementul mecanic cel mai important la un robot industrial este batiul. Pe acesta se montează, fix
sau cu posibilitate de deplasare, ansamblurile şi elementele ce compun roboţii. Precizia
traiectoriilor generate de un robot industrial depinde în cea mai mare parte, de menţinerea poziţiei
reciproce dintre ansamblurile fixe şi cele mobile. Aceste cerinţe impun ca bazele de aşezare ale
batiului să nu-şi schimbe poziţia reciprocă în timpul reglării şi funcţionării astfel spus, pricipala
condiţie ce trebuie să îndeplinească un batiu o constituie invariabilitatea poziţiilor relative dintre
bazele de fixare şi cele de ghidare în timpul funcţionării robotului.
- o rigiditate cât mai mare, pentru excluderea deformaţiilor elastice care apar în timpul deplasării
roboţilor datorită greutăţii piesei manipulate;
- rezistentă la vibraţii cât mai mare pentru a putea obţine o calitate a traiectoriei corespunzătoare
cerinţelor şi a obţine regimuri ridicate la deplasarea elementelor mobile;
26
Studiul privind proiectarea unui robot mobil cu senile
Datorită formelor variate pe care le pot avea traiectoriile organului terminal, controlul
dimensional şi de formă al ghidajelor constituie problemele cele mai dificile ale generării
suprafeţelor. Pentru înlăturarea acestor dificultăţi, sunt folosite drept mecanisme pentru realizarea
traiectoriilor organului terminal cuple cinematice inferioare, de translaţie sau de rotaţie, cum sunt
cuplurile sanie-ghidaj, respectiv lagăr-fix. În consecinţă curbele organului terminal cele mai
simple sunt realizate de roboţi prin traiectorii rectilinii şi circulare.
Ghidajele roboţilor au menirea de a conduce în timpul funcţionării elemente mobile cum sunt
mesele, săniile, suporţii, întărite subansambluri, ele susţin aceste elemente şi asigura precizia de
deplasare a lor. În timpul deplasării elementului mobil, indiferent de forma traiectorie, trebuie să
aibă un grad de libertate de translaţie sau de rotaţie, scop în care ghidajele sunt limitate la un
număr de suprafeţe numite suprafeţe de ghidare. Ghidajele pot avea orice profil poligonal rezultat
din combinarea unor suprafeţe plane, curbe sau combinate mixt.
Profilele ghidajelor roboţilor definite de forma secţiunii într-un plan perpendicular pe direcţia
mişcării, în calculul ghidajelor pentru mişcarea rectilinie şi respectiv într-un plan radial în cazul
ghidajelor pentru mişcarea circulară; triunghiulare, plane şi cilindrice.
Sistemele de acţionare furnizează energia mecanică necesară acţionării cuplelor cinematice ale
sistemului mecanic.
Elementele esenţiale şi indispensabile ale unui sistem de acţionare îl constituie motoarele care
transformă un anumit tip de energie (electrică, hidraulică, pneumatică) în energie mecanică, la
parametrii necesari funcţionării robotului.Cele mai importante sisteme utilizate la acţionarea
roboţilor sunt:
- electrice
- hidraulice
- pneumatice
27
Studiul privind proiectarea unui robot mobil cu senile
Motoarele de acţionare ale roboţilor trebuie să dezvolte cupluri mari la gabarite minime, să aibă
momente de inerţie reduse, în scopul îmbunătăţirii comportării dinamice şi, implicit facilitatea
poziţionărilor, să fie compatibile cu sistemul de comandă şi insensibile la perturbaţie. Acţionarea
cuplelor dinamice se poate face direct fie prin mecanisme de transmitere şi transformare a
parametrelor cinematici şi dinamici (organul de transmitere, reductoare, amplificatoare de cuplu).
Aşa cum se arăta mai sus, acţionarea electrică tinde să devină cea mai răspândită variantă de
acţionare a roboţilor, datorită unor avantaje evidente cum ar fi:
- disponibilitate energiei electrice în totalitatea mediilor în care acţionează roboţii, mai puţin
mediile explozive;
Motoarele electrice cele mai des utilizate în acţionarea roboţilor pot fi clasificate şi grupate astfel:
• cu rotor disc
• cu magneţi permanenţi
• cu reductanţă variabilă
• hibride
28
Studiul privind proiectarea unui robot mobil cu senile
• radial
• clasice
• liniare
• pas cu pas:
- oferă largi posibilităţi de reglare a parametrilor de acţionare (forţe, viteze, cupluri, turaţii)
- costul ridicat al fluidului de lucru. Acţionarea hidraulică este utilizată în cazul manipulării unor
sarcini mari, peste 250N.
29
Studiul privind proiectarea unui robot mobil cu senile
Dezavantaje:
- realizează forţe şi momente reduse, datorită presiunilor de lucru reduse (4-8 bari)
Domenii de utilizare:
Problemele specifice care apar la acţionarea pneumatică sunt legate de poziţionare, de reglare a
vitezelor, de frânări şi de blocare în poziţia programată.
Toate aceste probleme apar ca urmare a rigidităţii scăzute (elasticităţii) aerului, a fluidităţii
deosebite a acestuia şi a presiunilor uzuale reduse (4-8 bari).
În acest sens, în ultimii ani şi-au făcut apariţia o mare varietate de convertori electro-pneumo sau
fluido-mecanic, care transformă semnalul de intrare electric sau fluidic, cu variaţii incluse
(programate), în semnal mecanic, analog. Aceştia fac parte din structura diverselor
servomecanisme, cu funcţionare programabilă, care s-au impus în acţionarea şi comanda roboţilor
industriali. Servomecanismele asigură sistemului de acţionare, precizii de poziţionare,
caracteristici puterea/greutate şi comportări dinamice deosebite.
30
Studiul privind proiectarea unui robot mobil cu senile
Aşa cum s-a observat majoritatea sistemelor de acţionare sunt de tip hibrid.Se poate afirma că
acţionări pur hidraulice sau pneumatice sunt rar folosite în construcţia roboţilor, singurul sistem
de acţionare şi comandă care poate lucra independent fiind cel electric.
Orice robot mobil este echipat cu senzori, ce furnizează sistemului de comandă şi programare,
informaţii, care să permită supravegherea propriei activităţi pe deoparte, şi a mediului extern pe
de altă parte. Din acest punct de vedere o primă clasificare a senzorilor unui robot este
următoarea:
1. senzori interni – oferă informaţii asupra funcţionării celorlalte sisteme componente ale
robotului său, altfel spus asupra mediului propriu (intern) al robotului.
Informaţiile furnizate de sistemul senzorial sunt prelucrate de către sistemul de comandă, având
de cele mai multe ori ca rezultat transmiterea către sistemul de acţionare a unor comenzi menite
să corijeze traiectoria descrisă de către organul terminal, în vederea îndeplinirii sarcinilor de
lucru, a evitării unor obstacole. Organele de simţ ale robotului sunt constituite din traductoare şi
senzori, a căror varietate extrem de mare îngreunează încercările de clasificare. Dacă s-ar prelua
din automatică noţiunea de stare a unui sistem, atunci se poate spune că traductoarele şi senzorii
dau informaţii despre starea unui robot care execută o sarcină dată.
Robotul lucrează într-un mediu marcat de o serie de procese fizice specifice. Astfel, gravitaţia
influenţează mişcarea tuturor roboţilor care funcţionează pe pământ şi are un efect neglijabil
pentru roboţii din navele spaţiale. În multe aplicaţii mişcările robotului nu sunt libere, ele
efectuându-se în contact cu alte obiecte. Contactul fizic generează forţe de reacţiune, care
modifică starea robotului. Dacă mediul de lucru este parţial cunoscut, sau sarcina utilă de
executat este parţial descrisă, atunci robotul, prin interacţiunea la distanţă cu mediul, localizează
şi recunoaşte obiectele, le calculează poziţia şi orientarea în vederea ocolirii sau manipulării.
Interacţiunile cu mediul pot fi de tip editară (volume din spaţiul de lucru care nu pot fi atinse) şi
de tip control (robotul generează forţe prestabilite asupra obiectelor din mediu). Astfel,
interacţiunile se traduc prin restricţii de tip inegalitate sau egalitate.
În cazul ocolirii obstacolele, mişcarea robotului rămâne liberă şi dacă se iau măsuri de siguranţă
(toate obiectele se consideră mărite), atunci nerespectarea inegalităţilor impuse poate să nu
influenţeze negativ acţiunea robotului. Astfel de interacţiuni robot – mediu mai poartă denumire
de interacţiuni slabe.
În cel de al doilea caz când se generează forţe prestabilite între roboţi şi mediu, nerespectarea
egalităţii prescrise poate avea urmări grave (deteriorarea robotului sau a obiectelor).
31
Studiul privind proiectarea unui robot mobil cu senile
Localizarea obiectelor prin contact fizic impune restricţii asupra vitezei de mişcare a structurilor
mecanice de manipulare. Vitezele mari de lucru determină ca efectele dinamice ale unui contact
fizic cu obstacolele manipulate să fie riscante. Folosind senzori de proximitate, se pot localiza şi
măsura distanţele până la corpurile mediului fără efectuarea contactului fizic. Pentru a evidenţia
existenţa obiectelor în mediu şi distanţa până la ele, corpurile trebuie să emită un semnal (către
încă un punct) care să poată fi detectat. Acest lucru se poate întâmpla dacă corpul emite un
semnal natural (sau a fost dotat cu emiţător) sau dacă reflectă un semnal emis de robot spre el.
Senzorii de proximitate dotat cu emiţător şi receptor se numesc activi, iar cei dotaţi numai cu
receptori se numesc pasivi.
Un corp din mediu poate fi radioactiv (emite radiaţii ), luminiscent (emite fotoni în spectrul
vizibil), poate emite un câmp magnetic sau electromagnetic. Cu excepţia unor aplicaţii
particulare, radiaţiile naturale emise de corpuri sunt de intensitate scăzute şi nu pot fi uşor
detectate. Printre radiaţiile mai des folosite (clasificate în puncte de frecvenţă), pentru localizarea
corpurilor se pot enumera:
Cel mai des se echipează obiectul cu senzori de proximitate activ care controlează în timp
semnalul emis, de natură artificială (neexistent în mediul de lucru) ca şi pe cel recepţionat.
Obţinerea unei informaţii despre un parametru caracteristic mediului intern sau extern al
robotului presupune realizarea a două funcţii: sesizarea şi apoi măsurarea mărimii acestuia.
Senzorii realizează doar funcţia sesizării, furnizând un semnal electric ce este prelucrat ulterior de
sistemul de comandă. Traductoarele execută atât funcţia de sesizare (orice traductor are
încorporat un senzor) cât şi pe cea de măsurare, furnizând sistemului de comandă un semnal ce
caracterizează cantitativ parametrul urmărit.
• relativă sau incrementală, când valoarea măsurării este raportată la ultima poziţie înregistrată
32
Studiul privind proiectarea unui robot mobil cu senile
• mecanic
• electric
• optic
• în dispozitivul de prehensiune
• în sistemul de acţionare
- rezoluţia, care reprezintă cea mai mică mărime măsurabilă, ce corespunde incrementalul sau
pasului, pentru traductoarele numerice;
- precizia, care depinde de coeficientul de liniaritate al traductorului, sau altfel spus, constanţa
dintre rezultatul măsurării şi mărimea de măsurat în plaja de funcţionare;
- justeţea, sau diferenţa între valoarea indicată şi cea efectivă a mărimii măsurate;
- fidelitatea, care este determinată de variaţia valorilor măsurate pentru aceeaşi mărime în condiţii
identice.
Pentru funcţionarea roboţilor inteligenţi, spre deosebire de roboţii obişnuiţi, sunt necesare în mod
clar mai multe informaţii decât cele furnizate de traductoare. Aceasta deoarece cu ajutorul acestor
date se construieşte modelul concret al comportării robotului sau succesiunea mişcării
elementelor în conformitate cu problema de rezolvat. Roboţii dotaţi cu inteligenţa artificială îşi
găsesc aplicaţiile în procesele tehnologice de montaj automat, la sudarea cu arc electric, în
aplicaţiile care necesită roboţi mobili.
33
Studiul privind proiectarea unui robot mobil cu senile
Structura unui senzor şi clasificarea acestora, sunt prezentate în fig. 2.4. şi fig. 2.5.
Prelucrarea datelor furnizate de sistemele senzoriale funcţionale se face prin utilizarea unor
algoritmi specifici cum ar fi: de detectare a unui obiect, apreciere a distanţei, de recunoaştere a
formelor, de prehensiune, de evitare a obstacolelor.
Scopul principal al programării unui robot urmăreşte efectuarea de către acesta a unor acţiuni
tehnologice prescrise, în anumite puncte pe o traiectorie bine definită. în funcţie de complexitatea
arhitecturii robotului, ca sistem, se deosebesc 4 procedee de programare, de la cel mai simplu,
care permite programarea motoarelor de acţionare, până la cel mai complex, care defineşte
sarcina impusă spre realizarea în termen obiectiv:
- procedeul care exploatează funcţiile robotice bazate pe un sistem CAD (Computer Aided
Design).
Sistemul de comandă al robotului modern este realizat cu ajutorul unuia sau mai multor
microprocesoare programate de constructori să opereze pe baza unor programe de comandă scrisă
într-un cod maşină propriu. Din acest punct de vedere, cel mai simplu mod de programare a unui
robot este scrierea programului direct în cod maşină şi rularea lui de către unitatea centrală.
Aceasta înseamnă că toate secvenţele de mişcare şi datele furnizate de către sistemul senzorial
trebuie codate în datele binare recunoscute de către microprocesor, pentru a putea apoi fi
prelucrate de către acesta cu ajutorul setului propriu de instrucţiuni.
35
Studiul privind proiectarea unui robot mobil cu senile
- fişierul program sursă este interpretat direct de către unitatea de comandă şi executat;
- fişierul program sursă este compilat într-un cod intermediar de nivel semantic scăzut, apoi este
interpretat de către unitatea centrală.
Prin interpretor se înţelege un program special rezident în memoria unităţii de comandă, care
decodează instrucţiunile programului utilizator şi care pilotează diferitele acţiuni ale robotului.
Marea majoritate a limbajelor de programare sunt de tip interpretat, în care programul însărcinat
cu execuţia tratează în mod secvenţial fiecare instrucţiune înainte de a trece la următoarea.
- traiectoriile de realizat
- geometria pieselor
- operatori aritmetici;
- limbaje sărace în mijloace informatice, în care structura programului este liniară, iar poziţiile de
atins sunt precizate sub forma coordonatelor articulare, fie făcându-se referinţă la poziţii
memorate prin învăţare;
- limbajul de nivel înalt care conferă structuri de date predefinite clasice şi specifice roboticii;
- limbajul de programare pentru celule robotizate, care oferă mecanisme evoluate de evaluare a
mediului înconjurător şi permit supervizarea unui ansamblu de acţiuni, precum şi cooperarea
dintre acestea.
36
Studiul privind proiectarea unui robot mobil cu senile
CAPITOLUL 3
- pe şenile;
Prezenta lucrare se încadrează în categoria sistemelor mobile care se deplasează prin intermediul
şenilelor, şi îşi propune să-şi focalizeze atenţia asupra modului de proiectare şi realizare a unei
platforme mobile, care să funcţioneze în condiţii de siguranţă, să ştie să detecteze şi să ocolească
obstacolele, să fie capabil să detecteze şi să se ghideze pe o anumită traiectorie concretizată de un
traseu (bandă luminoasă), folosind contrastul a 2 culori.
Platforma mobilă este formată dintr-un şasiu pe care sunt montate 2 servomecanisme formate din
micromotoare de curent continuu de tip Gwss 03N (Futaba-Taiwan), având incluse reductoare cu
roţi dinţate drepte.
Platforma face parte din categoria miniroboţilor cu un gabarit de aproximativ 220x110x50 (mm)
37
Studiul privind proiectarea unui robot mobil cu senile
1 - șenilă
2 - carcasă
3 și 4 - roți motoare
5 și 6 - servomotoare
Servomotoarele au fost amplasate în interiorul saşiului din bachelită, în partea din spate a
acestuia, fiind fixată prin intermediul a 4 şuruburi. Partea de ghidare a platformei mobile este
constituită dintr-un modul de prelucrare al informaţiilor provenite de la un număr de 3 senzori
amplasaţi sub carcasă. Aceştia sunt dispuşi fizic pe suprafaţa liniei, sub forma unui triunghi
echilateral.
Partea electronică – constă inrealizarea plăcii de bază (fig. 3.1.) pe care a fost dispus
microcontrolerul, procesorul de 4 MHz, switch-ul de reset al watchdog timer-ului, cuplele de
legătură şi servomotoarele, plăcile de bază ale comparatoarelor de tensiune care preiau indicaţiile
senzorilor de detecţie ai liniei şi detecţie al obiectelor (fig. 3.2.), cablajele de legătură cu modulul
de telecomandă start/stop, cât şi modulului stabilizator de tensiune pentru încărcarea
acumulatorului necesar alimentării servomotoarelor.
Această modificare a tensiunii este sesizată de către microcontroler, acesta luând decizia de
comandă a servomotoarelor, în conformitate cu un altgoritm stabilit prin software.
39
Studiul privind proiectarea unui robot mobil cu senile
Fig 3.3 Cablajul imprimat al modulului comparator al senzorilor pentru detecţia liniei
40
Studiul privind proiectarea unui robot mobil cu senile
Circuitul electric din fig. 3.4 lucrează în regim de sursă de curent constant, fiind necesar
încărcării celor 4 acumulatori NiCd utilizaţi la acţionarea servomotoarelor.
Dioda înseriată cu pinul 3 al circuitului integrat stabilizator de tensiune are rolul de a preveni
conectarea inversă a polarităţii sursei de alimentare.
Rezistorul Rl a fost dimensionat astfel încât sursa să furnizeze la ieşire un curent constant de 240
mA necesar încărcării celor 4 acumulatori într-un interval de timp de aproximativ de 12 ore.
Factorul de dimensionare al rezistenţei:
Rezistorul Rl a fost dimensionat astfel încât sursa să furnizeze la ieşire un curent constant
de 240 mA necesar încărcării celor 4 acumulatori într-un interval de timp de aproximativ de 12
ore. Factorul de dimensionare al rezistenţei:
U
I= (3.1)
R
U U sursa−U ac 12 – (4 ∙ 1 ,2)
R= = = =30 [ Ω ] (3.2)
I I 0 , 24
41
Studiul privind proiectarea unui robot mobil cu senile
Se aproximează P ≈ 2 [W]
42
Studiul privind proiectarea unui robot mobil cu senile
CAPITOLUL 4
43
Studiul privind proiectarea unui robot mobil cu senile
Calculul organologic.
Reducând cilindrul la secţiunea sa dreaptă, ne vom ocupa de mişcarea discului circular, greu,
omogen, de centru O’ şi de rază R, în planul vertical xOy (fig. 4.1.), discul fiind obligat a rămâne
tangent necontenit la orizontala Ox. Vom presupune că în afară de greutatea proprie G şi de
reacţiunea normală N în punctul de sprijin A mai lucrează asupra discului un sistem de forţe
situate în planul discului, forţe care se pot reduce la un torsor în O’ exprimat printr-o forţă F ̅
aplicată în O`, de proiecţie Fx, Fy pe axele de coordonate Ox, Oy, şi la un cuplu de moment M ̅
normal la planul xOy. Vom presupune că sub acţiunea acestor forţe, discul capătă viteza
orizontală υ ̅ aplicată în centrul O’, precum şi o rotaţie în planul său, în jurul centrului O’, de
viteză unghiulară ω ̅ . Vom indica în figură prin săgeţile curbilinii σ şi σ’ sensul pozitiv al
momentului respectiv al rotaţiei discului de viteză unghiulară ω ̅. În punctul A de tangenţă
discul are tendinţa de aluneca pe Ox. Vom nota cu ν’ viteza de alunecare a punctului A
aparţinând discului pe axa Ox. Între mărimile ν, ω şi υ’ există o relaţie care se poate stabili
imediat dacă observăm că viteza υ’ a punctului A (viteza absolută) poate fi considerată ca fiind
rezultanta dintre viteza de rotaţie în jurul centrului O’ (viteza de transport).
'
υ =υ−Rω (4.1)
Fig 4.1
Viteza de alunecare ν’ sau numai tendinţa punctului A de a aluneca pe Ox va da naştere unei forţe
de frecare Ф, aplicată în punctul de contact A, aşezată în lungul axei Ox şi dirijată în invers
44
Studiul privind proiectarea unui robot mobil cu senile
vitezei ν’ (sau tendinţei de alunecare în cazul în care ν’ este nul). Presupunem semnul lui Ф
inclus în simbolul Ф.
Vom presupune că rostogolirea sau chiar numai tendinţa de rostogolire a discului pe axa Ox dă
naştere frecării de rostogolire de moment C, a cărei valoare maximă (în cazul rostogolirii) este
egală cu sN, s fiind coeficientul de frecare de rostogolire dat de relaţia (4.1.).
Teorema mişcării centrului de greutate O’ al discului, proiectată pe cele două axe de coordonate
ne va da:
m ν̇=Ф + F x (4.2)
0=N−G+ F y (4.3)
iar teorema momentului cinetic faţă de centrul de greutate O’ al discului se va exprima prin
relaţia:
'
J ω̇=M −C−R Ф=M −R Ф (4.4)
'
M =M −C (4.5)
'
J ω̇+ mR ν̇=M + R F x (4.6)
45
Studiul privind proiectarea unui robot mobil cu senile
N=G−F y (4.7)
Vom mai presupune în cele ce urmează că torsorul ( F , M ) este constant, adică mărimile M, F x, Fy
sunt constante.
Notăm cu υ0, ω0 valorile iniţiale (t = 0) ale mărimilor υ, ω respective. Vom presupune că aceste
mărimi sunt pozitive şi că între ele există relaţia:
υ 0=R ω 0 (4.8)
impusă de condiţia rostogolirii fără alunecare. Vom arăta că în acest caz este posibilă în anumite
condiţii o rostogolire fără alunecare, adică o relaţie permanentă.
υ=R ω (4.9)
46
Studiul privind proiectarea unui robot mobil cu senile
Se poate verifica că expresiile (4.11.) şi (4.12.) ale mărimilor υ şi ω verifică ecuaţiile (4.2.) şi
(4.4.) şi că ele sunt valabile şi în cazul particular υ0 = ω0 = 0 cu condiţia de a lua pentru forţa de
frecare Ф valoarea:
'
mRM −J F x
Ф= 2
(4.12)
J+m R
Însă pentru această expresie a lui Ф să fie admisibilă, ea nu trebuie să depăşească în valoare
absolută mărimea μN, μ fiind coeficientul de frecare de alunecare. Deci pentru ca mişcarea să fie
posibilă, trebuie să avem:
unde am notat:
2
J Fx μN (J +m R )
M 1= ; M 2= (4.15)
mR mR
În cazul în care mărimea M’ = (M – C) îndeplineşte condiţia (4.14.), soluţia problemei este dată
de formulele (4.10.) şi (4.11.); discul are o rostogolire fără alunecare, adică o rostogolire pură.
mărimile υ şi ω rămân tot timpul pozitive, fără a se anula vreodată şi că deci mişcarea de
rostogolire va dura la infinit. Viteza de rotaţie ω va creşte proporţional cu timpul sau, în cazul
semnului egal în (4.16.), se va menţine constantă. Dacă însă în loc de relaţia (4.16.) am avea
relaţia:
'
M <−R F x (4.17)
Pentru t > t1 va trebui să revenim la formulele (4.10.) şi (4.11.) în care vom presupune că timpul
este socotit din momentul t = t1, iar vitezele iniţiale υ0, ω0 sunt ambele nule (un caz particular al
celui studiat). Rezultă că vom avea tot timpul o rostogolire în sens negativ (ω < 0), dacă M’ +
RFx < 0, unde vom fi înlocuit pe C prin – C(M’ = M – C). În cazul:
−C ≤ M + R F x ≤ C , ω 0=0 (4.17)
În concluzie, dacă condiţia (4.14.) este îndeplinită, discul se va rostogoli tot timpul fără
alunecare, şi anume, în cazul M – C + RFx > 0, în sens pozitiv, uniform accelerat, iar în cazul M
– C + RFx < 0 rostogolirea va fi uniformă întârziată, trecând prin zero şi schimbându-şi sensul.
Cazul particular (4.17’.) se deduce imediat.
Aceste consecinţe le-am adus în ipoteza că mărimea M’ îndeplineşte condiţia (4.14.). Acum se
pune întrebarea: ce se va întâmpla în cazul când condiţia (4.14.) nu este îndeplinită? Cu alte
cuvinte, care va fi mişcarea discului când vom avea:
' '
M > M 1 + M 2 sau M < M 1−M 2 (4.19)
În acest caz, Ф neputând să depăşească valoarea maximă μN, va lua permanent această valoare
limită. Mişcarea discului nu va mai putea avea loc fără alunecare. Studiul unei mişcări de felul
acesta îl vom da în continuare.
Vom începe prin a studia cazul menţionat (4.19.). Vom continua a presupune υ0 = 0, însă luând:
' '
M > M 1 + M 2 sau M < M 1−M 2 (4.20)
}
1
υ=υ 0+
m
(Ф + F x )t
1 ' (4.21)
ω=ω 0+ ( M −RФ ) t
J
Ф=± μN
48
Studiul privind proiectarea unui robot mobil cu senile
R
υ=
'
J
(−M + M 1+ M 2 ) t
'
(4.23)
cu notaţiile:
2
J Fx μN (J +m R )
M 1= ; M 2= ; M ' =M −C (4.24)
mR mR
semnul dublu din (4.23.) corespunzând cu acela din (4.21.) din expresia frecării de alunecare Ф.
Însă Ф are sens opus vitezei υ’ încât va trebui să avem υ_+^'<0,υ_-^'<0, unde am notat υ_+^' şi
υ_-^' expresiile din dreapta relaţiei (4.23.) în care luăm semnul + respectiv semnul –. Deducem că
în cazul M’ < M1 – M2 vom avea o alunecare cu viteză υ’ negativă tot timpul, iar în cazul M’ >
M1 + M2 vom avea o alunecare cu viteza υ’ pozitivă tot timpul. Rostogolirea corespunzătoare v
fi dată de expresia lui ω din (4.21.), care în general va fi diferită de zero.
Aceste consideraţii împreună cu acelea de la cazul anterior rezolvă integral cazul υ_0^'=0.
Trecem la studiul cazului υ_0^'≠0. Vom presupune că între vitezele iniţiale 〖 υ_0,υ 〗 _0^' şi
ω_0 există relaţia generală:
'
υ 0=υ 0−R ω 0 (4.25)
care implică mişcarea de alunecare de viteză υ_0^' a punctului A al discului de pe axa Ox. Vom
presupune ω_0≥0, ceea ce nu înseamnă o particularizare, dacă lăsăm posibilitatea ca υ0 să fie
pozitiv, negativ sau nul.
Forţa de frecare Ф va avea sensul opus lui υ_0^'. Valoarea ei absolută va fi egală cu μN, cât timp
există o alunecare. În consecinţă, presupunând υ_0^'≠0 va trebui să luăm pe Ф constant şi egal cu
μN în valoare absolută cât timp υ’ nu-şi schimbă sensul. Cum υ’ este o funcţie continuă de timp,
ea va trebui să aibă acelaşi semn cu υ_0^', cel puţin pentru valori mici ale lui t.
Integrând, ca mai sus, ecuaţiile (4.2.), (4.4.) în raport cu timpul, vom obţine ecuaţiile (4.21.) din
care vom deduce pentru υ’ expresia:
49
Studiul privind proiectarea unui robot mobil cu senile
în locul relaţiei (4.23.). Notaţiile sunt acelea din (4.24.), iar dublul semn legat în acelaşi fel de
dublul semn din expresia lui Ф din (4.21.).
¿ (4.27)
Cazul I. În acest caz vom utiliza prima formulă din (4.27.). Deci, dacă mărimea – M’ + M1 – M2
nu este negativă, adică dacă M’ îndeplineşte condiţia M’ ≤ M1 – M2, atunci υ’ rămâne tot timpul
pozitiv. Dacă însă mărimea – M’ + M1 – M2 este negativă adică dacă avem M’ > M1 – M2.
Regăsim cazul studiat în paragraful precedent, luând drept moment iniţial, momentul t = t2. În
consecinţă, dacă M’ îndeplineşte condiţiile (4.26.) şi (4.28.), adică dacă M’ nu depăşeşte valoarea
M1 + M2 şi nu este mai mic decât valoarea – RFx, vom avea pentru t > t2 o rostogolire pură tot
timpul; dacă însă M’ nu depăşeşte valoarea M1 + M2 însă este mai decât – RFx, atunci
rostogolirea durează până în momentul t2 + t1 dat de relaţiile (4.28.) şi (4.18.), când discul se
opreşte υ = ω = 0 pentru ca apoi să ia o rotaţie negativă, deoarece expresia M’ + RFx este
negativă.
Dacă M’ nu îndeplineşte condiţia (4.26.), adică dacă avem M’ > M1 + M2, atunci după cum am
văzut la începutul acestui paragraf, pentru t > t2 vom avea o alunecare cu viteza υ’ negativă tot
timpul, însoţită de o rostogolire.
Cazul II. Cazul υ_0^'<0. În acest caz ne vom folosi de cea de-a doua formulă din (4.28.). Deci
dacă mărimea – M’ + M1 – M2 nu este pozitivă, adică dacă M’ îndeplineşte condiţia M’ ≤ M1 +
M2 atunci υ’ va rămâne tot timpul negativ. Dacă însă mărimea – M’ + M1 + M2 este pozitivă,
adică dacă avem M’ < M1 + M2, atunci υ’ se va anula la momentul t_2^' dat de expresia:
' −J υ 0
t 2= '
R (−M + M 1 + M 2)
(4.29)
când vom cădea din nou peste cazul studiat mai înainte. Discuţia este similară aceleia făcute la
cazul I 〖(υ〗_0^'>0).
Toată această discuţie, poate fi rezumată în următoarea tabelă, ordonată după valorile pe care le-
ar putea avea M’, M_1- M_2 ≤M^'≤ M_1+ M_2 la început (r) + (a), apoi (r):
}
'
M > M 1 + M 2 ( r )+(a)
M ' < M 1−M 2
50
Studiul privind proiectarea unui robot mobil cu senile
Am notat cu (r) rostogolirea pură (fără alunecare), cu (r) + (a) rostogolire cu alunecare.
Observaţie. În cazul în care M’ este cuprins în intervalul [M1 – M2, M1 + M2] şi υ_0^'≠0 am
văzut că la momentul t = t2 sau t = t_2^' (după cum υ_0^' este pozitiv sau negativ) viteza de
alunecare υ’ se anulează şi forţa de frecare Ф încetează de a mai avea valoarea ± μN, ci a lua
valoarea dată de (4.24.). Avem astfel în general o discontinuitate în valoarea lui Ф, ceea ce va
repercuta printr-o discontinuitate în valorile derivatelor (υ ) ̇şi ω ̇ date de ecuaţiile generale de
mişcare (4.2.) şi (4.4.); valorile lui υ şi ω rămân însă continue.
Modelarea sistemului mecanic articulat al unui robot industrial este o etapă de maximă
importanţă pe parcursul procesului care porneşte de la concepţia robotului şi se finalizează cu
implementarea sa industrială. Scopul acestei etape este acela de a furniza o serie de modele
reprezentată prin ecuaţii matematice, care să caracterizeze fie din punct de vedere al poziţiilor
(modelul geometric), fie al vitezelor (modelul cinematic), fie al forţelor care îl solicită (modelul
dinamic), robotul studiat.
Deoarece sistemul de comandă al robotului prelucrează datele sub formă numerică, este necesar
să se facă o asociere între poziţiile în spaţiu şi deplasările corpurilor solide din care este alcătuit
robotul şi anume valori numerice. Dacă se consideră un corp solid, nedeformabil, liber în spaţiu,
acestuia i se poate asocia un sistem de referinţă ortogonal Rj cu originea în punctul Oj, de versori
xj, yj, zj. Problema care se pune este aceea de a defini sistemul de referinţă Rj în raport cu un alt
sistem de referinţă ortogonal Rj, cu originea Oi şi de versori xi, yi, zi denumit şi sistem de
referinţă de bază. Pentru aceasta se definesc două categorii de parametrii, care, în robotică sunt
numiţi şi coordonate operaţionale şi anume:
- trei parametrii care definesc poziţia originii Oj în raport cu originea sistemului de referinţă de
bază, denumiţi parametri sau coordonate de poziţii;
- trei parametri care definesc orientarea axelor sistemului de referinţă Rj în raport cu axele
sistemului de bază, denumiţi şi coordonate de orientare. Parametrii de poziţie nu sunt altceva
decât coordonatele originii Oj exprimate în sistemul de referinţă de bază şi în funcţie de structura
51
Studiul privind proiectarea unui robot mobil cu senile
mecanică. Aceştia pot fii coordonate carteziene (X, Y, Z) cilindrice (R, a, J) sau sferice ( a, p, R ),
fig. 2.5. a, b, c.
Aceşti parametrii de poziţie permit definirea vectorului de poziţie OiOj şi a uneimatrici coloană
Py denumită şi matrice de poziţie a sistemului de referinţă în raport cu Rj, care au următoarele
expresii:
O i O j= X ∙ ⃗
x i+ Y ∙ ⃗
y i +Z ∙ ⃗
zi
[]
X
P y= Y
Z
(4.30)
Orientarea axelor sistemului de referinţă Rj în raport cu cele ale sistemului de bază poate fi
definită cu ajutorul mai multor categorii de parametrii dintre care cei mai utilizaţi sunt:
- cosinusurile directoare, care permit exprimarea versorilor axelor Xj, Yj, Zj în raport cu versorii
axelor sistemului de bază XjYjZj cu ajutorul relaţiilor următoare, sub formă vectorială şi
matriceală, fig. 4.3.
52
Studiul privind proiectarea unui robot mobil cu senile
• O primă rotaţie de unghi Ψ în jurul axei Zj, în urma căreia se obţine un nou sistem de referinţă
Ri (Rot Ψ, Zi); a doua rotaţie de unghi θ în jurul axei X, care conduce la obţinerea unui nou
sistem de referinţă R2 (Rot θ, X);
• A treia rotaţie de unghi θ în jurul axei Z2 în urma căreia se obţine sistemul de referinţă Rj căutat
(Rot θ, Z2).
- unghiurile lui Bryant, mai puţin utilizate decât unghiurile Euler permit definirea orientării
axelor sistemului de referinţă Rj pornind de la cele ale lui Ri cu ajutorul a trei rotaţii succesive
exprimate simplificat astfel:
( X n , Y n , Z n ) → ( X p ,Y p , Z p ) → ( X 2 , Y 2 , Z 2 ) → ( X j ,Y j , Z j ) (4.31)
[ ]
ax bx cx X
a by cy Y
T y= y
az bz cz Z
A Py
= y
0 1 [ ] (4.32)
0 0 0 1
Inversa matricei de trecere omogenă între două sisteme de referinţă RIJ defineşte transformarea
inversă între cele 2 sisteme de referinţă.
Dacă se consideră un corp solid liber în spaţiu, atunci orice deplasare a sa va fi definită prin
deplasarea sistemului de referinţă asociat acestuia. Această deplasare, este reprezentată prin
matricea omogenă de trecere, care defineşte noua poziţie atinsă de sistemul de referinţă în raport
cu cea iniţială.
53
Studiul privind proiectarea unui robot mobil cu senile
- deplasare nulă – cele două sisteme de referinţă fiind confundate, matricea omogenă de trecere
va fi matricea unitate:
[ ]
1 0 0 0
0 1 0 0
T 12= (4.33)
0 0 1 0
0 0 0 1
- translaţie pură de valoare d după una din axele sistemului de referinţă iniţial:
[ ]
1 0 0 0
0 1 0 0
T 12=Trans( X 1 , d)= (4.34)
0 0 1 0
0 0 0 1
54
Studiul privind proiectarea unui robot mobil cu senile
- rotaţie pură de unghi α în jurul unei axe a sistemului de referinţă iniţial, fig. 4.6
[ ]
cos α −sin α 0 0
sin α cos α 0 0
T 12=Rot (Z , α )= . (4.35)
0 0 1 0
0 0 0 1
55
Studiul privind proiectarea unui robot mobil cu senile
[ ]
1 0 0 d
0 cos α −sin α 0
T 12=Trans ( X 1 , d )−Rot (X , α )= (4.36)
0 sin α cos α 0
0 0 0 1
[ ]
1 0 0 a
0 1 0 b
T 12=Trans(U , d)= (4.37)
0 0 1 c
0 0 0 1
56
Studiul privind proiectarea unui robot mobil cu senile
Modelul geometric al unui robot industrial este un sistem de ecuaţii matematice care permit
exprimarea coordonatelor operaţionale Xi în funcţie de cele articulare Oj, exprimate prin ecuaţia:
X = F(θ) (4.39)
unde X şi θ sunt doi vectori ale căror componente sunt coordonatele operaţionale şi respectiv
articulare:
T
θ=[ θ1 ,θ 2 , … , θn ] (4.40)
Pentru a determina modelul geometric direct este necesar să se precizeze poziţia şi orientarea
sistemului de referinţă al organului terminal în raport cu sistemul de bază. Pentru aceasta există
mai multe metode dintre care cele mai utilizate:
57
Studiul privind proiectarea unui robot mobil cu senile
Modelul geometric invers este prezentat prin sistemul de ecuaţii literale care explică coordonatele
articulare în funcţie de cele operaţionale, aceasta permite găsirea configuraţiei articulare a
robotului, care plasează organul terminal la o anumită situaţie spaţială dorită, caracterizată prin
coordonatele operaţionale. Există mai multe metode de găsire a modelului geometric invers, şi
anume:
Principala problema care apare în timpul calculului modelului geometric invers este aceea a
interpretării soluţiei pentru coordonatele articulare, în vederea obţinerii unei soluţii unice, care
este influenţată de mai mulţi factori, unul dintre aceştia fiind soluţia aleasă de constructori pentru
realizarea fizică a cuplelor cinematice conducătoare. Astfel, dacă teoretic orice cuplă cinematică
de rotaţie permite efectuarea unei rotaţii de 360 de grade, în practică, datorită unei constrângeri
impusă de constructia mecanică a robotului, această valoare este realizabilă doar pentru prima
articulaţie, în timp ce pentru celelalte are valori mult mai mici.
Un alt factor de care trebuie să se ţină cont este volumul de lucru teoretic accesibil robotului.
Dacă punctul de origine M al sistemului de referinţă ataşat organului terminal este situat în afara
acestuia, atunci el nu poate fi atins şi modelul geometric direct nu poate fi inversat, deci nu avem
o soluţie realizabilă fizic pentru modelul geometric invers.
Se adoptă roţile dinţate Z1, Z2, Z3, Z4, Z5, Z6, Z7, Z8 cu caracteristici geometrice identice astfel
încât să angreneze corect.Numărul de dinţi pentru fiecare din cele 8 roţi este prezentat în tabelul
4.1.
Tabel 4.1
Z1 Z2 Z3 Z4 Z5 Z6 Z7 Z8
58
Studiul privind proiectarea unui robot mobil cu senile
10 62 10 50 10 35 11 33
Rapoartele de transmitere pe cele patru grupe de roţi dinţate, sunt date de relaţiile:
Z 1 10 1
i r 1= = ≅ (4.41)
Z 2 62 6
Z 3 10 1
i r 2= = ≅ (4.42)
Z 4 50 5
Z5 10 1
i r 3= = ≅ (4.43)
Z6 35 3 , 5
Z 7 11 1
ir 4 = = ≅ (4.44)
Z 8 33 3
1 1 1 1 1
i r =i r 1 ∙i r 2 ∙i r 3 ∙i r 4= ∙ ∙ ∙ ≅ (4.45)
i
6 5 3 , 5 3 315
Datorită spectrului larg de aplicaţii în care se poate utiliza acest tip de platformă mobilă (atât
aplicaţii industriale, cât şi non industriale), trebuie ţinut cont de faptul că servomotoarele trebuie
să dezvolte un moment de torsiune suficient de mare pentru a învinge forţele rezistente datorată
unor suprafeţe neregulate cum ar fi: denivelări, obiecte de mici dimensiuni care se pot interpune
pe traiectoria de deplasare şi care nu sunt detectate de sistemul senzorial, rampe cu un anumit
unghi de înclinaţie.Se consideră faptul că platforma mobilă se deplasează pe un plan înclinat cu
un unghi α = 20°.
59
Studiul privind proiectarea unui robot mobil cu senile
In triunghiul FaOG:
Fa
cosα= =¿ Fa=G ⋅cosα (4.46)
G
G = 1.2[KgF] = 1.2[daN]
0 (4.47)
cos 20 =0.951
D 52
=1.14 ∙ =0.032 [ daN ∙ m ]
'
M Fa=Fa ∙ (4.48)
2 2
d = 6[mm]
d
Mf =Ff ∙ (4.49)
2
G
Ff = ⋅μ (4.50)
2
G d Gdμ
Mf = ⋅μ ∙ = (4.51)
2 2 4
1.2 ⋅6 ⋅0.2
Mf = =0.0014 [daN ⋅m] (4.52)
4
'
Mfa=M Fa+ Mf (4.53)
Inlocuind se obține:
Cunoscând momentul forţei axiale MFA şi raportul de transmitere ir, se poate determina
momentul motorului:
1
M m=M FA ∙ i r=0,033∙ =0,0001 [ daN ∙ m ] =0 , 01 [ kg ∙ cm ] (4.55)
315
Pentru ca motorul să poată acţiona mecanismul din fig. 3.4, se impune ca puterea motorului să fie
mai mare decât puterea necesară pentru a pune în mişcare platforma adică:
G
M frost =μ ∙ =0 ,2 ∙ 0 , 4=0 , 08 [ daN ] (4.57)
3
D = 52 [mm]
Cunoscând diametrul roţii motoare se poate determina lungimea cercului descris de aceasta:
L = 2πR = πD (4.61)
61
Studiul privind proiectarea unui robot mobil cu senile
CAPITOLUL 5
Sistemul de control
Circuitul TSOP1740 are integrat mai multe blocuri cu diferite puncte: recepţie IR, amplificarea,
filtrare, demobilare (fig. 5.1)
62
Studiul privind proiectarea unui robot mobil cu senile
Capsula acestui circuit prezintă trei terminale, alimentare (Vs), ieşire (out) si masa (GND).
Conectarea la microcontroler se face pe un singur fir, celelalte terminale fiind cuplate la sursa de
alimentare şi la masă, corespunzător fig. 5.2
Acestui tip de conexiune ii corespunde modul de comunicaţie serial, deoarece şi semnalul preluat
de receptorul de infraroşu este serial. Caracteristicile semnalului de intrare şi al celui de ieşire
sunt prezentate în fig. 5.3
Interfaţa de emisie pe infraroşu este realizată cu ajutorul a două Led-uri specializată pentru
emisia în domeniul de undă infraroşu, fig. 5.4. Protocolul RC5 este format dintr-un şir de 14 biţi
(tabelul 5.1.). Fiecare cod transmis este format din 5 biţi pe adresă (sau sistem) şi 6 biţi de
comandă.Se permite astfel controlul a 32 sisteme (cum ar fi TV, CD, Video etc) şi 64 de comenzi
pe sistem.
64
Studiul privind proiectarea unui robot mobil cu senile
Tabel 5.1
S1 S2 T A4 A3 A2 A1 A0 C5 C4 C3 C2 C1 C0
Pentru a completa stadardul RC5 în sensul modificării numărului de comenzi la 128 per
dispozitiv în ultima perioadă de timp s-a mai adăugat încă un bit la biţii de comandă. Noul cod
trebuia să fie compatibil cu cel vechi RC5 astfel că nr de biţi a fost păstrat (14 biţi), iar bitul S2 a
fost înlocuit cu C6. Rezultatul acestei modificări poartă numele de protocol RC5 estins. Bitul T se
schimbă ori decâte ori se transmite o nouă comandă. Funcpa primară a acestui bit este de a
detecta o apăsare succesivă a celeaşi taste deoarece codul este transmis atâta timp cât tasta de pe
telecomandă este apăsată. O eliberare scurtă a tastei ar trece altfel neobservat.
Duty cycle-ul (timpul cât semnalul este pe 1 logic) semnalului modular este de 25%. Există
dispozitive integrate cu funcţii hard, ca PCA8521 care au acel Duty cycle programabil între 25 –
33%.Dacă calculăm media timpului de funcţionare (Duty cycle) pentru Ledu-ul IR obţinem: 25%
x 50% x 14/64 = 2,7%
Valoarea de 50% este duty cycle-ul specific modulaţiei Manchester. Raportul 14/64 reprezintă
numărul de biţi per perioadă completă de repetare. Astfel dacă avem un curent maxim de lOOmA
pe led va rezulta un curent mediu consumat în timpul transmisiei de 2,7 mA.
Modulaţia se realizează din modul software prin programarea timer-ului 1 de 16 biţi, să genereze
un semnal dreptunghiular cu factor de umplere de 25%. Ledul de IR este conectat la ieşirea CCP1
a microcontroler-ului, adică la pinul port B3 şi la ieşirea INT respectiv port BO.
65
Studiul privind proiectarea unui robot mobil cu senile
Folosirea unii senzor analogic de acest tip este posibilă fără un convertor analog–digital datorită
folosirii unui software inteligent. Principiul de funcţionare este următorul: când platforma se
deplaseză pe traiectoria impusă, (linie), semnalele luminoase emise de led-uri sunt reflectate şi
captate de către detectorii de IR a căror rezistenţă electrică este mare în lipsa luminii, şi scade în
funcţie de cantitatea de lumină recepţionată. Acest semanl electric este transmis unui CI
comparator. Acesta în lipsa informaţiilor de la senzori afişează la ieşire un semnal logic 1. În
momentul în care rezistenţa fotodetectorului scade (este luminat), tensiunea pe intrarea inversoare
a comparatorului creşte, fapt ce determină scăderea tensiunii pe ieşirea acestuia, care devine 0
logic. Această modificare a tensiunii este sesizată de către microcontroler, acesta luând decizia de
comandă a servomotoarelor, în conformitate cu un algoritm stabilit prin software.
66
Studiul privind proiectarea unui robot mobil cu senile
Conform celor prezentate mai sus, dacă este semnalată prezenţa unui obiect pe partea stângă în
sensul de deplasare, atunci microcontroler-ul va comanda servomotorul din partea dreaptă să se
rotească în sens invers pentru câteva milisecunde, fapt ce va determina deplasarea platformei
mobile către dreapta; această acţiune ca continua până când acel obiect care a cauzat această
modificare nu se mai află în raza vizuală a receptorului.
Microcontrolerele PIC au fost dezvoltate de firma americană Microchip, la începutul anilor 90.
Faptul remarcabil pentru care a putut cuceri un important segment din piaţa de microcontrolere a
fost modalitatea simpla de scriere a programului(serială, necesită doar trei fire), memoria
program conţinută în aceeaşi capsulă, noua tehnologie CMOS de realizare (deci consum redus) şi
preţul relativ scăzut.
"OTP" (One Time Programable), cele programabile o singură dată. Funcţional şi tehnologic sunt
identice cu cele "windowed", doar că nu au prevăzută fereastra de cuarţ, deci programul odată
scris nu mai poate fi şters. Deci o aplicaţie gata dezvoltată şi încercată cu o versiune "windowed",
poate fi multiplicată pentru producţie de serie în capsule "OTP" care sunt de câteva ori mai
ieftine. Aceste două versiuni,Windowed şi OTP sunt realizate în tehnologie CMOS EPROM.
67
Studiul privind proiectarea unui robot mobil cu senile
Mai nou ca o mediere între versiunile "windowed" şi "OTP" a apărut o nouă versiune numită
"Flash" bazată pe tehnologie CMOS EEPROM. Aceste chip-uri nu au fereastră dar pot fi totuşi
şterse şi reprogramate de mai multe ori. Sunt folosite atât la dezvoltarea de aplicaţii cât şi la
produse de serie. Ele sunt marcate cu un "F" pe capsula (ex. 16F628-04/P).
PIC18F14K50 are un număr total de 20 de pini. Este un controler de servo extrem de versatil şi
de uz general I/O într-o placă extrem de compactă (0,85" x 1,20") pachet. Aceasta susţine trei
metode de control: USB pentru conectare directă la un computer, serial TTL pentru utilizare cu
sisteme integrate, şi scriere internă independentă, controler-ul gazdă – aplicaţii libere. Canalele
pot fi configurate ca ieşiri de servo pentru utilizare cu control radio (RC), servo sau cu comenzi
electronice de viteză (CES), ca ieşiri digitale, sau ca intrări analogice. Extrem de precise, de
68
Studiul privind proiectarea unui robot mobil cu senile
înaltă rezoluţie impulsurile servo au un bruiaj mai mic de 200 ns, făcând ca aceste servo
controlere potrivite pentru aplicaţii de înaltă performanţă, cum ar fi robotica şi mecatronica, şi-a
construit în viteză şi acceleraţie de control pentru fiecare canal, ce face mai uşor de realizat o
mişcare lină, fără sudură, fără a fi necesară sursă de control pentru a calcula în mod constant
fluxul de actualizări intermediare.
RA4 - al patrulea pin la portul A. TOCK1 care funcţionează ca timer se găseşte de asemenea la
acest pin;
Unitatea de procesare centrală (CPU) este creierul microcontrolerului. Această parte este
responsabilă cu găsirea şi aducerea citirea din memorie a instrucţiuni corecte ce trebuie executată,
cu decodarea acelei instrucţiuni, şi în final cu executarea ei.
Portul se referă la un grup de pini a unui microcontroler ce pot fi accesaţi simultan. Fizic portul
este un registru în interiorul unui microcontroler ce este conectat cu la pinii microcontrolerului.
Toţi pinii portului pot fi definiţi ca intrare sau ieşire, conform cu nevoile unui montaj ce este în
dezvoltare.
70
Studiul privind proiectarea unui robot mobil cu senile
Memoria de date constă din memoriile EEPROM şi RAM. Memoria EEPROM constă in 64
locaţii de 8 biţi a căror conţinut nu este pierdut în timpul opririi sursei de alimentare.
Regiştrii SFR sunt regiştrii ai funcţiilor specializate ce au legatură cu unele blocuri ale
microcontrolerului.
Contorul de program (PC) este un registru de 13 biţi ce conţine adresa instrucţiunii ce se execută.
5.6. Servomotoare
71
Studiul privind proiectarea unui robot mobil cu senile
Sunt utilizate în sisteme flexibile care nu necesită momente de torsiune şi sarcini de încărcare
mari, dar în care se cere o înaltă precizie şi viteză de execuţie a sarcinii, consum scăzut de energie
fiind flexibile, eficiente, având un preţ relativ scăzut.
Sunt prevăzute cu 3 fire de alimentare: 2 constituie alimentarea cu tensiune de ± 4,8 V, iar cel de
al treilea fir reprezintă firul de comandă. Pe aceste din urmă se transmite impulsul de tensiune cu
o anumită perioadă. Pentru a funcţiona servomotorul aşteaptă un impuls la fiecare 20 ms.
Lungimea acestui impuls va determina viteza şi sensul de rotaţie a rotorului. De exemplu, la un
impuls de tensiune cu durată de 1,5 ms, rotorul va executa o rotaţie cu 90 de grade. Dacă acest
impuls are o durată mai mica de 1,5 ms atuncu unghiul de rotaţie va fi mai mic de 90 de grade, iar
dacă acesta este mai mare decât valoarea menţionată anterior, atunci unghiul de rotaţie se va
apropia de valoarea de 180 de grade.
Capitolul 6
72
Studiul privind proiectarea unui robot mobil cu senile
Pentru deplasarea înainte vom acţiona ambele servomotoare spre direcţia înainte cu o viteză
unghiulară egală.
Pentru deplasarea înainte şi virajul la stânga în timp ce motoarele sunt acţionate înainte cu viteze
unghiulare egale, la fel ca la virajul la dreapta, vom reduce, opri şi chiar schimba sensul
motorului, de data aceasta din partea stângă.Sau mărim viteza motorului din dreapta.
73
Studiul privind proiectarea unui robot mobil cu senile
6.2. Întoarcere
- pentru întoarcerea dreapta spate, se opreşte motorul din dreapta, lăsându-l pe cel din stânga să
învârtă roata stângă înapoi până la întoarcerea cu 180°.
- pentru întoarcerea stânga spate, se opreşte motorul din stânga acţionându-l pe cel din dreapta
înapoi până la întoarcerea cu 180°.
- pentru întoarcerea dreapta spate fără oprirea vreunui servomotor, se reduce viteza unghiulară a
servomotorului de pe partea dreaptă, se menţine sau eventual se măreşte viteza unghiulară a
servomotorului de pe partea stângă înapoi până ce robotul se întoarce cu 180°.
- pentru întoarcerea stânga spate fără oprirea vreunui servomotor, se reduce viteza unghiulară a
servomotorului de pe partea stângă, se menţine sau eventual se măreşte viteza unghiulară a
servomotorului din partea dreaptă înapoi, şi se menţine eventual, până ce acesta se configurează
cu 180° faţă de ultima lui poziţie.
Capitolul 7
textual, având înglobate multe funcţii specifice microcontrolerelor, pentru comanda diverselor
tipuri de device, cum ar fi:
- servomotoare;
- display-uri LCD;
Fişierul sursă rezultat este prelucrat cu ajutorul compilatorului intern, rezultatul fiind un fişier de
tip hexazecimal. Acest fişier este înscris în microcontroler cu ajutorul unui programator de port
serial şi al unui utilitar pentru OS Win9x - Icprog.
#urmarire linie
begin
# 200 delay
#200 delay
drop
stangaL
# 200 delay
repeat
sub dreaptaL
SD_Alb_Less # Apel Functie achizitie valoare senzor si comparare cu valoare prag senzor
dreapta
75
Studiul privind proiectarea unui robot mobil cu senile
if
#mers inainte
8000 0 servo
4000 1 servo
#delay
else
#curba la stanga
4000 0 servo
4000 1 servo
#delay
endif
sub stangaL
SS_Alb_Less # Apel Functie achizitie valoare senzor si comparare cu valoare prag senzor
stanga
if
8000 0 servo
4000 1 servo
76
Studiul privind proiectarea unui robot mobil cu senile
#delay
else
#curba la dreapta
8000 0 servo
8000 1 servo
endif
# return
sub SD_ Alb _Less # detectia benzii albe, senzorul din dreapta
return
sub SS_ Alb _Less # pe alb, senzorul din stanga,achizitie valoare senzor si comparare cu valoare prag
senzor stanga,
return
77