Documente Academic
Documente Profesional
Documente Cultură
zi
se alege n lungul axei cuplei cinematice (i, i+1); originea sistemului de coordonate
i, rigid legat de elementul i se gsete pe ambele perpendiculare pe axele
zi
, fie n punctul lor de intersecie dac exist un asemenea punct, fie n orice
axa
z i1
i
z i1
zi
xi
coincide cu axa
z i1
sau este
zi
z i1
zi
zi
zi
coincid; axa
yi
x0
este aleas
arbitrar.
Utilizarea acestui sistem specific de coordonate pentru elementele robotului
industrial permite folosirea a patru parametrii (i nu ase ca n cazul general)
pentru trecerea dintr-un sistem de coordonate n altul. Sistemul i-1 se poate raporta
la sistemul i cu ajutorul unei rotaii, a dou translaii i a nc unei rotaii realizate
n urmtoarele condiii:
1. se rotete sistemul i-1 n jurul axei
x i1
xi
z i1
x i1
xi
axele de coordonate;
4. se rotete n jurul axei
cu
zi
z i1
cu mrimea
si
pn
z i1
pn cnd axa
cu unghiul
xi
cu mrimea
cu unghiul
ai
pn cnd coincid
pn cnd se suprapune
Fiecare din aceste micri elementare corespund unei matrice de tip B fie
B
B
matrice de rotaie ( R ) , fie matrice de translaie ( T ) . Matricea rezultant de
trecere, care leag sistemele i-1 i i este produsul acestor matrici.
A i=B R ( k , i ) BT ( k , s i ) BT ( i , ai ) B R ( i , i )
n care
BT
BR
sunt de forma:
(3.35)
[ ]
[ ]
[ ]
[ ]
[ ]
[ ]
1
B T ( i , s )= 0
0
0
0
1
0
0
0
0
1
0
s
0
0
1
1
B T ( j , s )= 0
0
0
0
1
0
0
0
0
1
0
0
s
0
1
1
B T ( k , s )= 0
0
0
0
1
0
0
0
0
1
0
0
0
s
1
(3.38)
0 0
sin 0
cos 0
0 1
(3.39)
1 0
B R ( i , )= 0 cos
0 sin
0 0
(3.36)
(3.37)
cos 0 0 0
B R ( j , ) = 0 cos sin 0
0 sin cos 0
0 0 0 1
cos
B R ( k , ) = sin
0
0
sin
cos
0 1
0 0
0 0
0 0
0
1
(3.40)
(3.41)
(3.42)
n conformitate cu formula:
B k1 , k Rk =Rk1
(3.43)
Ai
cu ajutorul matricei
sistemele i i i-1.
Ri1= Ai Ri
n care
(3.44)
T
Ri =[ x i , y i z i ]
Ai
si
ai
Ai
(3.45)
n care
este fie
( )
R ( i )= i 0
0
0
];
fie
()
R ( j )= j 0
0
0
];
()
R ( k )= k 0
0
0
0 0 0
( i )= 0 0 1
0 1 0
0 0 1
( j )= 0 0 0
1 0 0
0 1 0
( i )= 1 0 0
0 0 0
n care
Tn
(3.46)
T n=A 1 A 2 A n
Ai
.
(3.47)
Rn
n formula (3.46)
R0
primele trei elemente din matrici sunt coordonatele punctului arbitrar al minii
mecanice corespunztoare sistemelor n i 0.
Coloanele matricei
Tn
au semnificaie geometric.
Primele trei rnduri ale coloanelor unu, doi i trei reprezint cosinusurile
directoare ale axelor
xn
yn
zn
(3.48)
Tn
, i cu formula
Fig. 3.6
Tabelul 3.1
a1
90o
a1
d2
90o
d3
0o
Cupla
cinematic
Variabila
cos
sin
-1
d2
d3
[ ]
[ ]
[ ]
1
0
A 1=
0
0
0 0
0 1
1 0
0 0
a1
0
0
0
1
0
A 2=
0
0
0 0 0
0 1 0
1 0 d1
0 0 1
1
0
A 3=
0
0
0 0
1 0
0 1
0 0
0
0
d1
1
Rezult:
[ ]
1 0 0 a1
0 1 0 d2
T PPP= A1 A 2 A 3=
0 0 0 d3
0 0 0 1
z1
z0
z3
i o rotaie n
3.2.
Tabelul 3.2
Cupla
cinematic
Variabila
d1
0o
90o
d3
0o
d1
0
a2
0
d3
cos
sin
-1
[ ]
1
0
A 1=
0
0
0 0
1 0
0 1
0 0
0
0
d1
1
[ ]
1
0
A 3=
0
0
0 0
1 0
0 1
0 0
0
0
d3
1
Fig. 3.7
Pentru un robot ce lucreaz ntr-un sistem de coordonate sferic sau polar
(figura 3.8) parametrii necesari pentru calculul matricei
T RRP
3.3.
Tabelul 3.3
Cupla
cinematic
Variabila
cos
sin
90
-1
90o
d3
0o
d3
Fig. 3.8
[
]
[
]
[ ]
cos 1 0 sin 1 0
A 1= sin 1 0 cos 1 0
0 1
0 0
0 0
0 1
cos 2 0 sin 2 0
A 2= sin 2 0 cos 2 0
0 1
0 0
0 0
0 1
1
0
A 3=
0
0
Deci:
0 0
1 0
0 1
0 0
0
0
d3
1
Fig. 3.9
Tabelul 3.4
Cupla
cinematic
Variabila
90o
cos
sin
0o
a2
0o
a3
cos 1 0 sin 1 0
A 1= sin 1 0 cos 1 0
0 1
0 0
0 0
0 1
[
[
cos 2
A 2= sin 2
0
0
sin 2 0 a 2 cos 2
cos 2 0 a2 sin 2
0
1 0
0
0 1
cos 3
A 3= sin 3
0
0
sin 3 0 a3 cos 3
cos 3 0 a3 sin 3
0
1 0
0
0 1
]
]
Rezult:
C 1C 23 C 1 S 23
S 1 C 23 S 1 S 23
S1
a
3
C
23+ a2 C 2)
C 1(
C 1
S 1( 3 C 23+ a2 C 2 ) S 23 C 23
0
0
0 a3 S 23+a 2 S 2
0
1
T RRR= A1 A 2 A 3=
( 2+ 3) ;
S 23=sin
( 2++3 ) .
C 23=cos
T =T bra T art =[ A 1 A 2 A3 ] =[ A 4 A5 A 6 ]
Pentru articulaia RPY (figura 2.9) valorile necesare de calcul sunt date n
tabelul 3.5.
Tabelul 3.5
Cupla
cinematic
Variabila
cos
sin
90o
-1
90o
[
[
cos 1 0 sin 1 0
A 1= sin 1 0 cos 1 0
0 1
0 0
0 0
0 1
]
]
cos 2 0 sin 2 0
A 2= sin 2 0 cos 2 0
0 1
0 0
0 0
0 1
cos 3
sin 3
1
0
0
0 cos 3 sin 3
A 3=
0 sin 3 cos 3
0
0
0
0
0
0
1
Deci
C 1 C 2 C 1 S 2 S 3S 1 C 3 C 1 S 2 C 3 +S 1 S 3 0
S 1 C 2 S 1 S 2 S 3 +C 1 C 3 S 1 S 2 C 3 C 1 S 3 0
T RYP= A 1 A2 A 3=
S 2 C 2 S 3
C 2 C 3 0
0
0
0
1
n care cu C s-a notat funcia cosinus iar cu S s-a notat funcia sinus.
Exemplu: S se determine poziia i orientarea minii mecanice a robotului
industrial a crei schem cinematic structural este dat n figura 3.10, a.
a)
b)
Fig. 3.10
generalizate)
Ai
.
T5
Tabelul 3.6
Cupla
cinematic
0
2
2
3
0o
a1
s1
s2
-1
s3
s4
-1
-1
90
o
90
90o
a5
cos
sin
De exemplu, aceste ase mrimi pot fi cele ase elemente ale diagonalei matricei
Tn
(3.49)