Documente Academic
Documente Profesional
Documente Cultură
Transformări omogene
dacă se poate exprima o matrice de tip general, ale cărei elemente descriu
poziţia originii sistemului de referinţă ataşat corpului şi cosinusurile
directoare ale versorilor sistemului de referinţă ataşat obiectului respectiv.
Dacă acest corp este supus unei modificări de poziţie, realizarea unei
nx ox a x 0
nx ox a x n o a 0
P px py pz
T
n y o y a y R
y y y
nz oz a z 0
n o a
z z
0 0 0 1
z
unde :
nx ox a x p x
n o a p 0R 0
P
0
G= y y y y =
nz oz a z p z 0 0 0 1
0 0 0 1
n x o x a x p x
n o a p y
R P
G
y y y
=
n z o z a z p z 0 0 0 1
0 0 0 1
n x ox ax
n y oy ay
n
z oz az
P px py pz 1 T
Translatie
Rotatie
1 0 0 X0
0 1 0 Y0
T ( X 0 O0Y0 Z 0 )
0 0 1 Z0
0 0 0 1
1 0 0 X0 nx ox a x p x nx ox a x px x0
0 1 0 n o a p y n o a p y y0
Y0 y y
T *G
y y y y
G (1) =
0 0 1 Z0 nz oz a z p z nz oz a z p z z0
0 0 0 1 0 0 0 1 0 0 0 1
1 0 0 0
0 cos sin 0
R ( x, )
0 sin cos 0
0 0 0 1
b. rotaţia in jurul axei O0 y0 :
cos 0 sin 0
0 1 0 0
R( y, )
sin 0 cos 0
0 0 0 1
cos sin 0 0
sin cos 0 0
R( z, )
0 0 1 0
0 0 0 1
1 0 0 0 nx ox a x p x
0 cos n o a p y
sin 0 y
G (1) R( x, ) * G G (1)
y y
0 sin cos 0 nz oz a z p z
0 0 0 1 0 0 0 1
n x ox ax px
n cos n sin o y cos o z sin a y cos a z sin p y cos p z sin
y z
G (1)
n y sin n z cos o y sin o z cos a y sin a z cos p y sin p z cos
0 0 0 1
n x ox u x 0
n o y u y 0
Rg
y
n z o z u z 0
0 0 0 1
a x nz
uy
2 sin
n y ox
uz
2 sin
( oz a y ) 2 ( a x n z ) 2 ( n y ox ) 2
sin
2
(oz a y ) 2 ( a x n z ) 2 ( n y ox ) 2
tg
nx o y a z 1
n x o x ax px
n o a y p y iR j i
Pj
G
y y
=
n z o z a z p z 0 0 0 1
0 0 0 1
-1 T
b. matricea R este ortogonală : R =R
i
c. inversa matricei Tj este jTi
d. o matice de transformare poate fi descompusă în două matrici: o translaţie
pură şi o rotaţie pură
r xi y j zk
r cos
r sin
P cyl =
z
1
r cos sin
r sin sin
Psph
r cos
1
M L0 6 (1)
unde:
M 6 (n 1) 5 c 5 (2')
n c5 1 (3)
M c5 n 1 (4)
Cum după (1) M 6 , din relaţia (4) rezultă numărul cuplelor cinematice şi
de elemente necesare alcătuirii dispozitivului de ghidare în general:
c 5 6 şi n 7 (4')
unde:
pc i 6 i (6)
pc 5 1 (6')
p c c 5c p c 5 c 5c (6")
M c 5c (7)
Membrul stâng al relaţiei (7) fiind egal cu membrul stâng al primei relaţii
(4), rezultă:
c 5 c 5c (8)
c 5c M 6 şi n c 5 1 7 (9)
MGT 3 (10)
L0 3 (10')
M MGT L 0 3 3 6 (10')
M c 5C 6 (11)
M c 5C 6 (11')
Spre exemplu, la unele operaţii de montaj, sau la extragerea obiectelor
aflate într-o mulţime neordonată în container, pentru evitarea unor obstacole
imprevizibile, se necesită ca elementele dispozitivului de ghidare să aibă mai
multe posibilităţi de dispunere pentru aceeaşi situare a efectorului final.
Numărul acestor posibilităţi se numeşte manevrabilitatea dispozitivului de
ghidare. Gradul de manevrabilitate se defineşte prin:
Ma M 6 (12)
Efectorul
Cuple cinematice final
MGD 0
GN ( q ) 0GN (q) f (q)
sau sau
MGD X (q) X (q) f (q)
3.5. Modelul geometric invers
Algoritmul care realizează transformarea vectorului coordonatelor
operaţionale X în vectorul de configuraţie q se numeşte model geometric invers
şi se notează MGI: q = f -1(X).
R(u, d ) R( x, x ) R( y, y ) R( z, z )
1 z y 0
z 1 x 0
R(u, d )
y x 1 0
0 0 0 1
cos 1, sin
z
0
0 x i 0 y j 0 z k y
0 0 0 0 T
sau x
pr ( 0 x n) 0
prx ( x o) prx ( x p 0 d )
0
prx ( x a)
0
x
pr ( 0 x n) pry ( x o) pry ( x a) pry ( x p d )
0 0 0 0
0
dG y
pr ( 0 x n) prz ( x o) prz ( x a) prz ( x p 0 d )
0 0 0
z
0 0 0 0
G
D J G 0D
X G
unde: J (q) ( sau J (q) ) reprezintă matricea Jacobiană, de dimensiune
q q
(mxn) a lanţului cinematic al robotului.
sin i S i
cos i C i
În expresia matricei 0 G E s-au folosit notaţiile:
sin( i j ) S ij
cos( i j ) C ij
sau, explicit:
Se observă că: dx J11dq1 ... J1i ... J1n dqn de unde rezultă:
dx dq dq
J 11 ... J 1i i ... J 1n n
dq1 dq1 dq1
Gn
D(i ) Gn dx(i ) Gn
dy(i ) Gn
dz(i ) Gn
x(i ) Gn
y(i ) Gn
z(i )
T
unde:
pentru cupla (i) de rotaţie:
Gn
Gn
d i k i 1 X p i dqi
d i k i 1 dqi
Gn
3
p x 1 0 0
p 0
y 00 1 0
p z 0 0 0
4 4
x 0 0
y 0
0
1
z i
1
Pentru a doua coloană:
3
p x C 4 0 0
p 0
y S 4 0 00
p z 0 1 0
5 5
x S 4 S 4
y C4
C4
0
z i
1
0 0 0
0 0 0
0 0 0
J EULER
0 S 4 C 4 S 5
0 C4 S 4 S5
1 0 C 5
0 0 0
0 0 0
0 0 0
J EULER
0 S 4 C4 S5
0 C4 S 4 S5
1 0 S 5
0 1 0
J CIL
0 0 0
0 0 0
1 0 0
0 S2d3 C2
J SFERIC
0 S1 0
0 C1 0
1 0 0
d) mecanismul generator de traiectorie al robotului antropomorf
5.6. Concluzii
Modelul diferenţial asigură relaţia dintre deplasările elementare din
spaţiul operational şi cel din spaţiul cuplelor cinematice. De asemenea,
modelul diferenţial permite găsirea unei soluţii pentru transformarea de
coordonate, respectiv introducerea noţiunilor de viteze operaţionale şi
viteze ale coordonatelor cuplelor cinematice, ceea ce contribuie la
comanda în viteza a roboţilor.
Modelul diferenţial al unui robot permite evaluarea erorilor de
situare a efectorului final şi, totodată, determinarea corecţiilor ce trebuie
aplicate la nivelul cuplelor cinematice.
Jacobianul robotului este util pentru determinarea modelului
cinematic, dar şi în statică, pentru studiul relaţiei dintre solicitările ce
acţionează asupra efectorului final şi cele ce acţionează asupra
elementelor robotului, respectiv în cuplele cinematice.
forţe considerat;
- momentul rezultant calculat în raport cu punctul de reducere 0
n
M 0 ri x Fi , unde ri sunt vectorii de poziţie ai punctelor de aplicaţie ale
i 1
T0 Rx Ry Rz M 0x M0y M oz
T
(6.1)
unde:
R ext ,leg .ext este rezultanta forţelor exterioare şi din legăturile interioare,
M 0 ext ,leg .ext este momentul rezultant al forţelor exterioare şi din legăturile exterioare
în raport cu punctual 0, d r v dt este deplasarea elementară în mişcarea de
0
Dacă torsorul forţelor exterioare şi din legăturile exterioare este scris sub
forma (6.1), iar deplasările elementare sunt exprimate sub forma vectorului
diferenţial (elementar) al mişcării, lucrul mecanic se poate determina cu relatia
matriceală: dL 0 T D
reprezinta masa corpului (j), component al elementului (i), iar ki este numărul
corpurilor ce compun elementul (i).
ki
m
j 1
j
i
rcj
i
rci kj
m
j 1
j
i
rci i xci i
y ci i
z ci 1
T
0
rci 0 Gi i rci
J y x 2 z 2 dm
v
J z y 2 x 2 dm
v
J yoz x 2 dm
v
J xoz y 2 dm
v
J yz yz dm
v
J xz xz dm
v
iJx i J xy i J xz
i
J i i J yx i
Jy i J yz
i
J zx i J zy i
J z
J yoz J xy J xz S x
J xy J xoz J yz S y
i
Ji
J J yz J xoy S z
xz
S x S y S z m
i
unde m este masa elementului (i), iar Sx, Sy , Sz sunt momentele statice ale
elementului considerat.
0
D 0 dx 0
dy 0
dz 0
x 0
y z
0 T
Gi
D Gi
dx
Gi
dy
Gi
dz
Gi
x
Gi
y
Gi
z
T
Q Q1 Qi Qn
T
Vectorul diferenţial al cuplelor se notează cu Dq şi conţine variaţiile
diferenţiale ale variabilelor cuplelor: Dq dq1 ......dqi ..........dqn T
după cum cupla cinematică este de translaţie sau de rotaţie (dj este variabila
cuplei de translaţie, iar i este variabila cuplei de rotaţie).
dL ( Gn on ) T Gn
D Q T Dq (6.3)
Gn
D Gn
dx Gn
dy Gn
dz Gn
x Gn
y Gn
z
T
v
0
i
2
Tr 0 vi ( 0 vi ) T
Astfel energia cinetică elementară a elementului (i) este:
1 i i 0Gi i i
T
0Gi
1
dEci 0 vi
2
Tr
2 j 1 k 1 q j
ri ri T
dm q j q k
2
q k
1 i i 0Gi
T
0Gi
Eci dEci Tr
2 j 1 k 1 q j vi
( i ri i ri T
dm) q j q k
q k
vi
1 i i 0Gi i 0Gi
T
Eci Tr J i q j q k
2 j 1 k 1 q j q k
Funcţia de forţă Ui din care provine forţa de greutate a elementului (i) este
de forma:
U i mi 0g T 0Gi i rci
d Ec Ec
Qi
dt q i qi
Pentru cazul unui robot supus acţiunii unui sistem de forţe conservative
(forţe de greutate), ecuaţiile lui Lagrange au membrul II egal cu zero.
n
Dij nkz2 k k2xx ok2z k k2yy ak2z k k2zz pk pk 2 k rck pk nk i pk ok j pk ak k
k i
n
Termenii inerţiei efective pentru cupla de translaţie: Dii mk
k i
unde:
J kx J ky J kz
K k2xx , K k2yy , K k2zz
mk mk mk
momentul de inerţie mecanic J (32) , al modulului de rotaţie şi al
efectorului final, în raport cu axa (2) ;
distanţele echivalente K ixx2 , K iyy2 , K izz2 definite prin:
J ix J iy J
2
K ixx 2
, K iyy 2
, K izz iz
mi mi mi
poziţiile centrelor de masă ale modulelor, exprimate în sistemele de
referintă ataşate acestora, k rck ;
torsorul de reducere al sistemului de forţe care acţionează asupra
dispozitivului de sudare, calculat în originea sistemului de referinţă
ataşat ultimului modul al robotului, 03G 3 .
Se calculează ecuaţiile dinamice.
unde Fi, F2, M3 reprezintă forţele motoare, respectiv momentul motor din
cuplele cinematice, iar Ff1, Ff2, Mf3 reprezintă forţele de frecare, respectiv
momentul de frecare din cuplele cinematice.
cos 3 sin 3 0 l1
0 0 1 l 2 q 2 l3
0
G3
sin 3 cos 3 0 l 0 q1
0 0 0 1
sin q3 0 0
cos q 0 0
3
0 0 0
Jr
0 0 0
0 0 0
0 0 0
Rezultă torsorul:
R x sin q3 R y cos q3
Q Rz
M 03z
e p max e p (t )
e0 max e0 (t )
În aceeaşi manieră ca la precizia cinematică, se pot determina valorile
extreme şi dispersia erorilor, respectiv corecţiile necesare pentru atingerea
situaţiei (optime) dorite.
n(t) = f1(q(t))
o(t) = f2(q(t))
a(t) = f3(q(t))
p(t) = f4(q(t))
xx xy xz
yx yy yz
zx zy xz
u x u y u
xx ; yy ; zz z ;
x y z
1 u u y
xy yx x ;
2 y x
1 u x u z
xz zx ;
2 z x
1 u u y
zy yz z ;
2 y z
xx xy xz
yx yy yz
zx zy xz
8.3. Concluzii
Mişcarea efectorului robotului este rezultatul compunerii mişcărilor
elementelor acestuia. Rezultă astfel un cuplaj între mişcările corpurilor - mişcări
generale şi deformaţii - deci matricea de inerţie depinde de configuraţia
robotului. Pulsaţiile proprii asociate vibraţiilor nu sunt constante, ci funcţie atât
de torsorul forţelor exterioare ce acţionează asupra efectorului, cât şi de evoluţia
situării efectorului.
Cu cât sistemul care se mişcă este mai complex, iar spaţiul în care acesta
evoluează este mai dens populat cu alte obiecte, problema are complexitate mai
mare. De asemenea, trecerea de la cazul bidimensional la cel tridimensional
complică problema, chiar dacă rămâne în studiu acelaşi robot, în acelaşi spaţiu
de lucru dificultatea studiului sporeşte cu atât mai mult cu cât robotului îi creşte
numărul gradelor de libertate, pentru că aceasta înseamnă o arhitectură mai
complicată şi o modelare mai dificilă şi mai complexă atât a robotului, ca sistem
de corpuri, cât şi a spaţiului de lucru propriu definit prin mişcarea efectorului
final.
Orice model este compus din două mulţimi de sfere: o mulţime care
realizează reprezentarea exterioară, ce aproximează prin surplus forma
sistemului real, prin acoperirea sa cu sfere şi o altă mulţime care realizează
reprezentarea interioară, compusă din sfere plasate în interiorul sistemului real,
ce aproximează forma sistemului prin deficit. Reprezentarea exterioară (sferele
exterioare) oferă o aproximare amănunţită, iar reprezentarea interioară (sferele
interioare) este folosită pentru corecţie.
Pentru asamblarea mai multor piese, într-o ordine care nu este specificată,
sistemul senzoriat trebuie să fie capabil să recunoască formele pieselor, apoi să
definească o strategie de asamblare, apelând la proceduri de inteligenţă
artificială.
10.5. Concluzii
Planificarea mişcării reprezintă una din acţiunile fundamentale pentru ca
un robot inteligent să-şi poată rezolva sarcinile. Problema planificării mişcării
constă în a găsi o traiectorie pentru un robot care trebuie să se deplaseze dintr-o
configuraţie iniţială, (cunoscută) într-o configuraţie finală (de asemenea,
cunoscută), într-un spaţiu care conţine o mulţime de obstacole predefinite, astfel
încât robotul să nu intre în coliziune cu nici un obstacol. Este evident că un robot
care se descurcă printre obstacole mobile va fi capabil să îndeplinească o gamă
mai largă de sarcini (şi evident, sarcini mai complexe). Planificarea dinamică a
mişcării presupune planificarea mişcării într-un mediu (spaţiu de lucru) variabil
în timp, unde atât obstacolele cât şi configuraţia finală sunt în mişcare.
Capitolul 11. SPAŢII DE LUCRU, DE COLIZIUNE
ŞI DE PROTECŢIE
11.1. Spaţiul de lucru raportat la robot şi cel raportat la obiectul manipulat
unde d1, ai sunt dimensiuni constante ale elementelor MGT, iar qi - parametri
poziţionali relativi ai elementelor cuplelor cinematice conducătoare, variabili
între limitele:
qi min qi qi max
r FP r FP (di , ai , d EF , qi ) (I = 1,2,3....., 6)
r FP r WP r EF
unde:
r FP r EF (d EF , qi ) (I=4,5,6)
r TP r TP (d i , ai , d EF , d OB , qi ) (I = 1, 2, ..., 6)
p m xm i y m j z m k
Pentru fiecare set de valori ale coordonatelor xm, ym, zm, relaţia defineşte
vectorul de poziţie al unui punct material Pm, aparţinând obiectului. Dând toate
valorile setului de coordonate, se obţin toţi vectorii de poziţie ai punctelor PM
posibile. Totalitatea acestor vectori de poziţie constituie modelul matematic al
spaţiului de coliziune instantaneu al obiectului.
r Pm 0TTP p m
unde elementele matricei 0TTP sunt dependente pe lângă dimensiunile constante
ale DG şi ale efectorului final, de cei I = 1, 2, ..., M valori ale parametrilor
poziţionali relativi qi ale elementelor cuplelor cinematice conducătoare.
Tab. 3.
TTT TRR
RTT RTR
TRT RRT
TTR RRR
- Secţiunea
5) RRT “SACARA”
CAPITOLUL 13. MODELAREA ŞI SIMULARE
Modelarea şi simularea sunt concepte intrate de foarte mult timp în
cotidianul comunicaţional datorită unei mase mari de informaţii cu foarte multe
referinţe implicite asupra acestora, informaţii provenite din cele mai variate
domenii. Din această cauză, există destule aspecte care ţin de conţinutul
propriu-zis al acestor concepte, care necesită, pentru relevare, consultarea
literaturii de specialitate care tratează ceea ce poate fi numit generic „Teoria
generală a modelării”
B1. modele sintetice, la care sunt prezentate proprietăţile relevante într-un tot
cvasiunitar;
B2. modele structurate (modulare), constituie dintr-unul sau mai multe modele
elementare, acestea din urmă relevând şi considerând determinant doar un
singur aspect al structurii sau comportării.
13.3. Tendinţe actuale în abordarea teoriei modelării
- Sistemul real, care constituie sursa datelor observabile, care sunt, de cele
mai multe ori, perechi de date intrare/ieşire.
- Modelul - baza, care constituie imaginea sau modelul mintal prin care
investigatorul - modelor percepe sistemul real. Este un sistem capabil să
redea, în ultimă instanţă ipotetic, întregul comportament al acestuia.
Complexitatea mare a sistemului real determină o complexitate similară a
modelului-bază.
- Cadrul experimental reprezintă setul de circumstanţe limitate în domeniul
cărora sistemul real va fi observat şi înţeles cu scopul de a se executa
modelarea
- Modelul concentrat este conceptul cel mai important de cel de model
propriu-zis din abordarea clasică, tradiţională. Reprezintă sistemul capabil
să reproducă comportamentul la ieşire al sistemului real prin prisma
limitărilor impuse de cadrul experimental. Este de fapt o simplificare
explicită şi realizare parţială a modelului de bază. Structura sa este
complet cunoscută de către investigator.
- Calculatorul este mijlocul cu ajutorul căruia este generat comportamentul
modelului concentrat.
-
13.4. Simularea. Prezentare generală.
Simularea este unul dintre cele mai puternice mijloace de analiză, folosit
pentru proiectarea sistemelor complexe, pentru planificarea şi controlul
acestora.
metode de calcul;
calculul variaţiilor;
programare liniară;
programare neliniară;
programare geometrică;
programarea ecuaţiilor de gradul doi;
programare dinamică;
programare integrală;
teoria jocurilor;
metode reţea;
programare stohastică, etc.
13.6. Simularea sistemelor şi proceselor
descrierea modelului;
execuţia efectivă a modelului;
efectuarea analizei.
Primul pas în construirea unui model de simulare pentru un sistem real
este gâsirea informaţiilor despre sistem. Aceste informaţii pot fi în formă
simbolică sau numerică.
Una dintre cele mai eficiente metode pentru modelarea sistemelor reactive
este creată pe baza Reţelelor Petri (Peterson 1981; .Reising 1982). Reţelele
Petri reprezintă o metodă analitică şi grafică pentru modelarea sistemelor şi
analiza lor, şi o mare parte din acţiunea de modelare este condusă folosind
această strategie.
Strategia de modelare cu reţele Petri a fost dezvoltată prin includerea unor
variabile cantitative precum şi a unor variabile calitative folosind Reţele Petri
colorate. Totuşi, abilitatea Reţelelor Petri de a descrie în mod adecvat un mediu
reactiv este restricţionată încă foarte mult. În cazul reţelelor Petri nu se poate
accepta activarea de reguli ale unei combinaţii de condiţii sau activarea
simbolurilor.
Funcţia Lagrange
hk ( x) 0 k 1,..., l
Supusa la:
ximin xi ximax
Metoda necesită alegerea iniţială a unui punct de stare X°, ale cărui
coordonate sunt reprezentate de un set de variabile de decizie.
x q x q1 * S q
Algoritmul Greedy
Este o procedură simplă de obţinere a optimului heuristic pentru
soluţionarea problemei. Abordarea "greedy" are ca esenţă construirea rând pe
rând a fazelor prin asignarea câte unei operaţii la faza aflată în construcţie, pe
baza unei liste de asignare.
dacă în listă există operaţii care satisfac toate restricţiile relative la faza
curent ultimă, atunci se alege dintre ele, aceea care este mai apropiată de
capul listei. Respectiva operaţie se elimină din listă.
dacă nu există nici o operaţie care satisface toate restricţiile relative la
faza curent ultimă, atunci se creează o nouă fază iniţializată cu operaţia
aflată în capul listei.