Kalman filter
Robust extended Kalman filter.