Kalman filter block diagram