Documente Academic
Documente Profesional
Documente Cultură
SISTEME
DE REGLARE
A MIŞCĂRII
Pi Pf Zf
Pi
a b
Figura 5.1
Generator
de
qd , q d Sistem
de
u Sistem
de
M
Robot
Sistem
senzorial
q, q
traiectorii reglare acţionare
Figura 5.2
N(q,q
J(q)q ) M
(5.1)
unde q (t ) ( q1 (t ),..., q n (t ))T este vectorul asociat celor n grade de libertate ale
robotului. În funcţie de complexitatea sistemului de acţionare adoptat, vectorul
momentelor M este o funcţie M(u), determinată de mărimile de ieşire
( u1 ( t ),...,u n ( t ))T generate de sistemul de reglare. Existenţa variabilelor de
control ui asociate fiecărui grad de libertate qi sugerează decompoziţia sistemului
general de conducere în subsisteme individuale, pentru fiecare grad de libertate în
parte.
R
qnd , q nd SRn
un
SAn
Mn
SSn
qn , q n
Generator
de qn 1d , q n 1d SRn-1
un-1
SAn-1
Mn-1
SSn-1
qn 1 , q n 1
traiectorii
Figura 5.3
ui hi (qi , q i ) i (5.2)
124 Roboţi industriali
ui hi q1 , q 1 , q 2 , q 2 ,..., qn , q n (5.3)
R
qnd , q nd qn , q n
SAn SSn
Generator qn 1d , q n 1d Sistemul qn 1 , q n 1
de de SAn-1 SSn-1
traiectorii reglare
q1d , q 1d q1 ,q 1
SA1 SS1
Figura 5.4
e( t ) q d ( t ) q( t ) (5.4)
Capitolul 5. Sisteme de reglare a mişcării 125
qd e M M q
GT SR SA q
-
Figura 5.5
1
e( s ) qd ( s ) (5.7)
1 Y (s)
1
E lim[ s qd ( s )] (5.9)
s 0 1 Y (s)
YR K R ,
M Jq Fq
(5.10)
se obţine
I K R ( qd q ) (5.11)
M KmI (5.12)
K m K R ( qd q ) Jq
Fq (5.13)
F k
q q 1 q 0 (5.14)
J J
F2 4k1
2
(5.15)
J J
F2
k1 (5.16)
4J
F t t
t
q (t ) e 2J
(C1e 2
C2 e 2
) (5.17)
q
qi
qd = 0
Figura 5.6
Este evident că
lim q(t ) 0
t
deci abaterea valorii unghiulare faţă de valoarea prescrisă q d 0 este zero, deci
eroarea staţionară E 0 .
Acelaşi rezultat este obţinut utilizând expresia (5.3) pentru un semnal de
*
intrare q d arbitrar. Considerând o variaţie treaptă q d a mărimii unghiulare
prescrise q d , rezultă
1 q* q d*
E lim s d lim
s 0 (5.18)
s 0
1 Y ( s) s 1 Y ( s )
deci
q* s ( Js F )
E lim d2 0 (5.20)
s 0 Js Fs k
1
128 Roboţi industriali
F2
k1 (5.21)
4J
qi
qd = 0
Figura 5.7
q *d 1
q st
t
Figura 5.8
F ( t ) G mz( t ) k f z ( t ) (5.22)
F (s) G ( s)
z ( s) 2 (5.23)
ms k f s ms k f s
2
v
zd F G z
GT SR SA
- z
F
Figura 5.9
zd F 1 z
kR km s( ms k f )
Figura 5.10
1
E lim s z d ( s ) (5.24)
s 0
1 Y (s)
unde
Capitolul 5. Sisteme de reglare a mişcării 131
k1
Y (5.25)
s (ms k f )
s( ms k f ) 1
E lim s 2
(5.26)
s 0 ms k f s k1 s
e(t ) z (t ) (5.27)
deci,
k1 z( s ) G( s )
z( s ) (5.28)
s( ms k f ) s( ms k f )
sau,
1
z (s) 2
G( s) (5.29)
ms k f s k1
G
F k1 z k1 E deci E
k1
M 2 J 2 (q
1 q
2 ) k f 2 q 2 (5.32)
1 s2 J2
q2 ( s ) M 2 (s) 2
s ( sJ 2 k f 2 ) s J1 sk f 1 s 2 J 2 sk f 2 M 1 (s) (5.34)
Relaţiile (5.34), (5.35) pun în evidenţă intercondiţionarea buclelor de
conducere pentru cele două articulaţii. Dacă articulaţia 1 este practic independentă
de cealaltă (în realitate şi articulaţia 1 este afectată indirect de modificarea
momentului de inerţie J1 ), controlul poziţiei articulaţiei 2 este direct afectat de
articulaţia 1. Ultimul termen din (5.35) pune în evidenţă acest efect perturbator şi el
poate fi bine urmărit în figura 5.11b.
Capitolul 5. Sisteme de reglare a mişcării 133
q2
qd M M1 q
M2
GT SR SA q1
q1d I1 M1 1 q1
kR1 km1
2
(s J1 sk f1 )
sJ 2
2
(s J1 sk f1 )
q2d I2 M2 1 q1
kR2 km2 2
(s J 2 sk f2 )
b
Figura 5.11
unde Y2 ( s ) este dat de relaţia (5.36), iar în Y p12 ( s ) sintetizăm numai efectul
braţului inferior asupra celui superior,
sJ 2
Y p12 ( s ) (5.37)
sJ 1 k f 1
ei ( s ) q d ( s ) 1
ei ( s ) q ( s)
ei ( s ) q i ( s ) qi ( s) d
1
ei ( s )
(5.38)
s ( sJ i k fi )
ei ( s ) 2
qd ( s ) (5.39)
s J i sk fi ki
q* s( sJ i k fi )
Ei lim s id 2 0 ,i 1,2
s 0 s s J i sk fi k i
sJ 2
q2 (s)
sJ1 k fr1 s 2 J 2 sk f 2 k 2
M 1 ( s)
1 sJ 2
E p q2 ( t ) lim s 2
0
s 0 s ( sJ k
1 f 1 )( s J 2 sk f 2 k 2 )
Rezultatele de mai sus confirmă obţinerea unor erori staţionare nule, atât
prin efectul căii directe cât şi al perturbaţiei determinate de elementul inferior, dacă
mărimile aplicate sunt constante în timp. În multe situaţii mărimea prescrisă q d şi,
în special, cuplul perturbator M 1 nu respectă această condiţie. Dacă se vor
considera, de exemplu, legi liniare în timp, de forma
q1 (t ) k d t
M 1 (t ) k p t
atunci din relaţiile (5.35) si (5.39) rezultă,
kd s( sJ i k fi ) k d k fi
Ei lim s 2 2
,i 1,2
s 0 s s J i sk fi k i ki
kp sJ 2 k p J2
E p lim s 2 2
s 0 s ( sJ k )( s J sk k 2
) k f 1k 2
1 f1 2 f2
k d k fi
Eadm , i 1,2 (5.40)
ki
kpJ2
E adm (5.41)
k f 1k 2
M 1 J 1q1 k f 1 q 1
M 2 J 2 (q
1 q
2 ) k f 2 q 2
............................................
M J (q q
... q
) k q (5.42)
............................................
i i 1 2 i fi i
M n J n (q
1 q
2 ... q
n ) k fn q n
Elementul cel mai afectat este elementul n a cărui mişcare este perturbată de
toate elementele inferioare. Din acest motiv dezvoltările ulterioare se vor referi
numai la acest element. Utilizând aceleaşi proceduri ca şi în cazul precedent se
obţine
1 s2Jn
qn ( s ) M n( s )
s 2 J n sk fn s J
2
2
n1 sk f ( n1 ) s J n sk fn M n1
s2Jn s 2 J n1
s J
2 2
2
n2 sk f ( n2 ) s J n1 sk f ( n1 ) s J n sk fn M n 2 ( s )
(5.43)
s2Jn 1 s2J2
s J
2 2
n sk fn s J1 sk f 1 1 s J2
2 sk f 2 (1
s2 J3
s J
2
3 sk f 3 ...))...)M ( s )
1
Capitolul 5. Sisteme de reglare a mişcării 137
M1 Mn-2 Mn-1
s2Jn s 2 J n 1
(s 2 J n 2 sk fn 2 ) (s 2 J n 1 sk fn 1 )
Pe baza relaţiei de mai sus se va obţine calculul erorii staţionare pentru bucla
de conducere n, perturbată sau neperturbată. Dacă se neglijează efectele buclelor
inferioare ale sistemului mecanic atunci în formula (5.43) se reţine numai primul
termen, ceea ce duce la o eroare de forma (5.39),
s ( sJ n k fn )
en ( s) q nd ( s ) (5.44)
s 2 J n sk fn kn
1
qn (s) 2
( sFk ( s ) M k (n) k n ( q n ( s ))) (5.45)
s J n sk fn
138 Roboţi industriali
Mk sFk ( s )
E nk lim s 0 (5.47)
s 0 s s 2 J n sk fn k n
sau
kn
Jn
Yon ( s )
k fn kn
s2 s
Jn Jn
Capitolul 5. Sisteme de reglare a mişcării 139
k fn
2 n
Jn
p1, 2 n nn j nn 1 n2 (5.52)
Este evident
n
că
determinată
valoarea
de
parametrii mecanici ai sistemului determină o anumită repartiţie a polilor şi
implicit o anumită comportare în regim tranzitoriu. Pentru n 0 se obţine
regimul neamortizat (doi poli imaginari conjugati) n 1 desemnează regimul
critic amortizat (poli reali confundaţi) iar n 1 (poli reali) – indică regimul
supraamortizat. Sistemul mecanic al robotilor industriali operează în special în
regimul 0 n 1 (doi poli complecşi conjugaţi), denumit şi regim subamortizat.
Considerând o marime prescrisă de forma d (t ) 1 mărimea de ieşire q n
a buclei de conducere va fi,
2
nn
q n ( s) d ( s) (5.53)
s 2 2 n nn s nn
2
sau
140 Roboţi industriali
e nnnt 1 n2
q n (t ) 1 sin nn 1 n2 t arctan (5.54)
1 n2 n
În figura 5.13 sunt reprezentate funcţiile qn (t ) pentru câteva valori
semnificative ale factorului de amortizare
n . Curba a reprezintă
regimul subamortizat în care se remarcă apariţia unei erori de supraurmărire iar
curbele b şi c reprezintă evoluţii amortizate critice sau supraamortizate în care nu
apar aceste erori, bineinteles în detrimetrul unui timp de răspuns mai mare.
Din relaţia (5.54) se poate obţine imediat supraurmărirea,
q n max q n (5.56)
qn(t)
a
c
t
Figura 5.13
dar
ui k Ri (qdi qi )
(5.58)
deci,
k mi
Mi ( k Ri ( qdi qi ) kbi q i ) (5.59)
Ri
qdi ei ui Mi 1 qi
kRi ( k i sk i)
s(Ji k fi )
Figura 5.14
qir ( s ) k Ri ( ki ski )
YiT ( s ) (5.62)
ei ( s ) s( J i s k fi )
1 s( J i s k )qd ( s )
ei ( s ) qid ( s ) 2
1 YiT ( s ) s J i s( k fi k i ) k i
(5.63)
ki ski
YoiT ( s ) 2 (5.65)
J i s s( k fi ki ) ki
notând
ki k k fi ki
zi ; i ni ; 2 i ni (5.66)
ki J i zi Ji
2 ni
( s zi )
zi (5.67)
YoiT ( s ) 2 2
s 2 i ni s ni
Capitolul 5. Sisteme de reglare a mişcării 143
s
YoiT ( s ) Yoi ( s )( 1 )
z1
(5.68)
unde Yoi (s ) este funcţia de transfer în circuit închis a buclei i (5.54) pentru
control după curent. Deci,
sau
1 dqiI ( t )
qiI ( t ) qiI ( t )
z i dt
( i i )
i
1 i2 (5.70)
iT 2i 2 i i 1 e
in
i (5.71)
zi
144 Roboţi industriali
1 i2
i arctan
i i
1 i2
tan i
i
Este evident că, în condiţiile în care ki 0 deci se produce atenuarea
componenţei derivative introdusă de controlul în tensiune, zi şi, deci,
supraurmărirea iT tinde către valoarea stabilită în formula (5.56).
qi
qiT(t)
qi(t)
1
t
Figura 5.15
i q i (5.72)
M 1 J1
1 k f 11 (5.73)
1
1 ( s ) M 1 (s)
J1s k f 1
(5.75)
1 sJ 2
2 (s) M 2 (s) M 1 (s) (5.76)
J2s k f 2 ( J 2 s k f 2 )( J 1 s k f 1 )
kmkR
Y2 ( s ) (5.77)
J 2s k f 2
de unde rezultă,
J2s k f 2
e( s ) 2d ( s) (5.78)
J 2 s (k f 2 k 2 )
2 d (t ) k d (5.80)
eroarea staţionară va fi
k J2s k f 2
E lim s d2 (5.81)
s 0 s J 2 s ( k f 2 k 2 )
J2s 2 ( s)
2 ( s) M 1 ( s) k 2 (5.82)
( J 1 s k f 1 )( J 2 s k f 2 ) J2s k f 2
J2s
2 ( s) M 1 (s)
( J 1 s k f 1 )( J 2 s (k f 2 k 2 ))
kp J 2s k p J2
E p lim s (5.84)
s 0 s ( J1s k f 1 )( J 2 s ( k f 2 k 2 )) k f 1 ( k f 2 k 2 )
2
Capitolul 5. Sisteme de reglare a mişcării 147
M1
sJ 2
J1s k f1
q 2d w 2d I M2 1 q 2 w 2
kR km
J 2 s k f2
Figura 5.16
sau
1
x c ( s ) k R (1 )( 2 d ( s ) 2 ( s )) (5.86)
Ti s
k m k R (Ti s 1)
Y2 ( s )
Ti s ( J 2 s k f 2 )
(5.87)
k m k R (Ti s 1)
Y02 ( s )
Ti J 2 s Ti ( k f 2 k m k R ) s k m k R
2
(5.88)
Ti s ( J 2 s k f 2 )
e( s ) 2
2d ( s)
J 2Ti s Ti (k f 2 k m k R ) s k m k R
(5.89)
k Ti s( J 2 s k f 2 ) k d Ti k f 2
E lim s d2 2
(5.90)
s 0 s J T s T ( k k k ) s k k km k R
2 i i f 2 m R m R
E E imp
(5.91)
kR kd k f 2
(5.92)
Ti k m E imp
Capitolul 5. Sisteme de reglare a mişcării 149
M1
sJ 2
J1s k f1
w 2d 1 1 wd
k R 1 km
Ti s J 2 s k f2
Figura 5.17
k m k R ( Ti s 1 ) J2S
w2 w2 M1 (5.93)
Ti s( J 2 s k f 2 ) ( J1s k f 1 )( J 2 s k f 2 )
sau
J 2Ti s 2
w2 M1
( J 2Ti s 2 Ti ( k f 2 k m k R )s k m k R )( J1s k f 1 )
(5.94)
E p lim e p (t ) lim 2 (t )
t t
150 Roboţi industriali
este nulă atât pentru cupluri perturbatoare M 1 de tip treaptă cât şi pentru cele
liniar variabile în timp.
Îmbunătaţirea regimurilor staţionare atât la nivelul buclei de conducere
directă cât şi al celei de conducere după perturbaţie este realizată în detrimentul
unei înrăutaţiri a regimului tranzitoriu. Într-adevăr, din relaţia (5.88) se observă
apariţia unui zero în funcţia de transfer în circuit închis,
1
z
Ti
(5.95)
1 T
xc ( t ) k R ( q d ( t ) q( t ))
Ti
0 ( q d ( t ) q( t ))dt TD ( q d ( t ) q ( t ))
(5.96)
Mărimea de comandă generată de acest regulator x c (t ) depinde deci şi
de derivata erorii ( q d q ) ceea ce perimite asigurarea unui regim de anticipare a
evoluţiei pe traiectorie permiţând eliminare regimurilor tranzitorii nedorite,
suparaurmărirea.
Utilizarea acestei legide reglare este similară cu cea folosită la regulatorul
PI, restricţiile şi performanţele dorite impunând alegerea corectă a parametrilor de
reglare, k R , Ti , TD
În sistemele de conducere a roboţilor este preferată o variantă uşor
modificată a legii de reglare (5.96) de forma,
kR T
xc (t ) k R (qd (t ) q (t ))
Ti
0 (qd (t ) q (t ))dt TD (q d (t ) q (t ))
(5.97)
km k (1 Ti s )
q2 ( R e k RTd sq2 )
s ( sJ 2 k f 2 ) Ti s
Deci, funcţia de transfer în circuit deschis va fi,
q2 ( s ) k m k R (1 Ti s )
Y2 ( s ) 2 (5.98)
e( s ) Ti s ( sJ 2 (k f 2 k m k RTd ))
1
e( s ) q2 d ( s )
k m k R (1 Ti s )
1
Ti s 2 ( sJ 2 (k f 2 k m k RTd ))
sau
Ti s 2 ( sJ 2 (k f 2 k m k RTd ))
e( s ) q2 d ( s ) (5.99)
Ti J 2 s 3 Ti ( k f 2 k RTd ) s 2 k m k RTi s k m k R
Regulator PID
q2
qd2 e 1 M2 w2
k R 1 km M2
Ti q1 M 1
k R Td
q 2 w 2 q2
Figura 5.18
152 Roboţi industriali
Relaţia (5.99) indică erori staţionare nule pentru valori de poziţie prescrise,
treaptă sau variabile liniar în timp.
Efectul elementului 1 în mişcarea elementului 2 se obţine după o tratare
similară cu cea utilizată în paragraful 5.3.2
Pentru q 2 d 0 , din (5.34) si figura (5.18) se obţine,
J2 km k (T 1)
q2 M1 [ R is q2
( sJ 1 k f 2 )( sJ 2 k f 2 ) s( sJ 2 k f 2 ) Tis (5.100)
k RTd sq 2 ]
sau
J 2Ti s 2
q2 ( s ) M 1( s )
( J1 s k f 2 )( Ti J 2 s 3 Ti ( k f 2 k m k R Td )s 2 k mTi s k m k R )
(5.101)
elementul 1
q1
SR
kRP J2s2
q2d 1 q2
YR km
s(J 2s k f2 )
Figura 5.19
q 2 Y2 (k m k R (q 2 d q 2 ) k m k RP q1 Y p q1 )
de unde rezultă
k m k R Y2 Y2 (k m YRP Y p )
q2 q2d q1 (5.104)
1 k m YR Y2 1 k m YR Y2
elementul 1
q1
SR
kRP J2s2
q2d 1 q2
YR km
s(J 2s k f2 )
Figura 5.20
k m YRP YP (5.105)
J2 2
YRP s (5.106)
km
1( t ) q
1( t ) (5.107)
1( s ) s 2 q1( s )
(5.108)
1 ( s ) s 2 q1 ( s )
(5.109)
(t ) k f q (t ) M (t )
Jq (5.110)
156 Roboţi industriali
M (t ) M 0 sin t (5.111)
q (t ) q 0 sin(t ) (5.112)
unde
1
Y2 ( j )
j k f
(5.115)
1
Y ( j )
J (5.116)
j 1
kf
J
20 log(Y2( j )) 20 log ( )2 1 (5.118)
kf
unde
2 101
kf
1 (5.120)
J
Y2( j ) 1 (5.121)
1
Y2( j )
J (5.122)
j
kf
YdB
1
kf
dB
(log)
kf
1
J (a)
(b)
(c)
Arg(Y)
kf
1
J (log)
0
-
2
- (d)
Figura 5.21
arg(Y2 ( j ))
2
Capitolul 5. Sisteme de reglare a mişcării 159
kf
arg(Y2( j )) 0 pentru
J
kf
arg(Y2( j )) pentru
2 J
n2
Y0 ( j ) (5.125)
n2 2 j 2 n
n2
Y ( j ) (5.126)
j ( j 2 )
unde
160 Roboţi industriali
2 2 n (5.127)
qd q
YR jω km Y2 jω
Y jω
Figura 5.22
2
(5.130)
2 n
2
E E imp
n
deci
YdB
a
ωn ω log
ω1 ω2
Figura 5.23
s 1
YR k R (5.133)
s 2