Professional Documents
Culture Documents
Ging vin:
Gi i PGS.
PGS TS.
TS Hunh
H h Thi Hong
H
B mn iu Khin T ng
Khoa in in T
i hc Bch Khoa TP
TP.HCM
HCM
Email: hthoang@hcmut.edu.vn
Homepage: http://www4.hcmut.edu.vn/~hthoang/
IU
KHIN
TI
U
C nhiu
hi bi tton
iu
i khin
khi ti u, t
ty th
theo:
Loi i tng iu khin
Min thi gian lin tc hay ri rc
Ch tiu cht lng
Bi ton ti u c rng buc hay khng
im u* c gi l im cc tiu cc b nu
L(u)L(u*) vi mi u nm trong ln cn ca u*.
im u* c gi l im cc tiu ton cc nu
L(u)L(u*) vi mi u
250
200
150
L 100
50
-50 u* 4
6 2
4 2 0
0
u2
-2 -4 -6 -4
4
-2
u1
x x
Vit g Lx f x
gn li: T 1
H x ( x , u) Lx ( x, u) T f x ( x , u) 0
H u ( x, u) Lu ( x, u) f u ( x , u) 0
T
H ( x , u) f ( x , u) 0
trong : H ( x , u) L( x , u) T f ( x, u)
T cc tr
Tm h L(u) 5u12 2u22 2u1u 2 8u1 3u2
t hm:
Vi iu kin rng buc:
f (u) u1 6u2 2 0
Gii:
Hm
H H Hamilton:
il
H ( u) L ( u ) f ( u)
T
250
200
150
L 100
50
-50
u* 4
6 2
4 2 0
0
u2
-2 -4 -6 -4
4
-2
u1
T cc tr
Tm h L( x, u ) ( x 2) (u 2)
t hm: 2 2
H Hamilton:
Hm H ilt
H ( x, u ) L( x, u ) T f ( x, u )
H ( x, u ) ( x 2) 2 (u 2) 2 ( x 2 3 x 6 u )
Gii h phng
h trnh,
h ta c
b
ba nghim:
hi
( x, u ) (4.53;0.92), (1.71;2.04), (1.68;8.22)
Thay 3 nghim trn vo L( x , u ) ( x 2) (u 2) , ta c
2 2
T cc tr
Tm h L( x , u ) x 3 x u
t hm: 2
1
2
2
2
H ( x , u ) L( x , u ) f ( x , u )
T
H ( x , u ) x12 3 x22 u 2 1 (2 x1 x2 4) 2 ( x1 u 2)
H u ( x, u ) 0 H ( x, u ) / u 2u 2 0
f ( x, u ) 0
f1 ( x, u ) 2 x1 x2 4 0
f 2 ( x, u ) x1 u 2 0
Gii h phng trnh, ta c:
x * 1.5714 0.8514 u * 3.5714 5.1429 7.1429T
T
Do L( x , u ) x 3 x u
2
1
2
2
2
l hm ton p phng g nn
cc tr tm c
H ( x , u )
xtrn
2
1 3 cng
x 2
2 u 2
1 (2 x1 l
chnh xcc 2 ( x1 u 2)
2 4)tiu
vi mi hm x (t ) nm trong ln cn ca (t ) x *
x (t ) x * (t )
15 January 2014 H. T. Hong - HCMUT 26
Tm cc tr phim hm?
Nhc li cc tr hm:
iu kin cn: o hm bc 1 ca hm cn tm cc tr
bng 0
im dng
im dng g c o
hm bc
2 xc nh
dng g
im cc tiu
Cc tr phim hm?
Khi nim bin phn (variation): c th hiu l o
hm ca p phim hm
Phng php bin phn (Calculus of Variation): da
vo khi nim bin phn a ra iu kin cc tr ca
phim
hm tng t nh iu kin cc tr hm
15 January 2014 H. T. Hong - HCMUT 27
Khi nim bin phn
L
Lng gia
i ca
phim hm: J ( x ) J ( x x ) J ( x )
hi h
x (t )
x (t ) x (t )
t
hm: J ( x) x 2 (t )dt
Cho phim
0
Ch phim
Cho hi h
hm dng
d tch
h phn
h tng
qut:
tf
J ( x ) L( x )dt
t0
x (t0 ) x (t f ) 0
Thc hin bin i tch phn,
phn suy ra:
tf
L( x, x , t ) d L( x, x , t )
J xdt
t0
x dt x
15 January 2014 H. T. Hong - HCMUT 31
iu kin cn phim hm t cc tr cc b
iu kin cn phim hm J ( x ) t cc tr cc b
ti x * (t ) l bin phn ca J ( x ) phi bng 0 ti x * (t )
J ( x ) 0 x x *
L x c (c l hng
x
s)
dt x
x t 0
15 January 2014 H. T. Hong - HCMUT 32
Ti u ha ng khng rng buc Th d 1
/2
Tm hm x(t) sao cho : J ( x) [ x (t ) x (t )]dt min
2 2
0
Vii iu
i kin bi x(0) 1, x( / 2) 3
ki bin:
Gii:
Theo bi, ta c: L x 2 x 2
Phng trnh Euler-Lagrange:
L d L d
0 2 x 2 x 0 x x 0
x dt x dt
qut: x(t ) C1 sin t C2 cos t
Li gii tng
Thay iu kin bin, suy ra: C1 3,C 2 1
Kt lun: x * (t ) 3 sin t cos t
15 January 2014 H. T. Hong - HCMUT 33
Ti u ha ng khng rng buc Th d 2
Tm hm x(t) sao cho phim hm di y t cc tiu:
2
J ( x) 1 x 2 (t )dt min vi K bin: x(0) 1, x(2) 0
0
Gii:
L d L
Phng trnh Euler-Lagrange: 0
x dt
d x
1
x 1 x 2 x xx
d x 1
x 2
0 0 x 0
dt 1 x 2
1
x 2
L : n n
f : n n p
tm cc tiu
i khng
kh rng buc
b phim
hi hhm J ( x )
iu kin cn phim hm J ( x ) c cc tr l:
H ( x, x , , t ) d H ( x, x , , t )
0
x dt x
(PT Euler-Lagrange ca bi ton ti u ng c rng buc)
15 January 2014 H. T. Hong - HCMUT 36
Ti u ha ng c rng buc dng tch phn
Bi ton ti u ng c rng buc: tm vector hm x(t) xc
nh trn on [t0, tf] sao cho phim hm J(x) t cc tiu:
tf
J ( x ) L( x, x , t )dt min
t0
tf
vi iu kin rng buc
t0
f ( x, x , t )dt q
v iu kin bin: x(t0)=x0, x(tf)=xf
Hm Hamilton v pphngg trnh Euler-Lagrange g g trong g
trng hp rng buc tch phn nh sau:
Hm Hamilton: H ( x , x , , t ) L( x, x , t ) T f ( x , x , t )
Phng trnh Euler-Lagrange:
H ( x, x , , t ) d H ( x, x , , t )
0
x dt x
15 January 2014 H. T. Hong - HCMUT 37
Trnh t gii bi ton ti u ng c rng buc
Bc 1: Xc nh hm mc tiu, tiu .kin
kin rng buc v iu
kin bin: tf
J ( x ) L( x, x , t )dt
t0
tf
.kin rng buc f ( x, x , t ) 0 hoc t f ( x, x , t )dt q
0
9 2 9
Kt lun: x (t )
*
t t
32 8 x(t ) t 2 c1t c2
4
15 January 2014 H. T. Hong - HCMUT 41
Ti u ha ng c rng buc Th d 2
Tm vector hm x (t ) x1 (t ) x2 (t ) sao cho phim hm
T
di y t cc tiu:
2
J ( x ) 5( x1 1) 2 x22 dt
d min
i
0
vi iu kin x (t ) f ( x (t ), u(t ), t )
trong t0, tf, v x (t0 ) x0 cho trc
Kt hhp iu
K i kin
ki rng
buc
b vo
hm
h mc tiu
i dng
d hm
h
Lagrange:
tf
J ( u) ( x (t f )) [ H ( x, u, t , ) T (t ) x ]dt
t0
(t))
c Jh(u) (trnh
gii l phng [ Htrng
x(t fh))
ng (t ) Tthi
(t ) x ]dt
hi d
x 0
min J ( u) ( x (t f )) L( x (t ),
) u(t ),
) t )dt
u( t )
t0
iu kin u: x (t0 ) x0
Bi ton im cui rng buc:
tf
2 20
(y l bi ton ti
u im
cui
t do)
trong l trng s ty chn (mun trng thi cui cng gn xf th
chn cng ln)
iu kin u: x0 0; t f 1
Bc 3: nh ngha hm Hamilton:
H ( x, u, , t ) L( x, u, t ) (t ) f ( x , u, t )
1 2
H ( x , u, , t ) u (t ) (t )[2 x(t ) u (t )]
2
15 January 2014 H. T. Hong - HCMUT 55
iu khin ti u Th d 1 (tt)
Bc 4: iu kin cn c nghim ti u
PT trng thi: x (t ) 2 x(t ) u (t ) (1)
H (2)
PT ng trng thi: (t ) (t ) 2 (t )
x
i ki
iu kin d
dng: HH
0 u (t ) (t ) 0 (3)
u
i ki
iu kin
u: x(t0 ) x0 0 (4)
(t f )
iu kin cui: (t f ) (1) ( x(1) 50) ((5))
x
1 2
H ( x , u, , t ) u (t ) (t )[2 x(t ) u (t )]
2
15 January 2014 H. T. Hong - HCMUT 56
iu khin ti u Th d 1 (tt)
Bc 5: Gii phng trnh vi phn
Nghim phng trnh (2):
(t ) C1e 2t (6)
C1 2t
x(t ) e C2 e 2t
4
22x(t()t ) u0(t )
x (tu)((tt)) (1)
(3)
(2)
Kt
lun: Tn hiu iu
khin
v qu o trng thi ti
u l:
u (t ) C1e 2t
C1 2t
x(t ) e C2 e 2t
4
x1 (t ) x 2 (t )
x (t ) 1 u(t )
2 M
x1 (t ) x2 (t )
x 2 (t ) 2u(t )
Kt
lun: Tn hiu iu
khin
ti
u l
u (t ) 60t 30
*
(7)
x2
on 2
on 3 xN
xk on 1
x0
x1
15 January 2014 H. T. Hong - HCMUT 67
Th d tm ng ngn nht dng DP
Tm ng ngn nht i t A n J,
J cho bit mng
li ng nh hnh v.
N42
N33
N23
Bc 1 Bc 2 Bc 3 Bc 4 Bc 5
15 January 2014 H. T. Hong - HCMUT 69
Th d tm ng ngn nht dng DP
K hiu:
*
J k ( N ki ) l khong cch ngn nht t nt N ki n nt ch J
g cch t nt N ki n nt N k 1, j
d ( N ki , N k 1, j ) l khong
Phng trnh Bellman: J k* ( N ki ) min d ( N ki , N k 1, j ) J k*1 ( N k 1, j )
j
Vng ngc:
Bc 5: bt u t nt ch J 5* ( N 51 ) 0
Bc 4: on ng ngn nht t nt N41 hoc N42
n ch:
J 4* ( N 41 ) d ( N 41 , N 51 ) J 5* ( N 51 ) 3
J 4* ( N 42 ) d ( N 42 , N 51 ) J 5* ( N 51 ) 4
15 January 2014 H. T. Hong - HCMUT 72
Th d tm ng ngn nht dng DP (tt)
Bc 3: c nhiu la
chn, t nt N3i phi
chn
ng g i n
ch qua nt N4j no
ti u on qu o
cui
i J 3* ( N 3i ) ?
J 3* ( N 3i ) mind ( N 3i , N 4 j ) J 4* ( N 4 j )
j
T nt
d ( N 3i , N 4j ) J *
4 (N4 j ) * Quyt nh
J ( N 3i )
3 i n
N3i N 41 N 42
N 31 1+3=4 4+4=8 4 N41 (H)
N 32 6+3=9 3+4=7 7 N42 ((I))
N 33 3+3=6 3+4=7 6 N41 (H)
15 January 2014 H. T. Hong - HCMUT 73
Th d tm ng ngn nht dng DP (tt)
Bc 2: tm ng
ti u t nt N2i n
nt ch N51 (tc nt J 3* ( N 31 ) 4
J), s dng kt
qu J 3* ( N 32 ) 7
ti u on cui tm J 3* ( N 33 ) 6
c bc 3
J 2* ( N 2i ) mind ( N 2i , N 3 j ) J 3* ( N 3 j )
j
T nt
d ( N 2i , N 3 j ) J 3* ( N 3 j ) * Quyt nh
J ( N 2i )
2 i n
N2i N 31 N 32 N 33
N 21 7+4=11 4+7=11 6+6=12 11 N 31 hoc N 32
N 22 3+4=7 2+7=9 4+6=10 7 N 31
N 23 4+4=8 1+7=8 5+6=11 8 N 31 hoc N 32
15 January 2014 H. T. Hong - HCMUT 74
Th d tm ng ngn nht dng DP (tt)
Bc 1: tm ng
ti u t nt N11 (tc J 2* ( N 21 ) 11
nt A)) n nt ch J 2* ( N 22 ) 7
N51 (tc nt J), s J 2* ( N 23 ) 8
dng kt qu ti u
on cui
i t
tm
c
bc 2
J1* ( N11 ) min d ( N11 , N 2 j ) J 2* ( N 2 j )
j
T d ( N11 , N 2 j ) J 2* ( N 2 j ) *
Quyt
Q t nh
J ( N11 )
1 i n
N 21 N 22 N 23
N11 2+11=13 4+7=11 2+8=10 10 N 23
V xui:
Vng i i t bc
b 1 n
bbc
5 rt
t ra ng
i ti u
Kt lun:
u: N11 N 23 N 31 N 41 N 51
ng i ti
hoc: N11 N 23 N 32 N 42 N 51
Ch : Bi ton ti u im cui t do ( N , x N ) 0
Bi ton ti u im cui c nh ( N , x N ) 0
tng gii bi ton K ti u ri rc dng nguyn l ti u
Bellman: tm kim nghim u* (k(k ) ph thuc x * (k ) theo chiu
ngc hng qu o t im cui xN n im u x0
15 January 2014 H. T. Hong - HCMUT 77
PP qui hoch ng gii bi ton K ti u ri rc
t hm mc tiu ti u cho on qu o t.thi t thi cui k t im x(k)
N 1
J k ( x ( k )) min ( N , x ( N )) L( x (i ), u(i )) , ( k 0, N 1)
*
u ( k ),...,u ( N 1)
i k
*
Biu din J k ( x (k )) di dng:
N 1
J k ( x (k )) min L( x (k ),
*
) u(k )) ( N , x ( N )) L( x (i ),
) u(i ))
u( k ),...,u ( N 1)
i k 1
J k* ( x (k )) min L( x (k ), u(k )) J k*1 ( x (k 1))
u (k
(k )
J k* ( x (k )) min L( x (k ), u(k )) J k*1 ( f ( x (k ), u(k )))
u( k )
(PT Bellman)
vi J N* ( x ( N )) ( N , x N )
Bc 2: Gii phng trnh Bellman qua 2 vng:
Vng ngc: k N 1 0 tm u ( k ) ph thuc x (k )
*
vi J k*1 (.)
( ) l biu thc hm mc tiu ti u ti u on qu
o cui tm c bc trc .
J k ((.))
Ch
: tm
t u (k ) , p*
dng
d PP ti u tnh,
t h gii
ii PT
PT: 0
u(k )
15 January 2014 H. T. Hong - HCMUT 80
Trnh t gii bi ton K ti u ri rc dng DP (tt)
*
Vng xui: xc nh gi tr c th uk (k
(k ) . Thc hin cc bc
sau y vi k=0,1,2,.N1:
Thay u* (k
Tha (k ) vo
o m hnh ton ca i ttng
ng tnh c
c
trng thi ti u thi im (k+1)
x (k 1) f ( x (k ),
) u* (k ))
vi: J 4* ( x(4)) 0
u ( 3)
J 3* ( x(3)) min x 2 (3) u 2 (3) (do J 4* ( x(4)) 0 )
u (0) 8 8 21
2 2
5 20
Vi k = 0: u (0) x(0)
*
21 21
1 1 20 32
x(1) ( x(0) u (0)) 4
*
2 2 21 21
x(1) 8
Vi k = 1: u * (1)
4 21
1 1 32 8 12
x(2) ( x(1) u (1))
*
2 2 21 21 21
2 2 21 21
20 8 4 4
Kt lun: Chui tn hiu K ti u l: u ; ; ;
*
21 21 21 21
26 2 416
Ch tiu cht
lng ti
u: J min J 0* ( x(0)) x (0)
21 21
15 January 2014 H. T. Hong - HCMUT 88
Qui hoch ng gii bi ton K ti u lin tc
Cho i tng m t bi phng trnh trng thi:
x (t ) f ( x (t ), u(t ), t )
g thi u: x (0) x0 , trng
Trng g thi cui: x (t f ) x f
Bi ton iu khin ti u: tm tn hiu iu khin u(t) sao cho:
tf
J (u) ( x (t f )) L( x (t ), u(t ), t )dt min ((*))
ti
x
H
0 T
H (t ) L( x, u , t ) (t ) f ( x , u, t )
15 January 2014 H. T. Hong - HCMUT 92
Cch tm li gii ti u
Rt u(t) t (3):
u(t ) R 1 B T (t ) (4)
Th (4) vo
Thay (1),
(1) tta
c
x (t ) Ax (t ) BR 1 B T (t ) (5)
Kt
hp (5) v (2), ta c phng trnh vi phn:
x (t ) A BR 1 B T x (t )
(t ) Q A (t )
(6)
Gii phng trnh vi phn (6), tm c x(t) v (t)
Thay (t) vo (4) tm c li gii ti u
T hiu
Tn hi iu khi ti u: u* (t ) K (t ) x (t )
i khin
trong : K (t ) R 1 B T P (t )
v P(t) l nghim bn xc nh dng ca phng trnh vi phn Ricatti:
P PA AT P Q PBR 1 B T P
P (t f ) M
0 p1 0 0 2 0 1 p22 p2 p3
0
2
0 p2 p1 p2 0 0 2 p2 p3 p3
1 2 1
2 p2 p1 p2 p3
2 2 0
1 1
p1 p2 p3 2 p2 p32
2 2
15 January 2014 H. T. Hong - HCMUT 98
iu khin LQR lin tc Th d 2
1 2
2 2 p 2 0 p1 2 2
1 2 2 2
p1 p2 p3 0 p2 2 P
2 p 2 2 2 2 2
2 p2 1 p32 0 3
2
Vit li
ch tiu cht lng:
g
1 2 0 x1
J ([ x1 x2 ] 1 u 2
(t ))dt
20 0 1 x2
R
Q
15 January 2014 H. T. Hong - HCMUT 100
iu khin LQR lin tc Th d 3
Phng trnh i s Ricatti:
PA AT P Q PBR 1 B T P 0
p1 p2 0 1 0 1 p1 p2 2 0
p2 p3 1 2 1 2 p2
p3 0 1
p p 2 0 p1 p2
1 0 1 0
p2 p3 1 p2
p3
p2 p1 2 p2 p2 p3 2 0 p22 p2 p3
2
0
p3 p2 2 p3 p1 2 p2 p2 2 p3 0 1 p2 p3 p3
2 p2 2 p22 p1 2 p2 p3 p2 p3
2
0
p3 p1 2 p2 p2 p3 2 p2 4 p3 1 p3
2 p2 2 p22 0 p1 2.403
p 2 p p p p 0 (chn cc
1 2 3 2 3 p2 0.732
p p1 2 p2 p2 p3 0 p 0.542 nghim
g dng)
g)
3
2 p2 4 p3 1 p32 0 3
2.403 0.732
P
0.732 0.542
li hi tip trng thi:
2.403 0.732
K R B P K 0 1
1 T
K [0.732 0.542]
0.732 0.542
x1 (t )
Lut iu khin ti u: u (t ) Kx (t ) [0.732 0.542]
*
x (t )
2
u * (t ) 0.732 x1 (t ) 0.542 x2 (t )
15 January 2014 H. T. Hong - HCMUT 102
Bi ton LQR ri rc
Cho i tng tuyn tnh ri rc m t bi phng trnh trng thi:
x (k 1) Ad x (k ) Bd u(k ) (*)
t
trong : x (k ) [ x1 (k ),
) xn (k )]T: vector
) x2 (k ),..., t trng
t thi
u(k ) [u1 (k ), u2 (k ),..., um (k )]T: vector tn hiu iu khin
Bi ton
t ra l tm
tn
hiu
hi iu
i khin
khi u(k)
(k) iu
i chnh
h h h thng
h t
trng thi u x (0) x0 bt k v trng thi cui x(N) = 0 sao cho
ti thiu ch tiu cht lng
g dng
g ton phng:
p g
1 T 1 N 1 T
J (u) x ( N ) Mx ( N ) x (k )Qx (k ) uT (k ) Ru(k )
2 2 k 0
0
T hiu
Tn hi iu khi ti u: u* (k ) K (k ) x (k )
i khin
trong :
1
K (k ) B P (k 1) Bd R BdT P (k 1) Ad
T
d
P ( k ) A P ( k 1) P ( k 1) Bd B P ( k 1) Bd R
T
d
T
d
1
BdT P ( k 1) Ad Q
P (N ) M
Nghim phng trnh Ricatti ri rc: ln lt thay k ( N 1) 0
vao phng trnh Ricatti s tm c P(k)
Nghim
hi phng
h trnh
h i
i s Ricatti
i i rii rc(discrete
(di algebraic
l b i Ricatti
i i
equation dare)
>> P P=dare(A
dare(A,B,Q,R)
B Q R)
x (t ) [ Ax (t ) Bu (t )] L[ y (t ) y (t )]
B lc Kalman lin tc:
y (t ) Cx (t )
Trong L l li ca b lc Kalman:
L C T RN1
vi l nghim ca phng trnh Ricatti:
A AT C T RN1C Q N 0
15 January 2014 H. T. Hong - HCMUT 109
S khi b lc Kalman lin tc
u(t) x(t) ()
y(t)
x (t ) Ax (t ) Bu (t ) C
L
+
x (t )
B ++
+ C
y (t )
x (t ) Ax (t ) Bu (t ) L( y (t ) y (t ))
B lc Kalman:
y (t ) Cx (t )
Trong : L C T RN1
A AT C T RN1C Q N 0
0 1 p1 p2 p1 p2 0 1 0.2 0
1 2 p2
p3 p2
p3 1 2 0 0.1
p1 p2 1 1 p1 p2
1 0 0
p2 p3 0 0.01 p2
p3
p2 p3 p2 p1 2 p2 0.2 0
p1 2 p2
p2 2 p3 p3 p2 2 p3 0 0.1
p12 p1 p2
100 2 0
p1 p2 p2
li b lc Kalman: L C T RN1
0.0441 0.00279 1 1
L
4.409
L
0.00279 0.0262 0 0.01 0.279
15 January 2014 H. T. Hong - HCMUT 113
Lc Kalman ri rc
x (k 1) Ad x (k ) Bd u (k ) w (k )
tnh ri rc:
Xt h tuyn
y (k ) C d x(k ) v(k )
Trongg : w(k)
( ) l nhiu h thng; ( ) l nhiu o lng.
g; v(k) g
Gi s nhiu h thng v nhiu o lng c phn b Gauss, khng
tng quan, c trung bnh bng 0 v phng sai l:
E[ ww T ] Q N E[vvT ] RN
B lc Kalman ri rc:
x (k 1) [ Ad x (k ) Bd u (k )] Lk [ y (k 1) y (k 1)]
y (k ) C x (k )
d
Trong L l li ca b lc Kalman:
L(k ) Ad (k )C d C d (k )C d RN
T T
1
L +
++ 1
x (t )
Bd z Cd
+ y (t )
Ad
B lc Kalman: x (k 1) [ Ad x (k ) Bd u (k )] Lk [ y (k 1) y (k 1)]
y (k ) C d x (k )
Trong :
L(k ) Ad (k )C C d (k )C RN
T
d
T
d
1
2 0
t
trong Q l cc
ma trn
t ttrng s
bn
b xc
nh
h dng
d
R l ma trn trng s xc nh dng
15 January 2014 H. T. Hong - HCMUT 118
Nguyn l tch ri
Nguyn l tch ri: Bi ton ti u LQG c th gii bng cch gii
ring bi ton iu khin ti u tin nh v bi ton c lng trng
thi ti u.
+
L
x (t )
B ++
+ C
y (t )
Thit k d
dng Matlab:
M tl b
>> K = lqr(A,B,Q,R)
Ty theo ln tng i gia trng s Q v R m h
thng c p ng qu v nng lng tiu tn khc nhau.
Mun trng thi p ng nhanh tng thnh phn Q tng
ng
Mun gim nng lng tng R
[rad],[rad/s]
1 0 0 0
0
0 1 0 0 -0.5
Q
0 1 2 3 4 5 6
1
0 0 1 0 x
x
m/s]
0.5
0 0 0 1
[m],[m
0
-0.5
R 1 10
0 1 2 3 4 5 6
u
5
[N]
-5
Gc l
G lchh con l
lc 0 1 2 3 4 5 6
Time [s]
c gi cn bng
tt, tuyy nhin v tr xe K= [34.3620 10.7009 1.000 2.4109]
dao ng kh ln
15 January 2014 H. T. Hong - HBK TPHCM 128
Kt qu m phng iu khin LQR h con lc ngc
0
0.5
[rad],[rad/s]
0
1 0 00 -0.5
0 1 0 0 -1
Q
0 1 2 3 4 5 6
2
0 0 100 0 x
x
m/s]
1
0 0 0 1
[m],[m
0
-1
R 1 20
0 1 2 3 4 5 6
u
10
Tng trng s q33
[N]
0
(tng ng vi v tr -10
xe) v tr xe t dao 0 1 2 3
Time [s]
4 5 6
0.5
[rad],[rad/s]
0
1 0 00 -0.5
0 1 0 0 -1
Q
0 1 2 3 4 5 6
2
0 0 100 0 x
x
m/s]
1
0 0 0 1
[m],[m
0
-1
R 1 0 1 2 3 4 5 6
20
u
10
Khuyt im ca b
[N]
0
iu khin LQR l -10
10
nu c nhiu o 0 1 2 3
Time [s]
4 5 6
Thit
k
dng Matlab:
>> K = lqr(A,B,Q,R)
>> L = lqe(A,G,C,QN,RN)
q ( , , ,Q , ) %G l ma trn
n v
B lc Kalman
Q N 0.000001I 6.5617 0.0571
21.5437 0.1876
0.001 0
L
RN 0.5713 0.1470
0 0 .01
1.9568 0.0271
(Do ta gi s khng c nhiu h thng nn chn QN rt b.
b Hai
thnh phn ca RN chnh l phng sai ca nhiu o lng)
15 January 2014 H. T. Hong - HBK TPHCM 132
M phng iu khin LQG h con lc ngc
[rad],[rad/s]
0
-1
-2
0 1 2 3 4 5 6
2
x
x
[m],[m/s]
-2
0 1 2 3 4 5 6
10
u
0
[N]
-10
0 1 2 3 4 5 6
Time [s]
Hng
s C c xc nh da vo iu
kin bin.
Trng hp 2: b 2 4ac 0
x(t ) C1e pt C2te pt vi p b /(2a)
Trng hp 3: b 2 4ac 0
x(t ) C1et sin t C2 et cos t
Vi b /(2a) v /(2a)
Cch 1: (t ) e At L1 ( sI A) 1
Cch 2:(t ) e At C0 I C1 A C2 A2 Cn 1 An 1
thay cc tr ring i ca ma trn A (nghim ca det(I A) 0 )
vo phng trnh trn s tnh c cc h s Ci
15 January 2014 H. T. Hong - HCMUT 141
Nghim ca phng trnh trng thi (tt)
Cc trng hp ring ca phng trnh vi phn bc 1:
Nu B=0: x (t ) Ax (t )
x(t ) (t ) x(t0 ) e A(t t0 ) x(t0 )
Nu u=1: x (t ) Ax (t ) B
t
x(t ) (t ) x(t0 ) (t ) Bd
t0