PENGANTAR
Rudiyanto dan Budi Indra Setiawan
Departemen Teknik Pertanian
Institut Pertanian Bogor
Bogor, 3 Mei 2007
Interface (ADC)
Pressure transducer
Komputer
Mengukur
FILTER KALMAN
Rudiyanto dan Budi Indra Setiawan
Departemen Teknik Pertanian
Institut Pertanian Bogor
Bogor, 3 Mei 2007
Observasi (pengukuran)
yt x1 t x 2 t
Observasi {y(t0),..y(t)};
Jika t1<t Interpolation (smoothing)
Jika t1=t Filtering mengurangi noise
Jika t1>t Prediction
Kalman Filter
1
1 n 1
x 1 x 2 x 3 ... x n 1
xk
n 1
n 1 k 1
1 n 1
n 1 n
1
k
k
n 1
n 1 k 1
n 1 n k 1
n
n
1
x
n
n 1
n 1
n
1
x n 1 n
n
n 1
n K x n 1 n
Dimana K = 1/(n+1)
n 1 n Kx n 1 n
Varians [2]
2
2 1
x* 1
1 22
2
1
1
1 2
2
2
x * x 1 Kx 2 x 1
12
K 2
2
1 2
Varian Gabungan
x * x 1 Kx 2 x 1
gab
1 2
2
2
1 2
2
gab 2 1 K 1 2
12
K 2
1 22
gab 1 K 1
2
1 2
2
Pada awal proses, buatlah taksiran yang jitu atas nilai vektor
keadaan x0|0 dan matrix kovarians P0|0. Nyatakan k = 1. Selanjutnya
untuk tiap saat k, kerjakan hitungan di bawah ini sampai semua data
telah terproses:
Prediksi:
[1]. Hitung xk|k-1 = Ak xk-1|k-1 + Bk uk
[2]. Hitung Pk|k-1 = Ak Pk-1|k-1 AkT + Qk
Inovasi:
[3]. Hitung yk = zk Hk xk|k-1
[4]. Hitung Sk = Hk Pk|k-1 HkT + Rk
[5]. Hitung Kk = Pk|k-1 HkT Sk-1
Estimasi:
[6]. Hitung xk|k = xk|k-1 + Kk yk
[7]. Hitung Pk|k = (I Kk Hk) Pk|k-1
Implementasi
A=1
H=1
Pustaka
R
R
R i 1
1 N
2
z k x k
N k 1
R
Ri
1 N
z k x k 2
N k 1
R
R
R i 1
2
Ri
H
Pustaka
Next