Kalman Filters

8
Kalman filters, the unscented transform and particle filters Kalman Filters z -1 I C(n) Process Noise, v 1 (n) F(n+1,n) x(n) Measurement noise v 2 (n) Observati on y(n) Process Equation Measurement Equation Models the state x(n) as the output of a linear system excited by white noise v 1 (n) Relates the observable output of the system y(n) to the state x(n) 1 ( 1) ( 1, ) () () n n n n n x F x v 2 () ()() () n n n n y H x v Signal Model: Observation Model: The filtering problem is posed as follows – Using the set of observed data , to find for each the MMSE of the state vector , and then to estimate the clean signal from the signal model. 1 ( 1) ( 1, ) () () n n n n n x F x v n () (/ ) n n s Hx y 2 () () () n n n y s v n y 1 n ˆ x ˆ s s(n)

description

Kalman Filters. Observation y (n). x (n). Process Noise, v 1 (n). z -1 I. C (n). s (n). F(n+1,n). Measurement noise v 2 (n). Measurement Equation. Process Equation. Models the state x(n) as the output of a linear system excited by white noise v 1 (n). - PowerPoint PPT Presentation

Transcript of Kalman Filters

Page 1: Kalman Filters

Kalman filters, the unscented transform and particle filters

Kalman Filters

z-1I C(n)Process Noise, v1(n)

F(n+1,n)

x(n)

Measurement noise v2(n)

Observationy(n)

Process Equation Measurement Equation

•Models the state x(n) as the output of a linear system excited by white noise v1(n)

•Relates the observable output of the system y(n) to the state x(n)

1( 1) ( 1, ) ( ) ( )n n n n n x F x v 2( ) ( ) ( ) ( )n n n n y H x v

Signal Model: Observation Model:

The filtering problem is posed as follows – Using the set of observed data , to find for each the MMSE of the state vector , and then to estimate the clean signal from the signal model.

1( 1) ( 1, ) ( ) ( )n n n n n x F x v

n( ) ( / )n ns Hx y2( ) ( ) ( )n n n y s v

ny1n x

s

s(n)

Page 2: Kalman Filters

Kalman filters, the unscented transform and particle filters

Unscented Kalman Filters (motivation… where Extended Kalman filters fail)

•Nonlinear State Estimation

•Predicting state vector, •Kalman gain,•Predicting observation

•When propagating a GRV through a linear model (Kalman filtering), it is easy to compute the expectation E[ ]

•However, if the same GRV passes through a nonlinear model, the resultant estimate may no longer be Gaussian – calculation of E[ ] is no longer easy!

•It is in the calculation of E[ ] in the recursive filtering process that we now need to estimate the pdf of the propagating random vector

1( )

k k k x F x ,v( )k k ky H x ,n

F, H are (nonlinear) vector functions

1 1ˆ ˆ[ ( )]k k kE x F x ,v

ˆ ˆ[ ( )]k k kE -y H x ,n

ˆ ˆ ˆ( )]k k k k kK x x y y

Prediction of Innovationˆ kx

a Posteriori estimate

1

k k k kx y y yk P P

K

Page 3: Kalman Filters

Kalman filters, the unscented transform and particle filters

Unscented Kalman Filters (motivation… where Extended Kalman filters fail)

•Extended Kalman Filters (EKF) avoid this by linearizing the state-space equations and reducing the estimate equations to point estimates instead of expectations

•The covariance matrices (P) are computed by linearizing the dynamic equations

•In EKF, the state distributions are approximated by a GRV and propagated analytically through a ‘first-order linearization’ of the nonlinear system

- If the assumption of local linearity is violated, the resulting filter will be unstable

- The linearization process itself involves computations of Jacobians and Hessians (which is nontrivial for most systems)

1ˆ ˆ( )k k

x F x ,v

1ˆ ˆk k k k

x y y yk P P

K

ˆ ˆ( )k k k -y H x ,n

1 ,k k kA Bv x x k k kC Dn y x

Page 4: Kalman Filters

Kalman filters, the unscented transform and particle filters

The Unscented Transform

•Problem statement: developing a method for calculating the statistics of a random variable which has undergone a nonlinear transformation

•The intuition: It is easier to approximate a distribution than it is to approximate an arbitrary nonlinear transformation

•Consider a nonlinearity

•The Unscented transform chooses (deterministically) a set of ‘sigma’ points in the original (x) space which when mapped to the transformed (y) space will be capable of generating accurate sample means and covariance matrices in the transformed space

•An accurate estimation of these allows us to use the Kalman filter in the usual setup, with the expectation values being replaced by sample means and covariance matrices as appropriate

( )y g x

Page 5: Kalman Filters

Kalman filters, the unscented transform and particle filters

The Unscented Transform (illustration)

0.2812 0.0046

0.0046 0.2014

1.2692 0.0060

0.0060 0.8818

0.2709 0.0510

0.0510 0.1607Py

Px

Py_ut

Page 6: Kalman Filters

Kalman filters, the unscented transform and particle filters

Unscented Kalman Filters (UKFs)

•Instead of propagating a GRV through the “linearized” system, the UKF technique focuses on an efficient estimation of the statistics of the random vector being propagated through a nonlinear function

•To compute the statistics of , we ‘cleverly’ sample this function using ‘deterministically’ chosen 2L+1 points about the mean of x

•It can be proved that with these as sample points, the following ‘weighted’ sample means and covariance matrices will be equal to the true values

•We use this set of equations to predict the states and observations in the nonlinear state-estimation model. The expected values E[ ] and the covariance matrices are replaced with these sample ‘weighted’ versions.

( )y g x

0

( ( ) ) , 1, 2,....

( ( ) ) , , 1,....2

i x i

i x i L

x

x L P i L

x L P i L L L

Sigma Points

2

0

2

0

{ }{ }

, ( ), 0,1, 2....2

Lm

i ii

Lc T

y i i ii

i i

y W y

P W y y y y

where y g i L

( )

( ) 2

( ) ( )

1

1, 1,2,...., 2

2( )

mo

co

c mi i

WL

WL

W W i LL

Page 7: Kalman Filters

Kalman filters, the unscented transform and particle filters

Unscented Kalman Filters (UKFs)… Algorithm development

Eric A. Wan and Rudolph van der Merwe, “The Unscented Kalman Filter for Nonlinear Estimation”

Augment the state vector to include the process and measurement noise and initialize the mean and covariance matrix of the augmented vector.

Compute the sigma points about the previously estimated mean vector

Compute the predicted value of the state vector and cov. matrix at time k

Predict the current observation given previous observed samples (mapped from the sigma points)

Compute the innovations covariance matrix, cross correlation matrix and hence the Kalman gain and update the current estimate of the state at time k

Page 8: Kalman Filters

Kalman filters, the unscented transform and particle filters

Unscented Kalman Filters (UKFs) vs. Particle Filters (PFs)

•The unscented transformation in UKFs allows the calculation of accurate sample means and covariance matrices using a few ‘cleverly’ chosen samples

•Particle filtering employs Monte-Carlo techniques to obtain an estimate of the statistics of the propagated random vector

•The two techniques are very close conceptually

•There is a subtle difference : in UKF based implementations, the sigma points for sampling are deterministically chosen whereas in PF based techniques, the sampling itself is done randomly

•Particle Filtering is more accurate but this comes at the cost of complexity (introduced due to the need for Monte-Carlo simulations)

•The complexity of UKF based implementations is about the same as that of regular Kalman filters