Kalman filter
Implicit extended Kalman filter.