Tuesday, November 10, 2015

Kalman Filter Understanding

I found a good way of thinking intuitively of Kalman Gain K. If you write K this way
 Kk=PkHTk(HkPkHTk+Rk)1=PkHTkHkPkHTk+Rk
you will realize that the relative magnitudes of matrices (Rk) and (Pk) control a relation between the filter's use of predicted state estimate (xk) and measurement (k).
 limRk0PkHTk HkPkHTk+Rk =H1k
 limPk0PkHTk HkPkHTk+Rk =0
Substituting the first limit into the measurement update equation
 x^k=xk+Kk(y~kHkxk)
suggests that when the magnitude of R is small, meaning that the measurements are accurate, the state estimate depends mostly on the measurements.
When the state is known accurately, then HPHT is small compared to R, and the filter mostly ignores the measurements relying instead on the prediction derived from the previous state (xk)

No comments:

Post a Comment