• Increase font size
  • Default font size
  • Decrease font size

Kalman Filter implementation

Using processing I have implemented a 2D Kalman Filter java applet. Here are my personal notes gathered during the development:

Matrix A

State transition (n x n) matrix.

Matrix B

Control input (n x l) matrix.

Matrix C

Extraction matrix (m x n) to get the measurement from the data.

Matrix P

Covariacne matrix (n x n) of state x.

Can bez zero from the beginning, it will be computed by the KF algorithm.

Matrix Q

Action Uncertainty - co-variance matrix (n x n) of the process noise (error in process).

The KF works bad without that eg. when the matrix has all elements zeros.

Matrix R

Sensor Noise - co-variance matrix (m x m) of the measurement vector z.

The KF can not work without that eg when the matrix has all elements zeros.

Matrix K

A n x m matrix is a gain or blending factor that minimizes a posteriori estimate error co-variance P.


Vector x

State vector - n-dimensional.

Vector u

l-dimensional vector of control input

Vector z

Measurement vector - m-dimensional


Below you can see my implementation of the KF filter. The tank is driving in the circle. Green rectangle shows noisy measurements that the KF is getting and the blue rectangle represents position of the tank estimated by the KF. The true position is of course represented by the tank itself. Press the 'space' button to enable/disable measurement update of the KF. When the measurement update is disabled, only the prediction is taking place (no measurements are feeded into KF) and therefor you may watch how the blue rectangle is constantly moving in a direction although the tank is turning away.




0 #13 mama bear t shirt 2019-11-30 07:44
Highly descriptive post, I loved that a lot.
Will there be a part 2?
0 #12 Vincentcic 2019-08-25 12:08
Hi. Good Job!
0 #11 Vincentcic 2019-08-25 11:44
Hello. Good Job!
0 #10 uniiyogusih 2019-06-18 22:33
http://mewkid.net/buy-amoxicillin/ - Amoxicillin 500 Mg Amoxicillin Without Prescription gua.zwpo.concordia.sk.cta.uf http://mewkid.net/buy-amoxicillin/
0 #9 elaozajlusivf 2019-06-18 22:08
http://mewkid.net/buy-amoxicillin/ - Amoxicillin 500mg Capsules Amoxicillin 500mg Capsules tgm.znxj.concordia.sk.wlw.fc http://mewkid.net/buy-amoxicillin/
0 #8 egudoki 2019-06-07 19:53
http://mewkid.net/buy-amoxicillin/ - Amoxicillin 500mg Buy Amoxicillin Online ijs.ksoz.concordia.sk.crd.ty http://mewkid.net/buy-amoxicillin/
0 #7 foxivja 2019-06-07 19:25
http://mewkid.net/buy-amoxicillin/ - Amoxicillin 500 Mg Amoxicillin 500 Mg xmr.gmlt.concordia.sk.vua.ot http://mewkid.net/buy-amoxicillin/
0 #6 profile3942 2018-11-02 17:58
Need cheap hosting? Try webhosting1st, just $10 for an year.

0 #5 BestMckinley 2018-11-01 03:23
I have noticed you don't monetize your blog,
don't waste your traffic, you can earn extra cash every month.
You can use the best adsense alternative for any type of website (they approve
all websites), for more details simply search in gooogle: boorfe's tips monetize your website
0 #4 ahodenvgo 2018-10-24 14:13
http://doxycycline-cheapbuy.site/ - doxycycline-cheapbuy.site.ankor onlinebuycytote c.site.ankor

Add comment

No bad words.

Security code

Design by i-cons.ch / etosha-namibia.ch