Extended Kalman Filter (EKF)

From GM-RKB
Jump to navigation Jump to search

An Extended Kalman Filter (EKF) is an kalman-like filter that linearizes about an estimate of the current mean and covariance.



References

2017a

2017b

  • (Wikipedia, 2017) ⇒ https://en.wikipedia.org/wiki/extended_Kalman_filter#Formulation Retrieved:2017-2-14.
    • In the extended Kalman filter, the state transition and observation models don't need to be linear functions of the state but may instead be differentiable functions. : [math]\displaystyle{ \boldsymbol{x}_{k} = f(\boldsymbol{x}_{k-1}, \boldsymbol{u}_{k-1}) + \boldsymbol{w}_{k-1} }[/math] : [math]\displaystyle{ \boldsymbol{z}_{k} = h(\boldsymbol{x}_{k}) + \boldsymbol{v}_{k} }[/math] Where wk-1 and vk are the process and observation noises which are both assumed to be zero mean multivariate Gaussian noises with covariance Qk and Rk respectively. uk-1 is the control vector.

      The function f can be used to compute the predicted state from the previous estimate and similarly the function h can be used to compute the predicted measurement from the predicted state. However, f and h cannot be applied to the covariance directly. Instead a matrix of partial derivatives (the Jacobian) is computed.

      At each time step, the Jacobian is evaluated with current predicted states. These matrices can be used in the Kalman filter equations. This process essentially linearizes the non-linear function around the current estimate.

2000

1997