Documente Academic
Documente Profesional
Documente Cultură
tefan Dumbrav
Editura POLITEHNIUM
2009
tefan Dumbrav
Editura POLITEHNIUM
2009
Prefa
Domeniul Roboticii este unul cu o evoluie deosebit, care a marcat creteri
ale ateniei acordate de cercettori i respectiv perioade n care domeniul a prut s
nu mai progreseze; n prezent aria de interes a Roboticii este n expansiune,
aprnd noi zone de aplicare i fiind necesar rezolvarea de noi probleme.
Considerat ca o disciplin a ingineriei de mai bine de 50 de ani, Robotica a
continuat s lanseze provocri i s determine rezultate deosebite att din punct de
vedere teoretic ct i aplicativ. Dei exist o literatur consistent n domeniul
Roboticii, mai ales n privina sistemelor de control sunt nc n studiu arhitecturi
de control care s determine o autonomie mai mare a roboilor, performane mai
bune privind viteza de lucru i precizia de operare, sau simplificarea prii de
programare.
O caracteristic sporind dificultatea domeniului Roboticii este dat de
caracterul interdisciplinar al acesteia. n acest context, lucrarea de fa a adunat o
parte din materialul susinut de autori n cadrul disciplinelor Sisteme de control al
roboilor i Robotic, pentru studenii specializrii de Automatic i Informatic
Aplicat din cadrul Facultii de Automatic i Calculatoare. Legtura domeniului
Roboticii cu cel al Automaticii i respectiv Informaticii Aplicate este evident. Un
robot este un sistem complex, multivariabil, neliniar, a crui arhitectur de control
presupune rezolvarea unor probleme complexe. De asemenea, n ceea ce privete
programarea, este necesar stpnirea unor metode i instrumente ale informaticii
clasice, iar mai recent din Inteligena Artificial, pentru a putea obine un program
eficient al unui robot, acesta necesitnd ntotdeauna i rezolvarea unei probleme de
programare. Dificultatea pe care autorii au ntlnit-o frecvent a fost aceea a
transmiterii pentru inginerii care urmeaz s lucreze cu sistemele de control i
programare ale unui robot a cunotinelor necesare, relevante din punct de vedere
al teoriei controlului, privind structura mecanic a roboilor, atunci cnd pregtirea
respectivilor studeni este mai restrns n domeniul Mecanicii. Materialul
prezentat n acest volum poate fi considerat o ncercare pentru depirea acestei
dificulti.
Astfel, cele dou pri ale lucrrii vizeaz formarea unei imagini corecte n
legtur cu ceea ce nseamn dependena dintre partea mecanic i subsistemele de
control i programare ale unui robot. Prima parte are drept scop introducerea
noiunilor fundamentale folosite n domeniul Roboticii; cunoaterea
IV
Cuprins
Prefa
Cuprins
III
V
I. Domeniul Roboticii
1.1. Definiia robotului i a robotului industrial
1.2. Definiia Roboticii
1.3. Istoricul Roboticii
1.4. Clasificarea roboilor
1.5. Caracteristici ale roboilor; criterii de selecie
1.6. Noiunea de sistem robotic
1.7. Domenii de aplicare a roboilor
1.8. Concluzii Probleme propuse
1
1
3
7
10
23
28
32
34
37
37
41
43
51
54
66
71
78
81
83
88
99
120
Bibliografie
Index
124
126
Domeniul Roboticii
realizrii unor sarcini variate [Mur, 00], [Fu, 87]. Cuprinznd elementele generale
de caracterizare a roboilor, accentul este pus n acest caz pe proprietatea de
mobilitate un robot folosit n industrie trebuie s poat efectua o secven de
micri prin care rezolv o sarcin tehnologic: deplaseaz obiecte, realizeaz o
operaie de vopsire, sudur, etc.
Robotul, prin flexibilitatea n utilizare dat printre altele de programabilitatea
sa, poate fi asemnat cu un calculator. La fel ca i acesta, robotul nu trebuie s fie
privit de utilizator ca un echipament destinat rezolvrii unei sarcini unice;
dimpotriv, prin reprogramare, robotul va fi capabil s ndeplineasc o gam
ntreag de sarcini. Dac exist aceast asemnare, trebuie remarcat i deosebirea
esenial dintre un robot i un calculator. Aceasta se refer la ieirile (rezultatele)
diferite pentru cele dou sisteme. Pentru un robot rezultatul este sub forma
micrilor pe care le execut, n timp ce pentru un calculator rezultatele sunt
informaiile comunicate utilizatorului ntr-o form sau alta (afiare pe terminal, date
nscrise n fiiere, etc). Altfel spus, un robot conine un calculator care i confer
caracteristica de programabilitate, dar acesta este cuplat cu un sistem mecanic, care
trebuie s asigure i el flexibilitate n utilizarea robotului, permind materializarea
a diferite micri, aciuni, conform programului rulat pe calculatorul robotului. De
aici i specificul n utilizare, n aceea c trebuie neles att calculatorul (sistemul de
control) care asigur programabilitatea i comanda prii mecanice, dar i sistemul
mecanic al robotului, cel care implementeaz aciunile acestuia. Astfel rezult
complexitatea sporit a unui robot fa de un calculator primul poate interaciona
cu mediul nconjurtor, producnd schimbri n acesta, ceea ce la un calculator nu
se ntmpl.
Cuplarea calculator - parte mecanic asigurnd micarea a fost considerat de
la primele variante de roboi industriali. Astfel Joseph Engelberger, unul dintre
ntemeietorii firmei Unimation, prima companie productoare de roboi industriali,
a definit robotul industrial ca o component de automatizare evoluat, ce combin o
parte electronic de tip calculator cu sisteme avansate de acionare mecanic,
obinndu-se un echipament independent de mare flexibilitate [Eng, 80]. Totodat
el scoate n eviden caracteristicile roboilor industriali ai anilor 1970, aspecte care
se pstreaz n mare parte i astzi, dndu-ne o imagine asupra unui asemenea
echipament. Conform viziunii sale un robot industrial trebuie s posede:
o mn care poate apuca sau elibera diferite piese;
un bra care poate mica mna dup cele trei direcii spaiale;
mna posed una sau mai multe articulaii determinnd trei posibiliti
de micare (acestea fiind necesare pentru realizarea orientrii);
2
Domeniul Roboticii
logic elegant, sub forma unui sistem de reguli care se pot apela recursiv, stabilind
modul n care robotul va interpreta comenzile primite:
un robot prin aciune sau inaciune nu trebuie s aduc prejudicii unei
fiine umane;
un robot trebuie s respecte comenzile omului, cu excepia celor care
contravin primei legi;
un robot trebuie s se autoprotejeze, atta timp ct aceast aciune nu
vine n conflict cu primele dou legi.
Robotica este n prezent o ramur a tiinelor tehnice, avnd ca obiect de
studiu automatizarea operaiilor umanoide [Pal, 89], [Kov, 82]. n corelaie cu
definiia general dat n paragraful anterior, robotica se ocup cu studiul roboilor,
prin operaii umanoide avndu-se n vedere activitile fizice i intelectuale,
realizate n general de om. Mai specific, robotica a urmrit n primul rnd
automatizarea operaiilor efectuate cu ajutorul braelor, minilor, picioarelor,
implicnd corelaia cu sistemul senzorial (n primul rnd vederea), i procesele de
raionament pentru luarea deciziilor de aciune. Odat cu rspndirea,
perfecionarea roboilor i trecerea de la aplicarea lor industrial la folosirea i n
alte domenii (aplicaii spaiale, medicale, casnice) s-a produs lrgirea gamei
operaiilor umanoide studiate i automatizate de robotic. Dac la primii roboi
industriali eseniale erau micrile de manipulare efectuate ntr-o zon relativ
restrns, ntr-o secven repetitiv cu puine interaciuni senzoriale, la roboii
actuali, chiar n aplicaiile industriale, apar schimburi informaionale importante, pe
baza crora sistemul de control al robotului decide secvena de aciuni potrivit
ndeplinirii unui scop fixat de utilizator.
Avnd n vedere complexitatea unui robot, care cuprinde subsisteme
mecanice, de control, senzoriale, de transfer de informaii, de programare, robotica
a aprut i s-a dezvoltat ca o tiin interdisciplinar. n fig. 1.1 sunt prezentate
domeniile aflate n conexiunile cu ea; acestea au influenat dezvoltarea Roboticii,
iar cunotine din domeniile respective sunt necesare n nelegerea ei. Coninutul
Roboticii poate fi apreciat din enumerarea capitolelor acesteia.
1. Modelarea
geometric/cinematic
studiaz
aspectele
geometrice/cinematice ale micrii diferitelor segmente ale robotului n raport cu
un sistem de referin de baz, fr a ine seama de forele sau momentele ce
produc micarea. Modelul cinematic poate ajuta la nelegerea sarcinilor pe care le
poate rezolva un robot prin determinarea zonei de lucru pe care acesta o poate
4
Mecanic
Arhitecturi de
calcul
Automatic
Programare
Robotic
Electronic
Electrotehnic
Inteligen
artificial
Sisteme de fabricaie
asistat de calculator
Domeniul Roboticii
numii staionari (cei care au o baz fix), i respectiv roboii mobili, adic aceia
care se deplaseaz folosind un vehicul sau un sistem de locomoie. n acest al
doilea caz problema este mai complicat, presupunnd un model al mediului i
informaii senzoriale care s permit corectarea traiectoriei n cazul unui mediu
variabil, dei pentru medii structurate exist i soluii simple, obinute de exemplu
pe baza unor ci de ghidare fixe.
4. Sistemul senzorial al roboilor este capitolul n care se studiaz
dispozitivele prin care s se capteze informaii att n legtur cu mediul robotului
ct i cu privire la starea robotului. Apare astfel o mprire a acestui capitol i
respectiv a senzorilor folosii n robotic n dou categorii: senzori externi i
interni. Primii sunt cei prin care robotul determin informaii cu privire la mediul
n care acioneaz, aici incluzndu-se senzorii de contact sau de proximitate prin
care roboii industriali actuali detecteaz poziia n care elementul terminal a ajuns
n apropierea obiectului de manipulat, sau sistemele senzoriale mai sofisticate,
mergnd de la senzori cu ultrasunete, cu laser i pn la camere video, care
echipeaz roboii mobili lucrnd n medii parial sau total necunoscute, n scopul
determinrii obstacolelor. Senzorii interni sunt cei care capteaz informaii despre
starea robotului, aici incluzndu-se cei care dau poziiile i vitezele articulaiilor.
Chiar dac senzorii folosii pe roboi pot fi adesea de uz general, astfel c pot fi
regsii i pe alte echipamente, includerea acestui capitol n domeniul roboticii este
necesar, deoarece n construcia i utilizarea unui robot care trebuie s fie
adaptabil la schimbrile din mediu sistemul senzorial este strict necesar; n plus,
folosirea senzorilor n robotic ridic i probleme specifice roboii sunt echipamente
n micare i cu grad sporit de autonomie, la care sistemul senzorial trebuie s asigure
informaiile necesare la toate nivelele sistemului de comand al robotului.
5. Controlul roboilor este capitolul care studiaz structura i funcionarea
sistemului de comand al roboilor, fiind implicate elemente din toate celelalte
capitole. Pe baza modelului cinematic i dinamic, a sarcinii de ndeplinit convertit
n traiectoria de urmat se stabilesc comenzile necesare spre elementele de acionare
i elementele hardware i software care s furnizeze aceste comenzi, folosind i
semnalele de reacie obinute de la sistemul senzorial. Rezult astfel complexitatea
sistemului de control al unui robot. Acesta va avea frecvent o organizare ierarhic,
n care pe nivelul superior se afl partea de decizie cu privire la aciunea de
ntreprins (la roboii industriali actuali pe acest nivel se efectueaz teste simple, de
exemplu cele cuprinse n instruciuni de tip if then), iar pe nivelul inferior
elementele de control i acionare ale articulaiilor. Dac funcia de decizie este
adesea simplificat, controlul unei micri va presupune trecerea prin cele dou
faze menionate anterior: planificarea traiectoriei i stabilirea comenzilor spre
6
Domeniul Roboticii
un servitor al omului. Lucrarea scriitorului ceh a influenat viziunea asupra
roboilor acetia trebuiau s fie nite maini avnd o nfiare apropiat de aceea
a omului, care s-l nlocuiasc pe acesta n activiti obositoare, de rutin, existnd
ns i pericolul ca mainile respective, ajunse la un anumit grad de inteligen, s
se rscoale mpotriva creatorilor, aa cum se sfrete piesa de teatru menionat.
Astfel se poate explica de ce mai trziu Isaac Asimov a considerat necesar
precizarea unor legi ale eticii roboilor, dei dezvoltarea de pn acum a
domeniului nu a creat nc problemele imaginate de cei doi scriitori. Este de
observat c una din ideile care apare n piesa autorului ceh a fost urmat de
productorii roboilor industriali chiar dac s-a plecat de la copierea omului, n
realizarea unui robot se poate renuna la acele caracteristici umane care sunt prea
puin utile n rezolvarea sarcinilor de ctre roboi (forma roboilor industriali actuali
nu este una antropomorfic).
Premergtoare roboilor propriu-zii, au existat nc din antichitate
mecanisme care se micau datorit unor energii interne, fiind controlate de sisteme
de comand proprii statuile mecanice articulate din Egiptul antic, statuile i
figurinele mecanice puse n micare de fora apei n China i Grecia antic, sau
figurinele mobile ale orologiilor din evul mediu [Cr, 86]. Apariia robotului
propriu-zis, ntr-o form apropiat de aceea a roboilor industriali actuali, este
legat de condiiile create dup cel de-al doilea rzboi mondial. Astfel, la apariia i
extinderea folosirii roboilor au contribuit [Dud, 89], [Fu, 87], [Dav, 86], [Sto, 05] :
trecerea de la fabricaia produselor n serii mari cu ajutorul mainilor
automate specializate, la fabricaia seriilor medii i mici, devenind numeroase i
importante operaiile de manipulare a pieselor, subansamblelor i dispozitivelor
tehnologice specializate (de vopsire, sudur); aceste operaii, numite secundare, au
putut fi i ele automatizate prin introducerea roboilor;
progresele din domeniul mecanicii privind proiectarea i realizarea unor
mecanisme articulate, cu mai multe grade de libertate;
progresele din domeniul conducerii cu calculator a mainilor unelte i
n general a conducerii proceselor de fabricaie.
Sistemele de tip telemanipulator au aprut naintea roboilor propriu-zii.
nc din anul 1947 a fost construit un asemenea sistem cu acionare electric. Cel
care este considerat primul realizator de roboi industriali este inventatorul
american George Devol. Acesta a fost influenat de un fenomen al anilor 1950
[Dud, 89], [Fu, 87]: accelerarea uzurii morale a mainilor unelte i numrul mare de
muncitori implicai n munca de deservire a acestor maini. n consecin, Devol a
8
Domeniul Roboticii
pe calculatoare de uz industrial [Reh, 00]. n prezent, cele mai mari companii
productoare de roboi industriali sunt: Fanuc Robotics Corporation, Motoman,
Seiko, Panasonic Factory Automation, Kawasaki, toate localizate n Japonia, ABB,
Reis Robotics din Germania i Adept Technology din SUA; companiile din
domeniul produciei auto sunt nc cei mai importani utilizatori ai roboilor
industriali [Reh, 00], [Sto, 05].
Pe de alt parte au existat i cercetri urmrind creterea abilitilor roboilor
astfel nct acetia s-i gseasc utilitatea i n afara sferei industriale. n acest sens
una din primele chestiuni cercetate a fost aceea a diferitelor bucle de reacie
senzoriale. nc din anul 1962 H. A. Ernst a fcut experimente cu un bra controlat
de un calculator dotat cu senzori tactili. Este apoi de amintit anul 1968, cnd la
laboratorul Stanford a fost construit i testat robotul Shakey, ca unul din primii
roboi care, prin dotarea senzorial (camer video, microfoane) i programele care
l echipau, putea avea o comportare adaptabil ntr-un mediu de lucru parial
cunoscut [Fu, 87]. n prezent sunt active mai multe domenii de cercetare viznd
obinerea roboilor inteligeni, printre care se pot enumera sistemele multi-robot i
cele bazate pe vedere artificial, cu aplicabilitate de exemplu n domeniul
proceselor tehnologice de asamblare, roboii mobili dotai cu sisteme de locomoie
i senzoriale complexe, care rezolv navigarea pe baza unor tehnici ale inteligenei
artificiale, avnd aplicabilitate variat, de la domeniul militar la cel casnic.
elementul terminal al robotului (aa numitul efector, adesea un apuctor) are forma
unui cub sau paralelipiped; zona respectiv este un parametru important al roboilor
industriali, numit spaiul de lucru. Adesea roboii n coordonate carteziene au
sistemul de acionare de tip pneumatic,
deoarece aceast variant poate materializa
uor o micare de translaie.
Exist unele avantaje i respectiv
dezavantaje ale acestor roboi; n funcie de
acestea i de aplicaia de rezolvat se va decide
alegerea lor. Avantajele sunt:
Domeniul Roboticii
de sarcin mai mare dect la roboii cartezieni; capacitatea de sarcin este o
caracteristic important a unui robot industrial care precizeaz greutatea sau masa
maxim pe care o poate deplasa robotul.
n comparaia cu roboii n coordonate carteziene cei n coordonate cilindrice
sunt dezavantajai de un spaiu de lucru mai mic, mai ales atunci cnd restriciile
mecanice determin limite restrnse pentru axa de rotaie. Operaiile de manipulare,
cum ar fi de exemplu deservirea mai multor maini unelte aezate pe un arc de cerc
n spaiul de lucru al robotului, reprezint una din aplicaiile cele mai rspndite
pentru roboii n coordonate cilindrice.
Roboii n coordonate sferice, numii i
roboi n coordonate polare se obin printr-o
succesiune format din dou axe de rotaie i una
de translaie, aa cum este ilustrat n fig. 1.4. n
acest caz spaiul de lucru va apare ca o poriune
cuprins ntre dou sfere concentrice, avnd
razele delimitate de limitele micrii de
translaie, iar micrile de rotaie fixeaz zonele
laterale i cele n plan vertical la care poate
Fig. 1.4. Robot n coordonate
ajunge efectorul robotului; un exemplu n acest
sferice
sens este dat n fig. 1.5, n care spaiul de lucru al
robotului este marcat prin haurare. Avantajele i
Domeniul Roboticii
distan maxim la care poate ajunge efectorul fa de baza robotului, datorit
felului n care segmentele ce compun robotul se pot aeza n prelungire;
avnd numai articulaii de rotaie, sistemul de acionare cu motoare
rotative este uor de implementat la asemenea roboi, motoarele electrice fiind
frecvent folosite; de aici decurge i obinerea unor micri de precizie deosebit
pentru aceti roboi, prin aplicarea unor metode de control avansate, specifice
acionrilor electrice;
abilitatea mai bun dect la alte configuraii de a permite lucrul prin
cooperare ntre doi roboi ntr-un spaiu comun.
axa 6
axa 2
axa 5
15
Domeniul Roboticii
pentru a crete spaiul de lucru al unui robot de tip staionar baza acestuia nu mai
este fixat, ci este plasat pe o cale de ghidare realizat cu ine i role sau pe un
sistem de tip enile. Este ca i cum robotului i se mai asigur un grad de libertate
suplimentar (o ax de micare n plus).
Roboii mobili au lrgit sfera de aplicabilitate a roboticii, ei trecnd de la
mediul industrial la domenii precum protecia mediului, agricultur, construcii,
aplicaii casnice. De asemenea, roboi mobili evoluai sunt folosii n explorarea
spaiului cosmic i a celui acvatic. Din punct de vedere al clasificrii fcute la
definirea noiunii de robot (vezi paragraful 1.1), unii din aceti roboi se pot ncadra
n categoria sistemelor de tip telemanipulator, deoarece nu execut un program n
mod autonom, ci doar micrile comandate, printr-un sistem adecvat de transmisie,
de ctre operatorul care i dirijeaz n mod continuu.
O alt clasificare are n vedere modul de aezare a robotului n mediul su de
lucru. Astfel, exist roboi n montare normal, acetia fiind cei care au baza la
cei de tip staionar, sau calea de rulare la cei de tip
mobil, pe podea. Exemple de roboi n montare normal
sunt cei din fig. 1.2 1.7. Cea de-a doua categorie n
aceast clasificare este cea a roboilor n montare
inversat (vezi fig. 1.10). La acetia baza robotului este
aezat deasupra spaiului de lucru, ea fiind sau fixat de
tavan, sau montat pe un cadru (numit i portal) prevzut
cu o cale de rulare cu ine, asigurnd n acest ultim caz
Fig.1.10. Robotul
micarea de translaie a bazei robotului deasupra spaiului
de tip gantry
de lucru i creterea acestuia; asemenea roboi se numesc
roboi de tip portal, folosindu-se i termenul din limba
englez, anume roboi de tip gantry. Este ca i cum ntr-o hal industrial locul
unui pod rulant care are puine posibiliti de manipulare este luat de un robot
gantry.
n funcie de tipul sistemului de acionare folosit pentru micarea robotului
exist roboi cu acionare hidraulic, pneumatic, electric i mixt. Fr a intra n
detalii, roboii hidraulici sunt dotai cu un rezervor al fluidului de lucru, de obicei
acesta fiind uleiul, o pomp i elementele de acionare propriu-zise, ce determin
micarea liniar sau de rotaie a segmentelor robotului. Avantajul acestui sistem de
acionare este acela al raportului mare ntre puterea pe care o poate dezvolta robotul
i dimensiunea sa. n consecin, roboii cu acionare hidraulic sunt cei care pot
ajunge la capaciti de sarcin mari. Acest aspect favorabil este nsoit de mai multe
16
Domeniul Roboticii
una liniar, atunci cuplarea motorului se va face printr-un sistem adecvat de
transformare a micrii.
Pe lng avantajul deja menionat al preciziei micrii, acionarea electric, n
comparaie cu variantele anterioare, nu mai necesit alt surs de energie n afar de
cea electric, este nepoluant, asigur viteze de deplasare mari, cu nivele de zgomot
reduse.
n concluzie, dac se urmresc micri de precizie cu un control al
traiectoriei, roboii acionai electric vor fi de preferat, cei pneumatici, prin costul
redus, se vor impune n aplicaii puin pretenioase, iar cei hidraulici pot determin
capaciti de sarcin mari. Se folosesc i roboi cu acionare mixt, un caz frecvent
fiind acela al acionrii electrice pentru toate micrile, mai puin acionarea
efectorului, care dac este un apuctor se prefer s fie cu acionarea pneumatic,
fiind vorba despre o nchidere/deschidere efectuat ntotdeauna la limite prefixate.
O alt clasificare se poate face n funcie de metoda de control al robotului,
existnd n acest sens trei variante. Prima categorie se refer la roboii de tip
telemanipulator, adic aceia care nu au o funcionare autonom, ci doar reproduc la
distan i eventual amplificate din punct de vedere al forei dezvoltate, micrile
operatorului care i conduce n mod nemijlocit (vezi i paragraful 1.1). Dac la
primii roboi ncadrai n aceast categorie sistemul de comand era cvasi
inexistent, fiind vorba doar de sisteme mecanice de transmitere a micrii, n
prezent i la aceast categorie se pune problema unei ci de reacie, care s permit
operatorului s perceap fora de manipulare, sau a unor sisteme de comunicaie
avansate, care fac s nu mai existe un contact mecanic propriu-zis ntre partea
manevrat de operator i partea de execuie.
Trecnd la roboii autonomi, roboii cu funcionare n bucl deschis (sau de
tip non-servo) sunt cei la care nu exist nici o informaie de reacie n timpul
micrii robotului, nici asupra poziiei i nici a vitezei sau acceleraiei. Aceasta
nseamn c sistemul de comand al robotului calculeaz deplasarea necesar,
eventual profilul traiectoriei i profilul de variaie a vitezei pentru axele de micare
ale robotului i apoi acestea sunt comandate, fr a exista nici o corecie n timpul
execuiei. Rezult c este vorba despre sisteme care se bazeaz pe precizia execuiei
comenzilor de ctre partea de acionare. Exemple de asemenea roboi sunt cei
acionai cu motoare pas cu pas, la care deplasarea de efectuat de ctre fiecare ax a
robotului este convertit, innd seama de eventualele elemente ale transmisiei
micrii, ntr-un numr ntreg de pai, care sunt comandai spre execuie. Evident
poziia final a robotului poate fi afectat de erori dac se produc pierderi de pai,
sau datorit imperfeciunilor prii mecanice (de exemplu, jocul n angrenaje). i
18
Domeniul Roboticii
Este evident c sistemul de comand al unui asemenea robot poate fi realizat cu un
automat programabil.
A doua categorie este cea a roboilor de tip punct cu punct, la care programul
const de asemenea dintr-o succesiune de puncte pe care efectorul robotului trebuie
s le strbat, dar de data aceasta nu mai este vorba despre puncte prefixate, ci ele
pot fi puncte oarecare din spaiul de lucru al robotului. n consecin, n memoria
sistemului de comand al robotului vor fi memorate informaii corespunztoare:
poziiile tuturor axelor care determin situarea efectorului n punctul dorit sau
poziia i orientarea efectorului n fiecare punct al ciclului de lucru. n acest ultim
caz, sistemul de comand al robotului trebuie s calculeze poziiile axelor din
situarea memorat a efectorului, acestea fiind necesare deoarece ele determin
comenzile spre elementele de acionare ale articulaiilor robotului.
Este clar c la roboii de tip punct cu punct, fa de cazul roboilor secveniali,
informaiile pe care le va conine programul robotului sunt mai complexe. Fr a
intra n detalii, aceste informaii pot fi furnizate n dou moduri, n funcie de felul
n care este programat robotul. Astfel, n cazul programrii prin nvare (termenul
n limba englez este teach and play-back) exist o faz de nvare n care
operatorul mic robotul n punctele ce trebuie s constituie programul de lucru i
informaiile cu privire la poziiile axelor robotului sunt memorate atunci cnd
robotul a fost adus ntr-un asemenea punct, conform unei comenzi explicite primite
de la operator. Conducerea robotului n punctele de lucru i comenzile de memorare
sunt realizate printr-o interfa adecvat, operatorul avnd la dispoziie o consol de
programare a robotului, numit teach pendant. Parcurgerea fazei de nvare
presupune ca robotul, prin echiparea cu senzori, s fie folosit ca un sistem de
msur n sensul c exist elementele care s furnizeze poziiile axelor atunci cnd
operatorul a adus robotul ntr-un punct dorit.
Cea de-a doua modalitate de furnizare a informaiilor cu privire la punctele
programului de lucru este cea a programrii textuale, cnd operatorul scrie un
program, ntr-un limbaj de programare specific robotului respectiv, preciznd n
instruciunile programului poziiile axelor sau informaiile de poziie i orientare ale
efectorului, pentru fiecare punct pe care trebuie s-l strbat robotul. Indiferent de
varianta prin care au fost furnizate informaiile cu privire la punctele de atins de
ctre robot, ceea ce este caracteristic unui robot de tip punct cu punct este faptul c
traiectoria ntre punctele ciclului de lucru nu este controlat; aceasta nseamn c
robotul este condus pe o traiectorie n faza de nvare ntre dou puncte de lucru i
se deplaseaz prin cele dou puncte, dar putnd trece cu efectorul pe alt traiectorie
n faza de execuie, dup cum n mai multe repetri ale programului de lucru
deplasarea ntre cele dou puncte se poate face pe traiectorii diferite.
20
Roboii cei mai evoluai conform acestei clasificri sunt cei cu comanda
continu a traiectoriei. La fel ca n cazul anterior este necesar stabilirea unor
puncte prin care trebuie s treac efectorul robotului, puncte care s fie determinate
prin nvare sau ca valori nscrise de ctre operator n program. Deosebirea apare
n ceea ce privete traiectoria pe care o strbate efectorul ntre punctele
semnificative ale deplasrii, aceasta nemaifiind arbitrar, ci una controlat de
sistemul de comand al robotului. Exist dou variante pentru principiul de
funcionare a roboilor cu comanda continu a traiectoriei. Prima se refer la
prefixarea traiectoriei prin program. Astfel, se poate ca sistemul de control i
instruciunile limbajului de programare a robotului s permit stabilirea de ctre
programator a unei anumite forme a traiectoriei efectorului ntre dou puncte ale
ciclului de lucru; variantele cele mai frecvente sunt cele n care se pot prescrie
traiectorii sub form de segment de dreapt sau arc de cerc. Cu excepia cazurilor
banale (de exemplu, robotul este de tip cartezian i deplasarea ntre cele dou
puncte presupune modificarea unei singure coordonate), sistemul de comand al
robotului va trebui s coreleze momentele de start i vitezele diferitelor axe, astfel
nct s se obin forma dorit a traiectoriei.
Cea de-a dou modalitate pentru obinerea comenzii continue a traiectoriei
este aceea de nvare a traiectoriei. Este vorba despre o programare prin nvare
conform celor descrise anterior, dar la care, spre deosebire de cazul roboilor de tip
punct cu punct, se memoreaz nu numai cteva puncte semnificative la momente
comandate de operator, ci ntreaga traiectorie pe care operatorul mic robotul. n
fapt sistemul de control preia, cu o perioad de eantionare de ordinul a 100 ms, de
la senzorii de pe robot poziiile axelor n timpul micrii robotului n faza de
nvare. n cea de execuie, traiectoria nvat este reprodus prin interpolare,
astfel c dac perioada de eantionare este suficient de mic nu vor exista diferene
semnificative ntre traiectoria nvat i cea executat. Este clar c fa de cazul
programrii prin nvare al unui robot de tip punct cu punct, la cei cu comanda
continu a traiectoriei deosebirea este aceea a numrului de puncte nvate. Roboii
din aceast ultim categorie sunt utili de exemplu n operaii de vopsire, cnd
robotul este nvat s se deplaseze pe o anumit traiectorie copiind ndemnarea
operatorului n realizarea operaiei respective.
O alt clasificare se poate face dup metoda de programare a roboilor.
Conform acestui criteriu, exist aa numiii roboi cu programare cablat, la care
iniial programul rezulta n funcie de structura hardware a circuitului secvenial ce
constituia sistemul de control al robotului. Era vorba, conform clasificrii
anterioare, numai de roboi cu secven fix, care executau un ciclu de lucru
21
Domeniul Roboticii
determinat prin schema cablat a circuitului secvenial folosit. Flexibilitatea n
utilizare era redus i ea este n prezent crescut pentru roboii ncadrai n aceast
categorie prin folosirea drept sistem de control a unui automat programabil. A doua
categorie este aceea a roboilor cu programare prin nvare, la care, conform celor
explicate i anterior, exist o faz de nvare, cu cele dou variante, n care
operatorul programator mic robotul fie n poziiile sau pe traiectoria dorit. Faza
de nvare este urmat de cea de execuie, n care robotul repet un ciclu de lucru
n care intervin elementele memorate la nvare. Ultima categorie n aceast
clasificare este cea a roboilor cu programare textual, cnd micrile i aciunile
robotului rezult n urma unui program nscris de ctre operatorul programator n
memoria sistemului de control al robotului, ceea ce nseamn c n acest caz exist
un text program, de unde denumirea categoriei.
Dup tipul interaciunii senzoriale exist n prezent dou categorii de roboi.
Astfel, roboii mai puin evoluai sunt cei cu detectare binar, cnd sistemul de
control al robotului primete informaii cu privire la strile unor elemente binare de
pe robot sau din mediul de lucru al acestuia (poate fi vorba de limitatoare de curs
sau senzori cu ieire binar), ceea ce permite stabilirea momentelor de terminare a
micrilor, sincronizarea cu procese externe prin schimbarea adecvat a secvenelor
de program memorate. Roboii mai evoluai sunt cei cu detectare adaptiv, cnd
robotul poate aciona, spre deosebire de cazul anterior, n medii parial sau total
necunoscute, datorit interaciunii senzoriale complexe i continue cu mediul. n
acest caz sistemul senzorial al robotului conine camere de luat vederi, senzori cu
ultrasunete, senzori tactili, etc.
Completnd aceast clasificare menionm c, fr a fi strict respectate n
mediul industrial sau n cercetare, exist i o serie de standarde n privina
diferitelor categorii de roboi. Astfel, standardul ISO/TR/8373 mparte roboii n
patru categorii, dup cum urmeaz [Reh, 00]:
roboi cu teleoperare, incluznd cazul telemanipulatoarelor;
roboi secveniali, corespunznd roboilor cu secven fix de la
clasificarea n funcie de modul de realizare a micrii robotului;
roboi cu micare pe traiectorie controlat, incluznd cazul comenzii
continue a traiectoriei, fiind vorba despre roboi cu funcionare n bucl nchis, cel
mai frecvent cu acionare electric i mai rar hidraulic;
roboi adaptivi, incluznd cazul deteciei adaptive, cnd pe lng partea
senzorial evoluat, exist sisteme de control bazate pe inteligen artificial;
22
roboii din aceast categorie sunt nc n faza de cercetare, fiind vorba despre roboi
inteligeni, conform definiiei date n paragraful 1.1.
Este de menionat c roboii actuali posed caracteristici din mai multe
categorii conform clasificrilor din punct de vedere al controlului i programrii.
De exemplu, roboii industriali produi de firma ABB [Reh, 00], [ABB, 00] pot fi
programai s funcioneze att ca roboi punct cu punct, ct i cu comanda continu
a traiectoriei (pot descrie traiectorii liniare sau circulare ntre punctele semnificative
ale deplasrii), dup cum pot fi programai att prin nvare, ct i n varianta
programrii textuale.
Domeniul Roboticii
este folosit ca efector al robotului, sau este fixat la mijlocul zonei n care efectorul
este prins de restul structurii mecanice a robotului, atunci cnd robotul nu are nc
ataat un efector. n literatura de limb englez se folosete pentru acest punct
caracteristic denumirea de TCP (Tool Center Point). Precizia de poziionare se
refer la situaia n care robotul este de tipul cu programare textual, n programul
su este prescris o anume poziie n care trebuie s ajung punctul caracteristic i
la execuia programului apare o abatere ntre poziia prescris i cea n care ajunge
n fapt punctul caracteristic.
O caracteristic important din punct de vedere al preciziei execuiei
sarcinilor de ctre un robot industrial este repetabilitatea. Ea reprezint abilitatea
robotului de a realiza n mod repetat aceeai poziie. Numeric, att repetabilitatea
ct i precizia de poziionare se exprim n mm. Repetabilitatea se poate determina
la un robot de tipul cu programare prin nvare msurnd diferena care apare ntre
poziia n care a fost plasat punctul caracteristic n faza de nvare i cea n care
ajunge la execuie, sau, indiferent de metoda de programare, msurnd diferena
care apare la deplasarea repetat a punctului caracteristic ntr-o aceeai poziie,
comandat n mod repetat, conform programului robotului. De exemplu, s
presupunem c programul unui robot comand deplasarea punctului caracteristic n
poziia P dat de coordonatele carteziene: xc = 100 mm, yc = 100 mm, zc = 500 mm,
ce sunt msurate fa de un reper de referin. Deplasarea n poziia P apare de 2 ori
n cadrul ciclului de lucru al robotului i la cele 2 treceri prin P se msoar
urmtoarele valori ale coordonatelor punctului caracteristic:
x1 = 100,05 mm; y1 = 100 mm; z1 = 500 mm
x2 = 100,03 mm; y2 = 100,04 mm; z2 = 500 mm
Dac se folosete standardul ANSI/RIA R15.05-1 al Asociaiei americane a
productorilor de roboi industriali (RIA Robotic Industries Association) vor
trebui aplicate urmtoarele formule pentru precizia de poziionare medie ( pp )i
respectiv repetabilitate (R):
pp =
R=
24
1 n
n i =1
1 n
ai ;
n i =1
( xi x c ) + ( y i
2
ai =
zc )
yc ) + (zi
( xi x ) + ( y i y) + ( z i z )
2
x=
1 n
xi ;
n i =1
y=
1 n
yi ;
n i =1
z=
1 n
zi
n i =1
unde n este numrul de experimente efectuate, xi, yi, zi sunt coordonatele realizate
la experimentul i, iar xc, yc, zc sunt coordonatele comandate. n relaiile de calcul
ale repetabilitii R apar x , y , z care reprezint valorile medii, pentru cele n
experimente, ale coordonatelor realizate pentru poziionarea repetat conform unui
acelai punct comandat, iar ai reprezint eroarea de poziionare n experimentul i
fa de punctul avnd drept coordonate valorile medii. Introducnd valorile
numerice ale exemplului considerat se obin rezultatele: pp = 0,05 mm, R 0,022
mm.
Evident determinarea preciziei de poziionare i a repetabilitii va presupune
efectuarea unui numr mai mare de experimente i n mai multe puncte, dar
ntotdeauna repetabilitatea roboilor este de cteva ori mai bun dect precizia de
poziionare. Aceasta se explic prin aceea c precizia de poziionare este
dependent de erorile sistemului de control, de toleranele pieselor folosite la
construirea robotului, de precizia construciei i de jocurile din angrenaje, n timp
ce repetabilitatea depinde numai de jocurile angrenajelor.
Privind capacitatea de micare a unui robot se mai definete rezoluia, ca
fiind cel mai mic increment de deplasare ce poate fi realizat de robot. Acest
parametru este condiionat de structura mecanic i de sistemul de control al
robotului.
Capacitatea de sarcin precizeaz pentru un robot greutatea (sau masa) pe
care acesta o poate transporta n ntreg spaiul de lucru, cu pstrarea performanelor
de precizie de poziionare, repetabilitate i vitez. Cum productorii livreaz roboii
fr efector, aceast caracteristic se refer la greutatea pe care o poate transporta
structura mecanic i de acionare respectiv, astfel c n situaia n care un
utilizator va folosi un apuctor, va trebui s ia considerare suma dintre greutatea
apuctorului i cea a obiectului de manipulat, care nu trebuie s depeasc
capacitatea de sarcin a robotului.
Pentru a caracteriza rapiditatea cu care un robot poate executa o sarcin se
folosesc parametri precum vitezele diferitelor axe (exprimate dup cum este cazul
ca viteze liniare sau unghiulare) i viteza punctului caracteristic. Pentru ilustrare n
tabelul urmtor sunt precizate caracteristicile pentru civa roboi industriali
realizai de firma ABB [ABB, 00]; se observ c mai apar ca parametri de
caracterizare greutatea robotului i respectiv a sistemului su de comand, ca i
25
Domeniul Roboticii
unele specificaii pentru consola de programare i interfaa cu care este dotat
sistemul de control al robotului.
Tab. 1.1. Caracteristici pentru civa roboi ABB
Tip robot
Capacitate
de
sarcin
Nr. gdl
Repetabilitate
Vitez maxim
(pentru TCP)
Distan maxim
de lucru
Greutate
robot/sistem
control
Caracteristici
consol
programare
IRB 1400
5 kg
IRB 2400
7 kg
IRB 4400
30 kg
6
0,05 mm
2,1 m/s
6
0,06 mm
2,1 m/s
6
0,1 mm
2,2 m/s
1,44 m
1,8 m
2,43 m
225 kg / 240kg
380 kg / 240 kg
940 kg / 240 kg
Portabil, joystick
i
tastatur,
display 16 linii x
40 caractere
Caracteristici
Intrri/ieiri
interfa
numerice (pn la
512) i analogice
(pn la 120), 4
canale seriale
Domenii
de Sudur,
aplicabilitate
asamblare,
deservire maini
unelte,
transfer
materiale,
debavurare, lipire
Intrri/ieiri
numerice (pn la
256) i analogice
(pn la 120), 2
canale seriale
Deservire maini
unelte,
transfer
materiale,
debavurare,
paletizare,
lefuire
cnd acesta este ncrcat cu o sarcin de cteva kg, asigurnd i o repetabilitate mai
bun de 0,1 mm.
Fr a exista un algoritm precis de selecie, atunci cnd se pune problema
introducerii unui robot ntr-un sistem de fabricaie, caracteristicile enumerate mai
sus pot constitui criterii de selecie. Astfel, spaiul de lucru, numrul gradelor de
libertate i configuraia structurii mecanice sunt elemente de alegere importante,
care se coreleaz cu organizarea zonei unde va fi amplasat robotul i elementele pe
care acesta le va deservi. Precizia de poziionare, rezoluia i repetabilitatea pot fi
cerine definitorii, impuse de tehnolog atunci cnd robotul este folosit ntr-o
operaie de asamblare. Din punct de vedere al interaciunii mecanice ntre robot i
obiectele din mediul su de lucru, o caracteristic luat uneori n considerare este
aceea a complianei. Aceasta poate fi explicat pe cazul unui robot destinat
asamblrii, referindu-se la relaia care apare ntre obiectele implicate n procesul
respectiv, innd seama de erorile n poziionare i de toleranele pieselor [Reh, 00],
[Dud, 89]. De exemplu, n cazul n care robotul, n procesul de asamblare, trebuie
s introduc o pies n locaul prevzut n alt pies, va fi imposibil de realizat
ntotdeauna o aliniere perfect ntre apuctorul robotului care conine una din piese
i locaul respectiv. n consecin compliana, pe care o determin att robotul ct i
piesele de asamblat i elementele de fixare ale acestora, va asigura sau nu
rezolvarea unei asemenea situaii. Exemplul de robot folosit cu succes n operaii de
asamblare i care asigur o complian sporit este robotul de tip SCARA. La acesta
compliana este obinut prin configuraia structurii mecanice i prin modul de
realizare a apuctorului.
Capacitatea de sarcin trebuie avut n vedere mpreun cu tipul i greutatea
efectorului i a obiectelor ce urmeaz s fie manevrate de robot. Eventual, procesul
tehnologic poate impune necesitatea folosirii mai multor elemente efectoare pe
acelai robot. Elementele de interfaare pe care le ofer sistemul de control al
robotului, mpreun cu modalitile de programare posibile sunt de luat n
considerare n funcie de modul n care robotul trebuie s se integreze n sistemul de
fabricaie. Mai menionm c n cataloage apare frecvent o indicaie a
productorului asupra domeniilor de folosire a fiecrui tip de robot (vezi i tab.
1.1), ceea ce poate de asemenea ghida selecia.
n afar de aceste elemente, costul robotului mpreun cu celelalte aspecte
economice ale amortizrii investiiei sunt de luat n considerare. n plus, n prezent
se pune frecvent problema realizrii unor celule sau sisteme flexibile de fabricaie,
conform conceptelor fabricaiei asistate de calculator (termenul folosit este cel de
CIM, din limba englez Computer Integrated Manufacturing) [Reh, 00],
27
Domeniul Roboticii
[Reh, 01], [Pan, 01]. ntr-o asemenea situaie se proiecteaz, realizeaz i/sau
achiziioneaz toate echipamentele care s rezolve specificaiile de fabricaie,
ctigul important fiind acela al modului n care compatibilitatea i integrarea ntre
toate elementele implicate sunt rezolvate de la nceput, aspectele respective
devenind mai dificile n cazul unei automatizri i robotizri n etape.
Ca i criteriu de comparaie ntre roboii industriali se pot folosi i o serie de
parametri globali, definii dup cum urmeaz [Isp, 90]:
Spatiul de lucru (m 3 )
k1 =
;
Greutatea de serviciu (N)
k2 =
alt aplicaie acele componente care trebuie s fac parte din acelai sistem robotic,
este scopul comun pe care acestea l au de rezolvat. Aceasta este o abordare care
conduce att spre principiile folosite n sistemele de fabricaie de tip CIM, ct i
spre metodele folosite n inteligena artificial, unde se pune problema ca roboii si determine aciunile de ndeplinit n funcie de scopul avut n lucru [Pan, 94],
[Pan, 95], [Pan, 03].
Surs energie
(electric, pneumatic, hidraulic)
Sistem control
robot
Consol
programare
Bra
manipulator
Efector
Interfa robot
Ethernet
Reea
local
Ieiri seriale
Ieiri numerice
i analogice
Comand conveior,
u main unealt,
etc.
Intrri numerice
i analogice
Senzori, stare
main unealt,
etc.
Comand
numeric
Domeniul Roboticii
sistemului robotic. Cel mai frecvent roboii sunt elementele fundamentale ale unui
sistem robotic, astfel c noiunile robot sistem robotic sunt adesea folosite n mod
echivalent.
Partea mecanic a unui robot industrial este constituit din braul manipulator
i efector, n cazul roboilor de tip staionar, la cei mobili adugndu-se i vehiculul.
Braul robotului este format din succesiunea de corpuri numite segmente ale
robotului, interconectate prin intermediul articulaiilor, acestea avnd i rolul de
realizare a micrii robotului. Conform structurii tipice din fig. 1.9, articulaiilor
robotului le corespund axe de micare; n funcie de tipul articulaiei i al modului
de transmisie a micrii de la articulaie la segmentele robotului, rezult micri de
rotaie sau translaie pentru segmentele robotului. Micrile sunt obinute prin
intermediul elementelor de acionare (motoare), care pot fi cuplate direct cu axele
de micare atunci cnd sunt aezate n articulaii, sau prin intermediul unor sisteme
de transmisie a micrii (sisteme cu roi dinate, curele, etc).
Conform clasificrii fcute n paragraful 1.4 exist mai multe tipuri de
acionri i corespunztor acestora va trebui ca robotul s fie dotat cu surse de
energie corespunztoare, care s asigure aportul energetic i pentru efector i
respectiv sistemul de control al robotului. Exist cteva aspecte definitorii pentru
braul robotului, deja precizate n paragrafele anterioare: montarea normal,
respectiv inversat, pe o baz fix sau pe un vehicul. Se poate face o mprire a
braului n dou subsisteme, primul fiind format din segmentele i articulaiile aflate
nspre baza robotului, care realizeaz poziionarea efectorului (de aici denumirea de
subsistem de poziionare), iar cel de-al doilea cuprinznd segmentele i articulaiile
aflate nspre efector, care determin orientarea acestuia (ele formeaz subsistemul
de orientare); aceast mprire se poate urmri pe robotul din fig. 1.9, unde trebuie
neles c ultimele segmente au dimensiuni reduse n comparaie cu primele
segmente ale robotului.
Efectorul robotului este elementul prin care acesta interacioneaz cu mediul,
n interiorul spaiului de lucru. Att braul robotului, dar mai ales efectorul trebuie
s fie ales n funcie de scopul de ndeplinit de ctre robot. n consecin, acesta
poate fi un apuctor (se folosete i denumirea de element de prehensiune, sau cea
din limba englez gripper), sau un dispozitiv pentru efectuarea sudurii, vopsirii,
etc. Chiar i n cazul celui mai simplu efector, se va putea pune n eviden un corp
propriu-zis al efectorului, avnd o structur mecanic adecvat funciei de
ndeplinit, unul sau mai multe elemente de acionare i eventual unul sau mai muli
senzori care s determine regimurile limit ale operaiei realizate [Iva, 94].
Efectorul este un element cheie n asigurarea flexibilitii n utilizare necesar
pentru un robot, astfel c exist o mare varietate de soluii constructive care s
30
permit robotului ndeplinirea a ct mai multe sarcini [Iva, 94], [Pal, 89], [Sha, 87].
n aceeai idee, pot fi situaii n care robotul este dotat cu o structur mecanic i de
control adecvat, astfel nct el este capabil s-i schimbe efectorul n timpul
ciclului de lucru.
Sistemul de control al unui robot trebuie s ndeplineasc mai multe funcii:
controlul micrii robotului n timpul operrii acestuia, facilitarea programrii
robotului atunci cnd este necesar modificarea operrii, comunicarea cu celelalte
echipamente ale sistemului robotic i cu operatorul. Fr a exista vreo standardizare
n domeniul arhitecturilor sistemelor de control ale roboilor, frecvent este vorba
despre sisteme de tip multiprocesor, n care unul sau mai multe procesoare
(microcontrolere) sunt dedicate controlului elementelor de acionare ale axelor
robotului, n timp ce altele rezolv interfaarea i programarea robotului. Partea de
memorie a sistemului de control asigur pstrarea programului robotului, adesea
memoria volatil fiind alimentat i de la baterii, pentru ca dup o cdere de
tensiune robotul s poat relua programul cu intervenii minime ale operatorului.
Ca i n general n cazul calculatoarelor de uz industrial, este important
partea de interfaare, trebuind s fie satisfcute cerinele integrrii ntr-un sistem de
fabricaie asistat de calculator. Astfel (vezi fig. 1.11), sistemul de control trebuie s
poat asigura legtura cu echipamentele lucrnd mpreun cu robotul prin
intrri/ieiri paralele, analogice i numerice, i pe linii seriale, fiind frecvente
cazurile cnd se comand prin programul rulnd pe sistemul de control al robotului
viteza de deplasare a unui sistem de transport de tip conveior, sau pornirea/oprirea
unei maini unelte. Senzorii ataai pe robot sau n mediul de lucru vor fi conectai
frecvent pe intrri numerice i/sau analogice. De asemenea, trebuie s existe i
posibilitatea legrii sistemului robotic la reeaua de calculatoare a sistemului de
fabricaie.
Exist o mare variabilitate i n ceea ce privete consola de programare a unui
robot. Frecvent ea conine o tastatur i un display i este legat de sistemul de
control printr-un cablu suficient de lung, facilitnd astfel desfurarea fazei de
nvare, n cazul programrii prin nvare a robotului. Se obine o flexibilitate
sporit atunci cnd programul robotului poate fi realizat att pe consola de
programare, ct i pe orice alt calculator extern. Programul realizat de utilizatorul
sistemului, rulnd pe sistemul de control al robotului, reprezint sursa de
informaie; aceast component a sistemului robotic nu a fost reprezentat explicit
n fig. 1.11, fiind considerat inclus n partea software a sistemului de control.
Trebuie subliniat c fr existena acesteia operarea sistemului nu este posibil
[Iva, 94].
31
Domeniul Roboticii
Alimentarea sistemului de control, a consolei de programare, ct i a
elementelor de acionare de pe braul manipulator i de pe efector, presupune ca
robotul s fie cuplat cu surse adecvate de energie, n primul rnd electrice, iar n
funcie de partea de acionare, i pneumatice sau hidraulice.
abordare care poate simplifica aceste cerine este aceea a folosirii pentru roboii
implicai n asamblare a unor sisteme senzoriale de tip vedere artificial [Reh, 00].
O alegere trebuie fcut i ntre folosirea roboilor i respectiv a mainilor automate
de asamblare; roboii sunt de preferat atunci cnd este vorba de loturi de fabricaie
mici, cu variaii ale dimensiunilor pieselor, cazuri mai dificil de rezolvat cu o
main de asamblat. Desigur, o comparaie se poate face i cu asamblarea manual,
aspectele care pot conduce la preferarea roboilor fiind cele valabile n general
pentru aplicarea industrial a acestora: creterea productivitii i a calitii,
eliberarea operatorului de activiti repetitive, obositoare.
Operaiile de sudur, n special n industria automobilelor, reprezint o
situaie tipic n care roboii industriali au nlocuit operatorii desfurnd o munc
repetitiv, n condiii dificile i conducnd totodat la un timp de lucru mai mic i
la o calitate superioar. n acest sens intervin performanele roboilor actuali
privind viteza de lucru, precizia de poziionare i repetabilitatea. Pentru realizarea
traiectoriilor complexe presupuse de operaiile de sudur se impune ca roboii
folosii s poat fi programai att prin nvare ct i textual, iar sistemul de
control s poat realiza o comand continu a traiectoriei. innd seama de aceste
specificaii ale prii de acionare i control, ca i de faptul c pentru roboii
implicai n sudur nu este necesar o capacitate de sarcin prea mare, roboii cu
acionare electric sunt folosii aproape n exclusivitate n acest caz.
Cerine asemntoare apar n cazul operaiilor de vopsire, n care, spre
deosebire de cazul manipulrii, este adesea puin important precizia de realizare a
punctelor extreme ale traiectoriei (de exemplu, acestea pot fi n afara zonei n care
se face vopsirea), fiind n schimb definitorie pentru procesul tehnologic respectiv
precizia de realizare a unei anumite traiectorii de micare. n consecin, metoda de
programare n acest caz este exclusiv aceea prin nvare (robotul este nvat
traiectoria pe care ar face-o operatorul conducnd pistolul de vopsire) i se mai
impune ca structura mecanic s asigure un spaiu de lucru suficient de mare i
roboii s aib gradul de protecie necesar pentru a putea lucra ntr-un mediu cu
pericol de explozie.
Folosirea roboilor industriali n aplicaii de turntorie, forj, n deservirea
preselor valorific posibilitile de lucru n medii ostile, capacitatea de sarcin mare
ce se poate obine pentru roboii cu acionare hidraulic, iar din punct de vedere al
programrii i traiectoriilor de realizat este vorba de condiii similare sau mai
simple ca acelea din cazul deservirii mainilor unelte. Ca echipare, roboii trebuie
s fie dotai cu apuctoare care s reziste la temperaturile ce apar n procesele
respective, fiind posibil i includerea n ciclul de lucru al robotului a unei faze de
rcire a sistemului de prehensiune. Creterea posibilitilor de interfaare, a
33
Domeniul Roboticii
flexibilitii n programare, a preciziei i vitezei permit n prezent folosirea
roboilor n majoritatea proceselor tehnologice, fiind citate i sistemele de
paletizare robotizate, aplicaiile de debavurare, tratamente termice, acoperiri
metalice i nemetalice, industria sticlei [Eng, 80], [Coj, 85].
n prezent capt extindere att folosirea roboilor n noi zone ale industriei,
ct i aplicarea neindustrial a acestora [Coo, 91], [Jor, 91], [She, 93], [Vir, 99],
[Mur, 00]. Domenii citate n acest sens sunt: industria nuclear, alimentar,
petrochimic, construcii civile i navale, agricultur, medicin, turism,
divertisment, aplicaii militare, cercetarea spaiului marin, extraterestru i chiar n
aplicaii casnice, de exemplu n deservirea persoanelor cu handicap. Roboii vor
cpta noi sarcini, ca: operaii de inspecie i mentenan n medii periculoase sau
dificil accesibile (centrale nucleare, conducte, zone minate, perei verticali ai
cldirilor, mediu marin, spaiul cosmic), transport de materiale n condiii deosebite
de clim, manipularea unor sarcini de mari dimensiuni n medii aglomerate
(agricultur, industria lemnului), realizarea unor traiectorii de mare precizie n
cuplare cu sisteme de vedere artificial n cazul interveniilor chirurgicale.
Dintre problemele pe care le ridic aceste tipuri de aplicaii robotizate sunt de
menionat [Oga, 95], [Tro, 95], [Mur, 00]: dezvoltarea mobilitii roboilor,
perfecionarea interaciunii senzoriale cu mediul de lucru i a celei om-robot,
realizarea unor construcii modulare care s permit reconfigurarea structurilor
mecanice i de control n funcie de specificul sarcinilor, mpreun cu creterea
adaptabilitii i versatilitii astfel ca roboii s poat fi utilizai i n producia de
serie mic, abstractizarea nivelului programrii pn la programarea bazat pe
scop, dezvoltarea strategiilor pentru rezolvarea prin cooperare a sarcinilor n
sistemele multi-robot i creterea gradului de interactivitate cu operatorii umani
pentru grupurile de roboi. Un punct final de atins ar fi acela n care roboii ar
deveni, prin multitudinea sarcinilor de ndeplinit, facilitile de comunicare cu
utilizatorul i pre, apropiai de performanele calculatoarelor actuale, ajungndu-se
la conceptele de robot personal [Coo, 91] i robot asistent [Mur, 00].
ntrebri i probleme
1. Numii echipamente din afara mediului industrial care se ncadreaz n
definiia robotului.
2. Facei o comparaie ntre definiia robotului i cea a calculatorului.
3. La ce se refer caracteristica de flexibilitate a unui robot i cum este
aceasta concretizat?
4. Schiai ntr-un limbaj de programare un fragment de program care s
transpun legile lui Asimov.
5. Enumerai capitolele Roboticii i precizai felul n care acestea sunt
necesare la construirea, respectiv utilizarea unui robot.
35
Domeniul Roboticii
6. Cnd au aprut roboii industriali i care au fost premisele pentru acest
eveniment?
7. Ce este un telemanipulator? Care sunt aspectele din definiia robotului pe
care acesta nu le satisface?
8. Pe baza avantajelor/dezavantajelor pe care le au diferitele tipuri de roboi
dup configuraia structurii mecanice, dai exemple de aplicaii potrivite pentru
fiecare din tipurile respective.
9. Precizai forma spaiului de lucru pentru diferitele tipuri de roboi.
10. Care sunt componentele i subsistemele prii mecanice a unui robot
industrial?
11. Facei o comparaie ntre roboii de tip non-servo i cei cu funcionare n
bucl nchis (avanataje/dezavantaje).
12. Dai exemple de aplicaii potrivite pentru diferitele tipuri de roboi
conform clasificrii dup modul de realizare a micrii robotului.
13. Care este diferena dintre precizia de poziionare i repetabilitate i cum
se calculeaz fiecare?
14. Care este diferena dintre noiunile de robot sistem robotic i care sunt
componentele tipice ale unui sistem robotic?
36
38
segment mobil
segment mobil
segment fix
segment fix
Metoda cea mai folosit pentru determinarea modelului cinematic al unui RI,
conducnd la rezolvarea celor dou probleme cinematice, este cea bazat pe
formalismul Denavit Hartenberg, formalism care utilizeaz reprezentarea
omogen a obiectelor i transformrile omogene, elemente care sunt prezentate n
continuare.
O
_
r = rx i + ry j + rz k
r o = ax a y az w
(2.1)
(2.2)
a y = ry w,
a z = rz w
(2.3)
41
1
4
P=
0
1 1 1
8 8 4
0 0 0
1 1 1
1
4
5
1
1 1 1
8 8 4
5 5 5
1 1 1
(2.4)
D1(-1, 4, 5) C1(-1, 8, 5)
A1(1, 4, 5)
B1(1, 8, 5)
D(-1, 4, 0)
C(-1, 8, 0)
A(1, 4, 0)
x
B(1, 8, 0)
zb
zs
js
Os
rs
P
is
r bs
rb
kb
ys
ks
xs
Ob
_
ib
jb
yb
xb
Fig. 2.5. Poziia relativ a dou
repere triortogonale
(2.5)
43
(2.6)
(2.7)
(2.8)
Pentru a putea scrie ntr-o forma compact aceste relaii mai considerm
descompunerile versorilor axelor reperului secundar fa de reperul de baz:
i s = a11 i b + a21 j b + a31 k b
j s = a12 i b + a22 j b + a32 k b
(2.9)
n acest fel relaia (2.7) se poate rescrie ntr-o form matriceal, n care toi
vectorii care apar s fie exprimai fa de reperul de baz, innd seama de (2.5),
(2.6), (2.8), i (2.9):
xb a11
y = a
b 21
z b a31
a12
a 22
a32
a13
a 23
a 33
x s xOs
y + y
s Os
z s z Os
(2.10)
a12
a 22
a32
0
a13
a 23
a33
0
xOs x s
y Os y s
z Os z s
1 1
(2.11)
n care ultima linie din matricea utilizat are doar rolul de a pstra egalitatea pentru
factorul de scar ales. n membrul stng al egalitii obinute apar coordonatele
omogene ale punctului P n reperul de baz, iar n cel drept coordonatele omogene
ale aceluiai punct n reperul secundar. Condensat relaia (2.11) se scrie sub forma:
r b = Abs r s
(2.12)
n care vectorii care apar sunt exprimai n coordonate omogene, iar matricea Abs:
a11
a
Abs = 21
a31
a12
a 22
a32
0
a13
a 23
a33
0
xOs
y Os
z Os
(2.13)
a12
a22
a32
a13
a 23
a33
(2.14)
(A )
'
bs
= (A ' bs )
(2.15)
a12 = j s i b = cos(Os y s , Ob xb );
....
(2.16)
a33 = k s k b = cos(Os z s , Ob zb )
Rezult astfel c n submatricea Abs a matricei de transformare omogen se gsesc
cosinusurile unghiurilor dintre axele celor dou repere, care se mai numesc i
cosinusuri directoare.
Dup relaia (2.8) observm c ultima coloan a matricei Abs conine
coordonatele originii Os a reperului secundar n reperul de baz. Concluzionnd,
matricea de transformare omogen Abs conine att informaii cu privire la poziia
reperului secundar fa de reperul de baz (prin ultima coloan), ct i informaii cu
privire la orientarea reperului secundar faa de cel de baz, prin primele trei
coloane. Astfel, este uor de dedus importana acestei matrice pentru modelarea
cinematic n robotic. Aici va fi necesar s exprimm atitudinea cinematic
relativ a diferitelor segmente ale RI i, dup precizrile fcute, vom putea face
aceasta atand repere triortogonale acestor segmente i folosind matricele de
transformare omogen. n plus, dup relaiile (2.11), (2.12), rezult c atunci cnd
matricea de transformare omogen este determinat, aceasta ne permite s aflm
coordonatele omogene ale uni punct fa de reperul de baz, dac sunt cunoscute
coordonatele omogene ale punctului respectiv fa de reperul secundar.
Se pune acum problema invers de a exprima poziia i orientarea reperului
Obxbybzb fa de reperul Osxsyszs. Aceasta nseamn c rolul celor dou repere n
fig. 2.5 se inverseaz i, refcnd acelai raionament ca mai sus, vom obine o
relaie de aceeai form cu (2.12), adic:
r s = Asb r b
(2.17)
(2.18)
(2.19)
(2.20)
k b = a 31 i s + a32 j s + a33 k s
n care am inut seama de faptul c matricea Abs satisface relaia (2.15). Conform
raionamentului fcut anterior, coeficienii din relaiile (2.20) vor fi plasai
respectiv pe prima, a doua i a treia coloan n matricea Asb, rezultnd o
transpunere a submatricei din colul stnga, sus, din matricea Asb, fa de aceeai
submatrice din matricea Abs. Pe ultima coloan n Asb, dup modul de construire a
acestei matrice, analog cu Abs, trebuie s apar coordonatele punctului Ob fa de
reperul Osxsyszs. Calculm prima dintre aceste coordonate (vezi fig. 2.5):
) (
xOb = r bs i s = xOs i b + y Os j b + z Os k b i s
(2.21)
(2.22)
47
(2.23)
(2.24)
Putem astfel observa c valorile lui xOb, yOb, zOb se obin respectiv ca
produsele scalare dintre primele trei coloane ale matricei Abs cu ultima coloan din
aceast matrice, produse scalare ce se nmulesc cu 1. Concluzionnd, regula de
inversare a unei matrice de transformare omogen de forma (2.13) este
urmtoarea:
- se transpune submatricea de dimensiune 3 x 3 care apare n colul din
stnga, sus a matricei de la care se pleac;
- se calculeaz primele trei elemente ale ultimei coloane ca produsele
scalare ale primelor trei coloane din matricea de inversat cu ultima coloan din
aceast matrice, nmulind rezultatele cu 1;
- ultima linie are aceleai elemente ca i n matricea de inversat, adic 0, 0,
0, 1.
Considernd pentru elementele matricei de transformare omogen Abs
notaiile:
nx
n
Abs = y
nz
sx
sy
sz
0
ax
ay
az
0
px
p y n s a p
=
p z 0 0 0 1
(2.25)
regula de inversare a unei matrice de transformare omogen, dat mai sus, conduce
la:
( Abs )1
48
n x
s
= Asb = x
a x
ny
sy
ay
0
nz
sz
az
0
n p
s p
a p
(2.26)
(2.27)
k n =1im + 0 jm + 0 k m
49
(2.28)
n relaiile (2.27) i (2.28) sunt folosii versorii axelor celor dou repere i
vectorul de poziie al originii reperului secundar fa de reperul de baz, vectori
care nu apar n fig. 2.6. Valorile coeficienilor din aceste relaiile ne permit s
construim matricea de transformare omogen cutat, conform (2.8), (2.9), (2.13),
adic:
Amn
0
1
=
0
0
0
1
0
1 4
0 0
0 10
0 1
(2.29)
r Pm = Amn
0 4
10 0
=
0 0
1 1
(2.30)
Anm
50
0
0
1
= ( Amn ) =
1
1
0
0
0
0 0
1 10
0 4
0 1
(2.31)
Se poate urmri, conform fig. 2.6, faptul c n matricea Anm apar coeficienii
descompunerilor versorilor axelor reperului Omxmymzm fa de reperul Onxnynzn (pe
primele 3 coloane), i respectiv coordonatele punctului Om fa de reperul Onxnynzn
(pe ultima coloan). Conform relaiei (2.17) matricea Anm ne permite s aflm, de
exemplu, coordonatele omogene ale punctului P fa de reperul Onxnynzn pe baza
coordonatelor punctului respectiv fa de reperul Omxmymzm:
r Pn = Anm
4 0
0 10
=
0 0
1 1
(2.32)
0
1
0
0
0
0
1
0
px
p y
pz
(2.33)
deoarece axele celor dou repere sunt paralele, iar coordonatele punctului Os n
reperul de baz sunt date de componentele vectorului p . Spunem despre matricea
Abs de forma (2.33) c este matricea unei transformri omogene elementare de
translaie. n cazul particular n care translaia se face chiar dup o ax a reperului
51
ks
_
kb
p
ib
Ob _
zs
jb
xs
Os
is
js
ys
yb
ks
ib = is
zb
_
k b_
js
jb
Ob
= Os
ys
xb=xs
xb
Dac atitudinea relativ a celor dou repere este rezultat n urma unei rotaii,
de exemplu n jurul axei Obxb de unghi , ca n fig. 2.8, atunci originile celor dou
repere coincid, iar descompunerile versorilor axelor reperului secundar fa de
reperul de baz sunt uor de exprimat:
i s = ib
j s = cos j b + sin k b
(2.34)
k s = sin j b + cos k b
ceea ce determin urmtoarea form pentru matricea de transformrii omogene
corespunztoare:
0
1
0 cos
A = Rx =
bs
0 sin
0
0
0
0
sin 0
cos 0
0
1
(2.35)
cos
0
y
Abs = R =
sin
0 sin
1
0
0 cos
0
0
0
0
0
(2.36)
sin
cos
0
0
0
0
1
0
0
0
0
(2.37)
T3 x1
w1x1
(2.38)
0
1
0
0
0
0
1
0
0
0
0
(2.39)
(2.40)
Os1
zb1
zs
xs1
ys1
xs
Ob1
zb
yb1
O
s
Abs
A
xb1
Ob
ys
yb
xb
(2.41)
r b = A r b1
(2.42)
(2.43)
zb
xs1
O s1
zs
Os
xs
A bs
Ob
ys1
ys
yb
xb
F ig. 2.10. C o m p unerea tra ns for m r ilor o m o ge ne
cazul m icr ii rapor tate la repe r ul se c undar
r b = Abs r s
r s = A r s1
(2.44)
(2.45)
57
zs3
xs3
zs2
z = zs
zs1
xs4
P
ys3 = ys4
xs2
Os3
Os4
30
O = Os=Os1=Os2
-45
ys1 = ys2
y = ys
P
x = xs = xs1
Fig. 2.11. O succesiune de micri pentru un
segment al unui RI
- o rotaie n jurul axei Ox a reperului de baz de unghi 30;
- o rotaie n jurul axei Osys (adic a axei Oy a propriului reper) de unghi
-45;
- o translaie n lungul axei Oz a reperului de baz de segment 2;
58
(2.46)
0
1
0
0 0 0 1
1 0 0 0
0 1 2 0
0 0 1 0
0
1
0
0
0
0
1
0
4
=
0
1
0
3/2
1/ 2
0
2 /2
2 /4
6 /4
0
0
0 2 / 2
1 / 2 0 0
3 / 2 0 2 / 2
0
1 0
0 2 / 2 0
1
0
0
0
2 / 2 0
0
0
1
0
0
2 /2
3 / 2 2 / 4 2 3
1/ 2
6 /4
4
0
0
1
(2.47)
pf = A p
(2.48)
59
) (
p f = 3 2 /2 2 33 2 /4 3 6 + 2 /4 1
(2.49)
D(0, 1, 0)
C(4, 1, 0)
A(0, 3, 0)
y
B(4, 3, 0)
x
D1(0, 1, -5)
C1(4, 1, -5)
A1(0, 3, -5)
B1(4, 3, -5)
1 0 4
0 0
2
0 1 0
0 0
1
(2.50)
n relaia de mai sus matricea I4 este cea care exprim atitudinea cinematic
iniial ntre reperul de baz i cel secundar. Dac suntem n cazul n care trebuie
determinat situarea final a obiectului, atunci matricea A ne permite s
determinm poziiile finale ale punctelor ce reprezint piramida. Calculul se
bazeaz pe relaia (2.12) i poate fi efectuat simultan pentru toate punctele
reprezentnd piramida. Astfel, folosind matricea P dat de relaia (2.4), care
reprezint situarea iniial a corpului n coordonate omogene, situarea final a
acestuia fa de reperul Oxyz este dat de matricea Pf:
0
3
Pf = A P =
0
4
3
0
1
4
1
0
1
0 0
4
4
0
1 3
3
1
1
0 5 5 5 5
1 1
1
1
1
(2.51)
61
ob
Acam
1
0
=
0
0 0
1 0
0 1
0 0
0 0
8
8
1 0
ap
; Acam =
0 1
2
1
0 0
1 4 2
0
6
; (2.52)
0 5 2
0
1
ap
Ab =
0
2
2
0
1
2
0
0
0
0
2
2
0
2
2
10 2
1
(2.53)
cam
ap
= Acam
Aap
6
0 1 0
0 0 1 5 2
1
=
1 0 0 4 2
1
0 0 0
(2.54)
cam
Abcam = Abap Aap
0
2
2
0
2
2
6 2
0 5 2
0 11 2
0
1
0
2
2
2
2
0
(2.55)
n fine, din aceast situare, n care reperul ataat obiectului este suprapus
peste cel ataat camerei, acesta ajunge n poziia i orientarea sa real, printr-o
ob
succesiune de micri ce sunt modelate de matricea Acam
. Din nou suntem n
situaia n care avem matricea raportnd situarea urmtoare la ultima poziie
intermediar a reperului care se mic, astfel c aplicnd nc o dat regula de
compunere a transformrilor omogene obinem:
cam
ob
ob
Abob = Abap Aap
Acam
= Abcam Acam
0
2
2
0
2
2
0
2
2
2
2
0
5 2
0 5 2
0 3 2
0
1
(2.56)
n relaia de mai sus am nlocuit valorile din relaiile (2.55) i (2.52). Calculul
efectuat conform relaiei (2.56) poate cpta o reprezentare grafic, precum aceea
din fig. 2.14. Pentru toate matricele de transformare omogen date prin enunul
problemei se traseaz cte o sgeat,
Abob
orientat de la reperul de baz ctre cel
secundar. Putem aplica regula de
compunere a transformrilor omogene
ap
cam
ap Acam
pentru cazul tuturor micrilor raportate
ob
b
ob
ap
la reperul secundar, dac avem o
Acam
Ab
cam
succesiune de sgei orientate n acelai
Aap
sens; de aceea n exemplul considerat a
ap
Fig. 2.14. Reprezentarea grafic a
fost nevoie de inversarea matricei Acam
.
aplicrii regulii de compunere a
De pe sgeile respective, plecnd de la
transformrilor omogene
reperul de baz ctre cel final, cel a crui
64
(2.57)
Se observ felul n care n produsul de mai sus dou matrice vecine respect
condiia ca indicele superior al matricei din stnga s fie acelai cu indicele inferior
al matricei din dreapta (ceea ce nseamn c acele dou matrice se refer la un
acelai reper, prima avndu-l ca reper secundar, a doua ca reper de baz).
n matricea dat prin relaia (2.56) avem informaiile cu privire la poziia i
orientarea obiectului fa de baza RI. Ceea ce intereseaz mai frecvent este
atitudinea cinematic a obiectului fa de apuctorul RI, pentru a putea extrage
informaiile cu privire la micrile pe care trebuie s le fac RI pentru a-i aduce
apuctorul n apropierea obiectului, n vederea prinderii acestuia. Din fig. 2.14 sau
din relaia (2.56) putem deduce direct valoarea matricei respective, adic:
ob
cam
ob
ap
Aap
Acam
= Aap
= Acam
ob
Acam
0 1
0 0
=
1 0
0 0
0
2
1
4 2
0 8 4 2
0
1
(2.58)
ob
, i anume pe baza valorilor din submatricea de
Conform matricei Aap
-
z3 = z2
zb = z1= z0
y3
r
x0 = xb
Os = Ob
y4
y5 = ys
y2
y1
yb = y0
x1 = x2
x5 = xs
-
x3 = x4
( )
dintre Osz1 i r este chiar , iar direcia vectorului r este una perpendicular pe
Osx1. n acest moment rotirea n jurul lui r de unghiul devine o rotaie n jurul
axei z a reperului secundar de unghi , reperul respectiv ajungnd n situarea
notat cu O3x3y3z3. Mai trebuie s efectum dou rotaii care s compenseze cele
dou micri auxiliare efectuate iniial. Aceasta presupune efectuarea de rotaii n
jurul acelorai axe ale reperului secundar, n ordine inversat, cu aceleai unghiuri
i de sensuri contrare; reperul secundar ajunge nti n poziia notat cu indicele 4
i apoi 5, aceasta fiind poziia final, cea care coincide cu aceea care s-ar fi obinut
dac reperul secundar ar fi suferit o singur micare, rotaia de unghi n jurul lui
r . Conform acestui raionament i innd seama de regula de compunere a
transformrilor omogene, avem (toate micrile efectuare au fost raportate la axe
ale reperului secundar):
( )
A r , = Rz R x Rz Rx Rz
(2.59)
67
(2.60)
( )
( )
A r , =
r (1 cos ) + cos
rx ry (1 cos ) + rz sin
rx rz (1 cos ) ry sin
2
x
rx ry (1 cos ) rz sin
r (1 cos ) + cos
rx rz (1 cos ) + ry sin
2
y
ry rz (1 cos ) + rx sin
0
ry rz (1 cos ) rx sin
rz2 (1 cos ) + cos
0
( )
0
(2.61)
0
( )
68
sx
sy
sz
0
ax
ay
az
0
0
0
0
(2.62)
1
(n x + s y + a z 1)
2
(2.63)
ceea ce permite aflarea lui . Fcnd diferenele a cte dou elemente alese
convenabil din matricele respective obinem:
2 rx sin = s z a y
2 ry sin = a x n z
(2.64)
2 rz sin = n y s x
i fiind deja determinat rezult componentele versorului r . Deci, pe baza
elementelor din matricea T, care exprim orientarea relativ a celor dou repere,
am putut afla versorul r i unghiul care dau micarea de rotire necesar pentru
suprapunerea celor dou repere.
Din cele prezentate apare ca existnd o echivalen ntre reprezentarea
orientrii ntre dou repere printr-o matrice de transformare omogen sau printr-un
69
s y cos
n x cos
a cos
, ry =
, rx = z
1 cos
1 cos
1 cos
(2.65)
0
1
0
1/ 2
T =
0 3 / 2
0
0
0
3/2
1/ 2
0
0
0
0
(2.66)
caracterizeze aceast rotaie. Prin relaia (2.63) rezult cos = 1/2, de unde se poate
alege valoarea = 60. Pe baza relaiilor (2.64) se calculeaz componentele
versorului
r
n jurul cruia trebuie efectuat rotaia. Rezult:
rx = 1, ry = 0, rz = 0 . Valorile obinute ne arat c apuctorul trebuie s se
roteasc n jurul axei Obxb, n sensul negativ al acesteia (datorit faptului c
vectorul r va fi direcionat n sensul negativ al lui Obxb), cu un unghi de 60; se
poate verifica obinerea n adevr a orientrii date de matricea T dup o asemenea
micare (vezi relaia (2.35)).
n concluzie, din cele prezentate pn aici rezult c prin compunerea
transformrilor omogene se poate modela atitudinea cinematic relativ a
corpurilor, atitudine rezultat dup o succesiune de micri precizate ale acestora.
Pentru cazul RI s-a dezvoltat un formalism specific, bazat pe transformrile
omogene, dar care ine seama i de particularitile lanurilor cinematice formnd
RI i care este eficient din punct de vedere computaional. Acesta este formalismul
Denavit-Hartenberg, prezentat n paragraful urmtor.
zi-1
zi-2
zi
i
ai
Oi
xi
ri2
xi
Oi
ai
xi
Segment
i-1
Ai
zi-1 di
xi-1
pe zi-1.
a)
Segment i
zi i
Ai-1
Articulaia i
Articulaia i+1
i +1
Articulaia
i-1
r i 1
yi
Articulaia
i+1
Oi-2
ai-1
yi-1
Segment
i+1
di
Oi-1
xi-1
xi
ri
i-1
Ai
b)
Oi-1
72
1
0
0
1
0
0
0 0 cos i
0 0 sin i
1 di 0
0 1 0
cos i
sin
i
=
0
sin i
cos i
0
0
sin i cos i
cos i cos i
sin i
0
0
0
1
0
0 1
0 0
0 0
1 0
0
1
0
0
sin i sin i
cos i sin i
cos i
0
0 a i 1
0
0 0 0 cos i
1 0 0 sin i
0 1 0
0
ai cos i
ai sin i
di
0
sin i
cos i
0
0
0
=
0
(2.67)
C i
S
i
Ai 1 = i
0
S i C i
C i C i
S i
0
S i S i
C i S i
C i
0
ai C i
ai S i
di
(2.68)
(2.69)
75
77
x1
x
y1
O1 = O2
x2
Fig. 2.17. Definirea unghiurilor lui Euler
z1 = z 12
z2
y2
O1 = O2
x1
x12
y 22
y 12
x1
x2
reperului
jurul axei
de unghi
Se execut o rotaie a
secundar O2x2y2z2 n
z a reperului de baz
; n urma acestei
79
C
S
=
0
C
0
0
0
0
1
0
0 1 0
0 0 C
0 0 S
1 0 0
CC SSC
SC + CSC
=
SS
80
0
S
C
0
0 C
0 S
0 0
1 0
CS SCC
SS + CCC
SC
0
S
C
0
0
SS
CS
C
0
0
0
1
0
0
0
0
0
0
=
0
(2.70)
Rrpy
Cr
Sr
z
y
x
= Rr R p R y =
0
Sr 0 0 Cp
Cr 0 0 0
0
1 0 Sp
0
0 1 0
0 Sp 0 1 0
0
1 0 0 0 Cy Sp
0 Cp 0 0 Sy Cy
0 0 1 0 0
0
0
0
0
0
0
0
0
0
=
0
(2.71)
()
fd : D Rn D' R6; z = fd q
(2.72)
(2.73)
n relaia de mai sus apar n matrice D-H, care sunt matrice de transformare
omogen i prin produsul acestora se obine tot o matrice de transformare
omogen, rezultnd relaia:
r 0 = A0n r n
(2.74)
(2.75)
xn
n
On
segment n
efector
zn
a
s
yn
rn
r0
segment 0
batiu
z0
y0
x0
O0
Fig. 2.20. Repere pentru determinarea modelului cinematic direct
fiecare matrice Aii1 depinde de cei patru parametri D-H, dintre care unul este
parametrul variabil la micarea articulaiei i i respectiv a segmentului i, acest
parametru intrnd n componena vectorului coordonatelor generalizate. Adic
relaia anterioar se scrie, innd seama de parametri variabili care apar, sub forma:
(2.76)
( )
sx
sy
sz
0
ax
ay
az
0
px
p y n s a
=
p z 0 0 0
(2.77)
85
86
( )
coordonatelor operaionale, conform celor artate mai sus. Cum A0n = A0n q(t ) ,
rezult c expresia (2.72) a operatorului modelului cinematic direct este justificat.
zob
(2.78)
Anob este
ale reperului 1 sunt mai dificil de ales. Apar astfel nedeterminrile despre care am
amintit anterior, n legtur cu plasarea originii O1 i a axei x1. Axele z ale
reperelor 0 i 1 nu se intersecteaz; mai mult, ele fiind paralele, orice dreapt din
planul robotului este perpendicular pe axele z ale reperelor respective. Aceste
nedeterminri se rezolv aa cum s-a indicat n paragraful 2.7: se alege plasarea
axei x1 n lungul segmentului 1, aceasta fiind singura poziie pentru care axa x a
reperului 1 se intersecteaz cu axa z a reperului 0 i deci parametrii D-H, d1 i
a1, pot fi determinai. Odat ce axa x1 a fost stabilit, originea O1 rezult la
intersecia lui x1 cu z1. Reperul O1x1y1z1 este completat prin fixarea axei y1, n aa
fel nct s rezulte un reper triortogonal drept.
Parametrii D-H se afl dup definiiile lor, conform algoritmului D-H i au
valorile (vezi i fig. 2.22):
d 1 = 0; a1 = l1 ; 1 = 1 (t ); 1 = 0
(2.79)
C 1
S
1
A0 = 1
0
S 1
C 1
0
0
0 l1C 1
0 l1 S 1
1
0
0
1
(2.80)
Plasarea reperului final, care este n cazul studiat reperul 2, se face respectnd
cerina ca axa z s fie paralel cu direcia de micare a ultimei articulaii. Celelalte
elemente ale reperului 2 sunt principial la alegerea celui ce determin modelul, dar
aici singura variant care permite s obinem parametrii d2 i a2 este aceea n care
axa x2 este aezat n lungul segmentului 2, caz n care se intersecteaz cu axa z1.
Se observ, dup fixarea reperului O2x2y2z2, c parametrii d2, a2, 2 i 2 au valori
similare cu cele date prin relaiile (2.79), cu singura deosebire c n loc de l1 apare
l2 lungimea celui de-al doilea segment al robotului. Rezult c i matricea A12
are form similar cu A01 (relaia 2.80), cu deosebirea c n loc de 1 apare 2 i
n loc de l1 apare l2.
89
0
C12
S
= 12
0
S12
C12
0
0
S 1
C 1
0
0
0 l1C1 C 2
0 l1 S1 S 2
1
0 0
0
1 0
0 l1C1 + l2C12
0 l1S1 + l2 S12
1
0
0
1
S 2
C 2
0
0
0 l 2 C 2
0 l 2 S 2
=
1
0
0
1
(2.81)
l1 cos 1 + l 2 cos( 1 + 2 )
l sin + l sin ( + )
1
2
1
2
1
0
z=
(2.82)
( )
sus, q(t ) = (1 (t ) 2 (t )) .
Odat determinat modelul cinematic direct, acesta ne permite s aflm
atitudinea cinematic a efectorului pentru diferite poziii precizate ale articulaiilor.
De exemplu, fie urmtoarele dou cazuri ale siturii articulaiilor robotului studiat,
precizate prin valorile vectorului q la dou momente de timp t1 i t2:
T
(
q(t ) = (26,612
i) q(t1 ) = 72,185o
ii)
314,427 o
o
45,573o
y0
2(t1)
x2
x1
O2
x2
1(t1) = 72
2(t1) = 315
1(t2) = 27
2(t2) = 45
2(t2)
x1
1(t1)
O0
1(t2)
x0
Considernd lungimile
celor dou segmente ale
robotului ca fiind egale, l1 =
l2 = 0,5 i calculnd valorile
vectorului
coordonatelor
operaionale la cele dou
momente de timp, obinem
aceeai poziie a efectorului
(vezi fig. 2.23), dat prin
coordonatele punctului O2:
xO2 (t1 ) = xO2 (t 2 ) = 0,6;
zO2 (t1 ) = z O2 (t 2 ) = 0
91
i
1 = variabil
2 = variabil
0
4 = variabil
5 = variabil
6 = variabil
i
-90
90
0
-90
90
0
ai
0
0
0
0
0
0
di
d1
d2
d3 = variabil
0
0
d6
93
C1
S
1
A0 = 1
0
0
1
0
3
A2 =
0
0 S1
0
C1
1 0
0
0
0
1
0
0
0
0
;
d1
0 0
0 0
;
1 d3
0 1
C 2
S
2
A1 = 2
0
0 S2
0 C2
1
0
0
0
C 6
S
6
A5 = 6
0
S6
C6
0
0
0
0
;
d2
(2.83)
0 0
0 0
1 d6
0 1
A45 are aceeai form ca A12` cu deosebirile c n loc de C2 i S2 apar C5 i S5, iar
ultima coloan are primele trei elemente nule. Pe baza celor 6 matrice Ai11 se poate
calcula matricea A06 , conform relaiei
6
0
n x = C1 (C 2 (C 4 C 5 C 6 S 4 S 6 ) S 2 S 5 C 6 ) S1 (S 4 C 5 C 6 + C 4 S 6 )
n y = S1 (C 2 (C 4 C 5 C 6 S 4 S 6 ) S 2 S 5 C 6 ) + C1 (S 4 C 5 C 6 + C 4 S 6 )
n z = S 2 (C 4 C 5 C 6 S 4 S 6 ) C 2 S 5 C 6
s x = C1 (S 2 S 5 S 6 C 2 (C 4 C5 S 6 + S 4 C6 )) S1 (C 4 C6 S 4 C5 S 6 )
s y = S1 (S 2 S 5 S 6 C 2 (C 4 C5 S 6 + S 4 C6 )) + C1 (C 4 C6 S 4 C5 S 6 )
s z = S 2 (C 4 C 5 S 6 + S 4 C 6 ) + C 2 S 5 S 6
a x = C1 (C 2 C 4 S 5 + S 2 C 5 ) S1 S 4 S 5
94
(2.84)
a y = S1 (C 2 C 4 S 5 + S 2 C 5 ) + C1 S 4 S 5
a z = S 2 C 4 S 5 + C 2 C5
Px = C1 S 2 d 3 S1d 2 + (C1C 2 C 4 S 5 S1 S 4 S 5 + C1 S 2 C5 ) d 6
Py = S1 S 2 d 3 + C1d 2 + (S1C 2 C 4 S 5 + C1 S 4 S 5 + S1 S 2 C5 ) d 6
Pz = C 2 d 3 + d1 + (C 2 C5 S 2 C 4 S 5 ) d 6
i
1 = variabil
2 = variabil
3 = variabil
4 = variabil
5 = variabil
6 = variabil
i
-90
0
90
-90
90
0
ai
0
432
-20
0
0
0
di
0
149
0
432
0
56
deasupra planului pe care este aezat baza RI (la o distan de 660,4 mm, conform
fig. 2.2), i n consecin rezultatele care se obin prin forma care se va deduce
pentru modelul RI vor fi raportate la acest plan.
Deoarece toate articulaiile robotului sunt realizate cu cuple cinematice
de rotaie, parametrii D-H variabili sunt i; n fig. 2.2 apar rotirile maxime ale
articulaiilor.
96
C1
S
A01 = 1
0
0 S1 0
0
C1 0
;
1 0
0
0
0 1
C3
S
3
A2 = 3
0
0 S3
0 C3
1
0
0
0
a3 C 3
a3 S 3
;
0
C 4
S
4
A3 = 4
0
0 S4
0 C4
1 0
0
0
C 5
S
5
A4 = 5
0
0 S5
0 C5
1
0
0
0
0
0
;
0
C 6
S
6
A5 = 6
0
S6
C6
0
0
C2
S
A12 = 2
0
C2
0
0
0 a2 C 2
0 a2 S 2
;
1 d2
0
1
0
0
;
d4
(2.85)
0 0
0 0
1 d6
0 1
n x = C1 (C 23 (C 4 C 5 C 6 S 4 S 6 ) S 23 S 5 C 6 ) S1 (S 4 C 5 C 6 + C 4 S 6 )
n y = S1 (C 23 (C 4 C 5 C 6 S 4 S 6 ) S 23 S 5 C 6 ) + C1 (S 4 C 5 C 6 + C 4 S 6 )
n z = S 23 (C 4 C 5 C 6 S 4 S 6 ) C 23 S 5 C 6
s x = C1 (S 23 S 5 S 6 C 23 (C 4 C5 S 6 + S 4 C6 )) S1 (C 4 C6 S 4 C5 S 6 )
s y = S1 (S 23 S 5 S 6 C 23 (C 4 C5 S 6 + S 4 C6 )) + C1 (C 4 C6 S 4 C5 S 6 )
s z = S 23 (C 4 C 5 S 6 + S 4 C 6 ) + C 23 S 5 S 6
a x = C1 (C 23 C 4 S 5 + S 23 C 5 ) S1 S 4 S 5
a y = S1 (C 23C 4 S 5 + S 23C5 ) + C1 S 4 S 5
(2.86)
a z = S 23 C 4 S 5 + C 23 C 5
p x = C1 (d 6 (C 23C 4 S 5 + S 23C5 ) + S 23 d 4 + a3C 23 + a2 C 2 ) S1 (d 6 S 4 S 5 + d 2 )
p y = S1 (d 6 (C 23C4 S 5 + S 23C5 ) + S 23 d 4 + a3C 23 + a2 C 2 ) + C1 (d 6 S 4 S 5 + d 2 )
p z = d 6 (C 23C5 S 23C 4 S 5 ) + C 23 d 4 a3 S 23 a2 S 2
0 0
98
0 149
1 920
0 20
0
1
(2.87)
()
fi :D' R6 D R n ; q = fi z
(2.88)
99
()
()
A0n q = E
(2.89)
B A0n S = E
(2.90)
n egalitatea de mai sus, cum baza RI este fix, iar obiectul este solidarizat de
efector, matricele B i S sunt constante n timp i pot fi calculate. Necunoscutele q1,
, qn apar numai n A0n i astfel relaia (2.90) sus se aduce la forma (2.89) dup
101
n n = s s = a a = 1; n s = a
(2.91)
cinematic invers este aceea de robot rezolvabil [Dom, 88]: un robot este rezolvabil
atunci cnd pentru orice valoare dat lui z se pot determina analitic toate valorile
corespunztoare ale lui q , conform modelului cinematic invers. Astfel spus, RI
este de tip rezolvabil dac pentru orice atitudine cinematic precizat a efectorului
se pot determina toate soluiile ecuaiilor care formeaz modelul cinematic invers,
prin expresii analitice explicite. Rezultatul formulat n acest sens este urmtorul
[Dom, 88]:
- Toi RI cu mai puin de 6 gdm sunt rezolvabili.
- Pentru RI cu 6 gdm se tie c sunt rezolvabili aceia care satisfac una din
condiiile:
a) cei care au 3 cuple de translaie;
b) cei care au 3 cuple de rotaie cu axele de rotaie concurente;
c) cei care au o cupl de rotaie i una de translaie cu axele de
micare coaxiale;
d) cei care au 2 perechi de cuple de rotaie cu axele de micare
concurente.
- Nu s-au formulat asemenea rezultate pentru RI cu mai mult de 6 gdm.
Se poate ns observa c RI actuali, pe care i-am folosit ca exemple anterior,
se ncadreaz n clasa celor rezolvabili: att RI Stanford ct i PUMA au 6 gdm i
au ultimele 3 articulaii de rotaie, cu axele concurente.
n ceea ce privete numrul de soluii pentru ecuaiile ce formeaz modelul
cinematic invers, pot apare toate cele trei situaii posibile.
1. Modelul cinematic invers nu are nici o soluie atunci cnd atitudinea
cinematic fixat pentru efector este n afara spaiului de lucru D. Conform celor
precizate n capitolul anterior, spaiul de lucru este o caracteristic a fiecrui RI,
fiind determinat de numrul gdm, de structura lanului cinematic, de dimensiunile
segmentelor RI i de restriciile mecanice ale deplasrilor articulaiilor. Atitudinea
cinematic fixat pentru efector se poate situa n afara spaiului de lucru din punct
de vedere al poziiei, al orientrii sau din ambele puncte de vedere. Pentru RI cu
mai puin de 6 gdm orientrile pe care le poate atinge efectorul sunt limitate, astfel
c frecvent se pune numai problema gsirii acelei valori a vectorului q pentru care
efectorul RI atinge o poziie precizat, fr s intereseze orientarea. n acest sens,
se folosesc i noiunile de spaiu de lucru de orientare (termenul n limba englez
103
(2.92)
(2.93)
sau lund n consideraie semnificaia inversei matricei A01 , relaia (2.93) devine:
A12 (q2 ) . . . Ann1 (qn ) = A10 (q1 ) E
(2.94)
(2.94) cu A12 (q 2 ) :
1
A10 (q1 ) E
(2.95)
(2.96)
n membrul drept al ultimei ecuaii singura necunoscut este q2, q1 fiind deja
determinat. Din (2.96) se va putea determina q2, dup care se procedeaz n mod
similar pentru q3, q4,,qn. Ultima ecuaie, care se folosete att pentru
determinarea lui qn-1, ct i a lui qn are forma:
Ann1 (q n ) = Ann12 (q n 1 )... A10 (q1 ) E
(2.97)
necunoscuta qn-1 fiind izolat n membrul drept al ecuaiei, iar qn n cel stng.
Pentru a explica felul n care se determin n fiecare pas o necunoscut s
considerm o ecuaie generic, aa cum apare n procesul separrii necunoscutelor:
Aii +1 (qi +1 ) . . . Ann1 (qn ) = Aii 1 (qi ) ... A10 (q1 ) E
(2.98)
107
(2.99)
[ ]
, obinndu-se:
(2.100)
Din aceasta se ncearc determinarea lui qn, dup care se va putea continua
procedeul cu izolarea, n ordine, a necunoscutelor qn1 , . . ., q1 . De asemenea,
aceast variant poate fi ncercat atunci cnd o necunoscut qi nu poate fi
determinat prin prima variant a metodei (ecuaia de forma (2.98) nu permite
calculul lui qi ). Vom exemplifica metoda pe cazul RI de tip Stanford.
Exemplul 2.10. S se determine modelul cinematic invers pentru RI de tip
Stanford, n urmtoarele ipoteze simplificatoare, care nu influeneaz modul de
aplicare a metodei.
Presupunem c atitudinea cinematic a efectorului, care este cunoscut
n cazul modelului cinematic invers, este precizat sub forma unei matrice de
transformare omogen E, exprimnd poziia i orientarea reperului O6x6y6z6 fa de
reperul O0x0y0z0, unde aceste repere sunt cele pe care le-am ataat atunci cnd am
calculat modelul cinematic direct al acestui RI (exemplul 2.9, Fig. 2.24).
Cunoatem deci matricea E ale crei elemente le notm cu:
nx
n
E= y
nz
sx
sy
sz
0
ax
ay
az
0
px
p y
pz
(2.101)
(2.102)
(2.103)
[A (q )]
1
0
C1
0
= A10 (q1 ) =
S1
S1
0
C1
0
0 0
1 d1
0 0
0 1
(2.104)
produsul A12 (q 2 )... A56 (q n ) = A16 (q 2 , ... , q 6 ) s fie deja calculat de la determinarea
modelului cinematic direct. Avnd matricea A16 , din relaia matriceal (2.103)
rezult direct necunoscuta q1 (q1 = 1, articulaia 1 fiind de rotaie), deoarece n
matricea A16 elementul de pe linia 3, coloana 4 nu depinde de nici una din
necunoscutele q2, . . . , q6. Ecuaia corespunztoare acestui element este:
S1 p x + C1 p y = d 2
(2.105)
] [A (q )]
1
0
(2.106)
(2.107)
] [A (q )] [A (q )]
2
1
1
0
(2.108)
(2.109)
Analog rezult q 4 = 4 :
] [A (q )] [A (q )] [A (q )]
3
2
2
1
1
0
(2.110)
(2.111)
Deoarece matricea A56 are pe primele trei linii elemente care nu depind de q6 (de
exemplu elementul de pe linia 3, coloana 4, vezi (2.83)), dup nmulirea relaiei
(2.110) n ambii membri, la stnga, cu inversa matricei A45 va putea fi determinat
necunoscuta q5 = 5, iar apoi q6 = 6 rezult direct, fiind singura necunoscut
rmas.
111
112
Muli RI satisfac una din aceste condiii astfel c metoda va putea fi aplicat.
Vom preciza modul de aplicare pentru RI care au ultimele 3 articulaii de rotaie, cu
axe concurente, situaia cea mai frecvent ntlnit n practic (de exemplu RI de tip
PUMA i Stanford se ncadreaz n aceast categorie). Dac aceast condiie este
ndeplinit atunci originile ultimelor 3 repere pot fi plasate n acelai punct (O4 =
O5 = O6), neglijndu-se lungimea efectorului (se consider d6 = 0, vezi Fig.2.24 i
2.25). Aceast aproximare poate fi compensat prin considerarea unei dimensiuni
corespunztor mai mari a obiectului de manipulat.
Dac reperul O3x3y3z3 este plasat la captul segmentului 3, acolo unde acesta
se leag de segmentul 4 prin articulaia 4 (vezi de exemplu plasarea reperelor pe RI
Stanford, Fig.2.24) atunci i originea O3 este plasat n acelai punct cu O6. La RI
de tip PUMA aceast plasare se poate obine prin modificarea celei din Fig. 2.25
printr-o translare a reperului O3x3y3z3 n lungul axei z3 de segment d4; n acest fel
parametrul D-H d3 preia lungimea lui d4, care se anuleaz. n aceast situaie
poziia punctului O6 este determinat de primele 3 articulaii i din sistemul de
ecuaii corespunztor poziiei lui O6 se vor determina necunoscutele q1, q2 i q3;
ultimele 3 articulaii influeneaz numai orientarea reperului final, astfel c din
considerarea acesteia se va scrie sistemul de ecuaii pentru determinarea lui q4, q5 i
q6, obinndu-se decuplarea respectiv.
Concret, n condiiile de mai sus poziia originii O6 fa de reperul de baz
O0x0y0z0 este aceeai cu poziia lui O3 fa de reperul de baz i este dat, conform
semnificaiei elementelor dintr-o matrice de transformare omogen, de ultima
coloan din matricea A03 . Cum A03 se calculeaz prin produsul A03 = A01 A12 A23 ,
ultima coloan a sa se poate determina prin:
A01 A12 (a3 cos 3 a3 sin 3 d 3 1)
(2.112)
adic prin produsul dintre matricea A02 i ultima coloan a matricei A23 , pentru care
am folosit expresia (2.67). Cum pentru modelul cinematic invers poziia reperului
final fa de reperul de baz este dat, nseamn c sunt cunoscute coordonatele
punctului O6 = O3, fa de reperul O0x0y0z0; fie aceste coordonate px, py i pz.
Egalndu-le pe acestea cu cele date de (2.112) obinem urmtoarea relaie:
113
1 1
(2.113)
(2.114)
[ ]
A36 ( 4 , 5 , 6 ) = A03
(2.115)
unde membrul drept este o cantitate cunoscut, iar cele 3 necunoscute sunt
unghiurile , deoarece lucrm n ipoteza n care ultimele 3 articulaii sunt de
rotaie. Din relaia matriceal (2.115) se va trece la un sistem de ecuaii scalare, cu
necunoscutele 4, 5 i 6, considernd egalitile corespunztoare elementelor din
submatricele de rotaie din matricele din cei doi membri ai egalitii (2.115).
Aceasta deoarece, n ipotezele n care lucrm, ultimele 3 articulaii influeneaz
numai orientarea efectorului i informaiile cu privire la aceasta sunt cuprinse n
submatricea de rotaie. Se obine tot un sistem de ecuaii trigonometrice i dup
rezolvarea acestuia modelul cinematic invers este complet determinat. Fcnd parte
din clasa metodelor algebrice, ca i la metoda separrii necunoscutelor, se impun
aceleai observaii cu privire la verificarea corectitudinii soluiilor obinute.
114
b
necunoscutele sunt n cazul modelului cinematic
invers 1 i 2. Spaiul de operare pentru acest
O1
x0
RI
a fost prezentat n Fig. 2.27 (pentru cazul l1 =
O01 a
l2) i deoarece RI respectiv are 2 gdm, pentru
efector
se va putea prescrie poziia n plan
Fig. 2.29. Determinarea
(pentru a putea realiza i o orientare prescris a
modelului cinematic invers
efectorului
n plan este necesar un RI cu mcar 3
pentru RI plan bimobil
gdm). nseamn c n cazul modelului cinematic
invers sunt cunoscute coordonatele punctului O2
(originea reperului final) fa de reperul de baz; fie acestea a, respectiv b.
Parametrul 2 poate fi determinat din triunghiul O0O1O2 pe baza teoremei
cosinusurilor:
y0
(2.116)
115
(2.117)
(2.118)
adic poziia prescris pentru apuctor (reprezentat n modelare prin punctul O2)
trebuie s se gseasc n interiorul coroanei circulare ce este delimitat de cercurile
de raz l1 l 2 i respectiv l1 + l2, acesta fiind spaiul de operare de poziionare
pentru acest RI, atunci cnd cele dou articulaii se pot roti n intervalul a 360,
conform celor artate anterior.
n ceea ce privete numrul de soluii, pentru orice valori fixate pentru a i b,
care verific inegalitile (2.118), prin ecuaia (2.117) vor rezulta dou soluii
pentru 2: una cuprins ntre 180 i 360, care corespunde siturii RI reprezentat
cu linie continu n Fig.2.29 i alta cuprins ntre 0 i 180, care corespunde
siturii RI ce este reprezentat cu linie ntrerupt. Atunci cnd poziia prescris
pentru O2 se situeaz pe frontiera spaiului de operare, ceea ce nseamn c este
ndeplinit una din condiiile
a 2 + b 2 = l1 +l2 , sau
a 2 + b 2 = l1 l 2 triunghiul
= arctg (b / a )
(2.119)
unde pentru specificarea din Fig. 2.29, n care a i b sunt pozitive, se va alege
unghiul situat n primul cadran; n mod corespunztor, n funcie de semnele
116
a 2 + b 2 + l12 l 22
2l1 a 2 + b 2
(2.120)
relaie din care va rezulta , alegndu-se o valoare cuprins strict ntre 0 i 180,
deoarece calculul s-a bazat pe faptul c este unghi ntr-un triunghi. O dat
determinate unghiurile i , 1 rezult:
1 =
(2.121)
unde cele dou soluii pentru 1 corespund celor dou soluii aflate pentru 2:
soluia corespunztoare semnului plus este cea pentru situarea figurat cu linie
continu, iar cea corespunztoare semnului minus este pentru situarea reprezentat
cu linie ntrerupt. Pentru cazul configuraiilor singulare rezult = 0 i deci la fel
ca i pentru 2, avem o singur soluie pentru 1 (conform relaiei (1.121), 1 = ).
Abordarea geometric ne poate furniza soluiile pentru orice poziie prescris
pentru efector. De exemplu, n Fig. 2.30 este prezentat cazul prescrierii unei poziii
n cadranul al doilea. Formulele (2.117), (2.119), (2.120) i (2.121) prin care se
determin necunoscutele 1 i 2 rmn valabile, iar semnele lui a i b intervin n
determinarea lui , prin relaia (2.119), alegndu-se acea valoare a lui care
corespunde cadranului n care se afl punctul O2. Singura situaie pe care am
exclus-o n aceast rezolvare este aceea n care punctul prescris este originea
reperului de baz (O2 trebuie s ajung n O0). De altfel, aceasta nseamn a = b =
0 i unghiurile i nu mai pot fi determinate prin (2.119) i (2.120). Se observ
pe Fig. 2.29 c RI studiat i poate aduce efectorul n O0 numai atunci cnd cele
dou segmente au lungimi egale. n acest caz, relaia (2.117) furnizeaz pentru l1 =
l2 i a = b = 0 n mod corect valoarea 2 = 180, iar 1 rmne nedeterminat. n
cazul n care l1 = l2 i 2 = 180, RI are efectorul n O0 indiferent de valoarea lui
1. De fapt, aceasta este singura situaie pentru acest RI n care aceasta poate
realiza orice orientare n plan a efectorului su i n funcie de orientarea dorit va
rezulta valoarea lui 1.
117
y0
l2 2
O2
x1
O1
l1 1
O0
1o = 0
O0
x0
O1
2o
x1 x0
l1= l2 = 0,5
O2
x2
Fig. 2.31. O poziie iniial
precizat a RI plan bimobil
11 = 26,612 o i 21 = 45,573o
12 = 72,185 o i 22 = 314,427 o
care concord cu valorile din exemplul 2.8.
Pentru poziia iniial a RI conform Fig. 2.31 valorile unghiurilor 1 i 2
sunt 1i = 0 i 2i = 270 o . Sistemul de control al robotului va alege una din cele
dou soluii i corespunztor acesteia vor rezulta deplasrile pe care trebuie s le
efectueze cele dou articulaii ale RI pentru a aduce efectorul n poziia final
dorit:
11 = 11 1i = 26,612 o i 21 = 21 2i = 224,427 o
12 = 12 1i = 72,185o i 22 = 22 2i = 44,427 o
O dat aleas, una dintre aceste perechi de valori este folosit de sistemul de
control pentru a comanda deplasrile celor dou articulaii; dac aceste deplasri
sunt realizate fr eroare i dac poziia iniial este corect determinat, atunci RI
i va aduce efectorul n poziia final prescris, conform sarcinii de ndeplinit. Este
astfel evideniat importana modelului cinematic invers pentru sistemul de control
al unui RI.
n concluzie, se poate spune c problema cinematic invers, cea a crei
rezolvare nseamn determinarea modelului cinematic invers, nu are o metod
general valabil de soluionare, ci exist cteva variante i cel care face modelarea
trebuie s o aleag pe cea care este mai potrivit pentru RI respectiv. Modelul
cinematic invers are pentru majoritatea RI soluii multiple i pentru RI de tip
rezolvabil toate acestea vor putea fi determinate, sistemul de control al RI trebuind
s aleag o singur soluie, corespunztor creia vor fi determinate deplasrile
articulaiilor care s aduc efectorul n situarea n care aceasta ndeplinete sarcina
prescris. Dac pentru RI cu mai mult de 6 gdm sunt dificil de determinat
expresiile explicite ale componentelor vectorului q n funcie de atitudinea
cinematic a efectorului fa de baza RI, n cazul RI actuali, avnd ntre 3 i 6 gdm,
s-a putut explicita modelul cinematic invers, fie prin abordri algebrice, fie
geometrice.
119
cteva tipuri de roboi industriali actuali se vor obine acele cunotine necesare
pentru utilizarea i programarea roboilor, respectiv pentru proiectarea sistemului
de control n cazul construirii unui robot.
ntrebri i probleme
1. Precizai ce nseamn problema cinematic direct i respectiv cea
invers.
2. Facei o comparaie ntre precizarea orientrii unui obiect prin
intermediul unghiurilor lui Euler, respectiv prin unghiurile roll, pitch i yaw.
3. Precizai ce nseamn c un RI este de tip rezolvabil.
4. Precizai ce nseamn spaiu de operare de poziionare i respectiv de
orientare. Cum pot fi determinate acestea?
5. Cte soluii poate avea modelul cinematic invers al unui RI?
6. Care sunt avantajele/dezavantajele metodelor de calcul al modelului
cinematic invers de tip algebric, respectiv geometric.
7. Fiind
date
reperele
triortogonale plasate ca n desenul
zC
alturat s se afle matricele de
yC
90
O
transformare omogen care exprim:
C
60
atitudinea cinematic a reperului cu
xC
indicele B fa de reperul cu indicele A,
zA
z
a
reperului cu indicele C fa de reperul
B
yA
cu indicele B i respectiv a reperului cu
xB OB
OA xA
indicele C fa de reperul cu indicele A.
yB
Se cunosc dimensiunile segmentelor:
OAOB = 3; OBOC = 2 i respectiv
unghiurile marcate pe desen.
8. Fie un reper de baz Oxyz (reper fix). Apuctorul unui robot are ataat un
sistem de coordonate triortogonal Ouvw, care iniial coincide cu reperul de baz
(Ou Ox; Ov Oy; Ow Oz). Un punct caracteristic P de pe apuctor se afl
_
III
II
I
122
ai
0
0
0
di
0
var
var
i
0
90
0
i
var
180
0
ai
0
0
1
di
0
var
0
i
0
0
90
i
var
0
var
123
Bibliografie
ABB User Manuals 4.0 (2000). ABB Robotics Products AB, Vasteras, Suedia.
Beni G., Hackwood S. (editori) (1985). Recent Advances in Robotics, John
Wiley & Sons, New York.
Borangiu Th., Hossu A. (1991). Sisteme educaionale n robotic, Editura
Tehnic, Bucureti.
Cru N. D., Popescu Gh. (1986). Roboi industriali n sistemele flexibile, n
AMC vol. 52 - 55, Editura Tehnic, Bucureti.
Cojocaru G., Kovacs Fr. (1985). Roboii n aciune, Editura Facla, Timioara.
Cooper G., Medrano-Cerda G., Larmouth J. C., Nagy F. L. N. (1991). Robot
Sapiens on the move to personal robots, Preprints of the IFAC/IFIP/IMACS
Symposium on Robot Control, Viena, pg. 205 212.
Craig J. (1986). Introduction to Robotics: Mechanics & Control, Addison
Wesley, Reading.
Davidoviciu A., Magda R. (1983). Roboi industriali, Editura Tehnic,
Bucureti.
Davidoviciu A., Drgnoiu Gh., Moang A. (1986). Modelarea, simularea i
comanda manipulatorelor i roboilor industriali, Editura Tehnic, Bucureti.
Dombre E., Khalil W. (1988). Modelisation et commande des robots, Hermes, Paris.
Dudi Fl., Diaconescu D., Gogu Gr. (1989). Mecanisme articulate, Editura
Tehnic, Bucureti.
Engelberger J. (1980). Robotics in Practice, American Management
Associations, USA.
Fu K. S., Gonzalez R. C., Lee C. S. G. (1987). Robotics: Control, Sensing,
Vision, and Intelligence, Mc Graw-Hill, New York.
Ispas V. (1990). Aplicaiile cinematicii n construcia manipulatoarelor i a
roboilor industriali, Editura Academiei Romne, Bucureti.
Ivnescu Mr. (1994). Roboi industriali, Editura Universitaria, Craiova.
Jordanides T., Torby B. (editori) (1991). Expert Systems and Robotics, SpringerVerlag, Berlin.
Kovacs Fr., Cojocaru G. (1982). Manipulatoare, roboi, i aplicaiile lor
industriale, Editura Facla, Timioara.
Mangeron D., Irimiciuc N. (1980). Mecanica rigidelor cu aplicaii n inginerie,
Vol. II, Editura Tehnic, Bucureti.
Murphy R. (2000). Introduction to AI Robotics, The MIT Press, Cambridge,
Massachusetts.
124
Index
A
Algoritmul Denavit-Hartenberg
Articulaie
76
30
B
Bra robot
15, 30
C
Capacitate de sarcin
Complian
Consola de programare
Coordonate omogene
Cosinusuri directoare
Cupl cinematic
12, 25
27
20, 31
41
46
39
D
Distan maxim de lucru
23
E
Efector
G
Grade de libertate
23
L
Lan cinematic
37
M
Metoda decuplrii
Metoda separrii necunoscutelor
126
112
106
Modelul diamic
P
Parametru Denavit-Hartenberg
Precizia de poziionare
Problema cinematic
Direct
Invers
Programare prin nvare
Programare textual
Punct caracteristic
73, 75
23, 24
38, 83, 86, 99, 120
38, 100, 102, 118, 119, 120
7, 20, 21, 22
7, 20, 22
23
R
Reper Denavit-Hartenberg
73
Repetabilitatea
24
Reprezentare Denavit-Hartenberg
71
Rezoluia
25
Robot
Acionat electric
17
Articulat
13
Autonom
1
Cu comanda continu a traiectoriei 20
Cu detectare adaptiv
22
Cu detectare binar
22
Cu programare cablat
21
Definiia
1, 35
De revoluie
13
Gantry
16
Hidraulic
16
Inteligent
2
n bucl nchis
19
n coordonate carteziene
10
n coordonate cilindrice
11
n coordonate sferice
12
Manipulator
10
Mobil
5, 6, 15
Non-servo
18
Plan bimobil
88, 104, 115
127
Pneumatic
Puma
Punct cu punct
Redundant n raport cu sarcina
Rezolvabil
Scara
Secvenial
Stanford
Tehnologic
Robotic
Robot industrial
Staionar
17
9, 40, 95, 102, 113
20
105
103
13, 27
19
9, 92, 109, 113
10
3, 4
1, 9
5, 15
S
Segment robot
Senzor intern/extern
Spaiul de lucru
De orientare
De poziionare
Subsistem de orientare
Subsistem de poziionare
23, 30
6
11, 12, 13, 23, 104
103
104
30
30
T
Telemanipulator
Transformare Denavit-Hartenberg
Transformarea Euler
Transformare omogen
Transformarea roll, pitch i yaw
1, 8, 16, 18
74
79
43, 45, 51, 52, 53
81
U
Unghiurile lui Euler
Unghiurile roll, pitch i yaw
78, 86
81, 86
V
Vectorul coordonatelor generalizate
Vectorul coordonatelor operaionale
Vetorul parametrilor de poziionare
128