Professional Documents
Culture Documents
Chng 1
IU KHIN TI U
Vi nt lch s pht trin l thuyt iu khin .
- Phng php bin phn c in Euler_Lagrange 1766 .
- Tiu chun n nh Lyapunov 1892 .
- Tr tu nhn to 1950 .
- H thng iu khin my bay siu nh 1955 .
- Nguyn l cc tiu Pontryagin 1956 .
- Phng php quy hoch ng Belman 1957 .
- iu khin ti u tuyn tnh dng ton
phng LQR ( LQR : Linear Quadratic
Regulator ) .
- iu khin kp Feldbaum 1960 .
- Thut ton di truyn 1960 .
- Nhn dng h thng 1965 .
- Logic m 1965 .
- Lut iu khin h thng thch nghi m hnh tham chiu MRAS v b t
chnh nh STR 1970 ( MRAS : Model-Reference Adaptive System , STR :
Self-Tuning Regulator ) .
- H t hc Tsypkin 1971 .
- Sn phm cng nghip 1982 .
- L thuyt bn vng 1985 .
- Cng ngh tnh ton mm v iu khin tch hp 1985 .
Hc k 1 nm hc 2005-2006
http://www.khvt.com
Chng 1 : iu khin ti u
iu kin tn ti cc tr :
o hm bc mt ca J theo u phi bng 0 :
J
=0
u
Xt gi tr o hm bc hai ca J theo u ti im cc tr :
2J
> 0 : im cc tr l cc tiu
u 2
2J
< 0 : im cc tr l cc i
u 2
Trang 3
J = L[ x(t ), u (t ), t ]dt
0
http://www.khvt.com
Chng 1 : iu khin ti u
kM iu M c = M q
d
dt
d
dt
(1)
(2)
kM iu = M q
d 2
dt 2
(3)
= t kM / M q
th (3) c dng :
d 2
= iu
d 2
(4)
d 2x
=u
d 2
(5)
T ta c :
J = L[ x(t ), u (t ), t ]dt = T
0
J = 1dt = T
0
Trang 5
J = x ( t )dt
0
Q = U u iu dt
0
U u = iu Ru + ke
v phng trnh cn bng moment :
kM iu M c = M q
d
dt
Ta tnh c :
T
Q = U u iu dt =
0
ke M c
(T 0 ) + Ru iu2 dt
kM
0
J = u 2 (t )dt
0
http://www.khvt.com
Chng 1 : iu khin ti u
3. Ti u ho tnh v ng
1
dL = LTu du + du T Luu du + O(3)
2
(1.1)
Lu
L / u1
L L / u 2
=
L / u m
(1.2)
2 L 2 L
=
u 2 u i u j
(1.3)
Luu c gi l ma trn un .
Mt im cc tr hoc im dng xut hin khi s bin thin dL vi thnh
phn th nht tin v 0 vi mi bin thin du trong qu trnh iu khin . V
vy , c im cc tr th :
Lu = 0
(1.4)
Gi s ang ti im cc tr , c Lu = 0 nh (1.4) . im cc tr tr
thnh im cc tiu , chng ta cn c :
Trang 7
dL =
1 T
du Luu du + O(3)
2
(1.5)
Luu > 0
(1.6)
(1.7)
dL = LTu du + LTx dx = 0
(1.8)
df = f u du + f x dx = 0
(1.9)
v:
http://www.khvt.com
Chng 1 : iu khin ti u
T (1.7) ta xc nh c x t gi tr u c, bin thin dx c xc nh
bi (1.9) t gi tr bin thin du c . Nh vy , ma trn Jacobi fx khng
k d v :
dx = f x1 f u du
(1.10)
(1.11)
Thay dx vo (1.8) ta c :
o hm ring ca L theo u cha hng s f c cho bi phng trnh :
L
u
( )
vi f xT = f x1
= LTu LTx f x1 f u
= Lu f uT f xT Lx
(1.12)
df = 0
. Lu rng :
L
u
= Lu
(1.13)
dx =0
(1.14)
LTu dx
= 0
f u du
(1.15)
kt qu dx T du T . iu ny ch xy ra nu ma trn h s (n + 1) (n + m )
c hng nh hn n+1 . C ngha l cc hng ca ma trn tuyn tnh vi nhau
tn ti mt vector c n s hng nh sau:
T
LTx
1 .
fx
T
LTu
=0
fu
(1.16)
Hay:
LTx + T f x = 0
(1.17)
LTu + T f u = 0
(1.18)
Trang 9
10
T = LTx f x1
(1.19)
(1.20)
V vy:
L
f
= LTx f x1
(1.21)
du = 0
(1.22)
(1.23)
Lu rng :
H =
H
= f ( x, u )
(1.24)
(1.25)
http://www.khvt.com
Chng 1 : iu khin ti u
f =0
=L
(1.26)
(1.27)
(1.28)
hay T = LTx f x1 .
Nu gi nguyn (1.25) v (1.27) th:
dL = dH = H uT du
(1.29)
(1.30)
(1.31a)
H
= L x + f xT = 0
x
(1.31b)
H
= Lu + f uT = 0
u
(1.31c)
12
L
du T xx
Lux
L xu dx
+ O(3)
Luu du
(1.32)
f
du T xx
f ux
f xu dx
+ O(3)
f uu du
(1.33)
dL = LTx
dx 1
LTu + dx T
du 2
df = [ f x
dx 1
f u ] + dx T
du 2
Vi:
f xu =
2 f
ux
[1
T ]
dL
T
= Hx
df
dx 1
H uT + dx T
du 2
H
du T xx
H ux
H xu dx
+ O(3)
H uu du
(1.34)
By gi , c c im dng ta cn c f = 0 , v ng thi thnh phn
th nht ca dL bng 0 vi mi s bin thin ca dx v du . V f = 0
nn df = 0 , v iu ny i hi H x = 0 v H u = 0 nh trong (1.31) .
tm iu kin cho im cc tiu , chng ta xt n thnh phn th hai .
u tin , ta cn xem mi quan h gia dx v du trong (1.34) . Gi s rng
chng ta ang im cc tr nn H x = 0 , H u = 0 v df = 0 . Sau , t
(1.33) ta c :
dx = f x1 f u du + O(2)
http://www.khvt.com
(1.35)
Chng 1 : iu khin ti u
Thay vo (1.34) ta c :
H
I xx
H ux
1
dL = du T f uT f xT
2
H xu f x1 f u
du + O(3)
H uu I
(1.36)
L = Luu
f
uu
= f f
T
u
T
x
H
I xx
H ux
H xu f x1 f u
H uu I
(1.37)
= H uu f uT f xT H xu H ux f x1 f u + f uT f xT H xx f x1 f u
Cho u R 2 v :
L(u ) =
1 T q11
u
2 q12
q12
u + [s1
q 22
s 2 ]u
1
= u T Qu + S T u
2
(1)
(2)
im cc tr c xc nh bi :
Lu = Qu + S = 0
(3)
u = Q 1 S
(4)
(5)
Trang 13
14
L* = L(u * ) =
=
1 T 1
S Q QQ 1 S S T Q 1 S
2
1 T 1
S Q S
2
(6)
Gi s cho L nh sau :
1 T 1 1
u
u + [0 1]u
2 1 2
(7)
2 1 0 1
u * =
=
1 1 1 1
(8)
L=
Khi gi tr u ti u s l :
u1 + 2u 2 + 1
(9)
http://www.khvt.com
Chng 1 : iu khin ti u
1 2
u1 + u1u 2 + u 22 + u 2
2
(1)
(2a)
L
= u1 + 2u 2 + 1 = 0
u 2
(2b)
Trang 15
16
(3)
Vy , im cc tr l (1 ,-1) .
Biu thc (1) l mt dng m rng ca biu thc (7) trong v d 1.1 , nh
vy chng ta va tm c mt kt qu tng t bng mt cch khc .
Ti u ha c iu kin rng buc
V d 1.3 : Khng gian ton phng vi iu kin rng buc tuyn tnh .
1 1 x
x
1
[x u ] + [0 1]
2
1 2 u
u
(1)
(2)
Hm Hamilton s l :
H = L + T f =
1 2
x + xu + u 2 + u + ( x 3)
2
(3)
(4)
Hx = x +u + = 0
(5)
H u = x + 2u + 1 = 0
(6)
(x, u ) = (3,2)
(7)
(8)
http://www.khvt.com
Chng 1 : iu khin ti u
f x 1
f = 0
u
(9)
(10)
(11)
(1)
(2)
(3)
Trang 17
18
(4)
Hx =
x
+ =0
a2
(5)
Hu =
u
+ m = 0
b2
(6)
http://www.khvt.com
Chng 1 : iu khin ti u
u = b 2 m
(7)
=
1 0
1
1
2
a
(8)
Gii ra ta c gi tr ca im dng :
x=
a 2c
a2 + b2m2
c
a + b2m2
Thay (9) , (10) vo (7) , ta c c gi tr u ti u :
(9)
(10)
b 2 mc
(11)
a2 + b2m2
xc nh im dng l cc tiu , dng (1.37) tm ra ma trn un :
u=
Luuf =
1 m2
+
b2 a2
(12)
f
> 0 v vy ta tm c mt im cc tiu .
Luu
L*
f
=
du = 0
L*
=
c
(13)
(14)
(15)
Trang 19
20
(16)
Lu
m
c
L = 1 2
2
2
a +b m
x
(17)
1 T
1
x Qx + u T Ru
2
2
(1)
(2)
1 T
1
x Qx + u T Ru + T ( x + Bu + c)
2
2
(3)
v cc iu kin c im dng l :
H = x + Bu + c = 0
(4)
H x = Qx + = 0
(5)
H u = Ru + B T = 0
(6)
http://www.khvt.com
Chng 1 : iu khin ti u
u = R 1 B T
(7)
= Qx
(8)
= QBu + Qc
(9)
T (5) ta c :
Kt hp vi (4) ta c :
dng kt qu ny thay vo (7) cho ta :
hay :
u = R 1 B T (QBu + Qc)
(10)
(I + R B QB )u = R B Qc
(R + B QB )u = B Qc
(11)
(12)
)
B Q) c
x = I B ( R + BT QB ) BT Q c
1
= Q QB ( R + BT QB )
(13)
(14)
= (Q 1 + BR 1 B T ) c
1
(15)
(16)
22
L* =
1 T
c Q QB R + B T QB
2
L* =
1 T
c
2
BT Q c
(17)
(18)
V th :
L *
=
c
(19)
(1)
y = x+c
(2)
vi ng thng :
Xem Hnh 1.7 .
Trong bi ton ny s c hai iu kin rng buc :
f1 ( x1 , y1 ) = y1 ax12 bx1 d = 0
(3)
f 2 ( x2 , y 2 ) = y2 x2 c = 0
(4)
V :
vi (x1 , y1 ) l 1 im trn parabol v (x 2 , y 2 ) l 1 im trn ng thng .
Chng ta chn hm ch tiu cht lng l mt na ca bnh phng khong
cch gia 2 im ny .
L( x1 , x 2 , y1 , y 2 ) =
1
1
( x1 x 2 ) 2 + ( y1 y 2 ) 2
2
2
(5)
x
x = 1 ,
x2
y
u = 1
y2
(6)
http://www.khvt.com
Chng 1 : iu khin ti u
1
1
( x1 x 2 ) 2 + ( y1 y 2 ) 2 + 1 ( y1 ax12 bx1 d ) + 2 ( y 2 x 2 c)
2
2
(7)
Khi , c im dng ta cn c :
H x1 = x1 x 2 2a1 x1 b1 = 0
(8)
H x2 = x1 + x2 2 = 0
(9)
H y1 = y1 y 2 + 1 = 0
(10)
H y2 = y1 + y 2 + 2 = 0
(11)
H 1 = y1 ax12 bx1 d = 0
(12)
H 2 = y 2 x2 c = 0
(13)
Trang 23
24
(14)
2 = x 2 x1 = y1 y 2
(15)
T (9) v (11) , ta c :
v s dng (14) vi y 2 = x 2 + c t (13) c c kt qu sau :
x 2 x1 = ax12 + bx1 + d x 2 c
(16)
Khi :
x2 =
1
ax12 + (b + 1) x1 + d c
2
(17)
1 = x1 x 2
1 =
1
ax12 + (b 1) x1 + d c
2
(18)
(2ax1 + (b 1))1 = 0
(19)
(2ax1 + (b 1) )(ax12 + (b 1) x1 + d c ) = 0
(20)
http://www.khvt.com
Chng 1 : iu khin ti u
J (u ) = L(u, u, t )dt
(1.38)
t0
c cc tr .
L l hm c o hm ring bc mt v bc hai lin tc vi mi bin ca n .
thng nht , y ta ly t0 = 0 v t1 = T .
Bin i ca J do u to nn l :
J (u + u ) = J (u + u ) J (u )
T
(1.39)
J (u , u ) = [(
0
L(u , u , t )
L(u , u , t )
)u + (
)u ]dt
u
u
(1.40)
Trang 25
26
u (t ) = u (t )dt + u (0)
0
J (u , u ) =
L(u , u , t ) T
L(u , u , t ) d L(u , u , t )
u 0 + [
]udt... (1.41)
dt
u
u
u
0
(1.42)
J (u * , u ) = [
0
L(u * , u * , t ) d L(u * , u * , t )
]udt = 0
u
dt
u
(1.43)
=0
dt
u
u
(1.44a)
=0
u dt u
(1.44b)
i (u, u, t ) = 0
t [0, T ] , i = 1, n
(1.45)
i =1
http://www.khvt.com
(1.46)
Chng 1 : iu khin ti u
La (u, u, , t ) d La (u, u , , t )
=0
u
u
dt
(1.47)
(1.48)
i =1
(u , u , t )dt = qi
(1.49)
La (u, u, , t ) = L(u , u , t ) + i (u , u , t )
(1.50)
i =1
Khi c iu kin rng buc dng (1.45) hoc (1.49) phi gii (n+1) phng
trnh xc nh y*(t) v i*(t) vi i=1,2,,n .
Phng trnh Euler_Lagrange vi tn hiu iu khin b hn ch
u (t )
(1.51)
(1.52)
Trang 27
28
mi u = z + , t :
2
u = 2 zz +
v ch tiu cht lng J c dng :
T
J = L[ z 2 + ,2 zz + , t ]dt
(1.53)
=0
z dt z
y
(1.54)
L L u L u L
L
=
+
=
2z +
2z
z u z u z u
u
L L u L u L
=
+
=
2z
z u z u z u
d L
d L L
= 2z(
)+
2z
dt z
dt u
u
v (1.54) s c dng :
d L L
L
L
2z +
2z 2z
2z = 0
u
u
dt u u
hay :
L d L
2 z
=0
u dt u
(1.55)
=0
u dt u
2. V d
V d 1.7 :
Tm qu trnh ti u x* = u2 v u2* =
du1
cc tiu ha ch tiu cht lng
dt
J:
http://www.khvt.com
Chng 1 : iu khin ti u
J (u ) = (u2 ) 2 dt
(1)
vi iu kin u :
T
u (t )dt =
2
(2)
v iu kin bin :
u2 (0) = u2 (T ) = 0
(3)
iu kin u c dng :
T
(u , u , t )dt = qi
(4)
=0
u2 dt u2
(5)
(6)
vi phim hm :
T 2 phng trnh trn ta c :
1 2u 2 = 0
(7)
Do :
u2 =
(8)
Ly tch phn , ta c :
u2 = x =
u 2 (t ) =
1
2
1
4
t + c1
t 2 + c1t + c 2
(9)
1
4
T 2 + c1T = 0
Trang 29
30
(t )dt =
12
T3 +
c1 2
T = 0
2
1 =
c1 =
24 0
T3
(10)
6 0
T2
(11)
T qu trnh ti u l :
u2 (t ) = x (t ) =
u2 (t ) =
60 12 0
3 t
T2
T
6 0
6
t 30 t 2
2
T
T
(12)
(13)
0 = 2 (ua .t )dt =
0
ua =
u aT 2
4
4 0
T2
(14)
J a = ua2 dt =
0
16 02
T3
(15)
cn v d ta ang xt :
T
J = ( x ) 2 dt =
0
12 02
T3
http://www.khvt.com
(16)
Chng 1 : iu khin ti u
J a 16
=
= 1.33 ln .
J 12
Hnh 1.8 : c tnh thi gian ca h tn hao nng lng ti thiu (a) v h
tc ng nhanh (b) .
V d 1.8 :
u dt =
2
(1)
(u )
2
dt = q0
(2)
iu kin bin :
u2 (0) = u2 (T ) = 0
(3)
(4)
L d L
=0
u2 dt u2
(5)
1 22u2 = 0
(6)
Trang 31
32
1
22
(7)
1
t + c1
22
(8)
1 2
t + c1t + c2
42
(9)
u2 (t ) = x(t ) =
u2 (t ) =
1
T .
42
2 0 1
T
T 2 62
24
1
= 30
2
T
c1 =
(10)
6 0
T2
(11)
Th vo (8) , (9) c :
u2 (t ) = x (t ) =
u2 (t ) =
60 12 0
3 t
T2
T
(12)
6 0
6
t 30 t 2
2
T
T
(13)
i = 1, n;
k [1, n]
(1)
J = ( x ) + (x ) dt
2
http://www.khvt.com
(2)
Chng 1 : iu khin ti u
+ =0
(3)
o hm ca hm s c dng :
n
n
d
xi +
i
=
dt
i =1 dx i
i =1 d i
(4)
Kt hp (4) v (1) ta c :
n
n
d
( f i (x, i ) + g k (x )u ) + i
=
dt
i =1 dx i
i =1 d i
n
=
i =1
ik
(5)
f i ( x, i ) +
g k ( x )u +
i
dxi
dxi
i =1 d i
n
n
u =
i
+ f i ( x, i ) +
g k ( x ) xi
i =1
i =1 i
ik
*
(6)
0 .
x k
Trang 33
34
Mt my bay bay theo hng t tri sang phi nh Hnh 1.9 qua cc im a,
b, c tng trng cho cc thnh ph , v mc nhin liu cn thit hon
tt mi chng ng . Chng ta s dng nguyn l ti u ca Belman
gii bi ton cc tiu ha nhin liu tiu hao .
Lit k cc trng thi k t 0 n 4 trong qu trnh ra quyt nh nh Hnh
1.9 (u mi tn v con s trong khung bc u c th cha cn quan tm).
Ti mi gi tr k = 0,1,....N 1 phi c mt quyt nh , v N l trng thi
cui .
Trng thi hin ti l nt m chng ta ang ra quyt nh . V th trng thi
ban u l x0 = a . Ti trng thi 1 , cc kh nng c th l x1 = b hoc
x1 = d . Tng t vi x2 = c , e hoc g ; x3 = f hoc h v trng thi cui
cng xn = x4 = i .
iu khin u k trng thi k n trng thi k+1 c hai gi tr u k = 1 : i
theo hng ln th u k = 1 v u k = 1 nu i theo hng xung .
n y chng ta c bi ton ti thiu ha nng lng tiu hao vi trng
thi cui c nh , lut iu khin v cc gi tr trng thi .
tm ra lut iu khin ng vi mc tiu hao nhin liu ti thiu , ta s
dng nguyn l ti u ca Belman , c bt u k = N = 4 . Khng c
quyt nh no c yu cu y do ta gim k = 3 .
Nu x3 = f th lut iu khin ti u l u3 = 1 v chi ph l 4 . iu ny
c th hin bng cch t (4) pha trn nt f v chiu mi tn theo chiu
t f n i . Nu x3 = h th lut iu khin ti u l u3 = 1 v chi ph l 2 ,
c th hin nh trn hnh .
http://www.khvt.com
Chng 1 : iu khin ti u
36
Phng php quy hoch ng cng c th d dng p dng cho h phi tuyn
Ngoi ra , nu c cng nhiu iu kin rng buc i vi tn hiu iu khin
v bin trng thi th ta c c li gii cng n gin .
t :
xk +1 = f k ( xk , uk )
(1.56)
J i ( xi ) = ( N , xN ) + Lk ( xk , uk )
(1.57)
k =i
(1.58)
J k ( xk ) = min Lk ( xk , uk ) + J k+1 ( xk +1 )
uk
(1.59)
Chng 1 : iu khin ti u
Xt h :
x k +1 = x k + u k
(1)
1 N 1 2
uk
2 k =0
(2)
(3)
(4)
(5)
(6)
Trang 37
38
uk
(7)
http://www.khvt.com
Chng 1 : iu khin ti u
x = f ( x, u , t )
(1.60)
J ( 0 ) = ( x (T ) , T ) + L ( x ( t ) , u ( t ) , t ) dt
(1.61)
Trang 39
40
(1.62)
xk +1 = xk + f ( xk , uk , k )
(1.63)
u ( k )
nh ngha hm ri rc :
f k ( xk , uk )
xk + f ( xk , uk , k )
(1.64)
Khi ta c th vit :
xk +1 = f k ( xk , uk )
(1.65)
J ( 0 ) = ( x (T ) , T ) +
k =0
N=
Trong :
L ( x ( t ) , u ( t ) , t ) dt
(1.66)
(1.67)
J ( 0 ) = ( x (T ) , T ) + L ( xk , uk , k )
(1.68)
k =0
nh ngha hm ri rc :
J0
J (0)
S ( N , xN ) ( x ( N ) , N )
Lk ( xk , uk ) L ( xk , uk , k )
(1.69)
Khi ta c :
N 1
J ( 0 ) = S ( N , xN ) + Lk ( xk , uk )
k =0
http://www.khvt.com
(1.70)
Chng 1 : iu khin ti u
Trong trng hp h thng tuyn tnh bt bin theo thi gian vi ch tiu
cht lng dng ton phng :
x = Ax + Bu
(1.71)
T
1
1
J ( 0 ) = xT (T ) S (T ) x (T ) + xT Qx + u T Ru dt
2
20
(1.72)
J (0) =
1 T
1 N 1
xN S N xN + xkT Q S xk + ukT R S uk
2
2 k =0
(1.73)
(1.74)
Trong :
S ( N )
SN
(1.75)
Q S = Q
(1.76)
R S = R
(1.77)
(1.78)
A S = e A
(1.79)
Trong :
B S = e A B dt
(1.80)
k t ( k + 1)
(1.81)
Trang 41
42
Cho h thng :
x = f ( x, u , t )
(1.82)
J (t 0 ) = ( x(T ), T ) + L( x, u, t )dt
(1.83)
t0
(1.84)
(1.85)
H ( x, u , , t ) = L ( x , u , t ) + T f ( x , u , t )
(1.86)
Tha tt c gi tr u
Tha tt c gi tr u (1.87)
http://www.khvt.com
Chng 1 : iu khin ti u
1 2
u 2u + 1
2
(1)
Vi iu kin :
u 1
(2)
tha u
(3)
(4)
Gi tr ti u ca L l :
Trang 43
44
1
2
(5)
(6)
u=2
(7)
L(2) = -1
(8)
nhn c :
v :
nh hn (5) ; nhng u=2 th khng nm trong khon u 1 .
2. iu khin Bang-Bang
(1.88)
J(t0) = 1dt
t0
(1.89)
t [t0 , T ]
(1.90)
(1.91)
H
= BT
u
(1.92)
http://www.khvt.com
Chng 1 : iu khin ti u
( )T Bu ( )T Bu
(1.93)
sgn ( w ) = ( 1,1) w = 0
1 w < 0
(1.94)
(1.95)
u* c biu din di dng bin trng thi , vi h tuyn tnh dng ton
phng .
Gi tr bT(t) c gi l hm chuyn i . Mt hm chuyn i mu v b
iu khin ti u c din t Hnh 1.12 . Khi hm chuyn i ny i
du , b iu khin chuyn t cc tr ny n cc tr khc . B iu khin
trong hnh c chuyn i bn ln . iu khin thi gian ti thiu tuyn
Trang 45
46
T (t ) Bu (t ) = ui (t )biT (t )
(1.96)
i =1
cng nh cng tt vi mi t [t 0 , T ] .
Ta c th vit :
u (t ) = sgn( BT (t ))
(1.97)
nu vi = sgn(w)
cho mi i
(1.98)
http://www.khvt.com
Chng 1 : iu khin ti u
U n = B
AB An 1 B
(1.99)
Ab An 1b
(1.100)
(1)
v =u
(2)
T
(3)
(x(T),T) =
=0
v(T )
(4)
Lp hm Hamilton (1.91) :
H = 1 + yv + vu
(5)
48
(6)
H
= y
v
(7)
y =
v =
iu kin tip tuyn :
0 = H (T ) = 1 + y (T ) v (T ) + v (T ) u (T )
(8)
v (T ) u (T ) = 1
(9)
(10)
y ( t ) = const
v ( t ) = v (T ) + (T t ) y
(11)
(12)
(13)
u (T ) = 1 v v (T ) = 1
(14)
hoc :
C nhiu kh nng cho hm chuyn i v ( t ) , tu thuc vo gi tr ca
http://www.khvt.com
Chng 1 : iu khin ti u
(15)
1
y ( t ) = y ( 0 ) + v ( 0 ) t + ut 2
2
(16)
( y ( t ) y ( 0 ) ) u = v ( 0 ) ( v ( t ) v ( 0 ) ) + 12 ( v ( t ) v ( 0 ) )
(17)
Trang 49
50
v<0
(18)
v>0
http://www.khvt.com
Chng 1 : iu khin ti u
v2 (t )
2
t 2 2v ( 0 ) t +
v2 ( 0)
2
v2 ( 0)
2
t2
2
t2
v ( 0) t +
2
y ( 0) = 0
(19)
Thi im chuyn i s l :
tS = v ( 0 ) + y ( 0 ) +
v2 ( 0)
(20)
(21)
(22)
Hoc :
T = v ( 0) + 2 y ( 0) +
v2 ( 0)
2
(23)
Trang 51
52
(1.101)
J ( t0 ) = ci ui ( t ) dt
(1.102)
t0 i =1
u =
u
m
(1.103)
J ( t0 ) = C T u ( t ) dt
(1.104)
t0
(1.105)
(1.106)
(1.107)
http://www.khvt.com
Chng 1 : iu khin ti u
C T u * + (* ) T Bu * C T u + (* ) T Bu
(1.108)
vi mi u(t) .
xc nh u*(t) t bin trng thi (t) tha mn (1.108) , ta gi s rng m
thnh phn ca b iu khin l c lp ln nhau (i=1,,m) . Tt c cc gi
tr ui(t) phi tha bt ng thc v hng :
( )
+
*
ui*
bi u *
ci
( )
+
ui
bi ui
(1.109)
ci
ui 0
ui 0
(1.110)
qi ( t )
1 + biT
ui
biT ui ci
ui +
=
T
ci
1 bi
ui
ci
ui 0
(1.111)
ui 0
nonnegative
ui ( t ) =
0
nonpositive
-1
bi (t ) / ci < 1
T
bi (t ) / ci = 1
T
1 < bi (t ) / ci < 1
T
(1.112)
bi (t ) / ci = 1
T
bi (t ) / ci > 1
T
Trang 53
54
w < 1
w = 1
1 < w < 1
w =1
w >1
(1.113)
u i (t ) = dez
c
i
i = 1,2,..., m
(1.114)
H thng c m t :
y=v
(1)
v=u
(2)
u (t ) 1
(3)
(x(T ), T ) =
http://www.khvt.com
(4)
Chng 1 : iu khin ti u
J (0 ) = u (t )dt
(5)
Ta cha ch n trng thi thi gian cui T hoc t do hoc rng buc,
mc d cui cng ta cng s xt n c 2 trng hp .
Hm Hamilton :
H = u + y v + v u
Trong = y
(6)
(7)
v = y
(8)
0 = H (T ) = u (T ) + v (T )u (T )
(9)
y ( t ) = const
v ( t ) = v (T ) + (T t ) y
(10)
(11)
Thnh phn bin trng thi v(t) l tuyn tnh . Ty thuc vo bin cha bit
y v v(T) ( chng tu thuc vo gi tr ca trng thi u ) , v(t) c th l
hng s (y = 0) , c th tng (y < 0) hoc gim (y > 0) . Xem Hnh 1.13 .
Nguyn l cc tiu Pontryagin yu cu :
u (t ) = dez (v (t ))
(12)
do iu khin ti u l :
1
[0;1]
u (t ) = 0
[- 1;0]
- 1
v (t ) < 1
v (t ) = 1
1 < v (t ) < 1
v (t ) = 1
v (t ) > 1
(13)
56
(14)
y (t ) = y ( 0) + v ( 0) t
(15)
Chng 1 : iu khin ti u
Trang 57
58
v 2 (0)
2
(16)
(17)
(18)
t12
y ( t1 ) = y ( 0 ) + v ( 0 ) t1
2
(19)
(20)
y ( t2 ) = y ( t1 ) + v1 ( t2 t1 )
(21)
0 = y (T ) = y ( t2 ) + v ( t2 )(T t2 )
(22)
(T t2 )
+
2
(23)
(24)
v
2
t1 (v0 + T )t1 + y 0 + v0T + 0 = 0
2
http://www.khvt.com
(25)
Chng 1 : iu khin ti u
vi nghim :
t=
(26)
(27)
v :
t2 =
(28)
u (t ) = 0
1
t < t1
t1 t t 2
(29)
t2 < t
(30)
1.2.4 Nhn xt
60
(1.115)
J = xT Qxdt
0
http://www.khvt.com
(1.116)
Chng 1 : iu khin ti u
(1.117)
= ( Ax ) Sx + xT S ( Ax ) + xT Sx
T
= xT AT Sx + xT SAx + xT Sx
= xT AT S + SA + S x
Q = AT S + SA + S
(1.118)
(1.119)
(1.120)
J = xT Qxdt = xT Sx = xT ( ) Sx ( ) + xT ( 0 ) Sx ( 0 )
0
(1.121)
Trang 61
62
Xt h thng :
x = Ax + Bu
(1.122)
(1.123)
J = (x T Qx + u T Ru )dt
(1.124)
(1.125)
J = x T Qx + x T K T RKx dt
0
(1.126)
= x Q + K RK xdt
T
V ( x) 0, x
(1.127)
V ( x) = xT Sx + xT Sx + xT Sx
= xT ( A BK )T Sx + xT Sx + xT S ( A BK ) x
= xT ( A BK )T S + S + S ( A BK ) x
http://www.khvt.com
(1.128)
Chng 1 : iu khin ti u
d T
x Sx = xT (Q + K T RK ) x
dt
T
xT Q + K T RK x = xT ( A BK ) S + S ( A BK ) + S x
Q + K T RK = ( A BK ) S + S ( A BK ) + S
T
(1.129)
J = x T Qx + u T Ru dt = x T Sx
0
Lu rng x( ) = 0
J = x(0) Sx(0)
T
(A
K T B T S + S ( A BK ) + S + Q + K T T T TK = 0
( )
AT S + SA + TK T T
][
( )
B T S TK T T
B T S SBR 1 B T S + Q + S = 0
(1.130)
Ch tiu cht lng J t gi tr cc tiu khi biu thc :
( )
x T TK T T
][
( )
B T S TK T T
BT S x
t gi tr cc tiu . Khi :
( ) BS
(T ) B S = R
TK = T T
K = T 1
T 1
BT S
(1.131)
Trang 63
64
(1.132)
(1.133)
(1.134)
Xt h ri rc :
xk +1 = Ak xk + Bk uk
(1.135)
vi xk R n v uk R m .
Ch tiu cht lng J c nh ngha trong khong [1,N] c dng :
N 1
J i = xkT Qk xk + ukT Rk uk
k =i
(1.136)
(1.137)
K k = ( BkT S k +1 Bk + Rk ) 1 BkT S k +1 Ak
(1.138)
vi Kk c xc nh nh sau :
Trong Sk phi tho mn phng trnh :
S k = AkT Sk +1 S k +1 Bk BkT S k +1 Bk + Rk
BkT Sk +1 Ak + Qk
(1.139)
http://www.khvt.com
(1.140)
Chng 1 : iu khin ti u
Bc 1 :
Thnh lp h phng trnh trng thi :
x = Ax + Bu
c = Dx
Xc nh cc thng s A , B , D .
Bc 2 :
Xc nh ma trn trng lng Q , R t ch tiu cht lng J cho di dng
ton phng tuyn tnh .
Bc 3 :
Tm nghim S ca phng trnh Riccati :
- i vi h lin tc : S = AT S + SA SBR 1 BT S + Q
- i vi h ri rc :
S k = AkT Sk +1 S k +1 Bk BkT S k +1 Bk + Rk
BkT Sk +1 Ak + Qk
Bc 4 :
Ch tiu cht lng ti u i vi h dng :
J = xT ( 0 ) Sx ( 0 )
min
Bc 5 :
Lut iu khin ti u :
- i vi h lin tc : u = R 1 BT Sx
- i vi h ri rc : uk = ( BkT S k +1 Bk + Rk ) BkT S k +1 Ak xk
1
V d 1.14:
66
J = (e 2 + e 2 )dt ( > 0 )
(1)
0+
t cc tiu .
T hnh v ta tm c :
C (s)
1
= 2
R( s ) s + 2s + 1
(2)
c + 2c + c = r
(3)
hoc c dng :
i vi tn hiu sai lch e , ta c :
e + 2e + e = r + 2r
(4)
e + 2e + e = 0 ,
e (0 + ) = 1 ,
e( 0 + ) = 0
(5)
(6)
x 2 = x1 = e
(7)
(8)
1
0
A=
1 2
vi
0+
0+
[x
0+
1 0 x1
x 2 ]
dt
0 x 2
Qxdt
(9)
0+
http://www.khvt.com
(10)
Chng 1 : iu khin ti u
(11)
s12 s11
+
s 22 s 21
s12 0
1 1 0
=
s 22 1 2 0
(12)
(13)
s 22 + s11 2s12 = 0
(14)
s11 2s 21 s 22 = 0
(15)
s12 2s 22 + s 21 2s 22 =
(16)
+ 4
S=
1
1
2
1+
4
(17)
1+ 2
1+ 2
x1 (0+ ) + x1 (0+) x 2 (0+) +
= +
x 2 (0 + )
4
4
(18)
1+
4
(19)
4 2
1+
2
Xt o hm bc hai ca J theo ti =
(20)
(21)
1+
:
2
Trang 67
68
1+
1+
2
2
2
>0
1+
(22)
(23)
V d 1.15 :
u (t )
0 0.1
0.01
(1)
J = x12k + 0.001uk2
k =0
(2)
0.00488
0 0.951
Nghim ca bi ton ti u c tnh theo (1.138) v (1.139) :
K k = ( BkT S k +1 Bk + Rk ) 1 BkT S k +1 Ak
S k = AkT Sk +1 S k +1 Bk BkT S k +1 Bk + Rk
BkT Sk +1 Ak + Qk
1 0
vi : Ak = Ad , Bk = Bd , Qk =
, Rk = 0.001
0 0
http://www.khvt.com
(3)
(4)
Chng 1 : iu khin ti u
0 0
(5)
1 0 0.00123
K 48 = [ 0.00123 0.00488]
+ 0.001 .[ 0.00123 0.00488] .
0 0 0.00488
1 0 1 0.488
(6)
0 0 0 0.951 = [1.228 0.599]
0 1 0 1 0 0.00123
1
1 0
S 48 =
[ 0.00123 0.00488]
.
0.488 0.951 0 0 0 0 0.00488
0 0
1
0.00123
1 0 1 0.488 1 0
0.001
0.00123
0.00488
+
[
]
0.00488
0 0 0 0.951 + 0 0
0.9985 0.4873
=
0.4873 0.2378
(7)
(8)
1.3.5 Nhn xt
Trang 69
70
Bi ton ch tiu cht lng dng ton phng v iu kin rng buc tuyn
tnh _ Trng hp v hng ( v d 1.4 )
Cho a = 3 , b = 2 , m = 1 , c = 1 . Vi : x(1) = x , x(2) = u . Khi bi ton
tr thnh tm gi tr ti thiu ca :
f ( x) =
x(1) 2 x(2) 2
+
18
8
g ( x) = x(1) + x(2) 1 = 0
y ta s s dng hm lsqlin ( Optimization Toolbox ) vi kt qu l gi
2
2
tr ti u ca x f ( x) = Cx D t gi tr nh nht ( Cx D l norm
http://www.khvt.com
Chng 1 : iu khin ti u
Phng trnh ng lc hc :
1 A B T1 E
=
T + F
C
D
2
2
Vi cc trng thi :
x1 = 1
x = x =
2
1
1
x3 = 2
x4 = x3 = 2
Trang 71
72
x1 = x2
x = AT + BT E
1
2
2
x3 = x4
x4 = CT1 + DT2 F
J = 12 + 12 + 22 + 22 dt
0
Vi phim hm dng :
1 = e1 + K1e1
2 = e2 + K 2 e2
e = r
vi 1 1r 1
e2 = 2 2
1r , 2r l gc t ca 1 , 2
e = 1 = x2
1
e2 = 2 = x4
e = 1 = x2
1
e2 = 2 = x4
2 + 2 = 0
K1 B e1 + EK1 x2 ( K1 + 1)
K 2 D e2 + FK 2 x4 ( K 2 + 1)
1
http://www.khvt.com
Chng 1 : iu khin ti u
Chng trnh :
Thng s u vo cho h thng (file thongso.m) :
global m1 m2 L1 L2 a1 a2 I1 I2
m1 = 3.6745;
m2= 1.0184;
L1= 0.6519 ;
L2= 0.6019;
a1= 0.3365 ;
a2= 0.2606;
I1= 0.370 ;
I2= 0.081;
Chng trnh tm tn hiu iu khin (file Giai_PT.m) :
function [C]= Giai_PT (theta1, theta2, theta1_dot, theta2_dot, e1, e2)
% Nhap thong so cho canh tay
m1 = 3.6745; m2 = 1.0184;
L1 = 0.6519; L2 = 0.6019;
a1 = 0.3365; a2 = 0.2606;
I1 = 0.370; I2 = 0.081;
K1 = 0.5; K2 = 0.8;
m11 = m1*a1*a1+m2*(L1*L1+2*L1*a2*cos(theta2)+a2*a2)+I1+I2;
m12 = m2*a2*(a2+L1*cos(theta2))+I2;
m22 = m2*a2*a2+I2;
n1 =
-m2*L1*a2*sin(theta2)*(2*theta1_dot*theta2_dot+theta2_dot*theta2_dot);
n2 = m2*L1*a2*sin(theta2)*theta1_dot*theta1_dot;
A = [m11 m12; m12 m22];
B = [n1; n2];
A = inv(A);
B = A*B;
A = [K1*A(1,1) K1*A(1,2); K2*A(2,1) K2*A(2,2)];
Trang 73
74
B = [e1+B(1,1)*K1-theta1_dot*(K1+1); e2+B(2,1)*K2-theta2_dot*(K2+1)];
C = inv(A)*B;
u1 = C(1,1);
u2 = C(2,1);
Kt qu m phng :
Chng 1 : iu khin ti u
Trang 75
76
http://www.khvt.com
Chng 1 : iu khin ti u
Qu o trng thi ti u .
1.4.4 LQR lin tc v ri rc
1. H lin tc
Xt h v hng :
x = ax + bu
1
1
J = s (T ) x 2 (T ) + ( qx 2 + ru 2 ) dt
2
2 t0
Vi a = 0.05 , b = r =1 , x(0) = 10 , ta s dng chng trnh ex v fex v
cc qu o ti u ng vi cc gi tr q = 0.01 , 0.1 , 1 , 10 , 100 .
Chng trnh :
function [x,u,S,tf] = ex
x0 = 10;
a = .05;
b = 1;
r = 1;
Trang 77
http://www.khvt.com
78
Chng 1 : iu khin ti u
Trang 79
80
Xt h v hng :
xk +1 = axk + buk
1
1 N 1
sN xN2 + qxk2 + ruk2
2
2 k =i
http://www.khvt.com
Chng 1 : iu khin ti u
Gi tr tun t sk (sN = 5)
li hi tip ti u Kk (sN = 5)
Trang 81
http://www.khvt.com
82
Chng 1 : iu khin ti u
Trang 83
84
J = ( 2 + 2 ) dt
0
+ =0
3. Pht biu nguyn l ti u ca Belman . Trnh by tng gii quyt bi
ton ti u ca phng php quy hoch ng .
4. Trnh by nguyn l cc tiu ca Pontryagin
5. Pht biu tiu chun n nh th hai ca Lyapunov .
6. ng dng Lyapunov trong bi ton LQR lin tc .
7. Tm im (x,y) thuc parabol :
y = x 2 + 3x 6
L( x, y ) = xy
vi iu kin rng buc : f ( x, y ) = 2 x + 2 y p = 0
b. Tm hnh ch nht c chu vi nh nht vi din tch cho trc l a 2 .
Ngha l cc tiu ho hm :
L ( x, y ) = 2 x + 2 y
Chng 1 : iu khin ti u
L=
1 T
x
2
1 0
1 T
0 2 x + 2 u
2 1
1 1 u
J = u 2 + u dt
2
vi cc iu kin u :
y (1) = y (1) = 0
y (1) = y (1) = 0
J = u 2 dt
0
vi x(0) = 0 v x(1) = 2 .
c. Tm qu o trng thi ti u .
12. Cho h thng :
xk +1 = xk uk + uk2
vi tn hao :
N 1
J 0 = xN2 + xk uk
k =0
86
Tm qu o pha ti u a h v gc to t mt im bt k .
14. Xt bi ton tc ng nhanh :
0
x= 2
1
0
x + u
0
1
u (t ) 1
a. Gii phng trnh bin trng thi. Dng nguyn l cc tiu Pontryagin
tm lut iu khin ti u .
b. V qu o pha cho trng hp u = 1 v u = -1 .
c. Tm phng trnh ng chuyn i .
15. Cho h thng :
x1 = x2
x2 = u
J=
1
x12 + 2vx1 x2 + qx22 + u 2 dt
2 0
vi q v 2 > 0 .
a. Tm li gii cho phng trnh Riccati i s .
b. Tm iu khin ti u v h thng vng kn ti u .
c. V qu o nghim s ca h thng khi q thay i t 0 n . Vi
gi tr no ca q th h thng n nh .
16. Cho h thng :
x1 = x2
x2 = ax1 2 x2 + u
1
J = 2 x12 + x22 + u 2 dt
20
http://www.khvt.com
Chng 1 : iu khin ti u
a. Tm li gii xk vi k = 0 ; 5 nu x0 = 3 .
b. Xc nh lut uk tn hao nng lng ti thiu a h thng t x0 = 3
v x5 = 0 . V qu o trng thi ti u .
c. Tm lut hi tip trng thi Kk ti u sao cho ch tiu cht lng J t
cc tiu :
4
Tnh hm tn tht J ti u vi k = 0 ; 5 .
18. Xt h ri rc :
xk +1 = axk + buk
J=
1
1 N 1
sN xN3 + ( qxk3 + ruk3 )
2
3 k =0
vi xk , uk l v hng .
a. Tm phng trnh trng thi , phng trnh bin trng thi v iu kin
tnh .
b. Khi no th ta c th tm c lut iu khin ti u uk . Vi iu kin
, hy kh uk trong phng trnh trng thi .
c. Tm li gii bi ton iu khin vng h ( trng thi cui xN c nh ,
sN = 0 , q = 0 ) .
Trang 87