Improved Kalman filter.