Kalman filter control