Professional Documents
Culture Documents
Tom Tat LV THS Luu Van Quyen
Tom Tat LV THS Luu Van Quyen
------------------------------------
LU VN QUYN
S DNG B LC KALMAN
TRONG BI TON BM MC TIU
CHUYN NGNH: K THUT VIN THNG
Ms: 60.52.02.08
TM TT LUN VN THC S
H NI - NM 2013
M U
Vi s pht trin ca khoa hc k thut. Nhu cu s dng h thng nh v v
dn ng tr thnh mt nhu cu khng th thiu trong cuc sng ngy nay. T
ngun gc vic theo di bm st mc tiu hin i ngy nay l s kt hp ca cc
khoa hc k thut nhn dng mc tiu v phng php theo di i tng, bao gm
v tr, kch thc, hnh dng vn tc ca i tng. Bm mc tiu s dng cho nhiu
mc ch khc nhau nh v tinh gim st khng gian c s dng theo di cc
chuyn ng ca mc tiu nht nh.
Thi gian gn y vic ng dng b lc Kalman c lng qu o ca i
tng qua cc khung hnh c s dng nhiu trong cc thit b in t dn dng nh
Camera gim st, iu hng Robot, d tm mn, thit b kim tra hnh l. Cho n
nay c nhiu cng trnh nghin cu v lnh vc bm bt mc tiu trn c s x l
nh v cc thut ton bm theo i tng chuyn ng nh: So khp mu, Meanshift, Camshift, Particle, Kalman Mi phng php c cc u im v nhc im
khc nhau v cho hiu qu nht nh vi tng loi i tng v mc tiu theo di
khc nhau.
Ni dung ca lun vn c cu trc thnh cc phn nh sau:
Chng I. Tng qut v l thuyt bm mc tiu
Chng II. S dng b lc Kalman trong bi ton bm mc tiu
Chng III. V d minh ho
(1.1)
(1.2)
C ( s )
K ( s)
y (t ) H ( s ) u (t )
D( s)
(1.3)
J = 1dt = T
(1.6)
(1.7)
J = u 2 (t )dt
(1.10)
y = Cx
(1.11)
(1.12)
4
x&
(1.17)
0 ... 0 0
0
0 ... 0 M
dx 0
=
z+
u
M
M 0
dt M
a0 a1 an 1 1
y = (c%1 c%2 L c%n ) z
(1.18)
z
a
i tng
(1.17)
z
5
1.1.6 Bi ton tng hp h thng
Bi ton tng hp h thng l ton b qu trnh tnh ton, la chn b sung
thm cc khu ph hp vo h thng. h thng khi hot ng t c nhng
yu cu cht lng ra v sai lch, thi gian p ng qu .
(1.25)
y (t ) = C ' (t ) x(t )
(1.26)
1
TI s
TD s
u (t ) = k P [e(t ) +
1
de(t )
e( )d + TD
]
TI 0
dt
(1.28)
6
R ( s ) = k P [1 +
1
+ TD s]
TI s
(1.29)
(1.32)
min
(1.34)
p = arg min f ( p)
(1.36)
+
+
x&
System
L
+
x&
Observer
(1.38)
y = Cx
(1.39)
(1.43)
y = Cx
1
min J = xT Qx + u T Ru dt ,
20
(1.44)
Chn lut iu khin hi tip trng thi u = - Kx, K l hng s, thay vo biu
thc ca J
J=
1 T
x (Q + K T RK ) xdt
20
(1.45)
8
x& = Ax + Bu + w
(1.57)
y = Cx + v
(1.58)
x&n = An xn + Bnun
(1.62)
yn = Cn xn
Vi
(1.63)
ye = Ce xe
(1.72)
y = Cx + v
(1.73)
x&
x&
(1.74)
(1.75)
10
x = F x k 1
K k = Pk H T ( HPk H T + R )1
Pk = FPk 1 F T + Q
xk = xk + K k ( zk Hx
k )
Pk = ( 1 K k H )Pk
Thc cht ca gii thut Kalman tuyn tnh l mt phng php c tnh
quy tuyn tnh cho php c lng trng thi ca mt h thng c nhiu sao cho
lch gia gi tr c lng v gi tr thc t l b nht.
11
(2.1)
zk = Hxk + ek
(2.2)
(2.3)
(2.4)
(2.5)
(2.6)
(2.7)
(2.8)
(2.9)
12
- Tnh ton li mch lc Kalman:
K k = Pk ( Pk + R) 1
(2.10)
(2.11)
Pk = ( I K k ) Pk
k 1
v ma trn hip
( 2.35)
( 2.36)
13
Cn phi c lng phn phi xc xut c iu kin kt hp ca trng vecter
chuyn ng dk, trng phn on cng sk, v trng phn on i tng (hay
video) zk. Dng lut Bayes ta c:
p ( d k , sk , zk g k , g k 1 , g k +1 ) =
p ( d k , sk , g k , g k 1 , g k +1 )
p ( g k , g k 1 , g k +1 )
(2.37)
zk
gk-1, gk+1
sk
gk
Hnh 2.1 M hnh mng Bayes cho bi ton phn on video
M t h thng:
S h thng gim st mc tiu hnh 2.2. H thng gm tn hiu vo v b phn
pht hin, bm mc tiu v a ra kt qu hin th.
14
15
CHNG 3: V D MINH HO
3.1. Bi ton bm mc tiu
3.1.1 t vn .
Mt h thng bm mc tiu bng hnh nh l mt tp hp cc bi ton nh.
u vo ca h thng s l hnh nh thu c ti cc im quan st.
u ra ca h thng s l thng tin v chuyn ng ca cc i tng c
gim st
M hnh khi qut chung cho h thng bm mc tiu.
16
ng ca cc vt i tng trong cc khung hnh lin tip t d on hng chuyn
ng ca i tng.
Qu trnh ghi hnh c thc hin bng Webcam ca my Laptop thng qua chc
nng h tr Image Acquistion ca phn mm matlab v lu li vi dng .avi hoc
.mat. Sau s dng file ny input cho module nhn dng nh v bm theo vt mc
tiu c thc hin bng b lc Kalman
Chng trnh m phng qu trnh nhn dng v bm mc tiu thc hin theo lu
hnh 3.6.
17
18
Rt trch
c trng
D on
Tnh li Kalman
Hiu chnh
Kt thc
Y
Hin th
x$ k = F x$ k 1 ,
(3.1)
Pk = FPk 1 F T + Q .
li Kalman:
K k = Pk H T ( HPk H T + R )1 .
(3.2)
Bc hiu chnh:
x$ k = x$ k + K k ( zk H x$ k ) ,
Pk = ( I K k H )Pk .
(3.3)
19
Bc d on:
x$ k = x$ k 1 ,
(3.4)
Pk = Pk 1 + Q .
li Kalman:
K k = Pk ( Pk + R )1 .
(3.5)
Bc hiu chnh:
x$ k = x$ k + K k ( zk x$ k ) ,
(3.6)
Pk = ( I K k )Pk .
2L
x$ k = i =0 Wi ( m ) ( X k )i ,
P = i =0 Wi
2L
(c)
(3.7)
T
( X ) x$ k ( X ) x$ k .
k i
k i
(3.8)
Bin i Unscented:
( Z k )i = h(( X k )i ) , i = 0,...,2L
(3.9)
T
2L
Pz$ k z$ k = i =0 Wi ( c ) ( Z k )i z$ k ( Z k )i z$ k + R ,
(3.10)
2L
Px$ k z$ k = i =0 Wi ( c ) ( X k )i x$ k ( X k )i z$ k ,
(3.11)
li Kalman:
K k = Px$ k z$ k Pz$k 1z$ k .
(3.12)
Bc hiu chnh:
x$ k = x$ k + K k ( zk z$ k ) ,
(3.13)
Pk = Pk K k Pz$ k z$ k K kT .
(3.14)
20
Frame 72
Frame 81
Frame 93
Frame 125
Hnh 3.8: Kt qu bm mc tiu
21
Gi tr o lng thc t ti v tr i tng c biu din bi mt hnh ch
nht mu en trong khi mu xanh th hin cho d on v tr ca mc tiu. Ngoi ra
kch thc ng bao c th hin qua nh xm nn en, bng nh m mu xanh
bm theo ng bao.
T hnh 3.5 cho thy mch lc Kalman c th d on v nh hng chnh
xc cao. hnh ch nht mu xanh (d on) ph hp tng i chng kht vi hnh
mu en (o lng). Mch lc Kalman c p ng nhanh. iu ny c ngha l khi
i tng di chuyn th cho php o thay i t ngt.
Kt qu m phng ca phng php bm mc tiu s dng mch lc Kalman,
gi tr sai s c lng RMSE c tnh theo cng thc.
RMSE = MSE (GT ES )
n
MSE =
t =1
(GT E ) 2
n
(3.15)
(3.16)
22