Documente Academic
Documente Profesional
Documente Cultură
LUCRARE DE DISERTAIE
Contribuii la studiul
cinetostatic al roboilor
antropomorfi
Coordonator tiinific:
Senior Lecturer Dr. Ing.
Florian Ion T. Petrescu
Absolvent:
Postoac (Florescu)
Ramona Georgeta
BUCURETI
2013
1. Introducere
1.1 Robotul
.... 4
................................................... 4
15
2.1.2 Echilibrul forelor i determinarea reaciunilor din cuplele cinematice (de rotaie) ... 15
2.2 Studiul cinetostatic al robotilor antropomorfi echilibrati static total
17???
Fig. 1 Structuri mecanice de roboti: a robot cartezian; b robot cilindric; c robot sferic; d robot tip
SCARA; e robot articulat; f robot paralel;
Tara
2005
2010
2005
2006
143.634
2006
2007
2007
2010
America
21.986
17.910
21.400
24.400
America de Nord
21.567
17.417
20.500
419
493
900
1.400
70.047
61.748
66.000
75.000
China
4.461
5.770
6.600
7.900
11.557
17.327
23.900
47.000
India
450
836
1.600
4.500
1.069
1.905
3.500
14.100
Japonia
50.501
37.393
39.900
362.900
Republica Korea
13.005
10.756
10.700
11.800
4.096
Thailanda/
Alte tari din Asia
200.900
3.650
3.955
4.700
8.100
America de Sud
Asia/Australia
61.576
68.420
4.307
15.464
19.204
1.458
1.102
2.472
3.574
1.163
812
11.095
11.385
913
772
4.938
5.554
28.432
31.536
485
498
4.148
4.382
1.097
1.459
9.362
10.128
Danemarca
354
417
2.661
3.013
Finlanda
556
321
4.159
4.349
3.077
3.071
3.300
30.236
32.110
10.075
11.425
12.700
5.425
6.259
6.900
Norvegia
115
Portugalia
Franta
Germania
Italia
35.000
39.000
3.200
296.918
73.600
94.000
34.000
38.800
147.400
6.400
56.198
60.049
181
811
960
144
268
1.542
1.710
Spania
2.709
2.409
24.141
26.008
Suedia
939
865
8.028
8.245
Elvetia
442
458
3.732
3.940
Turcia
207
368
403
771
63.800
72.000
1.363
1.220
1.287
1.000
14.948
15.082
1.322
9.446
10.781
157
995
809
1.520
204
426
634
1.060
700
800
900
15.300
13.800
1.700
4.400
Conform statisticilor furnizate de IFR [WOR 07] numarul de roboti industriali operationali pe plan
mondial a atins 950.974 de unitati in anul 2006. Aproape 50% din acestia sunt in Asia, 33% in Europa si 16 % in
America de Nord., in timp ce Australasia si Africa ating impreuna 1% din total.
Conform acelorasi statistici in anul 2007 s-a inregistrat o crestere de 10% a robotilor industriali vanduti in
intreaga lume. In Europa aceasta crestere s-a datorat investitiilor in robotizarea industriei, in principal a acelei de
automobile, din Europa Centrala si de Est, Germania si Italia. In acelasi sector s-a inregistrat o crestere a
implementarilor de roboti industriali si in America de Nord. In anul 2007 vanzarile de roboti industriali au crescut
si in Japonia, India, China si America de Sud, inregistrandu-se o stagnare in Republica Korea.
Pentru urmatorii ani, 2008 2014, se anticipeaza o crestere anuala in jur de 4%, astfel ca la finele anului
2010 numarul de roboti industriali operationali pe plan mondial va atinge cca. 1.200.00 de unitati [WOR 07].
In perioada 2001-2003 angajarile au stagnat in timp ce numarul de roboti industriali a continuat sa
creasca, rezultand in viitor o crestere a densitatii robotilor industriali [WOR 04]. La finele anului 2005, Japonia si
Republica Korea prezenta cea mai mare densitate de roboti industriali la 10.000 de angajati din industrie: 352 de
roboti in Japonia si 173 de roboti in Republica Korea.
Cu 171 roboti pe 10.000 de angajati din industrie, Germania este tara cu cea mai mare densitate de roboti
industriali din Europa, urmata de Italia cu 130 si Suedia cu 117. In Finlanda densitatea se reduce la 99, urmata de SUA
cu 90 si Spania cu 89, iar Franta cu 84 de roboti pe 10.000 de angajati din industrie. O densitate variind intre 67 si 44
exista in urmatoarele tari: Austria, Benelux, Danemarca, Elvetia si Marea Britanie. In Norvegia densitatea se reduce la
29, iar in Portugalia la 17. Tarile din Europa Centrala si de Est, cu exceptia Republicii Cehe au o densitate scazuta de
roboti industriali implementati in industrie. In ciuda faptului ca in tarile europene mentionate este o distributie mare a
densitatii robotilor industriali, este interesant de mentionat ca densitatea de roboti industriali din Germania este cu cca.
90% mai mare ca cea din SUA [WOR 06].
Tara
Franta
Germania
Italia
Japonia
Spania
Suedia
Marea
Britanie
S.U.A
Fig. 4 Evolutia preturilor robotilor industriali (index 100% in anul 1990 dolari USA), cu (rosu) sau fara
(albastru) luarea in considerare a cresterii performantelor [WOR 06]
10
Romat
FANUC
KUKA
Se mai folosesc azi i celule robotizate pregtite special pentru un anumit tip de operaii.
12
Fig. 8 Schema structural a lanului cinematic plan 2-3 legat la elementul 1 considerat fix
Elementul conductor 2 este legat de elementul considerat fix 1 prin cupla motoare O2, iar elementul
conductor 3 este legat de elementul mobil 2 prin cupla motoare O3.
Rezult un lan cinematic deschis cu dou grade de mobilitate, realizate de cele dou actuatoare, adic de
cele dou motoare electrice, montate n cuplele cinematice motoare A i B sau O2 respectiv O3.
13
R23y
2
y
B
FGiy2
M 2i
s2
B
G2
R
M1
x
B
C
l2
3
s3
M2
FGix2
x
R23
FGiy3
FGix3
G3
M 3i
l3
RDy
s3 '
3'
D
RDx
Modul de lucru:
Se dau (se impun) urmtorii parametrii:
l2 , l3 , s2 , s3 , xB , yB , xB , y B , xB , yB , xD , yD , xD , y D , xD , yD ,2 ,3 , 2 , 3 , 2 , 3 , m2 , m3 , J G2 , J G3 , M1 , M 2
Se cer (s se determine) cele ase reaciuni (descompuse pe axele X i Y) din cuplele cinematice de rotaie
pentru FI1 impus, n dou variante: 1=200 [s-1] i 1=300 [s-1].
x
x
RBx R12x , RBy R12y , RDx R03
, RDy R03y , R23
RCx , R23y RCy (unde RB nseamn reaciunea din cupla B,
proiectat pe axa x sau y, iar R12 nseamn reaciunea elementului 1 asupra elementului 2, proiectat pe x sau y;
reaciunea este fora dintr-o cupl; acolo unde lipsete un element al cuplei se ia obligatoriu aciunea elementului
lips asupra celui prezent, la cuplele de intrare, exterioare, B i D; la cupla intern C unde sunt prezente ambele
elemente ale cuplei, definim dou tipuri de reaciuni, egale ntre ele i de semne contrare:
x
x
x
R23
RCx , si R32
R23
; R23y RCy , si R32y R23y ; Am ales ca baz aciunea lui 2 asupra elementului 3
14
FGix m2 xG
2
2
iy
FG2 m2 yG2
i
M 2 J G2 2
FGix3 m3 xG3
iy
FG3 m3 yG3
i
M 3 J G3 3
sin
G2
B
2
2
y G2 y B s2 cos 2 2
2
xG2 xB s2 cos 2 2 s2 sin 2 2
2
yG2 yB s2 sin 2 2 s2 cos 2 2
y G3 y B l2 cos 2 2 s3 cos 3 3
2
2
xG3 xB l2 cos 2 2 l2 sin 2 2 s3 cos 3 3 s3 sin 3 3
y y l sin 2 l cos s sin 2 s cos
B
2
2
2
2
2
2
3
3
3
3
3
3
G3
x x l cos
B
2
2
C
yC y B l2 sin 2
2.1.2 Echilibrul forelor i determinarea reaciunilor din cuplele cinematice (de
rotaie)
Se pornete cu o sum de momente fa de punctul C, numai de pe elementul 2 (izolat), egal cu 0, i cu o
alt sum de momente fa de punctul D, de pe ambele elemente considerate ngheate n poziia respectiv,
egal cu 0. Din aceste dou ecuaii care alctuiesc un sistem liniar de dou ecuaii cu dou necunoscute, se
x
determin reaciunile RB ;
RBy .
15
( 2 , 3)
x
y
ix
iy
i
M D 0 RB y D y B RB xD xB M 1 FG2 y D yG2 FG2 xD xG2 M 2
ix
iy
i
M 2 FG3 y D yG3 FG3 xD xG3 M 3 0
y y R x x x R y M F ix y y F iy x x M i
B
B
C
B
B
1
G2
C
G2
G2
C
G2
2
C
x
y
ix
iy
y D y B RB xD xB RB M 1 FG y D yG FG xD xG M 2i
2
2
2
2
ix
iy
i
M 2 FG3 y D yG3 FG3 xD xG3 M 3
x
y
a11 RB a12 RB a1
a R x a R y a
22
B
2
21 B
ix
iy
i
a11 yC y B ; a12 xC xB ; a1 M 1 FG2 yC yG2 FG2 xC xG2 M 2
a21 y D y B ; a22 xD xB ;
ix
iy
i
ix
iy
i
a2 M 1 FG2 y D yG2 FG2 xD xG2 M 2 M 2 FG3 y D yG3 FG3 xD xG3 M 3
a21 a22
a2 a22
a21 a2
x x
; RBy y
RB
Se scriu apoi alte patru ecuaii de echilibru de fore, din care se deduc i ultimile patru reaciuni din
cuplele de rotaie.
( 2 , 3)
0 R Dy R By FGiy2 FGiy3 0 R Dy R By FGiy2 FGiy3
Fy
F (3) 0 R x F ix R x 0 R x F ix R x
23
G3
D
23
G3
D
x
Fy(3) 0 R23y FGiy RDy 0 R23y FGiy R Dy
3
3
16
17
( 3)
O3
0 ms d3 m3 s3 mIII 3
(2.1)
Astfel masa sarcinii endefectorului (cu tot cu masa transportat de el), aflat la distana d 3 fa de O3,
plus masa elementului 3 concentrat n centrul de mas sau de greutate S3 aflat la distana s3 fa de punctul O3,
sunt echilibrate prin greutatea masei suplimentare mIII montat la distana 3 fa de articulaia O3 de partea
cealalt (adic pe prelungirea elementului 3). Echilibrarea se face asemenea unui scrnciob, sau a unei prghii de
gradul 1.
n general se alege masa de echilibrare mIII i rezult prin calcul distana de montaj, 3 (relaia 2.2).
(2.3).
ms d 3 m3 s3
mIII
Dup echilibrare masa elementului 3 concentrat n articulaia O3 capt valoarea m3 dat de relaia
m3' m3 ms mIII
18
(2.2)
(2.3)
( 2 3)
O2
0 m3' d 2 m2 s2 mII 2
(2.4)
n general se alege masa de echilibrare mII i rezult prin calcul distana de montaj, 2 (relaia 2.5).
m3' d 2 m2 s2
mII
(2.5)
Dup echilibrare masa ntregului lan cinematic plan (format din elementele 2 + 3) se gsete
concentrat n articulaia O2 i capt valoarea m2 dat de relaia (2.6).
(2.6)
Justificare teoretic a metodei utilizate: Forele de greutate ale cror momente trebuiesc scrise fa de o
articulaie (mobil sau fix) sunt toate paralele ntre ele, orientate dup un suport vertical cu vrful n jos (sau
direcionate n sus cu valori negative), i au valoarea (modulul) dat de produsul dintre masa respectiv i
acceleraia gravitaional. Dac n relaia de momente simplificm peste tot cu g, atunci aceast sum de
momente apare ca o sum de mase amplificate fiecare cu braul forei respective. Dar i braele forelor sunt
asemenea cu distanele de la punctul n care este concentrat masa pn la articulaia fa de care s-au scris
momentele forelor de greutate, astfel nct se pot nlocui toate braele forelor de greutate cu distanele
respective. n final relaia sumelor momentelor forelor de greutate fa de articulaia respectiv, va fi suma
produselor mas distan. Aceast modalitate este mult mai comod, dar ea poate fi folosit numai n urma
justificrii teoretice corespunztoare.
19
Pentru nceput se studiaz cinetostatica elementului doi, care poart ns i masa m3 a elementului 3,
astfel nct elementul 2 suport efectul ntregului lan cinematic echilibrat, considerat sudat (asemenea unei
platforme), elementul 3 fiind nlocuit de masa m3 concentrat n punctul O3, de forele de inerie i de greutate
ale masei m3.
Deoarece mecanismul a fost deja echilibrat, forele de greutate nu mai produc efecte, ele fiind eliminate
din calculele ulterioare pentru a nu mai complica desenul i relaiile. Se consider doar rezultanta final a forei
de greutate a ntregului lan cinematic echilibrat, GO2, care nu mai produce nici un moment asupra acestui punct,
ci doar genereaz o component vertical a reaciunii din cupla O2.
Se vor considera n calculele cinetostatice urmtoare numai forele ineriale, cu precizarea important c
echilibrarea static total anihileaz practic i efectele forelor ineriale, astfel nct studiul are ca scop prezentarea
acestor fore pentru cunoaterea lor, observndu-se (verificndu-se) spre finalul calculelor c i efectele lor au
fost anulate prin echilibrarea total efectuat deja.
Ne reamintim, de la studiul cinematic, acceleraiile punctului O3 (2.7).
2
2
xO3 d 2 cos 20 20 ; yO3 d 2 sin 20 20
20
(2.7)
2
m3' d 2 cos 20 20
y
2
FiO3 m3' yO3 m3' ()d 2 sin 20 20
2
m3' d 2 sin 20 20
M iO3 J O3 3
(2.8)
Din torsorul de inerie al punctului O3 dat de relaiile sistemului (2.8) ne intereseaz pentru moment
numai forele de inerie din punctul O3 orientate pe axele x i y (practic e vorba de componentele scalare ale
forei de inerie dat de masa m3), ele producndu-i efectul asupra elementului 2. Intenionm s scriem suma
forelor ce acioneaz pe lanul cinematic 2-3 separat pe axele x i y, ct i suma momentelor, cuplurilor produse
de forele ineriale de pe lan fa de punctul O2. n afar de punctul O3 mai avem i forele ineriale date de masa
m2 din punctul S2 (relaiile sistemului 2.9), ct i forele de inerie date de masa de echilibrare mII din punctul I2
(relaiile sistemului 2.10).
x
2
FiS 2 m2 xS 2 m2 s2 cos 20 20
y
2
FiS 2 m2 yS 2 m2 s2 sin 20 20
x
2
(2.9)
(2.10)
Avem pregtite forele ineriale ce acioneaz pe elementul 2, i putem demara studiul ecuaiilor de
echilibru de fore pentru elementul 2 (dar care ine cont i de efectele elementului 3). Se scrie mai nti echilibrul
forelor de pe axa orizontal, x (relaiile 2.11), din care se va determina n final componenta orizontal a
reaciunii din cupla O2.
F x 0 m d cos 2 m s cos 2
3'
2
20
20
2
2
20
20
( 2 )
2
x
mII 2 cos 20 20 RO 0
2
2
x
(2.11)
(m3' d 2 m2 s2 mII II ) cos 20 20 R12 0
x
x
RO2 R12 0
n continuare se face o sum de fore (echilibrul forelor) proiectate pe axa vertical, y, de pe elementul
2 (dar innd cont i de ncrcrile de pe elementul 3), i se determin componenta vertical a reaciunii din cupla
fix (considerat fix) O2 (relaiile 2.12).
21
y
y
RO2 R12 m2' g GO2
Se poate observa c ncrcrile din cuple sunt minime tocmai datorit echilibrrii. Efectul dat de forele
de inerie (cuplurile produse de aceste fore) se anuleaz (datorit echilibrrii). Cuplurile produse de forele de
greutate se anuleaz i ele tot datorit echilibrrii.
Greutatea final echilibrat mai produce asupra lanului cinematic doar un singur efect, o ncrcare
vertical (determin o reaciune vertical) n cupla fix. La o echilibrare total chiar i ncrcarea orizontal din
cupla fix dispare. Singura ncrcare rmas este constant i din acest motiv nu prezint un pericol mare de
uzur, nu creiaz ocuri dinamice, mecanismul avnd un comportament dinamic normal (linitit) n funcionare.
Se va scrie n continuare i o sum de momente fa de articulaia fix, de pe elementul 2 (dar cu
considerarea i a efectelor de pe elementul 3), (relaiile 2.13).
( 2)
x
M O2 0 M m2 FiO3 d 2 cos 20 2
y
x
y
FiO3 d 2 sin 20 FiS 2 s2 sin 20 FiS 2 s2 cos 20
2
x
y
FiI 2 2 cos 20 FiI 2 2 sin 20 M iO2 0
2
2
2 2
2 2
M m2 m3' d 2 20 cos 20 sin 20 m3' d 2 20 sin 20 cos 20
m s 2 2 cos sin m s 2 2 sin cos
20
20
2
2
20
20
20
2 2 20
2
2
2
2
mII 2 20 cos 20 sin 20 mII 2 20 sin 20 cos 20
*
*
*
J O2 2 0 M m2 J O2 2 0 M m2 J O2 2
(2.13)
J O* 2 (momentul de inerie masic, sau mecanic al elementului 2, plus influena masei elementului 3), se
calculeaz cu relaia (2.14).
(2.14)
22
(2.15)
( 3)
O3
M m3 M iO3 0 M m3 J O3 3 0 M m3 J O3 3 (2.16)
M m3 ms d 32 m3 s32 mIII 32 30
Se determin i componenta vertical a reaciunii din cupla mobil, interioar, O3, prin realizarea
echilibrului proieciilor pe axa y, a tuturor forelor care acioneaz pe elementul 3 (relaia 2.17).
y
R23 m3' g
(2.17)
x
R32y 0 ).
Componenta orizontal a reaciunii din cupla cinematic mobil O3, este nul ( R23
23
CONCLUZII
Forele i momentele ce apar la mecanismul dezechilibrat sunt mai multe i mai dispersate, dar n general
mecanismele utilizate n practic sunt deja echilibrate tocmai n scopul unei bune funcionri, astfel nct este mai
justificat studiul cinetostatic al unui lan cinematic deja echilibrat total.
Deoarece mecanismul a fost deja echilibrat, forele de greutate nu mai produc efecte, ele fiind eliminate
din calculele ulterioare pentru a nu mai complica desenul i relaiile. Se consider doar rezultanta final a forei
de greutate a ntregului lan cinematic echilibrat, GO2, care nu mai produce nici un moment asupra acestui punct,
ci doar genereaz o component vertical a reaciunii din cupla O2.
Se vor considera n calculele cinetostatice urmtoare numai forele ineriale, cu precizarea important c
echilibrarea static total anihileaz practic i efectele forelor ineriale, astfel nct studiul are ca scop prezentarea
acestor fore pentru cunoaterea lor, observndu-se (verificndu-se) spre finalul calculelor c i efectele lor au
fost anulate prin echilibrarea total efectuat deja.
Din torsorul de inerie al punctului O3 dat de relaiile sistemului (2.8) prezint ioportan forele de
inerie din punctul O3 orientate pe axele x i y (practic e vorba de componentele scalare ale forei de inerie dat
de masa m3), ele producndu-i efectul asupra elementului 2. Se scrie suma forelor ce acioneaz pe lanul
cinematic 2-3 separat pe axele x i y, ct i suma momentelor, cuplurilor produse de forele ineriale de pe lan
fa de punctul O2. n afar de punctul O3 mai avem i forele ineriale date de masa m2 din punctul S2 (relaiile
sistemului 2.9), ct i forele de inerie date de masa de echilibrare mII din punctul I2 (relaiile sistemului 2.10).
Se poate observa faptul c ncrcrile din cuple sunt minime tocmai datorit echilibrrii. Efectul dat de
forele de inerie (cuplurile produse de aceste fore) se anuleaz (datorit echilibrrii). Cuplurile produse de
forele de greutate se anuleaz i ele tot datorit echilibrrii.
Greutatea final echilibrat mai produce asupra lanului cinematic doar un singur efect, o ncrcare
vertical (determin o reaciune vertical) n cupla fix. La o echilibrare total chiar i ncrcarea orizontal din
cupla fix dispare. Singura ncrcare rmas este constant i din acest motiv nu prezint un pericol mare de
uzur, nu creiaz ocuri dinamice, mecanismul avnd un comportament dinamic normal (linitit) n funcionare.
Fcnd suma momentelor tuturor forelor de pe elementul 3 n raport cu articulaia mobil O 3, (relaia
2.16) vom observa faptul c momentul motor Mm3 al actuatorului 3 se echilibreaz doar cu momentul de inerie
MiO3.
24
BIBLIOGRAFIE
1.
2.
3.
4.
5.
6.
7.
8.
9.
10.
11.
12.
13.
14.
15.
16.
17.
18.
19.
20.
21.
22.
23.
24.
25.
26.
27.
28.
29.
30.
31.
32.
33.
34.
26
Nitulescu M., Solutions for Modeling and Control in Mobile Robotics, In Journal of Control Engineering and
Applied Informatics, Vol. 9, No 3-4, 2007, pp. 43-50.
Ocnrescu C., The Kinematic and Dynamics Parameters Monitoring of Didactic Serial Manipulator,
Proceedings of International Conference of Advanced Manufacturing Technologies, ICAMaT 2007, Sibiu, pp.
223-228.
Olaru A., Dinamica roboilor industriali, Reprografia Universitii Politehnice Bucureti, 1994.
Pandrea N., Determinarea spaiului de lucru al roboilor industriali, Simpozion National de Roboi Industriali,
Bucureti 1981.
Punescu T., Celule flexibile de prelucrare, Editura Universitii Transilvania Braov, 1998.
Petrescu F.I., Grecu B., Comnescu Adr., Petrescu R.V., Some Mechanical Design Elements, Proceedings of
International Conference Computational Mechanics and Virtual Engineering, COMEC 2009, October 2009,
Braov, Romania, pp. 520-525.
Petrescu F.I., Petrescu R.V., Mecatronica Sisteme Seriale i Paralele, Create Space publisher, USA, March 2012,
ISBN-13: 978-1-4750-6613-5, 128 pages, Romanian edition.
Simionescu I., Ion I., Ciupitu Liviu, Mecanismele roboilor industriali. Vol. I, Ed. AGIR, Bucureti, 2008.
Stareu I., Proiectarea creativ n concepie modular a mecanismelor de prehensiune cu bacuri pentru roboii
industriali. Tez de doctorat, Universitatea Transilvania din Braov, 1995.
Stnescu A., Dumitrache I., Inteligena artificiala i robotica, Ed.Academiei, Bucureti 1983.
Tabr I., Martineac A., The influence of the revolute real axes deviations on the position accuracy of a robot
with parallel rotational axes. Proceedings of SYROM 2001, Bucharest, Romania, Vol. II, pp. 315-320.