Documente Academic
Documente Profesional
Documente Cultură
independente ntre ele sau nu. Dac mrimile geometrice care caracterizeaz
poziia unui sistem au toate valorile constante, se spune c poziia unui sistem au
toate valorile constante, se spune c poziia ocupat de sistemul material n raport
cu un anumit reper este fix sau c sistemul material respectiv se afl n repaus fa
de acelai sistem de referin. Se spune c poziia ocupat de un sistem material
este variabil fa de un reper sau c sistemul material respectiv se afl n micare
fa de reperul considerat dac cel puin unul din parametrii geometrici care o
caracterizeaz este variabil n funcie de timp.
n cele ce urmeaz va fi abordat micarea punctului caracteristic, aparinnd
minii mecanice a robotului industrial i a solidului rigid. Rezolvarea problemelor
de proiectare i de conducere a roboilor industriali presupune determinarea
poziiei lanurilor cinematice ale acestuia n raport cu un sistem de coordonate fix
poziia absolut a lanurilor cinematice (elementelor) ct i poziia relativ relev
coordonatele generalizate. n literatura de specialitate prima problem se numete
direct, iar cea de-a doua problem invers a poziiei punctului unui robot
industrial.
DE
ANALIZ
CINEMATIC
(3.1)
r
n care r i 1 sunt vectorii ataai de corp ce caracterizeaz poziia punctului
- unghiul de
rotaie. Aceast formul se poate pune sub o alt form, fcnd substituia :
cos=
12
1+ 2
sin=
2
1+2 ; n care
=tg
12 (
2
2
r 1=r
+ e r ) e
+ e r
2
2
1+
1+
1+2
(3.2)
Prin realizarea a dou rotaii finite a corpului rigid n jurul unei axe,
determinat de vectorii unitari
e 1
e 2
calculeaz cu formula:
= 1 + 2 1 2
11 2
n care:
=e tg
2
()
1=e1 tg 1
2
( );
2=e2 tg 2
2
( );
vectorul unitar al
rotaiei rezultante.
Se analizeaz cazul unui robot industrial cu 5 grade de libertate cu cuple
cinematice de rotaie (figura 3.1).
Poziia minii mecanice a robotului industrial n orice moment este
determinat de orientarea axelor lanurilor cinematice i a cuplelor cinematice
precum i de poziia acestora. n poziia considerat de zero pentru care
coordonatele generalizate sunt egale cu zero, poziia vectorilor orientai pe axele
lanurilor cinematice i a cuplelor cinematice se consider cunoscut. Pentru a
deplasa robotul industrial din poziia de zero n poziia caracterizat de
i (i=1, , 5)
coordonatele generalizate
i
articulaii cu unghiurile
i 2
transform n vectorii
i 31
i 3
i 41
i 4
;
i 51
i 5
jurul vectorului
i modific poziia i se
n care: i ;
(s=2, 3, 4, 5)
cartezian.
Avnd n vedere c vectorii
i s
vectorul k , termenul care conine aceti trei vectori n ultima formul este egal
Vectorii
j 2
j 3
j 4
(s=2, 3, 4)
rmn neschimbai.
Fig. 3.1
2
j 32
j 42
j 2
j 3
j 4
n jurul vectorului
care devin
j 22
deoarece:
(s=2, 3, 4)
j 21
se obine:
(s=2, 3, 4)
, coliniar cu vectorul
i 21
n jurul vectorului
j 44
5
i 5
n jurul vectorului
ataat acestui lan
cinematic.
5 + j 44 i5 s 5
i 55=i 51 cos
n care
li
3.1.2.
PROBLEMA
CARACTERISTIC
INVERS
POZIIEI
PUNCTULUI
A x1 y 1 z 1
x1
A x0 y 0 z0
x2
z1
; orientarea axei
este
. De lanul
B x2 y2 z2
y2
;
n
D x4 y 4 z4
E x5 y 5 z 5
, axa
y5
rotaie a cuplei E.
Se cunosc: - coordonatele punctului M care aparine obiectului manipulat
(adic minii mecanice) coordonate fix
minii mecanice,
E x5 y 5 z 5
xM yM zM
[]
i5 x
i 5= i 5 y
i5 z
[]
j5 x
j 5= j 5 y
j5 z
- lungimea elementelor:
l1
[]
k5x
k 5 = k
5y
k5z
l2
l3
l4
l5
Vectorii
l 2
(3.3)
i
l 3
coordonate fix:
[]
0
l 1= 0
l1
Vectorii
al axei
l 4
y5
l 2 cos 2 sin 1
l 2= l cos cos
2
2
1
l 2 sin 2
l 5
( 2+3 )sin 1
( 2+3) cos 1
y5
j 5
l 5=l 5 j 5
Unghiurile de comand
obiectului prins n mna mecanic sau pentru cazul cnd acesta este nencrcat
(punctul M), n spaiul de lucru al robotului industrial.
D=l 1 + l 2+ l 3
(3.4)
i 0
j 0
k 0
( 2+3 )
l 2 cos 2 +l 3 cos
x D=
( 2+ 3 )
l 2 cos 2 +l 3 cos
y D =
(3.5)
(3.6)
z D =z M ( l 4 +l 5 ) J 5 z
yD 2
+ ( z Dl 1 )2=l 22 +l 23 +2 l 2 l 3 cos 3
cos 1
de unde rezult:
cos 3=
yD
+ ( z Dl 1 )2 l 22 l32
cos 1
2 l2 l3
(3.7)
Din primele dou ecuaii ale sistemului (3.5) se obine:
tg 1=
x D
yD
sau
1=arctg
( )
x D
yD
S presupunem c unghiul
(3.8)
< 1
acest caz, ecuaia (3.8) are urmtoarea soluie unic n funcie de valorile lui
i
yD
. n
xD
:
1=arctg
1 =
( )
x D
yD
dac
1=arctg
( )
1=arctg
( )
1 =
xD > 0
dac
x D
yD
x D
yD
dac
xD< 0
dac
( )
x D
yD
xD> 0
y D =0
1= + arctg
yD> 0
xD < 0
yD> 0
(3.9)
y D =0
3 =arccos
yD
+ ( z D l1 )2 l 22l 23
cos 1
2 l2 l3
Ambele soluii sunt posibile (figura 3.2, a i b) deoarece fiecruia din cele
dou valori ale unghiului
Fig. 3.2
Pentru determinarea unghiului
obine
cos 2
:
cos 2=
l 3 sin 3
xD
sin 2
l 2 +l 3 cos 3
( l2+ l3 cos 3 ) sin 1
z D l 1
l sin 3
3
cos 2
l 2 +l 3 cos 3 l 2 +l 3 cos 3
(3.10)
sin 2
:
(3.11)
sin 2
xD
cos 2=
3 =0
i
2
unghiul
(3.12)
l 22+l 23 +2 l 2 l 3 cos 3
xD
sin 1
Termenul
1=0
( )
se noteaz cu k. Pentru
1=0
k =1
, iar pentru
i innd seama de
expresia (3.10) ca fiind o restricie impus, se va verifica, care din cele dou valori
este real. La aceasta se adaug restricia:
2= /2
xM
, valorile lui
coordonatei generalizate
1
valoarea lui
unitari
i 5
j 5
Unghiurile
yM
/2< 2< /2
deoarece pentru
[ ][
j3 x sin 1 cos ( 2 + 3 )
j 3= j 3 y = cos 1 cos ( 2+ 3 )
j3 z
sin ( 2+ 3 )
, corespunztor axei
y3
este:
(3.13)
i 4
al axei
x4
este:
[ ][ ]
i4 x
cos 1
i 4= i 4 y = sin 1
i4 z
0
(3.14)
E x5 y 5 z 5
, se poate scrie:
j 3 j 5=cos 4
|j 3 j 5|=sin 4
i 4 i 5=cos 5
(3.15)
|i 4 i 5|=s in 5
Folosind proprietile produselor vectoriale i scalare se obine:
cos 4=
sin 4=
j 3 j 5
=j j +j j +j j
|j3||j5| 3 x 5 x 3 y 5 y 3 z 5 z
(3.16)
1
|j 3 j5|
= [ ( j 3 y j 5 z j 3 z j 5 y )2+ ( j 3 z j 5 x j 3 x j 5 z )2 + ( j 3 x j 5 y j 3 y j 5 x )2 ] 2
|j3||j 5|
(3.17)
cos 5=
i 4 i 5
=i i +i i + i i
|i 4||i 5| 4 x 5 x 4 y 5 y 4 z 5 z
sin 5=
(3.18)
1
|i 4 i 5|
=[ ( i 4 y i 5 zi 4 z i 5 y )2 + ( i 4 z i 5 x i 4 x i5 z )2 + ( i 4 x i 5 y i 4 y i5 x )2 ] 2
|i 4||i 5|
(3.19)
Pentru determinarea semnului dinaintea radicalului din expresia (3.17) se
analizeaz direcia
n =j 3 j 5
. Dac vectorii
n =j 3 j 5
i 4
coincid ca direcie
( adic au direciile pe axa fix de coordonate de acelai semn) atunci radicalul din
n =j 3 j 5
i 4
au direcii
opuse, semnul va fi minus. Semnul din fata radicalului din expresia (3.19) se
determin n mod analog prin compararea direciei vectorilor
n =j 3 j 5
Produsul vectorial
[ ][
nx
j 3 y j5 z j 3 z j 5 y
=
ny
j3 z j 5 x j 3 x j 5 z
nz
j3 x j5 y j3 y j5 x
[ ][
mx
i 4 y i 5 zi 4 z i 5 y
m y = i 4 z i 5 x i 4 x i 5 z
mz
i 4 x i 5 y i 4 y i 5 x
j 3
are proieciile:
]
m=i 4 i 5
Produsul vectorial
m=i 4 i 5
are proieciile:
, iar cu
.
2
j 4 = j 5
y4
ai axelor
y5
][
[ ][ ][
[][
][ ] [
j5 x
j 4x
cos 1 sin 1 0 1
0
0
j 5 y = j 4 y = sin 1 cos 1 0 0 cos sin
j5 z
j4 z
0
0
1 0 sin cos
cos 1 sin 1 0
sin 1 cos
0
0
1 = sin 1 cos 1 0 cos = cos 1 cos
0
0
0
1 sin
sin
]
(3.20)
n care
=2 + 3+ 4
Fig. 3.3
Din relaia (3.20) se observ c poziia axelor
doar de coordonata generalizat de orientare
y4
y5
este determinat
aleatoare.
Pentru schema cinematic structural a robotului industrial prezentat n
figura 3.1, dispunerea axei
y5
(3.21)
Expresia:
j 3 x j 5 y j 3 y j 5 x =0
3.22)
y5
mecanice.
Din relaia (3.22) se obine:
j5 x j3 x
=
j 5 y j3 y
(3.23)
nlocuind (3.13) n (3.23) rezult:
j 5 x sin 1 cos (2 + 3) sin 1
=
=
=tg 1
j 5 y cos 1 cos ( 2+ 3 )
cos 1
(3.24)
j5 x x D
=
j5 y y D
(3.25)
Astfel pentru aflarea proieciei vectorului unitar
j5 y
j 5
este necesar ca
j5 x