Professional Documents
Culture Documents
Chng 3
x&2 f ( x ) u d ; vi x = x
2
yx
1
1 2
S
2
Thay vo ta c
dVSMC ( S )
SS& SKsgn( S ) 0
dt
o hm ta c:
& w& w
&
& x&1 &
& &
& &
S&(e) e& e&
x&
2 w w x1 f ( x ) u SMC K sgn( S )
&
& x&1 f ( x )
uSMC K sgn( S ) w& w
w, w& e, e&
-
f
SMC
Nhn
dng
i
tng
q, q&
dng tng hp ca mt m hnh tuyn tnh n nh dng chun iu khin v mt phn phi
tuyn bt nh mi. Php bin i c thc hin nh sau:
T (3.1) b qua tc ng ca nhiu, ta vit li di dng sau:
x&1 x2
T
trong , x (t ) x1 (t ) x2 (t ) ; A a a ; B 1 ; F x 0 F x
21
22
W2
F x
Wm
F x Wi*i x
i 1
i x
x Ci
exp
2 i2
x Ci
exp
2 i2
i 1
i 1, 2,...m
F x Wii x W T x
i 1
*
W%
i Wi Wi
T , v ta c:
F x F x * ;
m
* W%
ii x .
i 1
MH
HC
Hnh 1.3: S cu trc h thng nhn dng m hnh i tng
5
x&M (t ) AM xM (t ) BM u (t ) F x
- ta c:
E&(t ) AE (t ) F% x ,
trong
, E (t ) x (t ) xM (t );
F% x F x F x 0 F% x
F% x F x F x
Lut hiu chnh thch nghi ca khi HC phi c xc nh sao cho Wi Wi* , W%
i 0,
F x F x . Qu
(3.24)
trong
p12
p22
Ly o hm 2 v ca ta thu c
1 %
&T W+W
& E T AT P PA E 2 E T PF%( x ) W
&
% %T W)
%
%T W)
%
V& E T AT F%( x ) PE E T P AE F%( x ) (W
1 E E T QE 2 E
Ta c
& E T QE 2W%T ( x )( p e p e ) 2W%T W%
&
T
V& E T QE 2 F%
x ( p12 e1 p22 e2 ) W%T W%
12 1
22 2
&)
E T QE 2W%T ( ( x)( p e p e ) W%
12 1
22 2
Ta c
V& E T ( AT P PA) E T QE 0
Vy b c chng minh .
Cu trc b nhn dng:
Nhn dng
HC
W
-
xd
-
SMC
(3.9)
i tng
(3.37)
v ta c:
& H 1 (q ) C (q, q&)q& G (q ) Fd (q&) d H 1 (q )
q&
& f (q, q&) g (q )
q&
vi f (q, q&) [ f1 (q, q&), f 2 (q, q&),..., f n (q, q&)]T ; g (q) [ g1 (q), g 2 (q ),..., g n (q)]T
S dng php i bin:
7
1
H (q ) g (q ) u;
1
n
H (q )u g ( q)u; u R
Nh
vy, t v ta c th biu din robot n bc t do bng n h con truyn ngc cht sau:
qi xi1
q&i xi 2
i1
, vi xi x ; i 1, 2,..., n
i 2
&
&
q&
i xi 2 f i ( xi ) ui
SMC
qd , q&d e, e&(3.48)
-
Php i
bin
(3.40)
Robot
(3.37)
q, q&
trong : e1 q1d q1 vi
Ly o hm ta c:
q1 , q1d
l qu o v qu o t ca khu 1
dS1 (e1 )
&
&
& & &
& &
&
& &
&
&
e&
1 e1 ( q1d q1 ) q1d q1 q1d q1d q1 ( f1 u1 )
dt
kt hp iu kin trt ta c:
&
&
q&1d q&
1d q1 ( f1 u1 ) K sgn( S1 )
&2d q&2 f 2
u2 K sgn(S 2 ) q&2 d q&
vi S 2 (e2 ) e2 e&2 ; e2 q2 d q2
v q2 , q2 d l qu o v qu o t ca khu 2
v qn , qnd l qu o v qu o t ca khu n
- Nhn dng hm phi tuyn bt nh
Khi c c F q, q& ta d dng xc nh f q, q& theo biu thc sau:
f q, q& F q, q& a21q a22 q&
exp
q, q&
2
T
q& Ci
2 i2
exp
i 1
2
T
q& Ci
2 i2
W%
i Wi Wi
T , v ta c:
F q, q& F q, q& * ;
m
&
* W%
ii q , q
i 1
th *
I c1 0
0
1
m l2
12 1 1
0 ; I c 2 0
1
m l 2
12 1 1
1
m l2
12 2 2
12 m3l3
1 2
ml
12 2 2
; I c3
1
m l 2 0
12 3 3
0
0
di
li
l1
l2
d3
t: q1 1 , q2 2 , q3 d3 v q [q1, q2 , q3 ]T
H phng trnh ng hc ca Robot:
10
f1 l1 cos q1 l2 cos q1 q2 xE 0
f 2 l1 sin q1 l2 sin q1 q2 y E 0
f q z 0
3
E
3
1
1
v ta c: q&& H (q) C (q, q&)q& G (q) Fd (q&) d H (q)
2
2
2 1
h11 (q) 3 m1l1 l1 (m2 m3 ) l2 ( 3 m2 m3 ) l1l2cos(q2 )(m2 2m3 )
2 1
h12 (q) l2 ( 3 m2 m3 ) l1l2cos(q2 )(m3 2 m2 )
1
h22 (q) l22 ( m2 m3 )
3
1
h33 (q) m3
4
1
m2 )q&2 2
1q2 l1l2 sin( q2 )( m3
1 l1l2 sin(q2 )(2m3 m2 )q&&
2
1
2
2 l1l2 sin(q2 )(2m3 m2 )q&1
2
3 2 m3 g
T
T
T
v 1 2 F3 ; d d 1 d 2 d 3 ; Fd Fd 1 Fd 2 Fd 3
t:
A(q ) H 1 (q )
11
A11
A21
A
31
A12
A22
A32
A13
h22 h33 h23 h32
1
A23
h23 h31 h21h33
det( H )
A33
h21 h32 h22 h31
f 3
A31 1 A32 2 A33
3
d = -A(q) d
d1
= d 2
d3
Fms
Fms1
= -A(q) Fd = Fms 2
Fms 3
u=
u1
A(q) = u2
u3
Suy ra:
&
q&
1 f1 d1 Fms1 u1 f1 u1
&
&
q
2 f 2 d 2 Fms1 u2 f 2 u2
q&
3 f 3 d 3 Fms1 u3 f 3 u3
&
H (q)u A (q )u
1
; u Rn
i1
, vi xi x ; i 1, 2,3.
i 2
&
&
q&
i xi 2 f i ( xi ) ui
f11 ( x11 ) 0;
g11 ( x11 ) 1;
vi: f ( x , x ) f ; g ( x , x ) 1;
12 11 12
1
12
11 12
Tng t vi q&&2 ta c:
x&21 f 21 ( x21 ) g 21 ( x21 ) x22
12
f 21 ( x21 ) 0;
g 21 ( x21 ) 1;
vi: f ( x , x ) f ; g ( x , x ) 1;
22 21 22
2
22
21
22
&3 ta c:
Tng t vi q&
x&31 f 31 ( x31 ) g31 ( x31 ) x32
Vi: f ( x , x ) f ; g ( x , x ) 1;
32 31 32
3
32
31
32
Thit k m hnh 3D cho Robot: s dng phn mm SolidWorks cho php thit k tng b
phn ring r (cc khu) ca Robot, sau lp ghp kt hp li thnh cnh tay Robot hon
chnh qua cc khp quay, khp tnh tin.
Vic xc nh kch thc, khi lng, m men qun tnh ca vt th, hay xc nh ta
khi tm, t h trc ta gn vi tng khu c thao tc rt d dng. Mt u im ni
bt na l ta c th chuyn m hnh 3D trong SolidWorks sang m hnh c cc khi
SimMechanics trong Matlab, ng thi ta vn gi nguyn c cc yu t v kch thc,
khi lng, m men qun tnh, ta trng tm v cc h trc ta nh Hnh 3.3.
13
Chiu di (m)
3.27
0.45
2.93
0.45
2.13
0.565
14
15
3.6 Kt lun:
- xut thut ton thch nghi nhn dng hm phi tuyn bt nh ca i tng s
dng mng n ron (RBF). Pht biu v chng minh nh l v kho st tnh n nh ca h
thng.
- xut cu trc iu khin s dng mng n ron kt hp iu khin trt cho robot
n bc t do.
16
Nei E. Cotter: The Stone Weiestras Theorem and Its Application to Neural
Networks, IEEE Transaction on Neural Networks. Vol.1, No.4.1990, PP.290-295.
[97].
[98].
Gomn J. B., Yu D. L.: Selecting radial basis function networks centers with
resursive orthogonal least sepuares training. IEEE Transaction on Neural Networks.
Vol.11, ISSUE 2, 2000, PP.306-314.
[99].
Panchapakesan C., Ralph D. & Palanisami M.: Effects of moving the center in an
RBF Network. Proceeding of the 1998 IEEE Wold Congress on computational
Intelligence Neural Networks. Vol. 2, 1990, PP.1256-1269.